GVINS论文阅读(VINS-MONO + gnss 紧耦合)

原文 https://arxiv.org/pdf/2103.07899.pdf

github https://github.com/HKUST-Aerial-Robotics/GVINS

港科大 沈老师团队 在vins-mono基础上加入gnss原始测量值的紧耦合算法

原文详解

视觉、imu、gnss的紧耦合,gnss用的是伪距和多普勒观测值

整体的滑窗优化仍旧是vins-mono的体系

主要创新在于初始化部分和滑窗里面关于gnss的因子设计

初始化分为三步:

前提是vio初始化完成,参考vins-mono初始化,然后就是vio和gnss轨迹的一个4自由度的对齐(三维xyz+航向)

1.单点定位计算大概基准点,用来转换坐标系

2.构建约束,利用多普勒计算的速度来计算航向差异和接收机钟差

3.对齐航向后,再一次优化对齐轨迹

因子构建

共有三种因子,公式看原文

伪距因子:位置层面的约束

多普勒因子:速度层面的约束

接收机钟差钟漂因子:连续状态转移

阅读代码后再更

你可能感兴趣的:(自动驾驶)