CN110030991A - 融合陀螺和磁强计的飞行物高速旋转角运动测量方法 - Google Patents

Abstract

一种融合陀螺和磁强计的飞行物高速旋转角运动测量方法，包括：步骤S1：在被测物上与高速旋转轴平行的方向安装一个陀螺，测量旋转轴的旋转角速率；在与被测物高速旋转轴垂直的平面内，安装一对敏感轴正交的磁传感器，同步测量物体高速旋转时投影在磁传感器敏感轴上的地球磁场分量；步骤S2：当判断出旋转轴朝向的变化在一段时间内可以忽略时，以磁传感器输出计算该段时间段内旋转的角度变化量；步骤S3：该段时间内旋转的角度变化量与陀螺输出计算的旋转的角度变化量进行对比，计算陀螺误差源的误差大小；步骤S4：利用计算的陀螺误差，对陀螺测量值输出进行校正，得到高速旋转角速率的准确测量。本发明具有原理简单、操作简便、测量精度高等优点。

Description

融合陀螺和磁强计的飞行物高速旋转角运动测量方法

技术领域

本发明主要涉及到高速旋转物体的旋转运动测量领域，特指一种融合陀螺和磁强计的飞行物高速旋转角运动测量方法。

背景技术

为了简化控制，很多空中飞行物采用沿着某个轴高速旋转的方式，来实现飞行的自稳定。但由于高速旋转，如何实现对这些高速旋转的飞行物的运动测量，从而对其进行控制，则成为一个棘手的问题。

传统上，可以采用陀螺来敏感载体角运动，比如通过3个正交安装的陀螺仪，可以测量飞行物的完整的角运动。但在高速旋转方向，由于转动的角速率很大，从而导致陀螺的标度因数误差对旋转角度的测量精度的影响很大，即使很小的标度因数误差也会导致很大的角度测量误差，因此很难实现对高速旋转的准确测量。

另外常用的方法，如基于磁测滚转叫速率信息的高速旋转弹姿态估计方法CN201710395976.7、基于磁阻传感器的末制导迫击炮弹滚转姿态初始对准技术研究、基于双轴磁强计及GPS的滚转角测量方法等，均是是基于磁罗盘的思想，利用三轴磁强计以及其他传感器来计算，其核心思想是利用其他传感器首先测量并计算载体的俯仰角和(或)方位角，然后利用地磁场模型，计算滚转角，在获得三个欧拉角后，通过计算获得高速旋转轴的旋转角速率。这种方法的缺点在于：1)需要其他传感器提供3个角度中另外1个或2个角度的测量值；2)需要精确已知当地地球磁场模型。

Attitude determination of a spinning and tumbling rocket using datafrom two orthogonal magnetometers,Shu T.Lai,1981.讨论了使用2个正交的磁强计来测量，但其中一个的敏感轴朝向是高速旋转方向，并且主要用于测量载体的仰角。

综上所述，对于那些相对地球做高速旋转的载体，还没有一种简单高效精确的方法，来对高速旋转轴的旋转角速率进行全飞行时间段内的有效测量。

发明内容

本发明要解决的技术问题就在于：针对现有技术存在的技术问题，本发明提供一种原理简单、操作简便、测量精度高的融合陀螺和磁强计的飞行物高速旋转角运动测量方法。

为解决上述技术问题，本发明采用以下技术方案：

一种融合陀螺和磁强计的飞行物高速旋转角运动测量方法，其特征在于，包括：

步骤S1：在被测物上与高速旋转轴平行的方向安装一个陀螺，测量旋转轴的旋转角速率；同时在与被测物高速旋转轴垂直的平面内，安装一对敏感轴正交的磁传感器，同步测量物体高速旋转时投影在磁传感器敏感轴上的地球磁场分量；

步骤S2：当判断出旋转轴朝向的变化在一段时间内可以忽略时，以磁传感器输出计算该段时间段内旋转的角度变化量；

步骤S3：以该段时间内旋转的角度变化量与陀螺输出计算的旋转的角度变化量进行对比，计算陀螺误差源的误差大小；

步骤S4：利用计算的陀螺误差，对陀螺测量值输出进行校正，得到高速旋转角速率的准确测量。

作为本发明的进一步改进：所述陀螺测量旋转轴的旋转角速率，用下式表示：

其中，为t_k时刻飞行物高速旋转轴的真实旋转角速度，为t_k时刻陀螺的输出输出，δk为陀螺的标度因数误差，ε为陀螺的零偏误差。

