机器人看到的世界通常不是一张统一的坐标纸。底盘、相机、雷达和地图各有自己的坐标系。处理一个点之前,先写清楚它相对于哪个坐标系。
常见坐标系
base_link:固定在机器人本体上,描述传感器或部件相对底盘的位置。odom:用于描述一段时间内连续的运动估计;误差会逐渐累积。map:用于表达地图中的位置;定位更新可能修正它与里程计坐标系之间的关系。camera、laser:传感器自身的参考系。具体轴方向应以设备约定为准。
这些名字是常见约定,不代表所有项目都完全相同。读数据时仍要看消息中的坐标系字段和系统配置。
二维位姿如何变换
二维平面中,位姿可写作 (x, y, θ)。把传感器坐标系中的点 (px, py) 变换到底盘坐标系,需要知道传感器相对底盘的平移 (tx, ty) 和旋转 θ:
x_base = cos(θ) × px - sin(θ) × py + tx
y_base = sin(θ) × px + cos(θ) × py + ty
注意顺序:先旋转,再平移。反向变换不能只把平移取负,还需要考虑旋转。多个变换串联时,顺序也不能随意交换。
排错时检查什么
- 点和变换的源坐标系、目标坐标系是否写反。
- 角度使用弧度还是度;三角函数通常接收弧度。
- 变换对应的时间是否与传感器数据时间一致。
- 传感器的安装方向、左右手系约定是否正确。
最简单的验证方法是在纸上放一个已知点,例如传感器正前方 1 米处,手算预期位置,再与程序输出比较。
还没有评论,欢迎提出第一个问题。