概率机器人的核心就是由传感器数据来估计状态的思路。状态估计解决的是从不能直接观测但可以推断的传感器数据中估计数量的问题.
首先介绍一维正态分布的概率密度函数:
(1)
我们经常把它记为, 他指出了随机变量及其均值和方差。但是
经常是一个多维矢量。多元正态分布的密度函数有一下形式:
(2)
其中为均值矢量;
为一个半正定对称矩阵称为协方差矩阵。
在SLAM中我们称为信息矩阵。首先解释下半正定对称矩阵,协方差矩阵,信息矩阵以及反对称矩阵。
1)半正定对称矩阵:是由变量之间的协方差来求得的,即对于
这一组随机变量求他们之间的协方差,