作为本发明的进一步改进：在所述磁传感器中，设当地地球磁场矢量为M，地球磁场矢量投影到与高速旋转轴垂直的平面内的分量为M_s，定义载体高速旋转方向为X轴，M_s的方向为Ym轴，Zm轴按照右手坐标系定义确定，则两个正交的磁传感器的敏感轴位于YmZm平面内；假设敏感轴位于Ys和Zs，Ym轴与Ys轴的夹角为θ，则随着物体高速旋转，θ不断变化；传感器测量误差为n_y和n_z，则在t_k时刻，两个正交的磁传感器输出为：

其中，和为两个磁传感器t_k时刻的输出，不考虑外界其它干扰软磁或者硬磁的影响；或者，假设这些干扰磁场已经经过磁校正与补偿，则磁传感器误差n_y和n_z很小，等效为噪声。

作为本发明的进一步改进：所述步骤S2中，通过计算一对磁传感器测量到的信号幅度的变化在一段时间内是否小于某个阈值来判断，当小于该阈值，则认为朝向变化没有发生变化。

作为本发明的进一步改进：所述步骤S2中，直接由外部其他传感器给出的该旋转轴的朝向值或者朝向的变化，并据此判断朝向变化是否可以忽略。

作为本发明的进一步改进：所述步骤S2中，直接在与旋转轴平行的方向安装第三个磁传感器，敏感地球磁场在旋转轴方向的投影分量，并判断该磁传感器输出信号的变化是否小于某个阈值，当小于该阈值，则认为朝向变化忽略。

作为本发明的进一步改进：所述步骤S2中，以磁传感器输出计算一个旋转的角度变化量，具体为：

t_k时刻夹角为：

t_k时刻到t_k+1时刻旋转的角度为：

则从t_M到t_N这段时间转动的角度Θ_M,N为：

作为本发明的进一步改进：所述步骤S3中，以包含误差源的陀螺模型作为***方程，以该段时间内的磁传感器输出计算的旋转的角度变化量为观测量构建观测方程，采用卡尔曼滤波对陀螺的误差源进行估计。

作为本发明的进一步改进：建立卡尔曼滤波***方程：

X＝[δk ε]^T

其中，η_k和η_ω分别为标度因数和零偏误差的驱动白噪声，X为卡尔曼滤波的***状态向量；

建立如下观测方程：

其中，ΔT为采样时间，z表示卡尔曼滤波的观测量，υ_m为观测噪声，大小与磁传感器的误差大小有关。

与现有技术相比，本发明的优点在于：本发明的融合陀螺和磁强计的飞行物高速旋转角运动测量方法，原理简单、操作简便，通过在与高速旋转轴垂直的平面内，安装多个磁传感器，并测量地球磁场，根据高速旋转时磁传感器测量值的变化规律来计算旋转角速率，从而能够实现沿载体高速旋转轴旋转角速度的简单精确测量，而且不需要精确的地球磁场模型，误差不积累。

附图说明

图1是本发明方法的流程示意图。

图2是本发明在具体应用实例中结构原理示意图。

具体实施方式

以下将结合说明书附图和具体实施例对本发明做进一步详细说明。

如图1所示，本发明的一种融合陀螺和磁强计的飞行物高速旋转角运动测量方法，包括：

步骤S1：在被测物上与高速旋转轴平行的方向安装一个陀螺，测量旋转轴的旋转角速率；同时在与被测物高速旋转轴垂直的平面内，安装一对敏感轴正交的磁传感器，同步测量物体高速旋转时投影在磁传感器敏感轴上的地球磁场分量；

步骤S2：当判断出旋转轴朝向的变化在一段时间内可以忽略时，以磁传感器输出计算该段时间段内旋转的角度变化量；

步骤S3：以该段时间内旋转的角度变化量与陀螺输出计算的旋转的角度变化量进行对比，计算陀螺误差源的误差大小；

步骤S4：利用计算的陀螺误差，对陀螺测量值输出进行校正，得到高速旋转角速率的准确测量。

在具体应用实例中，所述在与高速旋转轴平行的方向安装一个陀螺，测量旋转轴的旋转角速率，是指由于高速旋转，导致陀螺的标度因数误差不可忽略，因此其测量输出的旋转角速率，可以用下式表示：

这里，为t_k时刻飞行物高速旋转轴的真实旋转角速度，为t_k时刻陀螺的输出输出，δk为陀螺的标度因数误差，ε为陀螺的零偏误差。

在具体应用实例中，所述在与被测物高速旋转轴垂直的平面内，安装一对敏感轴正交的磁传感器，同步测量物体高速旋转时投影在磁传感器敏感轴上的地球磁场分量，具体为：

