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

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

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

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

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

整体流程

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

ICP point2point

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

ICP推导

把旋转和平移进行解耦
多传感器融合定位(2-3D激光里程计)1-前端里程计ICP
去除与R无关项
多传感器融合定位(2-3D激光里程计)1-前端里程计ICP
trace 不等式证明
多传感器融合定位(2-3D激光里程计)1-前端里程计ICP
多传感器融合定位(2-3D激光里程计)1-前端里程计ICP
多传感器融合定位(2-3D激光里程计)1-前端里程计ICP
多传感器融合定位(2-3D激光里程计)1-前端里程计ICP