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