一种闭环正向滤波结合反向平滑的POS后处理方法

摘要

本发明属于POS后处理方法，具体涉及一种闭环正向滤波结合反向平滑的POS后处理方法。目的是提供一种高精度的位置姿态后处理方法。包括：卡尔曼滤波的步骤，和反向R-T-S平滑的步骤，其中，将正向Kalman滤波估计出的水平速度误差和高度误差，通过反馈控制参数实时反馈到惯性导航解算的输入端，进而抑制惯性速度和位置的发散，提高误差模型的线性度，并在此基础上对滤波估计量进行反向R-T-S平滑，从而得到POS的高精度位置姿态后处理结果。优点在于：满足POS的应用需求，提供高精度的位置和姿态信息给相关图像处理系统(例如包括雷达，或者相机)等等。