接上一篇MSCKF-Based Visual Wheel Odometry (VWO-MSCKF),这篇文章接入了GPS信息,来实现全局定位。
实现方法参考了Guoquan Huang老师组里的论文:
W. Lee, K. Eckenhoff, P. Geneva and G. Huang, "Intermittent GPS-aided VIO: Online Initialization and Calibration," 2020 ICRA
先看一下效果,红色的是融合定位轨迹,青色的是GPS数据
知乎视频www.zhihu.com代码请见:
https://github.com/ydsf16/TinyGrapeKitgithub.com坐标系
与VWO-MSCKF不同的是,这里的全局坐标系
变为ENU系,原点与初始化时轮速坐标系的原点重合。
系统状态
与VWO-MSCKF总体是相同的。