C++写的一个Ubuntu下扩展卡尔曼滤波程序，状态方程为线性，观测方程非线性，最后输出图片以便观察是否收敛，有比较详细的注释，分享给大家参考。还会上传一个matlab版本的。

本篇为组合导航扩展卡尔曼滤波 C++ 代码实现。 注：本例所用传感器有激光雷达传感器，雷达传感器 /*扩展卡尔曼滤波器*/ #include #include #include #include #include #include #include #include #define ROWS 1224 #define COLS 8 using namespace std; using namespace Eigen; int main(){ // **********************