Skip to content

feat(fisheye): 鱼眼标定参数随附标定分辨率(协议 V2.10) - #34

Merged
Vertax42 merged 5 commits into
mainfrom
fix/fisheye-cal-resolution-solo
Nov 19, 2026
Merged

Vertax42 merged 5 commits into
mainfrom
fix/fisheye-cal-resolution-solo

Conversation

@Vertax42

@Vertax42 Vertax42 commented Nov 19, 2026 •

Copy link
Copy Markdown
Collaborator

背景

从 #32 单独拆出。#32 的 9 个提交里只有这一条是鱼眼标定的改动,另外 8 条是同事还没合并的力位 / 高频 IMU 工作(main-0.4.6-fp-brake-imu-high-rate),#32 的 Python 测试失败(test_force_position_config_has_exactly_the_declared_fields)来自那 8 条。本 PR 只基于 main。

改了什么

腕部鱼眼默认从 640x480 改为 1920x1080,两种分辨率是不同的传感器裁切,内参不能互相缩放。固件主爪 1.2.8 / 从爪 1.2.18(命令集 V2.10)在 8 个参数旁边存下标定分辨率;SDK 增加带分辨率的读写与能力探测,旧固件按“分辨率未知”处理并只接受 640x480。详见 CHANGELOG [Unreleased]。

冲突处理

  • CHANGELOG.md:只保留本条,去掉同事分支的 “High-rate IMU” 段。
  • python/examples/_rerun.py 的 open_wrist:合并 main 的 82bf9ac(不去畸变时按相机最大 MJPG 尺寸打开,1080p 腕部相机不再被压成 640x480)与本提交(去畸变时按标定分辨率打开)。去畸变时如果显式传了与标定不同的 --wrist-width/--wrist-height,会打警告并以标定分辨率为准。

验证(本地,按 CI 同款命令)

  • cmake --build build:通过
  • taccap_unit_tests:583 passed
  • pytest python/tests -q:162 passed, 2 skipped
  • ruff 0.16.8 check / format --check:通过

注意

依赖固件 1.2.8 / 1.2.18 才能写入非 640x480 的标定;旧固件下行为不变。合并后 #32 中本人的部分可视为已替代,#32 是否关闭由作者决定。

更新(2026-11-19)

