桌面整理赛题经验与踩坑记录

7k1k 队员 2026-01-20 13:10:50

千寻机器人本体状态读取和命令发送失败：

通过阅读官方SDK文档以及example示例，尝试通过 robot.capture_observation() 读取机器人本体的笛卡尔位置以及关节位置的状态信息。但在开始读取时遇到了如下问题：首先在确认observation的key无误的情况下，读取的右臂关节位置数据无效且只有六个关节输出导致无法对齐，左臂同理。

问题发生原因如下：由于在读取文档的时候发现，千寻机器人的config配置中 structure 可以设为 dualarm 或 wholebody。由于当前操作任务只需移动双臂，因此在初始化配置过程中设置为 structure="dualarm" 。

在 MozRobot SDK 的定义中，dualarm 模式很可能是针对老款或特定构型的 6自由度 机械臂定义的。因此，SDK 在接收到底层数据流时，只截取了前 6 个浮点数作为关节数据。左臂读出了 4个数值，且数值巨大（如 -365.9711），左臂笛卡尔位置全为 0。这是典型的 字节对齐偏移 (Byte Alignment/Offset Issue)。机器人底层发送的数据包通常是连续的二进制流（例如：[右臂7个float][左臂7个float]...）。因为 SDK 错误地以为右臂只有 6 个 float，它读完前 6 个后，把第 7 个数据的一半或者下一个数据的头部当成了左臂的数据开始。这就导致了后续所有数据的读取都发生了错位，解析出来的 float 值自然就是无意义的乱码

最终将config中的structure设置为“wholebody”，解决了问题