SLAM学习笔记(一):数学基础

1.旋转矩阵及性质

SLAM学习笔记(一):数学基础

从坐标系X'O'Y'到坐标系XOY的变换可以任意取X'O'Y'中一点:SLAM学习笔记(一):数学基础,求其在XOY中的坐标SLAM学习笔记(一):数学基础。如上图所示,设SLAM学习笔记(一):数学基础,则:

SLAM学习笔记(一):数学基础

那么,有:

SLAM学习笔记(一):数学基础

展开可得:

SLAM学习笔记(一):数学基础

所以可以定义旋转矩阵R和平移矩阵t为:

SLAM学习笔记(一):数学基础,      SLAM学习笔记(一):数学基础

与此同时,不难验证:

SLAM学习笔记(一):数学基础

所以:

SLAM学习笔记(一):数学基础

2.反对称矩阵

首先,回顾一下向量的内积,也就是两个向量的内积可以定义为对应元素相乘求和:

SLAM学习笔记(一):数学基础

内积描述的是两个向量之间的投影关系,而外积则定义了两个向量张开四边形的有向面积,如图所示:

SLAM学习笔记(一):数学基础

公式定义为:

SLAM学习笔记(一):数学基础

将上述的矩阵写成矩阵形式有:

SLAM学习笔记(一):数学基础

这里a与b的叉乘可以写成a的反对称矩阵SLAM学习笔记(一):数学基础与向量b的乘法,将它变成线性运算。

上一篇:视觉 SLAM 十四讲 —— 第十三讲 建图


下一篇:机器人学习--激光slam简单案例版学习参考(转)