CN110030992B - 一种基于磁强计的空中飞行物高速旋转角运动测量方法 - Google Patents
一种基于磁强计的空中飞行物高速旋转角运动测量方法 Download PDFInfo
- Publication number
- CN110030992B CN110030992B CN201910271100.0A CN201910271100A CN110030992B CN 110030992 B CN110030992 B CN 110030992B CN 201910271100 A CN201910271100 A CN 201910271100A CN 110030992 B CN110030992 B CN 110030992B
- Authority
- CN
- China
- Prior art keywords
- speed
- time
- change
- rotation
- angle
- 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
- 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)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Life Sciences & Earth Sciences (AREA)
- Environmental & Geological Engineering (AREA)
- General Life Sciences & Earth Sciences (AREA)
- Geology (AREA)
- Automation & Control Theory (AREA)
- Measuring Magnetic Variables (AREA)
Abstract
本发明公开了一种基于磁强计的空中飞行物高速旋转角运动测量方法,为:在被测物体上,与物体高速旋转轴垂直的平面内,利用磁传感器组同步测量物体高速旋转时敏感到的地球磁场分量,从而计算获得旋转角度的变化量、旋转角速率。本发明具有原理简单、易实现、测量精度高等优点。
Description
技术领域
本发明主要涉及到高速旋转物体的旋转运动测量领域,特指一种基于磁强计的空中飞行物高速旋转角运动测量方法。
背景技术
为了简化控制,很多空中飞行物采用沿着某个轴高速旋转的方式,来实现飞行的自稳定。但由于高速旋转,如何实现对这些高速旋转的飞行物的运动测量,则成为一个棘手的问题。
传统上,可以采用陀螺来敏感载体角运动,比如通过3个正交安装的陀螺仪,可以测量飞行物的完整的角运动。但在高速旋转方向,由于转动的角速度较大,因此要求陀螺具有极大的测量范围。陀螺的标度因数误差也对测量精度的影响很大,从而使得测量的角速度误差较大,积分后转动的角度误差逐步积累,因此很难实现对高速旋转的准确测量。
另外一种常用的方法,是基于磁罗盘的思想,利用三轴磁强计以及其他传感器来计算,其核心思想是利用其他传感器首先测量并计算载体的俯仰角和方位角,然后利用地磁场模型,计算滚转角,在获得三个欧拉角后,通过计算获得高速旋转轴的旋转角速率。这种方法的缺点在于:1)需要其他传感器提供3个角度中另外2个角度的测量值;2)需要精确已知当地地球磁场模型。
综上所述,对于相对于地球做高速旋转的载体,目前暂时还没有一种简单高效精确的方法,来对高速旋转轴的旋转角速率进行有效测量。
发明内容
本发明要解决的技术问题就在于:针对现有技术存在的技术问题,本发明提供一种原理简单、易实现、测量精度高的基于磁强计的空中飞行物高速旋转角运动测量方法。
为解决上述技术问题,本发明采用以下技术方案:
一种基于磁强计的空中飞行物高速旋转角运动测量方法,为:在被测物体上,与物体高速旋转轴垂直的平面内,利用磁传感器组同步测量物体高速旋转时敏感到的地球磁场分量,从而计算获得旋转角度的变化量、旋转角速率。
作为本发明的进一步改进:所述磁传感器组为一对敏感轴正交的磁传感器,通过磁传感器同步测量物体高速旋转时敏感到的地球磁场分量。
作为本发明的进一步改进:所述磁传感器组为两对以上正交的磁传感器,每对传感器的敏感轴都在平面内,且互成一定的角度,则计算的旋转角度变化量、旋转角速率,是每对正交的磁传感器计算的结果的平均值。
作为本发明的进一步改进:所述计算获得旋转角度的变化量、旋转角速率的流程为:
作为本发明的进一步改进:所述步骤S2中,在tk时刻,两个正交的磁传感器输出为:
其中,假设当地地球磁场矢量为M,地球磁场矢量投影到与高速旋转轴垂直的平面内的分量为Ms,定义载体高速旋转方向为X轴,Ms的方向为Ym轴,Zm轴按照右手坐标系定义确定,则两个正交的磁传感器的敏感轴位于YZ平面内,假设敏感轴位于Ys和Zs,Ym轴与Ys轴的夹角为θ,则随着物体高速旋转,θ不断变化。
本发明进一步提出另外方案,即:一种基于磁强计的空中飞行物高速旋转角运动测量方法,在被测物体上,与物体高速旋转轴垂直的平面内,利用磁传感器组同步测量物体高速旋转时敏感到的地球磁场分量,当一段时间内高速旋转轴的朝向变化可以忽略时,通过磁传感器计算该段时间内获得旋转角度的变化量、旋转角速率。
作为本发明的进一步改进:所述当一段时间内高速旋转轴的朝向变化可以忽略时,是指直接由外部其他传感器给出的该旋转轴的朝向值或者朝向的变化,并据此判断朝向变化是否可以忽略。
作为本发明的进一步改进:所述当一段时间内高速旋转轴的朝向变化可以忽略时,是指在与旋转轴平行的方向,安装第三个磁传感器,敏感地球磁场在旋转轴方向的投影分量,并判断该磁传感器输出信号的变化是否小于某个阈值,当小于该阈值,则认为朝向变化可以忽略,具体为:
作为本发明的进一步改进:所述当一段时间内高速旋转轴的朝向变化可以忽略时,是指通过计算这对磁传感器测量到的信号幅度的变化是否小于某个阈值来判断,当小于该阈值,则认为朝向变化可以忽略,具体为:
设当地地球磁场矢量为M,地球磁场矢量投影到与高速旋转轴垂直的平面内的分量为Ms,定义载体高速旋转方向为X轴,Ms的方向为Ym轴,Zm轴按照右手坐标系定义确定;则两个正交的磁传感器的敏感轴位于YmZm平面内,假设敏感轴位于Ys和Zs,Ym轴与Ys轴的夹角为θ,则随着物体高速旋转,θ不断变化;传感器测量误差为ny和nz,则在tk时刻,两个正交的磁传感器输出为:
作为本发明的进一步改进:所述的当旋转轴的朝向变化可以忽略时,通过磁传感器计算该段时间内旋转的角度以及平均旋转角速率,具体流程为:
与现有技术相比,本发明的优点在于:
本发明通过在与高速旋转轴垂直的平面内,安装多个磁传感器,并测量地球磁场,根据高速旋转时磁传感器测量值的变化规律来计算旋转角速率。与现有技术相比,本发明仅仅使用多个磁传感器,而且不需要精确的地球磁场模型,误差不积累。
附图说明
图1是本发明中地球磁场与高速旋转轴的关系示意图。
图2是本发明中与旋转轴垂直的平面内磁传感器敏感轴与磁向量的关系示意图。
具体实施方式
以下将结合说明书附图和具体实施例对本发明做进一步详细说明。
实施例1:本发明的一种基于磁强计的空中飞行物高速旋转角运动测量方法,为:在被测物体上,与物体高速旋转轴垂直的平面内,利用磁传感器同组步测量物体高速旋转时敏感到的地球磁场分量,从而计算获得旋转角度的变化量、旋转角速率。
在本实施例中,本发明是安装了一对敏感轴正交的磁传感器,通过磁传感器同步测量物体高速旋转时敏感到的地球磁场分量,从而计算获得旋转角度的变化量、旋转角速率。
在具体应用实例中,通过磁传感器同步测量物体高速旋转时敏感到的地球磁场分量,计算获得旋转角度的变化量、旋转角速率,详细过程为:
参见图1和图2,假设当地地球磁场矢量为M,地球磁场矢量投影到与高速旋转轴垂直的平面内的分量为Ms,定义载体高速旋转方向为X轴,Ms的方向为Ym轴,Zm轴按照右手坐标系定义确定。则两个正交的磁传感器的敏感轴位于YZ平面内,假设敏感轴位于Ys和Zs,Ym轴与Ys轴的夹角为θ,则随着物体高速旋转,θ不断变化。不考虑传感器测量误差,则在tk时刻,两个正交的磁传感器输出为:
结合上述过程,在具体应用实例中,本发明的测量方法的详细计算流程如下:
步骤S5:转至步骤S1。
在具体应用实例中,在被测物体上,与物体高速旋转轴垂直的平面内,根据实际需要也可以安装两对以上正交的磁传感器,每对传感器的敏感轴都在该平面内,且互成一定的角度,则计算的旋转角度变化量、旋转角速率,可以是每对正交的磁传感器计算的结果的平均。
在具体应用实例中,由于计算的旋转角度变化量、旋转角速率以及M的大小均无关,只与Ms的朝向有关,因此该方法不仅仅可用于高速旋转的测量,也可用于任意空中飞行物现对于地球的转动运动的测量。
在具体应用实例中,由于计算的旋转角度变化量、旋转角速率与Ms以及M的大小均无关,只与Ms的朝向有关,因此只要Ms朝向的变化可以忽略,就可以采用该方法测量空中飞行物现对于地球的角运动。
实施例2:一种基于磁强计的空中飞行物高速旋转角运动测量方法,在被测物体上,与物体高速旋转轴垂直的平面内,利用磁传感器组同步测量物体高速旋转时敏感到的地球磁场分量,当一段时间内高速旋转轴的朝向变化可以忽略时,通过磁传感器计算该段时间内获得旋转角度的变化量、旋转角速率。
在本实施中,所述当一段时间内高速旋转轴的朝向变化可以忽略时,是指直接由外部其他传感器给出的该旋转轴的朝向值或者朝向的变化,并据此判断朝向变化是否可以忽略。
在本实施中,所述当一段时间内高速旋转轴的朝向变化可以忽略时,是指在与旋转轴平行的方向,安装第三个磁传感器,敏感地球磁场在旋转轴方向的投影分量,并判断该磁传感器输出信号的变化是否小于某个阈值,当小于该阈值,则认为朝向变化可以忽略,具体为:
在本实施中,所述当一段时间内高速旋转轴的朝向变化可以忽略时,是指通过计算这对磁传感器测量到的信号幅度的变化是否小于某个阈值来判断,当小于该阈值,则认为朝向变化可以忽略,具体为:
设当地地球磁场矢量为M,地球磁场矢量投影到与高速旋转轴垂直的平面内的分量为Ms,定义载体高速旋转方向为X轴,Ms的方向为Ym轴,Zm轴按照右手坐标系定义确定;则两个正交的磁传感器的敏感轴位于YmZm平面内,假设敏感轴位于Ys和Zs,Ym轴与Ys轴的夹角为θ,则随着物体高速旋转,θ不断变化;传感器测量误差为ny和nz,则在tk时刻,两个正交的磁传感器输出为:
在本实施中,所述的当旋转轴的朝向变化可以忽略时,通过磁传感器计算该段时间内旋转的角度以及旋转角速率,具体流程为:
以上仅是本发明的优选实施方式,本发明的保护范围并不仅局限于上述实施例,凡属于本发明思路下的技术方案均属于本发明的保护范围。应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理前提下的若干改进和润饰,应视为本发明的保护范围。
Claims (7)
1.一种基于磁强计的空中飞行物高速旋转角运动测量方法,其特征在于,在被测物体上,与物体高速旋转轴垂直的平面内,利用磁传感器组同步测量物体高速旋转时敏感到的地球磁场分量,从而计算获得旋转角度的变化量、旋转角速率;所述磁传感器组为一对敏感轴正交的磁传感器,通过磁传感器同步测量物体高速旋转时敏感到的地球磁场分量;所述计算获得旋转角度的变化量、旋转角速率的流程为:
其中,假设当地地球磁场矢量为M,地球磁场矢量投影到与高速旋转轴垂直的平面内的分量为Ms,定义载体高速旋转方向为X轴,Ms的方向为Ym轴,Zm轴按照右手坐标系定义确定,则两个正交的磁传感器的敏感轴位于YZ平面内,假设敏感轴位于Ys和Zs,Ym轴与Ys轴的夹角为θ,则随着物体高速旋转,θ不断变化;
2.根据权利要求1所述的基于磁强计的空中飞行物高速旋转角运动测量方法,其特征在于,所述磁传感器组为两对以上正交的磁传感器,每对传感器的敏感轴都在平面内,且互成一定的角度,则计算的旋转角度变化量、旋转角速率,是每对正交的磁传感器计算的结果的平均值。
5.一种基于磁强计的空中飞行物高速旋转角运动测量方法,其特征在于,在被测物体上,与物体高速旋转轴垂直的平面内,利用磁传感器组同步测量物体高速旋转时敏感到的地球磁场分量,当一段时间内高速旋转轴的朝向变化可以忽略时,通过磁传感器计算该段时间内获得旋转角度的变化量、旋转角速率;
所述当一段时间内高速旋转轴的朝向变化可以忽略时,是指通过计算这对磁传感器测量到的信号幅度的变化是否小于某个阈值来判断,当小于该阈值,则认为朝向变化可以忽略,具体为:
设当地地球磁场矢量为M,地球磁场矢量投影到与高速旋转轴垂直的平面内的分量为Ms,定义载体高速旋转方向为X轴,Ms的方向为Ym轴,Zm轴按照右手坐标系定义确定;则两个正交的磁传感器的敏感轴位于YmZm平面内,假设敏感轴位于Ys和Zs,Ym轴与Ys轴的夹角为θ,则随着物体高速旋转,θ不断变化;传感器测量误差为ny和nz,则在tk时刻,两个正交的磁传感器输出为:
所述的当旋转轴的朝向变化可以忽略时,通过磁传感器计算该段时间内旋转的角度以及平均旋转角速率,具体流程为:
6.根据权利要求5所述的基于磁强计的空中飞行物高速旋转角运动测量方法,其特征在于,所述当一段时间内高速旋转轴的朝向变化可以忽略时,是指直接由外部其他传感器给出的该旋转轴的朝向值或者朝向的变化,并据此判断朝向变化是否可以忽略。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910271100.0A CN110030992B (zh) | 2019-04-04 | 2019-04-04 | 一种基于磁强计的空中飞行物高速旋转角运动测量方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910271100.0A CN110030992B (zh) | 2019-04-04 | 2019-04-04 | 一种基于磁强计的空中飞行物高速旋转角运动测量方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110030992A CN110030992A (zh) | 2019-07-19 |
CN110030992B true CN110030992B (zh) | 2023-03-24 |
Family
ID=67237541
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910271100.0A Active CN110030992B (zh) | 2019-04-04 | 2019-04-04 | 一种基于磁强计的空中飞行物高速旋转角运动测量方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110030992B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110579620A (zh) * | 2019-10-25 | 2019-12-17 | 深圳航天东方红海特卫星有限公司 | 一种通过磁强计对角速度进行测量的方法及系统 |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5263024B2 (ja) * | 2009-06-18 | 2013-08-14 | 株式会社日立製作所 | 回転角検出装置および回転速度検出装置 |
CN101644579B (zh) * | 2009-08-17 | 2011-08-03 | 中国人民解放军国防科学技术大学 | 一种空中微小抛撒物运动参数测量方法及系统 |
CN105674815A (zh) * | 2016-01-14 | 2016-06-15 | 南京理工大学 | 一种应用于高速旋转弹体的姿态测量装置 |
CN107314718B (zh) * | 2017-05-31 | 2018-11-13 | 中北大学 | 基于磁测滚转角速率信息的高速旋转弹姿态估计方法 |
CN107883940A (zh) * | 2017-10-31 | 2018-04-06 | 北京理工大学 | 一种制导炮弹用高动态姿态测量方法 |
CN108168550B (zh) * | 2017-11-22 | 2021-08-03 | 西安现代控制技术研究所 | 一种高速旋转载体惯性姿态测量装置 |
CN109373833B (zh) * | 2018-12-07 | 2020-11-03 | 惠州学院 | 适用于旋转弹初始姿态和速度联合测量方法 |
-
2019
- 2019-04-04 CN CN201910271100.0A patent/CN110030992B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN110030992A (zh) | 2019-07-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111678538B (zh) | 一种基于速度匹配的动态水平仪误差补偿方法 | |
CN107270893B (zh) | 面向不动产测量的杆臂、时间不同步误差估计与补偿方法 | |
Guo et al. | The soft iron and hard iron calibration method using extended Kalman filter for attitude and heading reference system | |
CN103299247B (zh) | 用于磁近场的动态追踪及补偿的设备和方法 | |
CN108458714B (zh) | 一种姿态检测系统中不含重力加速度的欧拉角求解方法 | |
CN104459828B (zh) | 基于绕轴法的地磁矢量系统非对准校正方法 | |
CN101839719A (zh) | 一种基于陀螺、地磁传感器的惯性测量装置 | |
CN107024673B (zh) | 基于陀螺仪辅助的三轴磁强计全误差标定方法 | |
CN106153069B (zh) | 自主导航系统中的姿态修正装置和方法 | |
CN109682377A (zh) | 一种基于动态步长梯度下降的姿态估计方法 | |
CN105910606A (zh) | 一种基于角速度差值的方向修正方法 | |
US11408735B2 (en) | Positioning system and positioning method | |
CN106370178B (zh) | 移动终端设备的姿态测量方法及装置 | |
CN111272158B (zh) | 复杂磁扰动场景mems电子罗盘的动态方位角解算方法 | |
CN105892498B (zh) | 基于三轴云台的目标凝视与扫视控制系统 | |
CN103712598A (zh) | 一种小型无人机姿态确定系统与确定方法 | |
CN103630123B (zh) | 一种波浪传感器 | |
CN110736484B (zh) | 基于陀螺仪及磁传感器融合的背景磁场标定方法 | |
CN110030991B (zh) | 融合陀螺和磁强计的飞行物高速旋转角运动测量方法 | |
CN110030992B (zh) | 一种基于磁强计的空中飞行物高速旋转角运动测量方法 | |
CN111912402B (zh) | 基于地磁信息辅助gps的高旋转载体的测姿方法及装置 | |
CN106979779A (zh) | 一种无人车实时姿态测量方法 | |
CN107063181A (zh) | 复杂环境下多功能调试台的水平倾角的测量方法及装置 | |
CN109084755B (zh) | 一种基于重力视速度与参数辨识的加速度计零偏估计方法 | |
CN111141285B (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 |