基于横向地理坐标系的虚拟极区方法与流程

本发明涉及一种虚拟极区方法，特别涉及一种基于横向地理坐标系的虚拟极区方法。

背景技术：

由于地球两极独特的地理位置，导航算法研究人员很难有机会到极区进行实际试验验证，而纯数学仿真方法又难以真实反映载体的运动特征和惯性传感器误差。因此，研究基于真实试验数据的虚拟极区技术具有重要意义，能够将中低纬度地区的试验数据通过数学方法转换至极区进行等效的导航试验验证。

文献“基于虚拟极点验证极区导航算法的方法研究，ieee中国制导、导航与控制学术会议，2016，p2809-2814”公开了一种以赤道上任意一点为新极点的虚拟极区方法。该方法通过地理坐标系与横向地理坐标系之间的相互关系，将地球自转轴转换至赤道以建立虚拟极区，并采用横向游移导航编排进行了合理性验证。但是，文献所述方法仅能够将赤道附近区域虚拟为极区，要适应地球表面其它区域还需要进行繁琐的算法推导。此外，文献所述方法将地球近似为圆球模型，采用高斯曲率半径作为圆球半径，存在原理性误差，不满足高精度导航验证的需求。

技术实现要素：

为了克服现有虚拟极区方法适用性差的不足，本发明提供一种基于横向地理坐标系的虚拟极区方法。该方法保持横向地理系下的姿态矩阵、速度和高度信息不变，通过对补偿椭球校正系数后的横向速度积分重构极区位置轨迹；将非极区试验获得的陀螺和加速度计数据在横向地理坐标系下扣除当地地球自转角速率和重力加速度，并叠加虚拟极区的地球自转角速率和重力矢量，完成惯性传感器数据的极区重构。本发明在横向地理坐标系下重构极区轨迹数据和惯性传感器数据，使载体相对于当地水平面的运动特征保持不变，扩大了方法的适用区域，能够适用于地球表面除横向极点外的任意位置；通过椭球校正系数避免了圆球近似，提高了建模精度，从而达到与真实极区试验相同的效果。

本发明解决其技术问题所采用的技术方案：一种基于横向地理坐标系的虚拟极区方法，其特点是包括以下步骤：

步骤一、极区轨迹数据重构。在非极区，将地理坐标系下惯性/卫星组合导航的结果作为参考信息，包含姿态矩阵速度v^g和位置p^g。将姿态矩阵和速度信息转换至横向地理坐标系：

式中，和为横向地理坐标系下的姿态矩阵和速度，为横向方位角转换矩阵。转换过程中保证横向地理坐标系下的姿态和速度信息不变，即将和直接作为虚拟极区轨迹的姿态矩阵和速度。将地理坐标系高度h作为重构轨迹的高度

符号“*”表示重构的极区轨迹相关参数。考虑地球曲率的影响，位置方向余弦矩阵通过求解微分方程获得

将式中矩阵的积分初值记作其计算方法为

其中表示人为指定的极区轨迹起点处的横向经纬度。

公式(4)中位置牵连运动角速率计算方法如下：

式中，和表示补偿椭球校正系数后的极区横向地理坐标系速度

其中，为重构轨迹处的子午圈和卯酉圈半径；和为横向地理系速度的东、北向分量；α^*为重构轨迹处的横向方位角。

步骤二、惯性传感器数据重构。在横向地理坐标系内扣除当地地球自转角速率和重力加速度，并叠加虚拟极区的地球自转角速率和重力矢量，完成陀螺和加速度计数据的重构：

式中，和为实际试验中得到的陀螺和加速度计输出，和为极区重构的陀螺和加速度计数据；姿态矩阵为虚拟极区横向地理坐标系下的地球自转角速率；为虚拟极区横向地理坐标系下的重力加速度；和为当地横向地理坐标系下的地球自转和牵连运动角速率；为当地横向地理坐标系下的重力加速度。

本发明的有益效果是：该方法保持横向地理系下的姿态矩阵、速度和高度信息不变，通过对补偿椭球校正系数后的横向速度积分重构极区位置轨迹；将非极区试验获得的陀螺和加速度计数据在横向地理坐标系下扣除当地地球自转角速率和重力加速度，并叠加虚拟极区的地球自转角速率和重力矢量，完成惯性传感器数据的极区重构。本发明在横向地理坐标系下重构极区轨迹数据和惯性传感器数据，使载体相对于当地水平面的运动特征保持不变，扩大了方法的适用区域，能够适用于地球表面除横向极点外的任意位置；通过椭球校正系数避免了圆球近似，提高了建模精度，从而达到与真实极区试验相同的效果。

