卡尔曼滤波
在每一步中使用当前的估计状态计算Jacobian矩阵，这幾個矩阵可以用在卡尔曼滤波器的方程中。这个过程，实质上将非线性的函数在当前估计值处线性化了。