一种基于自适应差分进化BP神经网络的姿态误差抑制方法技术

本发明专利技术公开了一种基于自适应差分进化BP神经网络的姿态误差抑制方法，属于惯性技术领域。包括初始化惯性/星敏感器组合导航系统；采集星敏感器和惯性组件输出的数据；对惯性组件输出数据进行导航解算；利用星敏感器输出数据解算舰船相对于惯性系的姿态；利用ADE‑BPNN结合当前时刻前一段时间内组合导航姿态对载体系相对惯性系姿态角进行预测；利用预测姿态对星敏感器测量误差进行补偿利用补偿后的星敏感器输出信息解算舰船位置；获得的导航信息进行组合导航解算；存储并输出组合导航信息。本发明专利技术通过自适应差分进化BP神经网络对星敏感器姿态进行预测，解决舰船摇摆引起的星敏感器星图“拖尾”问题，增强了舰船摇摆时惯性/星敏感器组合导航系统的适用性。

A method of attitude error suppression based on adaptive differential evolution BP neural network

The invention discloses an attitude error suppression method based on adaptive differential evolution BP neural network, which belongs to the field of inertial technology. It includes initializing the inertial/star sensor integrated navigation system, collecting the output data of star sensor and inertial component, calculating the output data of inertial component, calculating the ship's attitude relative to inertial system by using the output data of star sensor, and combining ADE BPNN with the integrated navigation attitude pair in the period before the current moment. The attitude angle of the carrier system relative to the inertial system is predicted; the measurement error of the star sensor is compensated by the predicted attitude; the position of the ship is calculated by the output information of the compensated star sensor; the navigation information obtained is calculated by the integrated navigation; and the integrated navigation information is stored and output. The method predicts the attitude of star sensor by adaptive differential evolution BP neural network, solves the problem of star map \tailing\ caused by ship swaying, and enhances the applicability of inertial/star sensor integrated navigation system when ship swaying.

