一种基于恒星观测的船载惯导姿态角时序检测方法技术

本发明专利技术涉及一种基于恒星观测的船载惯导姿态角时序检测方法，包括以下步骤：一是利用惯导姿态角和经纬仪测角数据，计算出恒星在地平系下的实测指向。二是使用最小二乘法，拟合计算出任意时刻的惯导姿态角数据。三是计算出超前或滞后不同时间的惯导姿态数据，分别与经纬仪观测数据进行组合，寻找地平系下恒星方位、俯仰角误差的标准差最小的一组惯导姿态数据，对应时序即为惯导姿态角时序误差。本发明专利技术具有较高的惯导时序误差检测精度，可以有效提高惯导姿态角测量精度。

A ship borne inertial navigation system attitude angle time series detection method based on stellar observation

The invention relates to an attitude angle timing detection method of ship borne inertial navigation system based on stellar observation, including the following steps: one is to use the attitude angle of inertial navigation and the data of the theodolite to calculate the measured direction of the star in the ground system. The two is to use the least square method to calculate the attitude angle data of inertial navigation at any time. The three is to calculate the attitude data of the inertial navigation system before or at different time, and combined with the observational data of the theodolite to find a group of inertial navigation attitude data with the smallest standard deviation of the star azimuth and pitching angle error in the ground plane, and the corresponding timing is the time series error of the inertial navigation attitude angle. The invention has higher detection accuracy of inertial navigation timing error, and can effectively improve the measurement accuracy of inertial navigation attitude angle.

