去中心化
EM(期望最大化)
思想: 位姿的线性差值
更简单的方法:用分段线性函数进行近似
[1] VICP:Velocity updating Iterative Closest Point Algorithm. [2] LOAM:Lidar Odometry and Mapping in real-time
可以同tf::transformListenser进行获取