用C语言和C++实现卡尔曼滤波算法，可供参考，只要有矩阵的运算和下次值的最新估算。-Kalman filter algorithm using C language and C++, for reference, the latest estimates as long as the value of matrix operations and the next.