基于差商法磁测旋转飞行器滚转角的实时解算方法技术

本发明专利技术公开了一种基于差商法磁测旋转飞行器滚转角解算方法，利用捷联在飞行器体内的地磁传感器解算旋转飞行器滚转角，在飞行器飞行过程中，取同一个滚转周期内的三个磁测量点，将前一个磁测量点分别减去后两个磁测量点，然后将其差值作商，得到含有滚转角的数学表达式。本发明专利技术不仅简单、计算量小、不需要提前校正地磁传感器、在一个滚转周期的任何位置都能进行解算，而且该方法对传感器刻度因子误差和固定偏差具有很强的鲁棒性。

【技术实现步骤摘要】
基于差商法磁测旋转飞行器滚转角的实时解算方法
本专利技术属于飞行器姿态角测量领域，特别是一种基于差商法磁测旋转飞行器滚转角的实时解算方法。
技术介绍
地磁场是地球的天然磁场，可利用捷联在飞行器内的地磁传感器对其进行姿态解算。地磁传感器具有高灵敏、小体积、抗高发射过载和解算误差不随时间累积的优点。因此，地磁传感器能够应用于旋转飞行器的滚转角解算。南京理工大学曹鹏在博士论文“高旋弹丸滚转角的磁测量误差建模及仿真实验研究”中介绍了一种传统磁测滚转角的解算方法。在飞行器的滚转平面内，地磁矢量在弹径平面的分矢量为Bc，其分矢量在飞行器轴坐标系中的量测值为和在飞行器坐标系中的量测值为by和bz。则飞行器滚转角的计算表达式为：如果运用传统方法解算飞行器滚转角，该方法需要地磁传感器两个敏感轴方向的输出量，同时传感器刻度因子误差和固定偏差对该方法的解算精度有一定的影响。
技术实现思路
本专利技术的目的在于提供一种基于差商法磁测旋转飞行器滚转角的实时解算方法，利用地磁传感器单轴的磁测量信号，提高旋转飞行器磁测滚转角解算精度、消除传感器由于刻度因子误差和固定偏差引起的滚转角解算误差。实现本专利技术目的的技术解决方案为：一种基于差商法磁测旋转飞行器滚转角的实时解算方法，方法步骤如下：步骤1：建立地磁传感器敏感轴输出模型：步骤1-1：对飞行器进行坐标变换：采用地磁测量飞行器滚转角的过程中，捷联于飞行器内部的地磁传感器敏感方向与飞行器坐标轴方向一致，并利用测量所得的地磁信息进行飞行器姿态解算；飞行器发射坐标系ox1y1z1向飞行器体坐标系osxyz的转换关系为：分别为地磁场强度在发射坐标系ox1y1z1中各轴的分量，bx、by、bz分别为地磁场强度在飞行器体坐标系osxyz中各轴的分量，为飞行器姿态转换矩阵；θ为飞行器俯仰角，为飞行器偏航角，γ为飞行器滚转角；步骤1-2：计算参考滚转角γB：当飞行器滚转角γ与参考滚转角γB相等时，分矢量Bc在飞行器体坐标系osxyz中的分量bz为0；根据公式(1.2)和公式(1.3)得到bz的表达式将γ＝γB和bz＝0代入公式(1.4)得到参考滚转角的表达式：在飞行器的滚转平面内，地球地磁矢量在弹径平面的分矢量为Bc，by和bz为分矢量为Bc在飞行器体坐标系osxyz中的投影分量，即为地磁传感器敏感轴的输出量；和为分矢量为Bc在飞行器轴坐标系osx2y2z2中的投影分量；γB为地磁场分矢量Bc与y2轴方向的夹角，即参考滚转角；γ为飞行器体坐标系osxyz的y轴方向和飞行器轴坐标系osx2y2z2的y2轴方向的夹角，即飞行器滚转角；步骤1-3：获得地磁传感器敏感轴输出模型，通过地磁传感器y轴方向的地磁分量大小by表示：飞行器滚转一周，地磁传感器y轴方向的地磁分量大小by的表达式为by＝Bccos(γ-γB)(1.6)在飞行器磁测量环境下，磁场测量误差包括磁场敏感方向刻度因子误差、传感器的固定偏差和测量噪声带来的随机偏差；当只考虑前两种测量误差时，将表达式(1.6)改写为by＝kyBccos(γ-γB)+bs(1.7)式中，ky表示地磁传感器y轴方向的刻度因子误差，bs表示地磁传感器的固定偏差；步骤2：获取任意两个时刻滚转角间隔：Δγ为任意两个时刻滚转角间隔，Δt12为任意两个时刻的时间差，为第i个周期的滚转角速率。步骤3：解算飞行器滚转角。本专利技术与现有技术相比，其显著优点在于：(1)方法简单、计算量小、不需要提前校正地磁传感器，在一个滚转周期的任意位置都能进行解算。(2)对传感器刻度因子误差和固定偏差具有很强的鲁棒性，仅需要单轴的硬件滤波信号就能解算出飞行器滚转角。附图说明图1为本专利技术飞行器坐标转换示意图。图2为本专利技术飞行器滚转角解算原理示意图。图3为本专利技术地磁传感器输出量示意图。图4为本专利技术基于差商法磁测旋转飞行器滚转角的实时解算方法流程图。具体实施方式下面结合附图对本专利技术作进一步详细描述。结合图4，一种基于差商法磁测旋转飞行器滚转角的实时解算方法，方法步骤如下：步骤1：建立地磁传感器敏感轴输出模型：步骤1-1：对飞行器进行坐标变换：采用地磁测量飞行器滚转角的过程中，捷联于飞行器内部的地磁传感器敏感方向与飞行器坐标轴方向一致，并利用测量所得的地磁信息进行飞行器姿态解算。坐标轴定义如图1所示。其中坐标系osxyz为飞行器体坐标系，坐标系osx2y2z2为飞行器轴坐标系，坐标系ox1y1z1为飞行器发射坐标系。θ为飞行器俯仰角，为飞行器偏航角，γ为飞行器滚转角。飞行器发射坐标系ox1y1z1向飞行器体坐标系osxyz的转换关系为：分别为地磁场强度在发射坐标系ox1y1z1中各轴的分量，bx、by、bz分别为地磁场强度在飞行器体坐标系osxyz中各轴的分量，为飞行器姿态转换矩阵。步骤1-2：计算参考滚转角γB：在飞行器的滚转平面内，地球地磁矢量在弹径平面的分矢量为Bc，其分矢量在飞行器轴坐标系osx2y2z2和在飞行器体坐标系osxyz中的投影分量如图2。by和bz均为分矢量为Bc在飞行器体坐标系osxyz中的投影分量，同时也是地磁传感器敏感轴的输出量。和为分矢量为Bc在飞行器轴坐标系osx2y2z2中的投影分量。γB为地磁场分矢量Bc与y2轴方向的夹角，也称为参考滚转角。γ为飞行器体坐标系osxyz的y轴方向和飞行器轴坐标系osx2y2z2的y2轴方向的夹角，也称为飞行器滚转角。飞行器轴坐标系osx2y2z2是一个定坐标系，飞行器体坐标系osxyz是一个动坐标系。当飞行器滚转角γ与参考滚转角γB相等时，分矢量Bc在飞行器体坐标系osxyz中的分量bz为0。根据公式(1.2)和公式(1.3)得到bz的表达式将γ＝γB和bz＝0代入公式(1.4)得到参考滚转角的表达式：步骤1-3：获得地磁传感器敏感轴输出模型，通过地磁传感器y轴方向的地磁分量大小by表示：飞行器滚转一周，地磁传感器y轴方向的地磁分量大小by的表达式为by＝Bccos(γ-γB)(1.6)在飞行器磁测量环境下，磁场测量误差包括磁场敏感方向刻度因子误差、传感器的固定偏差和测量噪声带来的随机偏差。当只考虑前两种测量误差时，将表达式(1.6)改写为by＝kyBccos(γ-γB)+bs(1.7)式中，ky表示地磁传感器y轴方向的刻度因子误差，bs表示地磁传感器的固定偏差。步骤2：获取任意两个时刻滚转角间隔：步骤2-1：计算第i个周期飞行器滚转角速率在解算第i个周期飞行器滚转角时，其滚转角速率未知。假设在相邻两个滚转周期内，滚转角速率大小相近。因此，可以用第i-1个周期的滚转角速率替代第i个周期的滚转角速率的表达式用第i-1个周期的时间间隔Δti-1表示为步骤2-2：计算任意两个时刻滚转角间隔Δγ：在飞行器飞行过程中，在第i个周期内，任意两个时刻滚转角间隔Δγ可以用这两个时刻的时间差Δt12和第i个周期的滚转角速率表示步骤3：解算飞行器滚转角：步骤3-1：推导飞行器滚转角解算模型在飞行器滚转过程中，地磁传感器y轴测量输出量如图3所示，在第i个滚转周期的t1时刻，假设飞行器滚转角为γ。在t1时刻之前取两点，分别记为t2时刻和t3时刻。其中，t2时刻与t1时刻滚转角相差Δγ1，t3时刻与t1时刻滚转角相差Δγ2。在t1、t2、t3时刻，地磁传感器y轴测本文档来自技高网...

