镜像自地址
https://github.com/MINT-SJTU/Evo-RL.git
已同步 2026-11-20 18:17:06 +00:00
97 行
3.3 KiB
Python
97 行
3.3 KiB
Python
#!/usr/bin/env python
|
|
|
|
# Copyright 2026 The HuggingFace Inc. team. All rights reserved.
|
|
#
|
|
# Licensed under the Apache License, Version 2.0 (the "License");
|
|
# you may not use this file except in compliance with the License.
|
|
# You may obtain a copy of the License at
|
|
#
|
|
# http://www.apache.org/licenses/LICENSE-2.0
|
|
#
|
|
# Unless required by applicable law or agreed to in writing, software
|
|
# distributed under the License is distributed on an "AS IS" BASIS,
|
|
# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
|
# See the License for the specific language governing permissions and
|
|
# limitations under the License.
|
|
|
|
from dataclasses import dataclass, field
|
|
|
|
from lerobot.cameras import CameraConfig
|
|
|
|
from ..config import RobotConfig
|
|
|
|
|
|
@dataclass
|
|
class PiperFollowerConfigBase:
|
|
"""Configuration for a Piper follower arm controlled over CAN."""
|
|
|
|
# CAN interface name (e.g. "can0")
|
|
port: str
|
|
|
|
# Piper SDK connection options
|
|
judge_flag: bool = False
|
|
can_auto_init: bool = True
|
|
log_level: str = "WARNING"
|
|
startup_sleep_s: float = 0.1
|
|
|
|
# Motion mode for follower arm
|
|
speed_ratio: int = 100
|
|
high_follow: bool = True
|
|
mode_refresh_interval_s: float = 1.0
|
|
|
|
# Arm enable behavior
|
|
enable_on_connect: bool = True
|
|
enable_timeout_s: float = 3.0
|
|
|
|
# Calibration precision:
|
|
# homing_offset/range_min/range_max are stored as "degree * calibration_scale".
|
|
calibration_scale: int = 1000
|
|
# Whether calibration is required on connect when no calibration file exists
|
|
require_calibration: bool = True
|
|
|
|
# Gripper forwarding behavior
|
|
sync_gripper: bool = True
|
|
gripper_effort_default: int = 1000
|
|
gripper_status_code: int = 0x01
|
|
|
|
# Optional cameras
|
|
cameras: dict[str, CameraConfig] = field(default_factory=dict)
|
|
|
|
# Safety behavior on disconnect
|
|
disable_on_disconnect: bool = False
|
|
|
|
|
|
def _validate_piper_follower_config(config: PiperFollowerConfigBase) -> None:
|
|
if not (0 <= config.speed_ratio <= 100):
|
|
raise ValueError("`speed_ratio` must be between 0 and 100.")
|
|
if config.mode_refresh_interval_s < 0:
|
|
raise ValueError("`mode_refresh_interval_s` must be >= 0.")
|
|
if config.enable_timeout_s < 0:
|
|
raise ValueError("`enable_timeout_s` must be >= 0.")
|
|
if config.calibration_scale <= 0:
|
|
raise ValueError("`calibration_scale` must be > 0.")
|
|
if not isinstance(config.require_calibration, bool):
|
|
raise ValueError("require_calibration must be true or false.")
|
|
if config.startup_sleep_s < 0:
|
|
raise ValueError("`startup_sleep_s` must be >= 0.")
|
|
if not (0 <= config.gripper_effort_default <= 5000):
|
|
raise ValueError("`gripper_effort_default` must be between 0 and 5000.")
|
|
if config.gripper_status_code not in {0x00, 0x01, 0x02, 0x03}:
|
|
raise ValueError("`gripper_status_code` must be one of 0x00, 0x01, 0x02, 0x03.")
|
|
|
|
|
|
@RobotConfig.register_subclass("piper_follower")
|
|
@dataclass
|
|
class PiperFollowerConfig(RobotConfig, PiperFollowerConfigBase):
|
|
def __post_init__(self):
|
|
super().__post_init__()
|
|
_validate_piper_follower_config(self)
|
|
|
|
|
|
@RobotConfig.register_subclass("piperx_follower")
|
|
@dataclass
|
|
class PiperXFollowerConfig(RobotConfig, PiperFollowerConfigBase):
|
|
def __post_init__(self):
|
|
super().__post_init__()
|
|
_validate_piper_follower_config(self)
|