本发明涉及一种惯导系统高度通道阻尼方法，特别涉及一种地心地固坐标系下惯导系统高度通道的二阶阻尼方法。
背景技术：
与经典地理坐标系下的惯性导航编排相比，地心地固坐标系(ecef)导航编排能够实现包括极地区域在内的全球导航，并且计算量小，计算效率高。但是惯导系统的高度通道是不稳定的，没有外界高度阻尼的纯惯性解算不适合长时间导航。由于ecef坐标系为非水平坐标系，发散的垂向通道误差会耦合到各个轴向，给高度阻尼带来困难。
文献“gnss sins组合导航地固系高度阻尼算法，测绘通报，2016，vol11,p12-14”公开了一种ecef坐标系下的高度阻尼方法。该方法首先将ecef坐标编排解算的位置信息转换至地理坐标系，并用外部观测高度替换惯性指示高度后，再转换回ecef坐标系，抑制了高度通道的发散趋势。但是，文献所述方法直接使用外部辅助高度替换惯性解算高度，不能对天向速度误差进行等效阻尼，也不能有效抑制外部辅助高度的噪声和突变误差。
技术实现要素：
为了克服现有惯导系统高度通道阻尼方法实用性差的不足，本发明提供一种地心地固坐标系下惯导系统高度通道的二阶阻尼方法。该方法首先将ecef编排解算的位置坐标转换至地理坐标系，再计算惯性解算高度与外部测量高度之差，并转换至地心地固坐标系，借鉴经典的地理坐标系高度通道阻尼方法，设计ecef编排下的二阶高度阻尼网络。本发明利用ecef坐标系与地理坐标系之间的转换关系，将高度量测误差转换至地心地固坐标系，并构建二阶阻尼网络对ecef编排的天向通道进行等效阻尼，通过高度阻尼系数抑制了外部测量高度的噪声和突变影响，通过天向速度阻尼系数抑制了天向速度误差，能够有效抑制导航解算的天向速度误差和外部测量高度的噪声，提高ecef编排的天向速度和高度精度，获得与经典地理坐标系高度阻尼相同的效果。实用性好。
本发明解决其技术问题所采用的技术方案：一种地心地固坐标系下惯导系统高度通道的二阶阻尼方法，其特点是包括以下步骤：
(a)将ecef编排解算的位置坐标pe＝[xeyeze]t转换至地理坐标系得到pg＝[λlh]t
λ＝atan2(ye,xe)(1)
式中xe、ye、ze为ecef坐标系下惯导解算的三维位置坐标；λ、l、h为转换获得的经度、纬度和高度；上标t表示向量转置；e1为地球第一偏心率；re和rp为地球半长轴和半短轴；rn为当地卯酉圈半径；地心纬度θ＝atan2(zere,rrp)，赤道面半径
(b)计算惯性解算高度与外部测量高度之差，并转换至ecef坐标系
式中δhe为ecef坐标系下的高度误差，hr为外部辅助高度。
(c)借鉴经典的地理坐标系高度通道阻尼方法，设计ecef编排下的二阶高度阻尼网络，其速度、位置微分方程为：
式中，ve为ecef坐标系下的速度，
本发明的有益效果是：该方法首先将ecef编排解算的位置坐标转换至地理坐标系，再计算惯性解算高度与外部测量高度之差，并转换至地心地固坐标系，借鉴经典的地理坐标系高度通道阻尼方法，设计ecef编排下的二阶高度阻尼网络。本发明利用ecef坐标系与地理坐标系之间的转换关系，将高度量测误差转换至地心地固坐标系，并构建二阶阻尼网络对ecef编排的天向通道进行等效阻尼，通过高度阻尼系数抑制了外部测量高度的噪声和突变影响，通过天向速度阻尼系数抑制了天向速度误差，能够有效抑制导航解算的天向速度误差和外部测量高度的噪声，提高ecef编排的天向速度和高度精度，获得与经典地理坐标系高度阻尼相同的效果。实用性好。
下面结合附图和具体实施方式对本发明作详细说明。
附图说明
图1是本发明设计的ecef编排下的高度通道二阶阻尼网络。
图2是本发明实施例提供的高度和天向速度仿真轨迹曲线。
图3是本发明实施例提供的外部辅助高度误差曲线。
图4是本发明技术获得的高度误差和天向速度误差。
图5是本发明技术获得的结果与经典地理系阻尼结果的差异。
图6是背景技术获得的高度误差和天向速度误差。
具体实施方式
参照图1-5。本发明地心地固坐标系下惯导系统高度通道的二阶阻尼方法具体步骤如下：
1、位置信息转换至地理系。
定义地心地固坐标系(ecef)为e系；定义地理坐标系为g系，坐标轴指向当地位置的东北天方向。将ecef编排每周期解算的位置坐标pe＝[xeyeze]t转换为地理坐标系位置pg＝[λlh]t：
λ＝atan2(ye,xe)(1)
式中xe、ye、ze为ecef坐标系下惯导解算的三维位置坐标；λ、l、h为转换获得的经度、纬度和高度；上标t表示向量转置；e1为地球第一偏心率；re和rp为地球半长轴和半短轴；rn为当地卯酉圈半径；地心纬度θ＝atan2(zere,rrp)，赤道面半径
2、计算地理系高度误差并转换回ecef坐标系。
计算地理系高度测量误差为δh＝h-hr，并通过位置方向余弦矩阵将其转换至ecef坐标系得到
带入并化简得到
式中δhe为ecef坐标系下的高度误差，hr为外部辅助高度。
3、构造ecef坐标系二阶高度阻尼网络。
借鉴经典的地理坐标系高度通道阻尼方法，设计ecef编排下的高度通道二阶阻尼网络，参照附图1。对应的速度、位置微分方程为：
式中，ve为ecef坐标系下的速度，
下面通过仿真数据对本发明的具体实施方式和实施效果做进一步说明。
仿真条件：仿真轨迹的初始地理系位置为[120°e；30°n；0m]，初始俯仰、滚转、航向角为[0；0；0]°，纵向速度为50m/s，仿真时间长度为3600s；惯导系统的初始俯仰、滚转和航向误差角为[0.003；-0.003；0.05]°，解算周期为10ms；陀螺零偏误差为0.01°/h，随机游走噪声为
图2显示了仿真轨迹中天向速度和高度的变化曲线，在1000s和2400s处存在高度上升和下降过程。
图3显示了外部辅助高度的误差曲线，除随机噪声外，在第1600s和3000s处叠加了突变误差。
图6为背景技术获得的高度误差和天向速度误差曲线。由于背景技术直接采用外部测量高度，得到的高度误差受噪声和突变误差影响，与图3中的外部辅助高度误差相同；由于背景技术没有阻尼天向速度误差，得到的天向速度误差累积达2m/s。
图4为本发明技术获得的高度误差和天向速度误差曲线。由于采用了等效二阶阻尼网络，高度误差在1.5m以内，天向速度误差在0.1m/s以内，抑制了外部测量高度的噪声和突变影响，提高了天向速度和高度精度。
图5为本发明技术获得的高度和天向速度与经典地理系高度阻尼结果之差。图5中高度误差值10-6m以内，天向速度误差值在1.5×10-7m/s以内。实施效果表明，本发明技术能够获得高精度的天向速度和高度信息，与经典地理坐标系的高度阻尼效果一致。
1.一种地心地固坐标系下惯导系统高度通道的二阶阻尼方法，其特征在于包括以下步骤：
(a)将ecef编排解算的位置坐标pe＝[xeyeze]t转换至地理坐标系得到pg＝[λlh]t
λ＝atan2(ye,xe)(1)
式中xe、ye、ze为ecef坐标系下惯导解算的三维位置坐标；λ、l、h为转换获得的经度、纬度和高度；上标t表示向量转置；e1为地球第一偏心率；re和rp为地球半长轴和半短轴；rn为当地卯酉圈半径；地心纬度θ＝atan2(zere,rrp)，赤道面半径
(b)计算惯性解算高度与外部测量高度之差，并转换至ecef坐标系
式中δhe为ecef坐标系下的高度误差，hr为外部辅助高度；
(c)借鉴经典的地理坐标系高度通道阻尼方法，设计ecef编排下的二阶高度阻尼网络，其速度、位置微分方程为：
式中，ve为ecef坐标系下的速度，