下面结合附图和具体实施方式对本发明作详细说明。

附图说明

图1是本发明方法实施例中横向地球坐标系和横向地理坐标系示意图。

图2是本发明方法实施例中虚拟极区轨迹曲线。

图3是本发明方法实施例中虚拟极区轨迹的纯惯性导航结果。

具体实施方式

参照图1-3。本发明基于横向地理坐标系的虚拟极区方法具体步骤如下：

1、极区轨迹数据重构。

定义b为载体坐标系，坐标轴指向载体的右前上方向；i和e系为传统的惯性坐标系和地球坐标系；g为地理坐标系，坐标轴指向当地位置的东北天方向，该坐标系下的位置坐标用p^g＝[λlh]^t表示。定义et为横向地球坐标系，由e系绕oxe轴转动-90°，再绕oze转动-90°后获得；gt为横向地理坐标系，坐标轴分别指向当前位置横向伪经纬网的东北天方向，该坐标系下的位置坐标用表示。

在非极区试验中，将地理坐标系下惯性/卫星组合导航的结果作为参考信息，包含姿态矩阵速度v^g和位置p^g。首先将姿态矩阵和速度信息转换至横向地理坐标系：

式中和为横向地理坐标系下的姿态矩阵和速度，为横向方位角转换矩阵

式中α为横向方位角，并且

其中[λ,l]为当地经纬度，[λt,lt]为当地横向经纬度。

转换过程中保证横向地理坐标系下的姿态和速度信息不变，即将和直接作为虚拟极区轨迹的姿态矩阵和速度。将地理坐标系高度h作为重构轨迹的高度

式中符号“*”表示重构的极区轨迹相关参数。考虑地球曲率的影响，位置方向余弦矩阵通过求解微分方程获得

将式中矩阵的积分初值记作其计算方法为

其中和为初始横向经纬度，通过以下方法获得

式中为极区轨迹起点处的地理系经纬度，由人为指定。

公式(4)中位置牵连运动角速率计算方法如下：

式中和表示补偿椭球校正系数后的极区横向地理坐标系速度

其中为重构轨迹处的子午圈和卯酉圈半径；和为横向地理系速度的东北向分量；sinα^*和cosα^*计算方法如下：

式中极区重构的地理系经纬度[λ^*,l^*]和横向经纬度根据位置方向余弦矩阵求解：

式中cij表示矩阵的第i行第j列元素。

2、惯性传感器数据重构。

在横向地理坐标系内扣除当地地球自转角速率和重力加速度，并叠加虚拟极区的地球自转角速率和重力矢量，完成陀螺和加速度计数据的重构：

式中和为实际试验中得到的陀螺和加速度计输出，和为极区重构的陀螺和加速度计数据；姿态矩阵为虚拟极区横向地理坐标系下的地球自转角速率，为虚拟极区横向地理坐标系下的重力加速度：

其中ωie为地球自转角速率模值，g^*为根据极区纬度l^*计算的重力加速度模值。

公式(8)中的角速率计算方法如下

其中转换矩阵根据当地横向地理经纬度[λt,lt]求解

公式(9)中g^gt＝[00-g]^t，g为根据当地纬度l计算的重力加速度模值；角速率计算方法如下：

式中和表示补偿椭球校正系数后的当地横向地理坐标系速度

其中rm、rn为当地的子午圈和卯酉圈半径。

下面通过仿真数据对本发明的具体实施方式和实施效果做进一步说明。

仿真条件：非极区试验数据的起始点为[120°e,50°n,0]，舰船沿120°e经线以10m/s的速度向北行驶48小时，航行期间无姿态和高度变化。利用该试验数据进行极区轨迹重构，并将极区航线的起点置于北极点附近。

图2显示了原始轨迹曲线和重构的极区轨迹曲线。从轨迹外形上看，本发明技术能够在极区准确复现非极区的试验轨迹。

图3显示了在不叠加误差情况下，利用重构的极区轨迹进行纯惯性导航解算的水平位置误差。图3中导航48h的最大位置误差在0.05m以内，主要由字长舍入误差引起，表明该虚拟极区技术不存在原理性误差。实施效果表明，本发明技术符合地球椭球模型和标准力学编排，建模精度高。