描述: 把两个bag的数据分别计算自己的轨迹后,和gps做刚体对齐 找两个轨迹的共視关系 通过两个轨迹的点云匹配后得到两个轨迹的相似变换,把第二个轨迹变换到第一个轨迹的坐标系下 加入gps边的pose graph 优化 加入gps的BA优化 数据分析: 第一个bag的轨迹 绿色是共視关系,红色的点是gps轨迹,白色的点是slam得到的相机轨迹。 第二条轨迹 然后做两条轨迹间的共視关系计算