一共分为4步
step-1 read data from rosbag 从rosbag读取数据
step-2: converting scan to csm type 将激光数据转换为csm格式
step-3: canonical match match 经典的icp匹配,计算2帧数据之间的x,y,angle
step-4 start synchronzing,解算激光与odom之间的外参
这里给第3步来个图,scan_1 和 scan_2是相邻的2帧激光,odom根据时间戳来找到scan附近的数据从而计算线速度。
第4步暂时没有功力看懂,先给个贺博的正确计算结果,如果和他的一样,说明距离真相了,ok有时间再来补充。