#!/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)