【技术保护点】
一种基于差商法磁测旋转飞行器滚转角的实时解算方法，其特征在于，方法步骤如下：步骤1：建立地磁传感器敏感轴输出模型：步骤1‑1：对飞行器进行坐标变换：采用地磁测量飞行器滚转角的过程中，捷联于飞行器内部的地磁传感器敏感方向与飞行器坐标轴方向一致，并利用测量所得的地磁信息进行飞行器姿态解算；飞行器发射坐标系ox1y1z1向飞行器体坐标系osxyz的转换关系为：

【技术特征摘要】
1.一种基于差商法磁测旋转飞行器滚转角的实时解算方法，其特征在于，方法步骤如下：步骤1：建立地磁传感器敏感轴输出模型：步骤1-1：对飞行器进行坐标变换：采用地磁测量飞行器滚转角的过程中，捷联于飞行器内部的地磁传感器敏感方向与飞行器坐标轴方向一致，并利用测量所得的地磁信息进行飞行器姿态解算；飞行器发射坐标系ox1y1z1向飞行器体坐标系osxyz的转换关系为：分别为地磁场强度在发射坐标系ox1y1z1中各轴的分量，bx、by、bz分别为地磁场强度在飞行器体坐标系osxyz中各轴的分量，为飞行器姿态转换矩阵；θ为飞行器俯仰角，为飞行器偏航角，γ为飞行器滚转角；步骤1-2：计算参考滚转角γB：当飞行器滚转角γ与参考滚转角γB相等时，分矢量Bc在飞行器体坐标系osxyz中的分量bz为0；根据公式(1.2)和公式(1.3)得到bz的表达式将γ＝γB和bz＝0代入公式(1.4)得到参考滚转角的表达式：在飞行器的滚转平面内，地球地磁矢量在弹径平面的分矢量为Bc，by和bz为分矢量为Bc在飞行器体坐标系osxyz中的投影分量，即为地磁传感器敏感轴的输出量；和为分矢量为Bc在飞行器轴坐标系osx2y2z2中的投影分量；γB为地磁场分矢量Bc与y2轴方向的夹角，即参考滚转角；γ为飞行器体坐标系osxyz的y轴方向和飞行器轴坐标系osx2y2z2的y2轴方向的夹角，即飞行器滚转角；步骤1-3：获得地磁传感器敏感轴输出模型，通过地磁传感器y轴方向的地磁分量大小by表示：飞行器滚转一周，地磁传感器y轴方向的地磁分量大小by的表达式为by＝Bccos(γ-γB)(1.6)在飞行器磁测量环境下，磁场测量误差包括磁场敏感方向刻度因子误差、传感器的固定偏差和测量噪声带来的随机偏差；当只考虑前两种测量误差时，将表达式(1.6)改写为by＝kyBccos(γ-γB)+bs(1.7)式中，ky表示地磁传感器y轴方向的刻度因子误差，bs表示地磁传感器的固定偏差；步骤2：获取任意两个时刻滚转角间隔：Δγ为任意两个时刻滚转角间隔，Δt12为任意两个时刻的时间差，为第i个周期的滚转角速率。步骤3：解算飞行器滚转角。2.根据权利要求1所述的基于差商法磁测旋转飞行器滚转角的实时解算方法，其特征在于，上述步骤2中获取任意两个时刻滚转角间隔，具体步骤如下：步骤2-1：计算第i个周...

【专利技术属性】
技术研发人员：于纪言，鞠潭，王钰，殷婷婷，冯斌，
申请(专利权)人：南京理工大学，
类型：发明
国别省市：江苏,32