Lidar第一帧作为基坐标
1、lidar原始数据预处理默认不提取特征,对原始数据间隔式(间隔3个点)降采样提取。
2、imu初始化、惯性解算、误差分析、状态、协方差预测
3、Lidar与imu时间状态对齐
4、Lidar去畸变
5、构建局部地图,提供最近点索引,最小二乘方法拟合平面,构建点面残差
6、误差卡尔曼滤波
一、IMU
IMU初始化:计算加速度、角速度均值,利用均值计算方差。
IMU惯性解算、误差分析:状态、协方差预测
惯性解算:
利用相邻两个时刻的imu数据,采用离散中值法作为运动方程输入的加速