【技术实现步骤摘要】
一种基于自适应差分进化BP神经网络的姿态误差抑制方法
本专利技术属于惯性
中减小导航信息误差的方法，具体涉及一种基于自适应差分进化BP神经网络的姿态误差抑制方法。
技术介绍
惯性/星敏感器组合导航是一种以惯性导航系统(InertialNavigationSystem，INS)为主的导航系统，可为载体提供实时速度、姿态和位置信息。INS主要利用陀螺仪和加速度计测量载体角速度和线运动信息。经导航解算后得到导航信息；星敏感器通过拍摄星图并与自身星图库作对比，得到安装载体相对于惯性空间的姿态信息。惯性/星敏感器组合导航系统以星敏感器解算的导航信息为基准，对INS的发散式定位误差进行周期性重校，其不需要任何外界信息，是一种全自主导航系统。惯性/星敏感器组合导航系统具有实时性强、导航精度高、全自主等优点，被广泛应用于船舶导航中。然而，由于舰船水平摇摆使星敏感器拍摄的星图具有“拖尾”现象，影响星敏感器的解算精度，进而影响惯性/星敏感器组合导航精度。《中国惯性技术学报》2010年18卷第4期中由杨波等人撰写的《弹载惯性/卫星/星光高精度组合导航》一文中，提出了对陀螺误差和星敏感器安装偏差角的在线自标定方法，抑制了器件偏差对导航精度的影响；《中国空间科学技术》2013年6月第3期中由张承等人撰写的《直接敏感地平的空天飞行器惯性/天文组合方法》一文中，提出了采用星敏感器和陀螺仪构造惯性基准，并在此基础上进行基于红外地平仪的天文定位解算，最后进行惯性/天文组合定位的方法，抑制了陀螺的漂移误差；公开号为CN105737858A的专利在2016年7月6日公开的《一种机载惯导系统姿态参数校准方法与装置》，该方法使用精度高的高动态星敏感器输出的姿态数据为基准完成机载INS姿态参数的动态在线校准；《IEEESENSORSJOURNAL》2017年17卷第21期中由杨延强等人撰写的《In-flightCalibrationofGyrosandStarSensorwithObservabilityAnalysisforSINS/CNSIntegration》一文中，通过分析基于奇异值的误差状态的可观测度，提出了一种四位解耦校准方法，抑制了器件偏差对导航精度的影响，以上文献都提出了能够抑制器件偏差的方法，并且多以弹载、机载为应用背景，并没有针对船用环境下，由于舰船摇摆这一特殊应用环境造成的星图“拖尾”引起的星敏感器解算信息不精确问题进行深入研究。
技术实现思路
本专利技术的目的在于提供提高导航精度，增强导航信息适用性的一种基于自适应差分进化BP神经网络的姿态误差抑制方法。本专利技术的目的通过如下技术方案来实现：基于ADE-BPNN，将惯性/星敏感器组合导航系统的一段时间内组合导航信息作为输入，预测出当前t时刻载体姿态，利用卡尔曼滤波对t时刻预测载体姿态和t时刻星敏感器解算载体姿态进行数据融合，对星敏感器的导航误差进行估计、补偿，得到星敏感器高精度导航信息，与INS导航信息进行组合导航解。一种基于自适应差分进化BP神经网络的姿态误差抑制方法，包括以下步骤：步骤1：上电，初始化惯性/星敏感器组合导航系统。步骤2：采集星敏感器和惯性组件输出数据。步骤3：对步骤2中惯性组件输出数据进行导航解算，得到载体位置载体三向速度载体三轴姿态角其中，分别表示纬度、经度；分别表示东向、北向、天向速度；姿态角包括纵摇角、横摇角和航向角，分别由表示。步骤4：由步骤2中星敏感器输出相对于惯性空间的姿态矩阵得到载体相对惯性系姿态角即其中，b表示载体坐标系，i表示惯性系，表示载体系到惯性系转换矩阵；cbimn(m,n＝1,2,3)表示中第m行、第n列矩阵元素；arcsin为三角函数中的反正弦函数，arctan为三角函数中的反正切函数；分别表示载体相对惯性系的纵摇角、横摇角和航向角。步骤5：利用ADE-BPNN预测t时刻载体相对惯性系姿态角其中，t表示当前时刻，分别表示载体相对惯性系纵摇角、横摇角和航向角的预测值。步骤6：构造卡尔曼滤波器1，以星敏感器测量误差δφCi(i＝x,y,z)为状态量，步骤4中星敏感器解算载体姿态和步骤5中预测载体姿态之差为观测量，解算δφCi(i＝x,y,z)，利用解算结果对步骤4解算结果进行补偿，得到φCi(i＝x,y,z)。其中，δφCx、δφCy、δφCz分别表示星敏感器纵摇角、横摇角和航向角误差；φCx、φCy、φCz分别表示载体相对惯性系的纵摇角、横摇角和航向角。步骤7：根据转换矩阵间的数学关系，得到地球坐标系相对准地理坐标系的转换矩阵转换过程为进一步解算得到载体的位置，即其中，分别表示纬度和经度；e表示地球系，N表示准地理坐标系，表示地球系到准地理坐标系的转换矩阵；ceNmn(m,n＝1,2,3)表示中第m行、第n列矩阵元素；表示载体系到准地理坐标系的转换矩阵；表示载体系到惯性系转换矩阵；角标T表示矩阵转置；表示地球系到惯性系转换矩阵。步骤8：构造卡尔曼滤波器2，以步骤7解算位置与步骤3中INS解算位置之差λC-λS为观测量，INS位置误差δλS，速度误差δvSi(i＝x,y,z)，失准角Φi(i＝x,y,z)，三轴陀螺常值误差εi(i＝x,y,z)，三轴加速度计零位偏置误差ΔAi(i＝x,y,z)为状态量，解算δλS、δvSi(i＝x,y,z)、Φi(i＝x,y,z)、εi(i＝x,y,z)、ΔAi(i＝x,y,z)，对步骤3解算结果进行补偿，得到载体位置λ，速度vi(i＝x,y,z)，姿态角φi(i＝x,y,z)。其中，δλS分别表示纬度、经度误差；δvSx、δvSy、δvSz分别表示东向、北向和天向速度误差；Φx、Φy、Φz分别表示纵摇失准角、横摇失准角、航向失准角。步骤9：将步骤8中得到的导航信息载体位置、速度和姿态角存储并输出。本专利技术的有益效果在于：在得到舰船正常工作的组合导航信息后，结合ADE-BPNN算法，预测出星敏感器输出惯性姿态，消除星图“拖尾”对星敏感器输出姿态角的影响，与INS进行组合导航解算，输出导航信息。(1)增强了在舰船出现水平摇摆时惯性/星敏感器组合导航系统的适用性，减小了因舰船摇摆导致的误差补偿不充分问题；(2)不需要任何外界辅助信息即可提高定位精度；(3)计算量小，简单易实现。附图说明图1为本专利技术的组合导航算法流程图；图2为利用本专利技术进行的仿真试验结果；图3为利用本专利技术进行的实测实验结果；图4为实测实验舰船航行轨迹。具体实施方式下面结合附图对本专利技术的具体实施方式作进一步说明：如图1所示，本专利技术提供一种针对惯性/星敏感器的组合导航算法，具体包括如下步骤：步骤1：上电，初始化惯性/星敏感器组合导航系统。导航初始化，需初始化系统：(1)初始化INS初值：船体的载体位置λ0(单位均为度)，载体三向速度vi0(i＝x,y,z)(单位均为m/s)，载体三轴姿态角φi0(i＝x,y,z)(单位均为度)；初始化转换矩阵初始化四元数q0；(2)卡尔曼滤波器1参数初值：状态变量初值δφCi0(i＝x,y,z)，均方误差阵Pp0，系统噪声方阵Qp，量测噪声方阵Rp，量测阵Hp；其余初值根据实际情况设定。(3)卡尔曼滤波器2参数初值：状态变量初值δvS0i(i＝x,y,z)、δλS0、Φi0(i＝x,y,z)、εi0(本文档来自技高网...

【技术保护点】
1.一种基于自适应差分进化BP神经网络的姿态误差抑制方法，其特征在于，包括以下步骤：(1)上电，初始化惯性/星敏感器组合导航系统；(2)系统实时采集星敏感器输出矩阵

【技术特征摘要】
1.一种基于自适应差分进化BP神经网络的姿态误差抑制方法，其特征在于，包括以下步骤：(1)上电，初始化惯性/星敏感器组合导航系统；(2)系统实时采集星敏感器输出矩阵惯性组件加速度计输出的三轴加速度和陀螺仪输出的三轴角速度其中，分别表示加速度计测量的比力在载体系oxb轴、oyb轴、ozb轴上的分量，单位均为m/s；分别表示陀螺仪测量的角速度在载体系oxb轴、oyb轴、ozb轴上的分量，单位均为rad/s；(3)对步骤(2)中惯性组件采集数据进行导航解算；(4)由步骤(2)中星敏感器输出相对于惯性空间的姿态矩阵得到载体相对惯性系姿态角(5)利用ADE-BPNN预测t时刻载体相对惯性系姿态角其中，t表示当前时刻，分别表示载体相对惯性系纵摇角、横摇角和航向角的预测值；(6)构造卡尔曼滤波器1，以星敏感器测量误差δφCi(i＝x,y,z)为状态量，步骤(4)中星敏感器解算载体姿态和步骤(5)中预测载体姿态之差为观测量；根据解算结果，对步骤(4)解算结果进行补偿，得到惯性姿态角φCi(i＝x,y,z)；(7)根据转换矩阵间的数学关系，得到地球坐标系相对准地理坐标系的转换矩阵转换过程为进一步解算得到载体的位置，载体系到准地理系的转换矩阵由步骤(3)中解算的水平姿态得到，载体系到惯性系转换矩阵由步骤(6)中解算结果惯性姿态角得到；(8)构造卡尔曼滤波器2，以步骤(7)解算位置与步骤(3)中INS解算位置之差λC-λS为观测量，INS位置误差速度误差δvSi(i＝x,y,z)，失准角Φi(i＝x,y,z)，三轴陀螺常值误差εi(i＝x,y,z)，三轴加速度计零位偏置误差ΔAi(i＝x,y,z)为状态量，根据解算结果，对步骤(3)中INS解算结果进行补偿，得到导航信息载体位置λ，速度vi(i＝x,y,z)，姿态角φi(i＝x,y,z)；(9)将步骤(8)中得到的导航信息载体位置、速度和姿态角存储并输出。2.根据权利要求1所述的一种基于自适应差分进化BP神经网络的姿态误差抑制方法，其特征在于，所述的步骤(1)具体包括：(1.1)初始化INS初值：船体的载体位置λ0(单位均为度)，载体三向速度vi0(i＝x,y,z)(单位均为m/s)，载体三轴姿态角φi0(i＝x,y,z)(单位均为度)；初始化转换矩阵初始化四元数q0；(1.2)卡尔曼滤波器1参数初值：状态变量初值δφCi0(i＝x,y,z)，均方误差阵Pp0，系统噪声方阵Qp，量测噪声方阵Rp，量测阵Hp；其余初值根据实际情况设定。(1.3)卡尔曼滤波器2参数初值：状态变量初值δvS0i(i＝x,y,z)、δλS0、Φi0(i＝x,y,z)、εi0(i＝x,y,z)、ΔAi0(i＝x,y,z)，均方误差阵P0，系统噪声方阵Q，量测噪声方阵R，量测阵H；其余初值根据实际情况设定。初始化转换矩阵计算如下：其中，n表示导航系，表示初始载体系到导航系的转移矩阵；初始化四元数q0计算如下：q00＝a，其中q0＝[q00q01q02q03]T，cbnij(i,j＝1,2,3)表示中第i行、第j列矩阵元素；导航过程中，利用该初始信息进行更新，得到任意时刻载体的位置、速度和姿态角。3.根据权利要求1所述的一种基于自适应差分进化BP神经网络的姿态误差抑制方法，其特征在于，所述的步骤(3)具体包括：(3.1)四元数姿态矩阵更新：设任意时刻载体系相对导航系的转动四元数为q＝[q0q1q2q3]T，四元数的及时修正如下：其中，分别表示qi(i＝0,1,2,3)的变化率；(3.2)将t时刻载体系相对导航系的转动四元数qi(t)(i＝0,1,2,3)代替式(4)中qi(i＝0,1,2,3)，得到t时刻转动四元数的变化率在t+1时刻载体的转动四元数为其中式中ωi(i＝x,y,z)省略了上角标b；T为采样时间；当t＝1时，q(1)为步骤1中的载体初始四元数q0。(3.3)根据q(t+1)中元素qi(t+1)(i＝0,1,2,3)，更新捷联矩阵其中，上式中的qi(i＝0,1,2,3)为式(5)中qi(t+1)(i＝0,1,2,3)，更新姿态信息：(3.4)利用转换关系式将加速度计沿载体系测量的比力信息投影转换到导航系，利用下列微分方程求解载体运动速度：其中，表示的变化率；分别表示加速度计测量的比力在导航系oxn轴、oyn轴、ozn轴上的分量(单位均为m/s)；(3.5)将t时刻比力在导航系的投影fin(t)(i＝x,y,z)，代替式(8)中的fin(i＝x,y,z)，得到载体速度变化率得到t+1时刻载体速度和位置：其中，R表示地球半径；当t＝1时，为步骤1中载体速度初始值vi0(i＝x,y,z...

【专利技术属性】
技术研发人员：王秋滢，张明惠，刘凯悦，匡春旭，钟万青，尹娟，程铭，郭铮，崔旭飞，
申请(专利权)人：哈尔滨工程大学，
类型：发明
国别省市：黑龙江,23