多传感器融合定位(1-3D激光里程计)1-前端里程计ICP

多传感器融合定位(1-3D激光里程计)1-前端里程计ICP

在这里插入图片描述

机械激光雷达与固态激光雷达

在这里插入图片描述
在这里插入图片描述

整体流程

在这里插入图片描述
在这里插入图片描述

ICP point2point

在这里插入图片描述

ICP推导

把旋转和平移进行解耦
在这里插入图片描述
去除与R无关项
在这里插入图片描述
trace 不等式证明
在这里插入图片描述
在这里插入图片描述
在这里插入图片描述
在这里插入图片描述

猜你喜欢

转载自blog.csdn.net/weixin_41281151/article/details/109008854
今日推荐