懦弱小懒猪

文章
7
资源
0
加入时间
2年10月24天

VINS(五)非线性优化与在线标定调整

首先根据最大后验估计(Maximum a posteriori estimation,MAP)构建非线性优化的目标函数。初始化过程通过线性求解直接会给出一个状态的初值,而非线性优化的过程关键在于求解增量方程,并不断迭代到最优点,需要在初值以及后续的迭代点附近线性化(泰勒展开保留一阶后平方构建高斯牛顿梯度下降的增量方程):在初值x附近泰勒展开$f(x+\Delta x) = f(x) +...