/reflector_ekf_slam

laser reflector and EKF

Primary LanguageC++

reflector_ekf_slam

这是一个基于EKF的激光反光板方案,整个框架基于ROS开发的,对应的CSDN博客一起做激光反光板系列中推导的公式。

已添加功能

(1)ROS消息的接收:轮速计和激光点云

(2)ROS消息的发送:反光板地图、实时位姿、历史轨迹、栅格地图、匹配点云

(3)2D和3D激光反光板检测与匹配

(4)EKF公式的实现

(5)反光板地图的保存与读取

(6)Scan-Submap匹配,栅格地图的创建与保存

(7)支持不同的里程计模型:diff(差速模型)和omni(全向模型)

(8)360度2D激光雷达激光反光板检测:考虑0度附近反光板无法检测情况

(9)加入2D激光的畸变校正

(10)开源测试数据集

后续待添加的功能

(1)滑窗类EKF方案:状态空间维护滑窗内多帧的位姿

(2)ICP方案的使用:前后帧ICP,当做观测。考虑:libPointMatcher、点线csm、scan-submap匹配的方式

(3)特征的使用:直角点、线段,当做观测

(4)FEJ的使用:First-Estimates Jacobian

(5)激光雷达相对于车体中心的外参放到状态空间内进行优化