SLAM-去除激光雷达运动畸变

1激光雷达运动畸变

2去除畸变原理

3 程序流程

1) main-构造函数
    订阅scan话题
    调用scancallback处理
2) scancallback
    scan话题数据提取到vector数组(包括angles,ranges) 
    vector数组保存到pcl::PointCloud<plc::PointXYZRGB>类型的点云中
    调用Lidar_Calibration进行畸变矫正
3) Lidar_Calibration
    程序对激光雷达数据进行分段线性插值*****
    调用Lidar_MotionCalibration激光雷达运动畸变去除分段函数*****
    调用getLaserPose得到激光雷达在odom中的位姿

4 程序实现显示

scan使用ros话题显示
  校正后的使用pcl_viewer显示
 (后续可以把pcl改为话题发布,这样数据一块显示可以作比较)
 SLAM-去除激光雷达运动畸变