OptimalStateEstimation课后上机练习源码，对于理解书中概念有很大帮助

二维卡尔曼滤波，速度与位置两个状态，入门卡尔曼的好程序