基于卡尔曼滤波器的C++程序设计,主要针对卡尔曼滤波器算法的实现