目录
证明:若某个高斯随机变量为零均值,协方差为对角线矩阵且大小相同(各向同性),那么在乘任意旋转矩阵以后,其均值仍为零,且协方差不变;
在运动过程代码中,将矩阵拆开,分别为每种状态变量实现运动方程。请给出公式和代码实现的说明 代码实现:
GNSS+IMU融合: GNSS+INS+ODOM: