Files
a7l20-hug-sim/docs/left_hand_fist_restore.md

3.0 KiB
Raw Permalink Blame History

左手握合与恢复:JSON查表和诊断日志

入口:scripts/left_hand_fist_restore.py,使用 $RETARGET_PYTHON。 默认仅离线加载标定表,--execute才打开can0并控制左手0x28。 不连接机械臂,不写使能、速度、扭矩或工厂校准设置。

--open --execute为只张开模式:按JSON的zero_command_u8伸直root/tip, 保留侧摆/对掌,成功后保持张开,不执行握合或返回弯曲原位。 09-27授权实测 --open --seconds 16 --execute 通过,日志 data/left_hand_open_q10r1mak/,最大到位误差5计数;不代表握合已验证。

标定表

默认 assets/L20/LEFT/g20_left_G20.json。 要求schema v4、LEFT G20、16主动+5被动关节、每关节256点。 指令和反馈角度均按angle_rad原表查找,不用SDK线性范围替代。 角度反查采用最接近的实测点;越界请求直接拒绝。zero_angles偏置不重复叠加。 被动关节由其驱动电机查表推算,不是假称独立传感器测量。 文件声明的序列号会记录,但并未读取实机序列号验证对应关系。

尤其注意JSON命名:motor5=thumb_cmc_roll、motor10=thumb_cmc_yaw, 与旧手部映射中的拇指roll/yaw命名不同。本次仅修本入口,不迁移整个抓取链。

运动范围

只改root/tip槽位,侧摆、拇指对掌和预留字节保持。 标称目标:拇指根/末端0.70/1.0rad,其余1.2/0.95rad; 实际预设不超过各自表内行程85%,避免因新表范围缩小而靠近端点。 当前已更弯的关节保持原值。每步最多2计数、至少50ms间隔,默认每段至少8秒。 这是指令推进节奏,不是经过标定的物理速度保证。 跟随偏差18计数、侧摆8计数及到位8计数门限未放宽。

每次运行的日志

独立目录 data/left_hand_fist_*/:

  • calibration_used.json:本次完整JSON快照;路径/SHA256/声明序列号写入结果。
  • events.jsonl:UTC与单调时钟时间、阶段与步号、逐帧发送前/后记录、 逐指查询和回复、CAN时间戳、完整目标/反馈字节、16个主动关节名称、 CAN属性/槽位、原始计数误差及查表弧度/角度误差;21关节反馈解释含被动估计标记。
  • result.json:原位/目标、最终状态、最后指令与反馈、具体异常关节与触发上下文; 运行前和失败后的速度/故障查询原始值,以及保持指令是否发送。

正常完成合拢→停1秒→恢复本次启动时读到的位置。 不会自动恢复到此前失败运行的原位。故障或中断只尝试保持新鲜反馈位置, 不盲目返回;断电/断线时不保证停止或恢复。 单次门限仍可能因真实滞后触发;本次补日志和查表不是完整跟随控制器修复。 速度/故障码只记录,不自动清故障或调整参数。

离线验证

tests/test_left_hand_fist_restore.py使用模拟CAN,不访问硬件; 覆盖查表、全主动表点往返、左右表误用拒绝、目标槽位保持、 正常恢复、完全受阻、延迟跟随及反馈超时的错误上下文。