[发明专利]一种基于室内主导方向的航向误差测量方法

摘要

本发明提供例了一种基于室内主导方向的航向误差测量方法。利用规则建筑物具有相对走廊平行、相邻走廊以直角正交的特点，以已知的室内主导方向提供的航向作为参考值，解决了航向误差的不可观测性问题，采用精确的室内主导方向提供的航向和步幅航向的差值作为系统状态变量，应用卡尔曼滤波器对其进行估计，得到航向误差，克服了航向误差漂移大的缺点，提高了导航精度；本发明方法简单，稳定性和可靠性高，给出了一种航向误差测量方法，有效的提高了导航精度。

主权项

1.一种基于室内主导方向的航向误差测量方法，其特征在于包括以下步骤：步骤一：采集固定于移动体脚面的微惯性测量单元输出的量测信息，包括陀螺输出的角速度w_ib、加速度计输出的比力f和电子罗盘输出的航向步骤二：根据步骤一中得到的角速度w_ib得到移动体航向步骤三：根据步骤一中得到的比力f得到移动体位置p；步骤四：根据步骤三中得到的移动体位置p得到移动体步幅航向θ，其量测方程为：θ=arctan(pE,m-pE,m-1pN,m-pN,m-1)]]>其中，arctan为反正切函数，(p_E,m p_N,m)为第m步单兵在东向和北向的位置坐标，(p_E,m-1 p_N,m-1)为第m-1步移动体在东向和北向的位置坐标；步骤五：根据步骤一中得到的航向和步骤二中得到的移动体航向得到航向偏差第m步的航向偏差量测方程为：式中，为移动体在第m步的航向误差，为移动体在第k步的电子罗盘输出，为由步骤四得到的移动体在第k步的航向，ε为零均值高斯白噪声；步骤六：根据步骤四得到的步幅航向θ和步骤五得到航向偏差得到修正的步幅航向θ₁，其量测方程为：步骤七：根据移动体轨迹确定室内主导方向根据步骤六得到修正的步幅航向θ₁和室内主导方向得到系统状态变量Δθ，其测量方程为：利用卡尔曼滤波器对状态变量进行估计，得到航向误差Δθ。