【技术实现步骤摘要】
一种基于恒星观测的船载惯导姿态角时序检测方法
本专利技术属于船舶导航
，涉及一种基于恒星观测的船载惯导姿态角时序检测方法，用于船载惯导姿态数据拟合和惯导姿态角时序误差计算。
技术介绍
船载惯导设备能够连续输出船体的横纵摇和航向信息，不受天气和电磁环境变化的影响，为很多船载设备的正常工作提供了稳定坐标基准。惯导姿态角测量结果的准确性，除受自身惯性器件性能、系统编排以及导航算法等影响外，还与惯导姿态时序误差有关。在船摇周期10s、船摇幅度5°的情况下，1ms时序误差最大可带来约130″的惯导姿态角测量误差。目前还未有适用于惯导姿态角时序误差稳定情况下的检测方法。
技术实现思路
本专利技术所要解决的技术问题是针对上述现有技术提供一种基于恒星观测的船载惯导姿态角时序检测方法，该方法适用于惯导姿态角时序误差稳定情况下的检测计算。本专利技术解决上述问题所采用的技术方案为：一种基于恒星观测的船载惯导姿态角时序检测方法，所述方法包括以下步骤：步骤一、利用惯导姿态角和经纬仪测角数据，计算出恒星在地平系下的实测指向；步骤二、使用最小二乘法，拟合计算出任意时刻的惯导姿态角数据；步骤三、计算出超前或滞后不同时间的惯导姿态数据，分别与经纬仪观测数据进行组合，寻找地平系下恒星方位、俯仰角误差的标准差最小的一组惯导姿态数据，对应时序即为惯导姿态角时序误差。优选地，步骤一具体包括：1)计算经纬仪甲板系下恒星实测位置首先，使用脱靶量数据对经纬仪方位和俯仰角进行修正，设恒星在经纬仪视场内方位和俯仰方向的脱靶量分别为△A、△E，则：式中：Aj、Ej为经纬仪方位和俯仰轴角编码器测量数据；然后，对经纬仪轴系参数进行修正，式中：g—经纬仪方位零位；c—经纬仪照准差；I—经纬仪横轴差；βm—经纬仪垂直轴最大倾斜量；最后，利用轴系参数修正后的经纬仪测角数据，计算恒星在经纬仪甲板坐标系所在方向单位矢量的直角坐标(xj,yj,zj)，2)计算地平系下恒星实测位置利用惯导姿态测量数据进行坐标系的旋转和变换，经纬仪甲板系转换到地平系应进行三次坐标旋转，坐标旋转后，在地平系下恒星单位矢量的直角坐标(x,y,z)为：式中：R—惯导实测横摇；P—惯导实测纵摇；H—惯导实测航向。根据恒星在地平系下的直角坐标，计算出恒星在地平系下的实测方位、俯仰角：Edc＝atan(z)，式中，Adc为实测方位角，Edc为实测俯仰角。优选地，步骤二具体包括：采用最小二乘法完成惯导姿态角基于时间序列的四次多项式拟合，设短时间的惯导姿态数据用四次多项式进行表示：式中：R为横摇，P为纵摇，H为航向，r0～r4—横摇多项式系数；p0～p4—纵摇多项式系数；h0～h4—航向多项式系数。根据最小二乘法原理，横纵摇和航向多项式系数计算表达式为：其中：与现有技术相比，本专利技术的优点在于：本专利技术以空间位置精确已知的恒星作为基准，利用经纬仪观测恒星，采用最小二乘法拟合出基于时间序列的惯导姿态角计算表达式，将不同时序条件下的惯导数据与经纬仪测角数据进行组合，根据恒星在地平系下观测结果的标准差变化趋势和具体数值，分析并确定出惯导姿态角的时序误差。附图说明图1为本专利技术中惯导姿态时序正常情况下的经纬仪方位角误差示意图。图2为本专利技术中惯导姿态滞后10ms引起的经纬仪方位角误差示意图。具体实施方式以下结合附图实施例对本专利技术作进一步详细描述。本专利技术提供一种基于恒星观测的船载惯导姿态角时序检测方法，主要内容涉及恒星在地平系下实测位置计算、惯导姿态数据拟合和惯导姿态角时序误差计算。一、相关说明为便于本
技术实现思路
描述，在此对专利技术中涉及的坐标系定义简要说明。本专利技术主要涉及如下二个坐标系：二、恒星在地平系下实测位置计算1.经纬仪甲板系下恒星实测位置计算首先，使用脱靶量数据对经纬仪方位和俯仰角进行修正。设恒星在经纬仪视场内方位和俯仰方向的脱靶量分别为△A、△E，则：式中：Aj、Ej为经纬仪方位和俯仰轴角编码器测量数据。然后，对经纬仪轴系参数进行修正。式中：g—经纬仪方位零位；c—经纬仪照准差；I—经纬仪横轴差；βm—经纬仪垂直轴最大倾斜量。最后，利用轴系参数修正后的经纬仪测角数据，计算恒星在经纬仪甲板坐标系所在方向单位矢量的直角坐标(xj,yj,zj)。2.地平系下恒星实测位置计算利用惯导姿态测量数据进行坐标系的旋转和变换，经纬仪甲板系转换到地平系应进行三次坐标旋转，坐标旋转后，在地平系下恒星单位矢量的直角坐标(x,y,z)为：式中：R—惯导实测横摇；P—惯导实测纵摇；H—惯导实测航向。根据恒星在地平系下的直角坐标，计算出恒星在地平系下的实测方位、俯仰角：Edc＝atan(z)三、惯导姿态数据拟合由于船舶惯性较大，其横纵摇和航向的变化曲线较为平滑，可采用最小二乘法完成惯导姿态角基于时间序列的四次多项式拟合。设短时间的惯导姿态数据可以用四次多项式进行表示：式中：r0～r4—横摇多项式系数；p0～p4—纵摇多项式系数；h0～h4—航向多项式系数。根据最小二乘法原理，横纵摇和航向多项式系数计算表达式为：其中：四、惯导姿态角时序误差计算1.惯导姿态角时序误差特点与恒星在地平系下的理论方位、俯仰相比，恒星实测方位、俯仰角的误差为下面三种误差的叠加。(1)惯导姿态角常值性误差，由于短时间内恒星在地平系下的位置变化较小，引起的恒星实测方位、俯仰误差可视为常值。(2)惯导姿态角随机性误差，引起的恒星实测方位、俯仰误差可视为随机性误差。(3)经纬仪轴系参数常值性误差，引起的恒星实测方位、俯仰误差可视为常值。当惯导姿态角时序正常时，恒星实测方位、俯仰角误差特点应为围绕常值误差的随机分布，惯导姿态角时序正常情况下的恒星实测方位角误差，如图1所示。当惯导姿态角时序存在稳定误差时，惯导姿态角误差将呈现出类似正弦的变化。该误差引起的恒星实测方位、俯仰误差特点，应为围绕常值误差变化的类似正弦叠加曲线，如图2所示。2.惯导姿态角时序误差检测方法使用最小二乘拟合算法，计算出在现有时序下超前或滞后不同时间时的惯导姿态数据，使其分别与经纬仪观测数据进行组合，计算出在地平系下恒星方位、俯仰角误差的标准差。恒星实测方位、俯仰角误差的标准差会随着惯导姿态角时序误差的增大而变大，标准差最小的那组惯导姿态数据对应的时序，即为惯导姿态角时序误差。实施例：经纬仪在观测同一颗恒星的过程中，不断调整惯导时统修正量，修正量的步进幅度为1ms，获取了数组惯导和经纬仪实测数据，并对各组数据对应的实测恒星方位角误差的标准差进行计算，具体结果如表1所示。表1惯导时序误差与经纬仪方位标准差关系表表1中，惯导姿态角时序误差越大，经纬仪方位误差标准差也越大。除上述实施例外，本专利技术还包括有其他实施方式，凡采用等同变换或者等效替换方式形成的技术方案，均应落入本专利技术权利要求的保护范围之内。本文档来自技高网...

