一种用于导航定位任务的序贯不变扩展卡尔曼滤波方法

    公开(公告)号:CN120084337A

    公开(公告)日:2025-06-03

    申请号:CN202510319117.4

    申请日:2025-03-18

    Abstract: 本发明提出了一种用于导航定位任务的序贯不变扩展卡尔曼滤波方法,属于汽车导航领域。解决了在IEKF框架下难以实现多坐标系观测的高效融合,并无法保证协方差传递的几何一致性的问题。方法包括:根据导航传感器所处坐标系的不同,将传感器的观测量进行划分;构建李群形式的状态向量:对惯性测量单元的输出进行建模;根据李群状态方程进行状态传播;计算协方差矩阵的传播;根据划分的两类矩阵建立左不变观测方程和右不变观测方程;通过左不变扩展卡尔曼滤波器和右不变扩展卡尔曼滤波器同步更新状态估计,利用公共状态协方差矩阵将左不变协方差矩阵和右不变协方差矩阵进行映射,完成序贯融合。它主要用于自动驾驶领域。

Patent Agency Ranking