一.KF 1.从概率来理解概率估计因为希望整个运动估计较长时间内最优,所以反而会用最新的知识去更新之前的状态,就比如在做完当前帧的位姿估计的时候,修改局部地图的路标点.如果站在之前的状态上来考虑,用的是未来的信息.所以不仅用过去的信息估计现在的状态,也用未来的信息更新自己.因为自己站在一个中间的时间点上.这是批量式 batch渐进式:只考虑过去和前一个时刻的.incremental1.1前言运动方程:xk=f(xk-1,uk)+wk;由于xk表示的位姿,它和上一时刻之间的位姿是运动关系.而带观测