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

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

多传感器融合定位(1-3D激光里程计)1-前端里程计ICP_第1张图片

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

多传感器融合定位(1-3D激光里程计)1-前端里程计ICP_第2张图片
多传感器融合定位(1-3D激光里程计)1-前端里程计ICP_第3张图片

整体流程

多传感器融合定位(1-3D激光里程计)1-前端里程计ICP_第4张图片
多传感器融合定位(1-3D激光里程计)1-前端里程计ICP_第5张图片

ICP point2point

多传感器融合定位(1-3D激光里程计)1-前端里程计ICP_第6张图片

ICP推导

把旋转和平移进行解耦
多传感器融合定位(1-3D激光里程计)1-前端里程计ICP_第7张图片
去除与R无关项
多传感器融合定位(1-3D激光里程计)1-前端里程计ICP_第8张图片
trace 不等式证明
多传感器融合定位(1-3D激光里程计)1-前端里程计ICP_第9张图片
多传感器融合定位(1-3D激光里程计)1-前端里程计ICP_第10张图片
多传感器融合定位(1-3D激光里程计)1-前端里程计ICP_第11张图片
多传感器融合定位(1-3D激光里程计)1-前端里程计ICP_第12张图片

你可能感兴趣的:(多传感器融合定位学习)