上一篇文章有讲到卡尔曼滤波了，现在需要将其添加到我们之前的C52测试程序中。

一、再看一下卡尔曼滤波程序一