港科大 沈老师团队 在vins-mono基础上加入gnss原始测量值的紧耦合算法
视觉、imu、gnss的紧耦合,gnss用的是伪距和多普勒观测值
整体的滑窗优化仍旧是vins-mono的体系
主要创新在于初始化部分和滑窗里面关于gnss的因子设计
前提是vio初始化完成,参考vins-mono初始化,然后就是vio和gnss轨迹的一个4自由度的对齐(三维xyz+航向)
1.单点定位计算大概基准点,用来转换坐标系
2.构建约束,利用多普勒计算的速度来计算航向差异和接收机钟差
3.对齐航向后,再一次优化对齐轨迹
共有三种因子,公式看原文
伪距因子:位置层面的约束
多普勒因子:速度层面的约束
接收机钟差钟漂因子:连续状态转移