【自动驾驶】Submap总结

大规模建图优化问题

使用图像或雷达扫描点云帧序列完成大规模三维重建，如城市规模三维重建，将全局环境地图分割为submap（子地图），“各个击破”——逐一优化每个子地图，并优化子地图间关联关系，如相对位姿优化调整。
Ni Kai等人提出的主要流程：a. 消除每个submap内部的优化变量，只保留submap之间的变量 b. 优化submap之间的变量 c. 优化每个submap内部的变量。问题中变量是指传感器位姿和地图点坐标等。引入”局部坐标系“，submap内部变量用基础节点（base node，笔者理解为根据submap设定的局部坐标系）表达相对坐标，submap之间优化通过调整基础节点实现，使得submap整体发生很大变化，但内部变量无需改变。

1. 分割submap在工程上具体操作是什么？
   形如切豆腐，分割后一个几何空间中的路标点和相机位姿组成一个submap。
2. submap间的约束如何构建？
   如使用重投影约束，子地图 A中某陆标点${\mathbf{X}}_A$（坐标为A对应的局部坐标系）被B中的相机观测到，可据此构建submap间的重投影约束。Ni Kai的方法以基础节点的姿态与位置参数为优化参数，间接改变陆标点坐标和相机的位姿参数，以优化重投影误差：该陆标点在B相应局部坐标系下的表达，

$${\mathbf{X}}_B=R_{WB}^{-1}[(R_{WA}\mathbf{X}$$