1.基于模型的方法--线性最小二乘法。
2.代码实践
在odom_calib文件夹下打开终端,运行cmake . make进行编译,./odom_calib运行可执行文件。
3.代码展示。
odom_calib.cpp
#include <string>
#include <iostream>
#include <fstream>
#include <math.h>
#include <vector>
#include <Eigen/Core>
#include <Eigen/Geometry>
#include <Eigen/Dense>
using namespace std;
string scan_match_file = "./scan_match.txt"; //存放雷达数据的文件
string odom_file = "./odom.txt"; //存放轮速计数据的文件
int main(int argc, char** argv)
{
// 放置激光雷达的时间和匹配值 t_s s_x s_y s