![[具身智能-816]：SLAM 建图的绝对位置、参考原点、是否需要标定？](http://pic.xiahunao.cn/yaotu/[具身智能-816]：SLAM 建图的绝对位置、参考原点、是否需要标定？)
SLAM 建图的绝对位置、参考原点、是否需要标定核心结论Gmapping / Cartographer 这类激光 SLAM 生成的栅格地图本身没有现实世界的 GPS 绝对坐标。地图只有一套相对坐标系原点是机器人开机建图瞬间的位置不会自动对齐大楼、大地真实坐标如果业务需要真实绝对位置就必须额外做标定。1、SLAM 地图坐标原点怎么来的相对坐标在建图程序启动那一刻机器人当前所在的位置自动被定义为地图坐标系的原点map (0,0,0)朝向为 0°。机器人往前跑坐标 x 增大向右跑 y 增大旋转角度 θ 变化。整张地图上所有墙、障碍物的坐标全部是相对于开机起点的相对坐标。SLAM 算法只关心物体之间互相的距离、相对位置关系它不知道这个原点对应现实世界大楼的哪个角落不知道经纬度。举例子 开机建图小车放在机房门口这一刻 → map (0,0)。小车行驶到机柜旁边地图上机柜坐标 map (2.5,1.2)。 这个(2.5,1.2)只代表机柜距离开机起点 X 方向 2.5 米Y 方向 1.2 米不代表大地坐标系下的真实地理坐标。通俗类比 你拿本子画房间平面图你站的位置定为本子的 (0,0)画出家具之间的相对位置但本子上不会自动标记这个房间在城市的哪个经纬度。2、什么时候不需要标定参考位置绝大多数室内机器人场景只使用地图内部相对坐标不需要绝对位置不用标定。 适用场景室内巡逻、AGV 搬运、定点巡检导航只关心机器人在地图里面相对于地图原点的 (x,y,θ)导航路径点也写在这套 map 坐标系下。工作逻辑 建图时我在地图上手动标记巡检点 A (1.0,2.0)、巡检点 B (5.0,3.0)机器人后续只需要跑到这张图内部的这些相对坐标点即可。不需要和 GPS、大楼 CAD 世界坐标对齐。这是机器人室内项目最常见的模式绝大多数 ROS 小车都是这么干的。3、什么时候必须标定获得绝对位置当需要把 SLAM 地图坐标对齐到外部绝对坐标系就必须人工标定。典型需求需要输出 GPS 经纬度把机器人位置上传到后台 GIS 地图需要和建筑 CAD 图纸坐标完全对齐多台机器人共用同一套全局大地坐标系室外场景SLAM 局部地图融合 GPS 全局坐标。标定的本质求解一组坐标变换map坐标系 ↔ 大地/GPS/CAD绝对坐标系得到旋转、平移参数。 常用两种标定手段人工选特征点标定最常用室内在真实环境找 2 个以上明显标记点柱子、墙角。测量该墙角在现实 CAD/GPS 里面的真实绝对坐标在 SLAM 地图读取同一个墙角的 map 相对坐标算法解算平移、旋转矩阵完成两套坐标系的对齐。后续机器人输出位置就可以换算成绝对坐标。GPS 辅助标定室外机器人在建图时同时记录 GPS 位置把 SLAM 局部坐标系和 GPS 坐标系做融合得到绝对位姿。室内 GPS 失效该方案不可用。⚠️注意标定只是增加一套坐标转换不会修改 SLAM 栅格地图本身。地图内部障碍物相对关系不变只是多一层换算公式。4、一个非常容易踩的工程坑每次重新启动 SLAM 建图原点会变你把小车挪到同一个物理地点重新启动 gmapping/cartographer 建图 新地图的 map (0,0) 是这次开机的位置和上一次建图的原点完全不一样。两次建图得到两张地图里面同一个机柜在两张图的 map 坐标数值完全不同。如果没有做坐标标定两张地图的坐标不能直接混用。解决办法建图完成后保存地图文件后续只进入定位模式不再重新建图原点就固定不变如果必须重新建图需要再次做特征点标定对齐到统一绝对坐标系。5、AMCL 定位阶段的坐标情况导航定位阶段加载已经建好的静态地图输出的位姿依然是这张老地图的相对 map 坐标系即使定位跑的再准输出 (x,y) 依旧是相对于当初建图开机原点不是大地绝对位置想要 GPS / 建筑绝对坐标依然要额外做坐标变换标定。简明对比表表格项目SLAM 原生地图未标定标定之后的地图坐标类型相对坐标系可换算到绝对坐标系GPS/CAD原点来源建图启动瞬间小车位置自动生成原点不变新增一套坐标转换矩阵是否需要标定不需要必须人工采集特征点标定适用场景室内巡逻、AGV只在地图内部跑点位对接 GIS、多机协同、对接建筑 CAD、输出经纬度缺点不同次建图原点不一致没有现实地理含义标定存在人工测量误差简短总结SLAM 自己生成的地图只有相对坐标原点是建图开机时刻机器人位置不会自动获得现实世界绝对位置。普通室内巡逻巡检只用地图内部相对点位不需要标定这是主流做法。如果需要 GPS、CAD 图纸这种外部绝对坐标必须额外标定求解坐标变换矩阵地图本身栅格数据不改动。每次重新建图原点会改变尽量建好图就保存后续只跑定位避免原点变动带来麻烦。
SLAM 建图的绝对位置、参考原点、是否需要标定核心结论Gmapping / Cartographer 这类激光 SLAM 生成的栅格地图本身没有现实世界的 GPS 绝对坐标。地图只有一套相对坐标系原点是机器人开机建图瞬间的位置不会自动对齐大楼、大地真实坐标如果业务需要真实绝对位置就必须额外做标定。1、SLAM 地图坐标原点怎么来的相对坐标在建图程序启动那一刻机器人当前所在的位置自动被定义为地图坐标系的原点map (0,0,0)朝向为 0°。机器人往前跑坐标 x 增大向右跑 y 增大旋转角度 θ 变化。整张地图上所有墙、障碍物的坐标全部是相对于开机起点的相对坐标。SLAM 算法只关心物体之间互相的距离、相对位置关系它不知道这个原点对应现实世界大楼的哪个角落不知道经纬度。举例子 开机建图小车放在机房门口这一刻 → map (0,0)。小车行驶到机柜旁边地图上机柜坐标 map (2.5,1.2)。 这个(2.5,1.2)只代表机柜距离开机起点 X 方向 2.5 米Y 方向 1.2 米不代表大地坐标系下的真实地理坐标。通俗类比 你拿本子画房间平面图你站的位置定为本子的 (0,0)画出家具之间的相对位置但本子上不会自动标记这个房间在城市的哪个经纬度。2、什么时候不需要标定参考位置绝大多数室内机器人场景只使用地图内部相对坐标不需要绝对位置不用标定。 适用场景室内巡逻、AGV 搬运、定点巡检导航只关心机器人在地图里面相对于地图原点的 (x,y,θ)导航路径点也写在这套 map 坐标系下。工作逻辑 建图时我在地图上手动标记巡检点 A (1.0,2.0)、巡检点 B (5.0,3.0)机器人后续只需要跑到这张图内部的这些相对坐标点即可。不需要和 GPS、大楼 CAD 世界坐标对齐。这是机器人室内项目最常见的模式绝大多数 ROS 小车都是这么干的。3、什么时候必须标定获得绝对位置当需要把 SLAM 地图坐标对齐到外部绝对坐标系就必须人工标定。典型需求需要输出 GPS 经纬度把机器人位置上传到后台 GIS 地图需要和建筑 CAD 图纸坐标完全对齐多台机器人共用同一套全局大地坐标系室外场景SLAM 局部地图融合 GPS 全局坐标。标定的本质求解一组坐标变换map坐标系 ↔ 大地/GPS/CAD绝对坐标系得到旋转、平移参数。 常用两种标定手段人工选特征点标定最常用室内在真实环境找 2 个以上明显标记点柱子、墙角。测量该墙角在现实 CAD/GPS 里面的真实绝对坐标在 SLAM 地图读取同一个墙角的 map 相对坐标算法解算平移、旋转矩阵完成两套坐标系的对齐。后续机器人输出位置就可以换算成绝对坐标。GPS 辅助标定室外机器人在建图时同时记录 GPS 位置把 SLAM 局部坐标系和 GPS 坐标系做融合得到绝对位姿。室内 GPS 失效该方案不可用。⚠️注意标定只是增加一套坐标转换不会修改 SLAM 栅格地图本身。地图内部障碍物相对关系不变只是多一层换算公式。4、一个非常容易踩的工程坑每次重新启动 SLAM 建图原点会变你把小车挪到同一个物理地点重新启动 gmapping/cartographer 建图 新地图的 map (0,0) 是这次开机的位置和上一次建图的原点完全不一样。两次建图得到两张地图里面同一个机柜在两张图的 map 坐标数值完全不同。如果没有做坐标标定两张地图的坐标不能直接混用。解决办法建图完成后保存地图文件后续只进入定位模式不再重新建图原点就固定不变如果必须重新建图需要再次做特征点标定对齐到统一绝对坐标系。5、AMCL 定位阶段的坐标情况导航定位阶段加载已经建好的静态地图输出的位姿依然是这张老地图的相对 map 坐标系即使定位跑的再准输出 (x,y) 依旧是相对于当初建图开机原点不是大地绝对位置想要 GPS / 建筑绝对坐标依然要额外做坐标变换标定。简明对比表表格项目SLAM 原生地图未标定标定之后的地图坐标类型相对坐标系可换算到绝对坐标系GPS/CAD原点来源建图启动瞬间小车位置自动生成原点不变新增一套坐标转换矩阵是否需要标定不需要必须人工采集特征点标定适用场景室内巡逻、AGV只在地图内部跑点位对接 GIS、多机协同、对接建筑 CAD、输出经纬度缺点不同次建图原点不一致没有现实地理含义标定存在人工测量误差简短总结SLAM 自己生成的地图只有相对坐标原点是建图开机时刻机器人位置不会自动获得现实世界绝对位置。普通室内巡逻巡检只用地图内部相对点位不需要标定这是主流做法。如果需要 GPS、CAD 图纸这种外部绝对坐标必须额外标定求解坐标变换矩阵地图本身栅格数据不改动。每次重新建图原点会改变尽量建好图就保存后续只跑定位避免原点变动带来麻烦。
