4.5 KiB
手部标定
这个仓库有两套标定,都在界面里操作。URDF 标定量出关节行程,并写出一份新的 URDF。行程标定量出每条指令实际能到达的范围,并写出结果文件。
先做完「准备」,再按对应的步骤启动。下面的命令都在仓库根目录、已经 source 过 ROS 2 的终端里执行。
准备
- 安装界面依赖:
pip install numpy scipy pyyaml PyQt5
- 编译相机包并 source 本仓库:
colcon build --packages-select camera_parameters
source install/setup.bash
- 把下面三个文件里的
setup改成这台机器上的路径:
src/urdf_calibration/hands/o30/config.yaml:O30 驱动的install/setup.bash,已 source 驱动时可以留空src/range_calibration/hands/o30/config.yaml:同一份 O30 驱动src/camera_parameters/config/cameras.yaml:能启动海康相机的setup.bash
-
三台相机的内外参放在仓库根目录
output_camera/。行程标定使用其中时间最新的一份;URDF 标定使用原产品配置指定并通过 SHA256 校验的外参。 -
填写工装位置:
- URDF 标定:按照
src/urdf_calibration/hands/o30/docs/中的原项目要求布置贴纸和相机;当前原实现不使用此前简化实现的工装变换配置。 - 行程标定:在
src/range_calibration/hands/o30/config.yaml里把fixture_from_hand_base_link和front_from_fixture改成这套工装的实测值。
URDF 标定
已按原项目实现迁入 src/urdf_calibration。公共代码在 calibration/,图形入口在 gui/,型号配置、业务及源 URDF 在 hands/。原项目 ROS 包名仍为 linkerhand_calibration。
source /opt/ros/jazzy/setup.bash
colcon build --packages-select camera_parameters linkerhand_calibration
source install/setup.bash
PYTHONPATH=src/urdf_calibration${PYTHONPATH:+:$PYTHONPATH} python3 -m gui
界面选择型号和左右手后,可以先点「检查配置(不启动设备)」,再点「开始标定」。原流程负责拉起 SDK、相机、检测和运动,界面显示运行日志并可停止。各型号 config.yaml 的 setup 留空时使用当前终端环境。已有完整产品配置的型号是 O30、O12、O6、L6、G20 右手,其他侧的 URDF 作为源资源保留。
也可以只检查 O30 配置:
PYTHONPATH=src/urdf_calibration${PYTHONPATH:+:$PYTHONPATH} python3 -m calibration.session.runner \
--config src/urdf_calibration/hands/o30/product.yaml --validate-only
标定结果在 output_urdf_calibration/,原始 URDF 在 hands/<型号>/urdf/。O30 原默认配置先在线采集,再离线拟合;采集完成不代表精度通过或 URDF 已发布。相机参数从 output_camera/ 读取,并保持原项目产品配置的外参 SHA256 和内参指纹校验。换外参需要同步更新产品配置。
完整说明见 URDF 标定说明,复制来源和原始文件指纹见 src/urdf_calibration/migration_manifest.json。此次用原项目实现替换了此前的简化算法和滑块式 URDF 标定界面。
行程标定
- 启动界面。窗口打开后会拉起三台相机和贴纸检测。顶部显示「相机没有拉起」时,回到准备第 3 步检查相机的
setup。
PYTHONPATH=src/range_calibration python3 -m gui
-
型号选 O30,选左手或右手,点「连接」。连接成功并收到关节反馈后,滑块和标定按钮才可用。
-
先保存全手基础姿态。拖动滑块把整只手摆到基础位置,等运动完成、反馈稳定。下拉框选「全手基础姿态」,点「保存当前已到达姿态」。状态变成「所需示教已完成」后才能开始。避让姿态已经写在型号配置里,保存基础姿态即可。
-
点「开始标定」,按顺序测完全部任务。只重测一项时,在下拉框里选中该任务,点「试标定 / 重测所选任务」。
-
扫描过程中可以点「暂停」。点「继续(重做当前任务)」会把当前这项重新测一遍。点「取消 / 保持目标」会停在当前目标。
-
完成后,界面下方会显示结果目录,文件在
output_range_calibration/。表格里「指令曲线」是这次记下的指令。关掉窗口后,这次拉起的相机和驱动会一起退出。
「下发行程偏移到设备」只接受旧的 min/max 结果。这次写出的曲线文件交给嵌入式烧录。「清除行程偏移」会把设备上的偏移恢复成每个关节 0~255。