Repository navigation
feat(fisheye): 鱼眼标定参数随附标定分辨率(协议 V2.10) - #34
Merged
Merged
Conversation
腕部鱼眼默认分辨率由 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>
…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>
This was referenced Nov 20, 2026
Merged
This file contains hidden or bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
Sign up for free
to join this conversation on GitHub.
Already have an account?
Sign in to comment
Add this suggestion to a batch that can be applied as a single commit.This suggestion is invalid because no changes were made to the code.Suggestions cannot be applied while the pull request is closed.Suggestions cannot be applied while viewing a subset of changes.Only one suggestion per line can be applied in a batch.Add this suggestion to a batch that can be applied as a single commit.Applying suggestions on deleted lines is not supported.You must change the existing code in this line in order to create a valid suggestion.Outdated suggestions cannot be applied.This suggestion has been applied or marked resolved.Suggestions cannot be applied from pending reviews.Suggestions cannot be applied on multi-line comments.Suggestions cannot be applied while the pull request is queued to merge.Suggestion cannot be applied right now. Please check back later.
背景
从 #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 passedpytest python/tests -q:162 passed, 2 skippedruff 0.16.8 check/format --check:通过注意
依赖固件 1.2.8 / 1.2.18 才能写入非 640x480 的标定;旧固件下行为不变。合并后 #32 中本人的部分可视为已替代,#32 是否关闭由作者决定。
更新(2026-11-19)
82bbf7f,含 feat(force-position): 夹持意图 set_target(..., grip=True),目标落在物体表面也锁存到预算 #33 夹持意图、test(force-position): 字段清单补上刹车/起步加速度参数 #35、力位控制改进 + 高频 IMU 候选 + 从爪交换合并发送 #36 力位刹车/高频 IMU)。只有 CHANGELOG 冲突,两段都保留。e1a3eae):真机上旧固件的探测会抛异常。 固件把处理函数的错误都走 cmd=0 的 NACK 路径,send_cmd抛NackError,InvalidParam = 不支持、CalNotSet = 未标定两个分支在真机上走不到。实测 1.2.17 从爪 0016s:supports_fisheye_size()抛NACK: InvalidParam,resolve_fisheye()因此静默改用 SDK 参考内参,丢掉设备烧录的标定。修复后读到设备标定,按主点推断为 640x480。C++ 与 Python 两个假设备原先都用回显 cmd 的方式回错误,所以测试是绿的;已改成与固件一致(不带修复时 10 个 C++ 用例失败)。9fc8401:假设备的旧固件对 37 字节op=0x03回LengthMismatch(与 1.2.17 实测一致)。2cbe2ce:高频 IMU 配套固件顺延为 1.2.9 / 1.2.19,1.2.8 / 1.2.18 定给本功能。protocol mirror失败是 CI 缺 token,不对:它失败是因为固件主干还没有 V2.10 符号。tc-gu-01 Ship EL05 motor firmware in firmware/; English-only source #28 合并(b9656f5)后这项已通过。真机(本分支)
op=0x01作废分辨率、断 24V 后记录保留,均通过。force_position_control.py5/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