卡尔曼滤波
For simplicity, assume that the control input formula_45. Then the Kalman filter may be written: