python实现迭代最近点ICP算法(notebook版本)

直接看notebook,写的应该很清楚了

准备数据

python实现迭代最近点ICP算法(notebook版本)_第1张图片
python实现迭代最近点ICP算法(notebook版本)_第2张图片

暴力搜索初值

icp对初值要求高,实际情况下也可以使用ndt进行初值搜索,这里使用了暴搜。
python实现迭代最近点ICP算法(notebook版本)_第3张图片

ICP精匹配

python实现迭代最近点ICP算法(notebook版本)_第4张图片

你可能感兴趣的:(SLAM_in_python,slam,机器人,SLAM,定位导航,最优化算法)