CN110030991B - 融合陀螺和磁强计的飞行物高速旋转角运动测量方法 - Google Patents
融合陀螺和磁强计的飞行物高速旋转角运动测量方法 Download PDFInfo
- Publication number
- CN110030991B CN110030991B CN201910270742.9A CN201910270742A CN110030991B CN 110030991 B CN110030991 B CN 110030991B CN 201910270742 A CN201910270742 A CN 201910270742A CN 110030991 B CN110030991 B CN 110030991B
- Authority
- CN
- China
- Prior art keywords
- gyroscope
- change
- speed
- error
- speed rotation
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/04—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means
- G01C21/08—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means involving use of the magnetic field of the earth
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/18—Stabilised platforms, e.g. by gyroscope
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
- G01P3/00—Measuring linear or angular speed; Measuring differences of linear or angular speeds
- G01P3/42—Devices characterised by the use of electric or magnetic means
- G01P3/44—Devices characterised by the use of electric or magnetic means for measuring angular speed
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Life Sciences & Earth Sciences (AREA)
- Environmental & Geological Engineering (AREA)
- General Life Sciences & Earth Sciences (AREA)
- Geology (AREA)
- Navigation (AREA)
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:利用计算的陀螺误差,对陀螺测量值输出进行校正,得到高速旋转角速率的准确测量。
作为本发明的进一步改进:所述陀螺测量旋转轴的旋转角速率,用下式表示:
作为本发明的进一步改进:在所述磁传感器中,设当地地球磁场矢量为M,地球磁场矢量投影到与高速旋转轴垂直的平面内的分量为Ms,定义载体高速旋转方向为X轴,Ms的方向为Ym轴,Zm轴按照右手坐标系定义确定,则两个正交的磁传感器的敏感轴位于YmZm平面内;假设敏感轴位于Ys和Zs,Ym轴与Ys轴的夹角为θ,则随着物体高速旋转,θ不断变化;传感器测量误差为ny和nz,则在tk时刻,两个正交的磁传感器输出为:
作为本发明的进一步改进:所述步骤S2中,通过计算一对磁传感器测量到的信号幅度的变化在一段时间内是否小于某个阈值来判断,当小于该阈值,则认为朝向变化没有发生变化。
作为本发明的进一步改进:所述步骤S2中,直接由外部其他传感器给出的该旋转轴的朝向值或者朝向的变化,并据此判断朝向变化是否可以忽略。
作为本发明的进一步改进:所述步骤S2中,直接在与旋转轴平行的方向安装第三个磁传感器,敏感地球磁场在旋转轴方向的投影分量,并判断该磁传感器输出信号的变化是否小于某个阈值,当小于该阈值,则认为朝向变化忽略。
作为本发明的进一步改进:所述步骤S2中,以磁传感器输出计算一个旋转的角度变化量,具体为:
则从tM到tN这段时间转动的角度ΘM,N为:
作为本发明的进一步改进:所述步骤S3中,以包含误差源的陀螺模型作为***方程,以该段时间内的磁传感器输出计算的旋转的角度变化量为观测量构建观测方程,采用卡尔曼滤波对陀螺的误差源进行估计。
作为本发明的进一步改进:建立卡尔曼滤波***方程:
X=[δkε]T
其中,ηk和ηω分别为标度因数和零偏误差的驱动白噪声,X为卡尔曼滤波的***状态向量;
建立如下观测方程:
其中,z表示卡尔曼滤波的观测量,υm为观测噪声,大小与磁传感器的误差大小有关。
与现有技术相比,本发明的优点在于:本发明的融合陀螺和磁强计的飞行物高速旋转角运动测量方法,原理简单、操作简便,通过在与高速旋转轴垂直的平面内,安装多个磁传感器,并测量地球磁场,根据高速旋转时磁传感器测量值的变化规律来计算旋转角速率,从而能够实现沿载体高速旋转轴旋转角速度的简单精确测量,而且不需要精确的地球磁场模型,误差不积累。
附图说明
图1是本发明方法的流程示意图。
图2是本发明在具体应用实例中结构原理示意图。
具体实施方式
以下将结合说明书附图和具体实施例对本发明做进一步详细说明。
如图1所示,本发明的一种融合陀螺和磁强计的飞行物高速旋转角运动测量方法,包括:
步骤S1:在被测物上与高速旋转轴平行的方向安装一个陀螺,测量旋转轴的旋转角速率;同时在与被测物高速旋转轴垂直的平面内,安装一对敏感轴正交的磁传感器,同步测量物体高速旋转时投影在磁传感器敏感轴上的地球磁场分量;
步骤S2:当判断出旋转轴朝向的变化在一段时间内可以忽略时,以磁传感器输出计算该段时间段内旋转的角度变化量;
步骤S3:以该段时间内旋转的角度变化量与陀螺输出计算的旋转的角度变化量进行对比,计算陀螺误差源的误差大小;
步骤S4:利用计算的陀螺误差,对陀螺测量值输出进行校正,得到高速旋转角速率的准确测量。
在具体应用实例中,所述在与高速旋转轴平行的方向安装一个陀螺,测量旋转轴的旋转角速率,是指由于高速旋转,导致陀螺的标度因数误差不可忽略,因此其测量输出的旋转角速率,可以用下式表示:
在具体应用实例中,所述在与被测物高速旋转轴垂直的平面内,安装一对敏感轴正交的磁传感器,同步测量物体高速旋转时投影在磁传感器敏感轴上的地球磁场分量,具体为:
设当地地球磁场矢量为M,地球磁场矢量投影到与高速旋转轴垂直的平面内的分量为Ms,定义载体高速旋转方向为X轴,Ms的方向为Ym轴,Zm轴按照右手坐标系定义确定。则两个正交的磁传感器的敏感轴位于YmZm平面内,假设敏感轴位于Ys和Zs,Ym轴与Ys轴的夹角为θ,则随着物体高速旋转,θ不断变化。传感器测量误差为ny和nz,则在tk时刻,两个正交的磁传感器输出为:
在一个具体应用实例中,所述判断出旋转轴朝向的变化在一段时间内可以忽略是指:通过计算这对磁传感器测量到的信号幅度的变化在一段时间内是否小于某个阈值来判断,当小于该阈值,则认为朝向变化没有发生变化,具体为:
则计算tM时刻到tN时刻时间段内高速旋转轴的朝向是否变化,就是判断下式
是否成立:
在另一个具体应用实例中,所述的判断出旋转轴朝向的变化在一段时间内可以忽略,是指可以直接由外部其他传感器给出的该旋转轴的朝向值或者朝向的变化,并据此判断朝向变化是否可以忽略。
在第三个具体应用实例中,所述的判断出旋转轴朝向的变化在一段时间内可以忽略,是指可以直接在与旋转轴平行的方向,安装第三个磁传感器,敏感地球磁场在旋转轴方向的投影分量,并判断该磁传感器输出信号的变化是否小于某个阈值,当小于该阈值,则认为朝向变化可以忽略,具体为:
可以理解,上述方法仅为本发明较佳的实施例而已,采用上述方法之外的方式,只要能够达到本发明的目的,也应在本发明的保护范围之内。
在具体应用实例中,所述以磁传感器输出计算一个旋转的角度变化量,具体为:
则从tM到tN这段时间转动的角度ΘM,N为:
在具体应用实例中,所述以该段时间内的磁传感器计算的旋转的角度变化量和陀螺输出计算的旋转的角度变化量进行对比,计算陀螺的主要误差源的误差大小,可以是采用最优估计的方法,以包含其主要误差源的陀螺模型作为***方程,以该段时间内的磁传感器输出计算的旋转的角度变化量为观测量构建观测方程,采用卡尔曼滤波对陀螺的主要误差源进行估计,具体为:
建立如下卡尔曼滤波***方程:
这里ηk和ηω分别为标度因数和零偏误差的驱动白噪声,X为卡尔曼滤波的***状态向量。
建立如下观测方程:
这里z表示卡尔曼滤波的观测量,υm为观测噪声,大小与磁传感器的误差大小有关。这里卡尔曼滤波为常规方式。
由于计算的旋转角度变化量与Ms以及M的大小均无关,只与Ms的朝向有关,因此该方法不仅仅可用于高速旋转的测量,也可用于任意空中飞行物现对于地球的转动运动的测量。
如果只采用磁强计的方式,其前提是地球磁场在磁传感器敏感面内投影的方向必须不发生变化。而大多数的空中旋转物体由于姿态的变化,很难全程做到这一点。另一方面,很有可能在一定时间段内,地球磁场正好与高速旋转轴一致,则磁传感器的输出为零,没有办法对其进行测量并计算。该方法只对一定的时间段有效,不能全程有效。因此,本发明的方法就能够很好的解决该问题。
在一个具体应用实例中,一个详细的处理流程为:
S101:同步采集2个正交安装的磁传感器输出以及陀螺输出;
S102:根据式(2)对陀螺输出进行校正;
S103:根据式(5)判断旋转轴朝向变化是否可以忽略;如果不可以忽略,则转至S101);如果可以忽略,则转S104)
S105:根据式(11)和式(12)计算***方程可观测方程,并利用卡尔曼滤波进行状态估计;
S106:转至1)。
以上仅是本发明的优选实施方式,本发明的保护范围并不仅局限于上述实施例,凡属于本发明思路下的技术方案均属于本发明的保护范围。应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理前提下的若干改进和润饰,应视为本发明的保护范围。
Claims (9)
1.一种融合陀螺和磁强计的飞行物高速旋转角运动测量方法,其特征在于,包括:
步骤S1:在被测物上与高速旋转轴平行的方向安装一个陀螺,测量旋转轴的旋转角速率;同时在与被测物高速旋转轴垂直的平面内,安装一对敏感轴正交的磁传感器,同步测量物体高速旋转时投影在磁传感器敏感轴上的地球磁场分量;
步骤S2:当判断出旋转轴朝向的变化在一段时间内可以忽略时,以磁传感器输出计算该段时间段内旋转的角度变化量;
步骤S3:以该段时间内旋转的角度变化量与陀螺输出计算的旋转的角度变化量进行对比,计算陀螺误差源的误差大小;
步骤S4:利用计算得到的陀螺误差,对陀螺测量值输出进行校正,得到高速旋转角速率的准确测量。
4.根据权利要求1或2或3所述的融合陀螺和磁强计的飞行物高速旋转角运动测量方法,其特征在于,所述步骤S2中,通过计算一对磁传感器测量到的信号幅度的变化在一段时间内是否小于某个阈值来判断,当小于该阈值,则认为朝向变化没有发生变化。
5.根据权利要求1或2或3所述的融合陀螺和磁强计的飞行物高速旋转角运动测量方法,其特征在于,所述步骤S2中,直接由外部其他传感器给出的该旋转轴的朝向值或者朝向的变化,并据此判断朝向变化是否可以忽略。
6.根据权利要求1或2或3所述的融合陀螺和磁强计的飞行物高速旋转角运动测量方法,其特征在于,所述步骤S2中,直接在与旋转轴平行的方向安装第三个磁传感器,敏感地球磁场在旋转轴方向的投影分量,并判断该磁传感器输出信号的变化是否小于某个阈值,当小于该阈值,则认为朝向变化忽略。
8.根据权利要求7所述的融合陀螺和磁强计的飞行物高速旋转角运动测量方法,其特征在于,所述步骤S3中,以包含误差源的陀螺模型作为***方程,以该段时间内的磁传感器输出计算的旋转的角度变化量为观测量构建观测方程,采用卡尔曼滤波对陀螺的误差源进行估计。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910270742.9A CN110030991B (zh) | 2019-04-04 | 2019-04-04 | 融合陀螺和磁强计的飞行物高速旋转角运动测量方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910270742.9A CN110030991B (zh) | 2019-04-04 | 2019-04-04 | 融合陀螺和磁强计的飞行物高速旋转角运动测量方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110030991A CN110030991A (zh) | 2019-07-19 |
CN110030991B true CN110030991B (zh) | 2022-12-02 |
Family
ID=67237558
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910270742.9A Active CN110030991B (zh) | 2019-04-04 | 2019-04-04 | 融合陀螺和磁强计的飞行物高速旋转角运动测量方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110030991B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111856355B (zh) * | 2020-07-16 | 2023-04-14 | 北京控制工程研究所 | 一种保持磁强计最优灵敏度的***及方法 |
CN112946313B (zh) * | 2021-02-01 | 2022-10-14 | 北京信息科技大学 | 二维弹道脉冲修正弹的滚转角速率的确定方法及装置 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101839719A (zh) * | 2010-05-16 | 2010-09-22 | 中北大学 | 一种基于陀螺、地磁传感器的惯性测量装置 |
FR2976353B1 (fr) * | 2011-06-07 | 2013-07-05 | Movea | Procede d'estimation simplifie de l'orientation d'un objet et centrale d'attitude mettant en oeuvre un tel procede |
US9207079B2 (en) * | 2012-06-21 | 2015-12-08 | Innovative Solutions & Support, Inc. | Method and system for compensating for soft iron magnetic disturbances in a heading reference system |
US10132829B2 (en) * | 2013-03-13 | 2018-11-20 | Invensense, Inc. | Heading confidence interval estimation |
CN107314718B (zh) * | 2017-05-31 | 2018-11-13 | 中北大学 | 基于磁测滚转角速率信息的高速旋转弹姿态估计方法 |
-
2019
- 2019-04-04 CN CN201910270742.9A patent/CN110030991B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN110030991A (zh) | 2019-07-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111678538B (zh) | 一种基于速度匹配的动态水平仪误差补偿方法 | |
CN104736963B (zh) | 测绘***和方法 | |
JP2020076781A (ja) | 機首方位参照システムにおける軟鉄磁気妨害の補償方法とシステム | |
CN108458714B (zh) | 一种姿态检测***中不含重力加速度的欧拉角求解方法 | |
CN103299247B (zh) | 用于磁近场的动态追踪及补偿的设备和方法 | |
CN106153069B (zh) | 自主导航***中的姿态修正装置和方法 | |
KR20040013439A (ko) | 지자계 센서의 자세 오차 보상장치 및 방법 | |
JP2014006248A5 (zh) | ||
CN104459828B (zh) | 基于绕轴法的地磁矢量***非对准校正方法 | |
CN109916394A (zh) | 一种融合光流位置和速度信息的组合导航算法 | |
CN107024673B (zh) | 基于陀螺仪辅助的三轴磁强计全误差标定方法 | |
CN111780786A (zh) | 一种三轴tmr传感器在线校准方法 | |
CN105910606A (zh) | 一种基于角速度差值的方向修正方法 | |
CN111272158B (zh) | 复杂磁扰动场景mems电子罗盘的动态方位角解算方法 | |
US11408735B2 (en) | Positioning system and positioning method | |
CN110030991B (zh) | 融合陀螺和磁强计的飞行物高速旋转角运动测量方法 | |
JP6983565B2 (ja) | 乗物の機首方位基準システムにおける軟鉄磁気擾乱を補償するための方法とシステム | |
CN110736484B (zh) | 基于陀螺仪及磁传感器融合的背景磁场标定方法 | |
JP5678357B2 (ja) | 回転情報演算方法、回転情報演算プログラム、磁気型ジャイロスコープおよび移動体 | |
CN105021193A (zh) | 一种无陀螺仪惯性导航***的控制算法 | |
JP2018052489A (ja) | 機首方位測定システムにおけるセンサ測定の欠如を補償するシステムと方法 | |
CN108871319A (zh) | 一种基于地球重力场与地磁场序贯修正的姿态解算方法 | |
CN111141285B (zh) | 一种航空重力测量装置 | |
CN110030992B (zh) | 一种基于磁强计的空中飞行物高速旋转角运动测量方法 | |
CN116660579A (zh) | 一种风速计数据校正方法、***及装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |