激光slam:3激光的前端配准算法 课程内容ICP匹配方法PI-ICP方法基于优化的方法相关匹配与分枝定界加速 课程内容 ICP匹配方法 1.ICP介绍 2.已知对应点的求解 3.未知对应点的求解 EM算法是非线性MLE的工具 ICP的缺点是由于激光点是离散的,前后两帧打到的可能不是同一个物体。 PI-ICP方法 基于优化的方法 基于优化的匹配方法(梯度优化):hector(高斯牛顿)和cartographer(ceres) 1.介绍 T= 求梯度,而地图、似然场均栅格化,离散,于是可以对地图进行插值。 2.求解 Si(T)是线性的,可以对其求导 M(Si(T))是非线性的,对其求导结果未知 3.双线性插值 相关匹配与分枝定界加速