本文介绍了VINS-Mono的初始化过程，包括为何需要初始化、初始化哪些变量。主要步骤涉及检查IMU激励、使用SFM计算关键帧位姿、通过PnP求解非关键帧位姿，并详细阐述了视觉惯性对齐的实现。重点关注了位移、速度、旋转、加速度零偏和相机IMU外参的初始化策略。
1. 关于初始化
（1）为什么需要初始化？
基于优化框架的VIO非常依赖于初始值，因为解优化问题类似于一个迭代下降的过程，以初始值为起点，通过高斯牛顿或L-M算法，不断迭代寻找极小值。为保证最终的极小值为最小值，防止陷入局部极小值，就要求给定的起始初值离最小值足够接近（要求有良好的初值），并且这样迭代的次数就会更少，计算量也会减少，从而保证系统实时性。
（2）初始化哪些变量？
需要初始化的变量如下：
χ=[x0,x1,⋯ ,xn,xcb,λ0,λ1,⋯ ,λm]xk=[pbw,vbkw,qbkw,ba,bg],k∈[0,n]xcb=[pcb,qcb] \chi = [x_0,x_1,\cdots,x_n,x_c^b,\lambda_0,\lambda_1,\cdots,\lambda_m] \\ x_k = [p_b^w,v_{b_k}^w,q_{b_k}^w,b_a,b_g],k \in [0,n] \\ x_c^b = [p_c^b,q_c^b] χ=[x0,x1,⋯,xn,xcb,λ0,λ1,⋯,λm]xk=[pbw,vbkw,qbkw,ba,bg],k∈[0,n]xcb=[pcb,q
扫一扫
1879
被折叠的 条评论
为什么被折叠?
到【灌水乐园】发言