【技术保护点】
一种基于恒星观测的船载惯导姿态角时序检测方法，其特征在于：所述方法包括以下步骤：步骤一、利用惯导姿态角和经纬仪测角数据，计算出恒星在地平系下的实测指向；步骤二、使用最小二乘法，拟合计算出任意时刻的惯导姿态角数据；步骤三、计算出超前或滞后不同时间的惯导姿态数据，分别与经纬仪观测数据进行组合，寻找地平系下恒星方位、俯仰角误差的标准差最小的一组惯导姿态数据，对应时序即为惯导姿态角时序误差。

【技术特征摘要】
1.一种基于恒星观测的船载惯导姿态角时序检测方法，其特征在于：所述方法包括以下步骤：步骤一、利用惯导姿态角和经纬仪测角数据，计算出恒星在地平系下的实测指向；步骤二、使用最小二乘法，拟合计算出任意时刻的惯导姿态角数据；步骤三、计算出超前或滞后不同时间的惯导姿态数据，分别与经纬仪观测数据进行组合，寻找地平系下恒星方位、俯仰角误差的标准差最小的一组惯导姿态数据，对应时序即为惯导姿态角时序误差。2.根据权利要求1所述的一种基于恒星观测的船载惯导姿态角时序检测方法，其特征在于：步骤一具体包括：1)计算经纬仪甲板系下恒星实测位置首先，使用脱靶量数据对经纬仪方位和俯仰角进行修正，设恒星在经纬仪视场内方位和俯仰方向的脱靶量分别为△A、△E，则：式中：Aj、Ej为经纬仪方位和俯仰轴角编码器测量数据；然后，对经纬仪轴系参数进行修正，式中：g—经纬仪方位零位；c—经纬仪照准差；I—经纬仪横轴差；βm—经纬仪垂直轴最大倾斜量；最后，利用轴系参数修正后的经纬...

【专利技术属性】
技术研发人员：王前学，刘新明，周海渊，赵李健，徐如祥，杨恒，黄晓娟，桑海峰，冯小勇，
申请(专利权)人：中国人民解放军六三六八六部队，
类型：发明
国别省市：江苏,32