误差函数: ; 是状态向量,每个x代表机器人的位置(也可以是landmark的位置); 给定一个,我们就能根据测量方程计算出一个估计观测量,而实际测量量是通过传感器测量计算出来的; 这两个观测量之间存在一个err