feat(piper): add calibration-driven leader/follower mapping

- add calibration_scale config and validation for piper leader/follower

- implement interactive calibration capture and calibrated offset conversion

- require calibration before action/feedback paths and update teleop tests
这个提交包含在:
Elvin
2026-03-05 21:09:46 +08:00
父节点 df08db9005
当前提交 422f5c50e7
共有 5 个文件被更改,包括 273 次插入 和 28 次删除

查看文件

@ -46,6 +46,10 @@ class PiperFollowerConfigBase:
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
# Gripper forwarding behavior
sync_gripper: bool = True
gripper_effort_default: int = 1000
@ -69,6 +73,8 @@ class PiperFollowerConfig(RobotConfig, PiperFollowerConfigBase):
raise ValueError("`mode_refresh_interval_s` must be >= 0.")
if self.enable_timeout_s < 0:
raise ValueError("`enable_timeout_s` must be >= 0.")
if self.calibration_scale <= 0:
raise ValueError("`calibration_scale` must be > 0.")
if self.startup_sleep_s < 0:
raise ValueError("`startup_sleep_s` must be >= 0.")
if not (0 <= self.gripper_effort_default <= 5000):