设当地地球磁场矢量为M，地球磁场矢量投影到与高速旋转轴垂直的平面内的分量为M_s，定义载体高速旋转方向为X轴，M_s的方向为Ym轴，Zm轴按照右手坐标系定义确定。则两个正交的磁传感器的敏感轴位于YmZm平面内，假设敏感轴位于Ys和Zs，Ym轴与Ys轴的夹角为θ，则随着物体高速旋转，θ不断变化。传感器测量误差为n_y和n_z，则在t_k时刻，两个正交的磁传感器输出为：

这里，和为两个磁传感器t_k时刻的输出，不考虑外界其它干扰软磁或者硬磁的影响，或者假设这些干扰磁场已经经过磁校正与补偿，则磁传感器误差n_y和n_z很小，可以等效为噪声。

在一个具体应用实例中，所述判断出旋转轴朝向的变化在一段时间内可以忽略是指：通过计算这对磁传感器测量到的信号幅度的变化在一段时间内是否小于某个阈值来判断，当小于该阈值，则认为朝向变化没有发生变化，具体为：

则t_k时刻磁传感器测量到的地球磁场分量的幅度为：

则计算t_M时刻到t_N时刻时间段内高速旋转轴的朝向是否变化，就是判断下式是否成立：

这里表示对在时间段[t_M,t_N]求均值。σ为阈值，其大小与磁传感器误差相关。

在另一个具体应用实例中，所述的判断出旋转轴朝向的变化在一段时间内可以忽略，是指可以直接由外部其他传感器给出的该旋转轴的朝向值或者朝向的变化，并据此判断朝向变化是否可以忽略。

在第三个具体应用实例中，所述的判断出旋转轴朝向的变化在一段时间内可以忽略，是指可以直接在与旋转轴平行的方向，安装第三个磁传感器，敏感地球磁场在旋转轴方向的投影分量，并判断该磁传感器输出信号的变化是否小于某个阈值，当小于该阈值，则认为朝向变化可以忽略，具体为：

这里m_c表示该磁传感器的输出，表示对在时间段[t_M,t_N]求均值。σ_c为阈值，其大小与该磁传感器误差相关。

可以理解，上述方法仅为本发明较佳的实施例而已，采用上述方法之外的方式，只要能够达到本发明的目的，也应在本发明的保护范围之内。

在具体应用实例中，所述以磁传感器输出计算一个旋转的角度变化量，具体为：

t_k时刻夹角为：

t_k时刻到t_k+1时刻旋转的角度为：

则从t_M到t_N这段时间转动的角度Θ_M,N为：

在具体应用实例中，所述以该段时间内的磁传感器计算的旋转的角度变化量和陀螺输出计算的旋转的角度变化量进行对比，计算陀螺的主要误差源的误差大小，可以是采用最优估计的方法，以包含其主要误差源的陀螺模型作为***方程，以该段时间内的磁传感器输出计算的旋转的角度变化量为观测量构建观测方程，采用卡尔曼滤波对陀螺的主要误差源进行估计，具体为：

建立如下卡尔曼滤波***方程：

这里η_k和η_ω分别为标度因数和零偏误差的驱动白噪声，X为卡尔曼滤波的***状态向量。

建立如下观测方程：

这里ΔT为采样时间，z表示卡尔曼滤波的观测量，υ_m为观测噪声，大小与磁传感器的误差大小有关。这里卡尔曼滤波为常规方式。

由于计算的旋转角度变化量与M_s以及M的大小均无关，只与M_s的朝向有关，因此该方法不仅仅可用于高速旋转的测量，也可用于任意空中飞行物现对于地球的转动运动的测量。

如果只采用磁强计的方式，其前提是地球磁场在磁传感器敏感面内投影的方向必须不发生变化。而大多数的空中旋转物体由于姿态的变化，很难全程做到这一点。另一方面，很有可能在一定时间段内，地球磁场正好与高速旋转轴一致，则磁传感器的输出为零，没有办法对其进行测量并计算。该方法只对一定的时间段有效，不能全程有效。因此，本发明的方法就能够很好的解决该问题。

在一个具体应用实例中，一个详细的处理流程为：

S101：同步采集2个正交安装的磁传感器输出以及陀螺输出；

S102：根据式(2)对陀螺输出进行校正；

S103：根据式(5)判断旋转轴朝向变化是否可以忽略；如果不可以忽略，则转至S101)；如果可以忽略，则转S104)

S104：根据式(9)计算转动角

S105：根据式(11)和式(12)计算***方程可观测方程，并利用卡尔曼滤波进行状态估计；

