【多传感器融合定位SLAM专栏】前端里程计、IMU预积分、滤波、图优化推导与应用(2)

本专栏基于深蓝学院《多传感器融合定位》课程基础上进行拓展,对多传感器融合SLAM的学习过程进行记录

第二章 点云地图构建及基于地图的定位

后端优化

目的:利用回环检测结果和惯导先验位姿修正里程计误差。回环在此处提供的是两帧之间的相对位姿。

观测:

  1. 连续两帧的相对位姿观测

  2. 回环匹配得到的相对位姿观测

  3. 组合导航提供的先验位姿观测

使用方式:

  • 1和2的观测提供了基于回环的位姿修正
  • 1和3的观测构成了基于先验观测的位姿修正

【多传感器融合定位SLAM专栏】前端里程计、IMU预积分、滤波、图优化推导与应用(2)_第1张图片

李群、李代数基础知识

【多传感器融合定位SLAM专栏】前端里程计、IMU预积分、滤波、图优化推导与应用(2)_第2张图片

李群:旋转矩阵

李代数:用一个矢量将绕三个轴旋转等价于绕某一轴的旋转。

【多传感器融合定位SLAM专栏】前端里程计、IMU预积分、滤波、图优化推导与应用(2)_第3张图片

李群:变换矩阵

李代数:旋转和平移的矢量

基于回环的位姿修正

回环检测

目的:消除累积误差

你可能感兴趣的:(多传感器融合SLAM,算法,自动驾驶)