扩展卡尔曼滤波——非线性EKF C++

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