S106：转至1)。

以上仅是本发明的优选实施方式，本发明的保护范围并不仅局限于上述实施例，凡属于本发明思路下的技术方案均属于本发明的保护范围。应当指出，对于本技术领域的普通技术人员来说，在不脱离本发明原理前提下的若干改进和润饰，应视为本发明的保护范围。

Claims (9)

1.一种融合陀螺和磁强计的飞行物高速旋转角运动测量方法，其特征在于，包括：

步骤S1：在被测物上与高速旋转轴平行的方向安装一个陀螺，测量旋转轴的旋转角速率；同时在与被测物高速旋转轴垂直的平面内，安装一对敏感轴正交的磁传感器，同步测量物体高速旋转时投影在磁传感器敏感轴上的地球磁场分量；

步骤S2：当判断出旋转轴朝向的变化在一段时间内可以忽略时，以磁传感器输出计算该段时间段内旋转的角度变化量；

步骤S3：以该段时间内旋转的角度变化量与陀螺输出计算的旋转的角度变化量进行对比，计算陀螺误差源的误差大小；

步骤S4：利用计算得到的陀螺误差，对陀螺测量值输出进行校正，得到高速旋转角速率的准确测量。

2.根据权利要求1所述的融合陀螺和磁强计的飞行物高速旋转角运动测量方法，其特征在于，所述陀螺测量旋转轴的旋转角速率，用下式表示：

其中，为t_k时刻飞行物高速旋转轴的真实旋转角速度，为t_k时刻陀螺的输出输出，δk为陀螺的标度因数误差，ε为陀螺的零偏误差。

3.根据权利要求1所述的融合陀螺和磁强计的飞行物高速旋转角运动测量方法，其特征在于，在所述磁传感器中，设当地地球磁场矢量为M，地球磁场矢量投影到与高速旋转轴垂直的平面内的分量为M_s，定义载体高速旋转方向为X轴，M_s的方向为Ym轴，Zm轴按照右手坐标系定义确定，则两个正交的磁传感器的敏感轴位于YmZm平面内；假设敏感轴位于Ys和Zs，Ym轴与Ys轴的夹角为θ，则随着物体高速旋转，θ不断变化；传感器测量误差为n_y和n_z，则在t_k时刻，两个正交的磁传感器输出为：

其中，和为两个磁传感器t_k时刻的输出。

4.根据权利要求1或2或3所述的融合陀螺和磁强计的飞行物高速旋转角运动测量方法，其特征在于，所述步骤S2中，通过计算一对磁传感器测量到的信号幅度的变化在一段时间内是否小于某个阈值来判断，当小于该阈值，则认为朝向变化没有发生变化。

5.根据权利要求1或2或3所述的融合陀螺和磁强计的飞行物高速旋转角运动测量方法，其特征在于，所述步骤S2中，直接由外部其他传感器给出的该旋转轴的朝向值或者朝向的变化，并据此判断朝向变化是否可以忽略。

6.根据权利要求1或2或3所述的融合陀螺和磁强计的飞行物高速旋转角运动测量方法，其特征在于，所述步骤S2中，直接在与旋转轴平行的方向安装第三个磁传感器，敏感地球磁场在旋转轴方向的投影分量，并判断该磁传感器输出信号的变化是否小于某个阈值，当小于该阈值，则认为朝向变化忽略。

7.根据权利要求3所述的融合陀螺和磁强计的飞行物高速旋转角运动测量方法，其特征在于，所述步骤S2中，以磁传感器输出计算一个旋转的角度变化量，具体为：

t_k时刻夹角为：

t_k时刻到t_k+1时刻旋转的角度为：

则从t_M到t_N这段时间转动的角度Θ_M,N为：

8.根据权利要求1或2或3所述的融合陀螺和磁强计的飞行物高速旋转角运动测量方法，其特征在于，所述步骤S3中，以包含误差源的陀螺模型作为***方程，以该段时间内的磁传感器输出计算的旋转的角度变化量为观测量构建观测方程，采用卡尔曼滤波对陀螺的误差源进行估计。

9.根据权利要求8所述的融合陀螺和磁强计的飞行物高速旋转角运动测量方法，其特征在于，建立卡尔曼滤波***方程：

X＝[δk ε]^T

其中，η_k和η_ω分别为标度因数和零偏误差的驱动白噪声，X为卡尔曼滤波的***状态向量；

建立如下观测方程：

其中，ΔT为采样时间，z表示卡尔曼滤波的观测量，υ_m为观测噪声，大小与磁传感器的误差大小有关。