真机(本分支)

  • 从爪 0016s,1.2.17:探测返回 False,读到设备标定(分辨率推断 640x480)。
  • 从爪 0016s,1.2.18(tc-gu-01 Ship EL05 motor firmware in firmware/; English-only source #28):带分辨率读写、固件侧拒绝、op=0x01 作废分辨率、断 24V 后记录保留,均通过。
  • main 的力位控制改动:force_position_control.py 5/5;0.2↔0.8 往返 10 次纹波 4.2%、均速/命令 101%、反向帧 0;grip=True 空夹越过目标 0.044 试探后回到目标保持,符合设计。

本地:C++ 623 passed,Python 166 passed / 2 skipped,ruff 通过。

🤖 Generated with Claude Code

腕部鱼眼默认分辨率由 640x480 改为 1920x1080;两者是传感器的不同取景范围(4:3 / 16:9),
内参不能互相缩放。主爪 1.2.8 / 从爪 1.2.18(命令集 V2.10)在 0x2B 上新增 op 0x02/0x03,
随参数读写标定分辨率;SDK 对应支持如下。

- 协议层:CAMERA_FISHEYE_CAL_OP_READ_SIZED/_OP_WRITE_SIZED/_SIZED_SIZE、CameraFisheyeCalSized、
  encode_camera_fisheye_cal_{read,write}_sized()、decode_camera_fisheye_cal_sized()。
  check_protocol_drift.py 新增 CONSTANT_MAP,对比 0x2B 的 op 与长度常量。
- Calibration:supports_fisheye_size()(以 0x02 探测,旧固件回 InvalidParam;结果按实例缓存,
  传输失败不缓存)、read_fisheye_record()、write_fisheye_sized()(先做与固件相同的合理性检查;
  旧固件只接受 640x480 并回退到 0x01,其它分辨率报错要求升级固件)。read_fisheye/write_fisheye 不变。
- FisheyeCalRecord、fisheye_cal_size_plausible()、infer_fisheye_cal_size()(候选仅 640x480 与
  1920x1080,主点在各轴 10% 内且唯一匹配才返回;与 PC 工具共用此规则)。
- ResolvedFisheyeCal 新增 calibrated_size / size_inferred;resolve_fisheye() 用记录的分辨率,
  未知时推断并告警,推断不出则回退参考值(640x480)。
- FisheyeUndistorter 新增 (cal, calibrated_size, frame_size, balance) 构造,两者必须相等;
  原 (cal, size, balance) 构造不变(按 640x480)。install_wrist_undistorter 按标定分辨率构建。
- Python 绑定同名暴露;resolve_fisheye() 改为返回 ResolvedFisheyeCal,仍可按原三元组解包;
  FisheyeUndistorter 增加 calibrated_size=(w, h) 关键字。
- 示例:fisheye_cal.py set-fisheye 需 --width/--height 并用 write_fisheye_sized,show 显示分辨率
  及其来源;read_intrinsics.py、wrist_camera.py、rerun 查看器按标定分辨率工作。文档与 CHANGELOG 同步。

测试:假从爪固件支持 0x02/0x03 并可切换为旧固件行为;新增编解码、探测、读写回退、拒绝、推断、
resolve 与构造函数测试。C++ 609/609 通过;Python 161 通过、2 跳过、1 失败(
test_force_position_config_has_exactly_the_declared_fields,基线 fe7771b 即失败,与本修改无关)。
check_protocol_drift.py --firmware tc-gu-01@6a41bc3 通过。

从 #32 单独拆出:只基于 main,不带同事未合并的力位 / 高频 IMU 提交。
解决两处冲突:CHANGELOG 只保留本条;_rerun.py 的 open_wrist 合并 main
的「按相机最大 MJPG 尺寸打开 1080p 腕部相机」与本提交的「去畸变时按标定分辨率打开」。

Co-Authored-By: Claude Opus 5.5 <noreply@anthropic.com>
Vertax42 and others added 4 commits November 19, 2026 18:54
…ion-solo

CHANGELOG [Unreleased] 两边都保留:鱼眼标定分辨率在前,夹持意图与高频 IMU 在后。

Co-Authored-By: Claude Opus 5.5 <noreply@anthropic.com>
固件对处理函数的所有错误都走 cmd=0 的纯 ACK 路径(protocol_handler.c),
send_cmd 会把它抛成 NackError,于是 read_fisheye_sized_ 里"InvalidParam =
不支持"、read_fisheye 里"CalNotSet = 未标定"这两个分支在真机上都走不到。

实测 1.2.17 从爪 0016s:supports_fisheye_size() 抛 "NACK: InvalidParam";
resolve_fisheye() 因此静默回退到 SDK 参考内参(is_reference=True),设备烧录
的标定被丢弃。修复后读到设备标定,按主点推断为 640x480。

PTY 测试原先是绿的,因为 C++ 与 Python 两个假设备都用回显 cmd 的方式回错误。
两边都改成与固件一致的 cmd=0 NACK;不带本修复时 C++ 有 10 个用例失败。

Co-Authored-By: Claude Opus 5.5 <noreply@anthropic.com>
1.2.8 / 1.2.18 已定给鱼眼标定分辨率(协议 V2.10,tc-gu-01 #28)。

Co-Authored-By: Claude Opus 5.5 <noreply@anthropic.com>
与 1.2.17 实测一致:旧命令表把 0x2B 载荷限制在 33 字节,op=0x03 在处理函数之前
就被拒绝;只有 op=0x02 回 InvalidParam。SDK 以 op=0x02 探测,行为不受影响。

Co-Authored-By: Claude Opus 5.5 <noreply@anthropic.com>
@Vertax42
Vertax42 merged commit 0da6efa into main Nov 19, 2026
5 of 6 checks passed
@Vertax42
Vertax42 deleted the fix/fisheye-cal-resolution-solo branch November 19, 2026 11:43
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment

Labels

None yet

Projects

None yet

Development

Successfully merging this pull request may close these issues.

1 participant