卡尔曼滤波算法

Kalman filtering algorithm