CN112179380A - 一种动态情况下速率陀螺误差补偿方法 - Google Patents
一种动态情况下速率陀螺误差补偿方法 Download PDFInfo
- Publication number
- CN112179380A CN112179380A CN202011025235.8A CN202011025235A CN112179380A CN 112179380 A CN112179380 A CN 112179380A CN 202011025235 A CN202011025235 A CN 202011025235A CN 112179380 A CN112179380 A CN 112179380A
- Authority
- CN
- China
- Prior art keywords
- angle
- carrier
- gamma
- pitch angle
- course
- 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.)
- Granted
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C19/00—Gyroscopes; Turn-sensitive devices using vibrating masses; Turn-sensitive devices without moving masses; Measuring angular rate using gyroscopic effects
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Manufacturing & Machinery (AREA)
- Gyroscopes (AREA)
Abstract
本发明提供了一种动态情况下速率陀螺误差补偿方法。当载体处于圆周运动或盘旋飞行运动状态的航向角在90°±Δφ和270°±Δφ范围内,倾斜角γ在0°±Δγ和180°±Δγ的范围内时,利用加速度计纵向分量解算俯仰角,利用该俯仰角和三轴磁传感器的输出在解算出载体倾斜角和航向角。再利用俯仰角、倾斜角和航向角对速率陀螺解算出的俯仰角、倾斜角和航向角进行补偿。该方法解决了载体长时间处于加速运动时,陀螺仪漂移误差大、系统精度低的问题。
Description
技术领域
本发明属于惯性导航领域,具体涉及一种速率陀螺误差补偿方法。
背景技术
采用三轴MEMS加速度计、三轴MEMS陀螺仪和三轴磁传感器组合测量载体的三维姿态是构成小型化航姿系统的重要技术。由于三轴MEMS陀螺仪精度低,导致航姿系统精度偏低。如何对三轴MEMS陀螺仪进行补偿校准提高其测量精度是本领域的关键技术。
中国专利CN 103411623 B“速率陀螺校准方法.”公开了一种速率陀螺标定方法。该方法将载体分别绕X轴、Y轴、Z轴旋转,由磁传感器的输出数据变化计算载体的旋转角速率,分别校准速率陀螺的每个轴的标度因数和零偏误差。该方法无需速率转台,实现条件简单,适用于在线快速标定,但仅适用于静态标定,无法在载体存在额外加速度时对陀螺仪进行补偿。文献“基于ARM的航姿参考系统研究[D].上海交通大学,2010.”公开了一种载体额外加速度较小时,利用三轴MEMS加速度计和三轴磁传感器解算出的俯仰角、倾斜角和航向角信息对速率陀螺进行补偿的方法。但如果载体长时间处于非匀速直线运动状态(例如飞机长时间盘旋飞行),速率陀螺得不到及时补偿将造成较大的测量误差。当采用三轴MEMS陀螺仪时,情况更为严重。
发明内容
为了克服现有技术的不足,本发明提供了一种动态情况下速率陀螺误差补偿方法。当载体处于圆周运动或盘旋飞行运动状态的航向角在90°±Δφ和270°±Δφ范围内,倾斜角γ在0°±Δγ和180°±Δγ的范围内时,利用加速度计纵向分量解算俯仰角,利用该俯仰角和三轴磁传感器的输出在解算出载体倾斜角和航向角。再利用俯仰角、倾斜角和航向角对速率陀螺解算出的俯仰角、倾斜角和航向角进行补偿。该方法解决了载体长时间处于加速运动时,陀螺仪漂移误差大、系统精度低的问题。
本发明解决其技术问题所采用的技术方案包括以下步骤:
步骤1:当载体做匀速直线运动时,三轴MEMS加速度计测量到载体在xyz三轴的加速度值分别为:Ax0、Ay0、Az0;计算得到载体重力加速度为:
由Ax0、Ay0、Az0与俯仰角θ和倾斜角γ的关系式:
能解算出载体做匀速直线运动时的俯仰角和倾斜角,再利用三轴磁传感器的输出与俯仰角、倾斜角和航向角的关系计算出载体做匀速直线运动时的航向角;
步骤2:当载体做非匀速直线运动时,计算俯仰角、倾斜角和航向角;
步骤2-1:三轴MEMS加速度计测量到载体在xyz三轴的加速度值分别为:Ax、 Ay、Az;计算得到载体合重力加速度为:
此时存在额外加速度ax、ay和az,Ax、Ay、Az与俯仰角θ、倾斜角γ和额外加速度 ax、ay和az的关系为:
步骤2-2:计算载体做非匀速直线运动时的俯仰角:
步骤2-3:计算载体做非匀速直线运动时的航向角和倾斜角;
其中,h0为地磁场水平分量,hv=hotanα,α为当地的地磁倾角;
求解式(6)得到:
当0°<γt-1<90°时,γ=γt-1;
当90°<γt-1<270°时,γ=180°-γt-1;
当270°<γt-1<360°时,γ=360°+γt-1;
步骤3:设定航向角校正精度和倾斜角校正精度Δγ;当航向角在90°或270°倾斜角γ在0°±Δγ或180°±Δγ内时,将步骤1和步骤2的计算结果分别带入求解姿态的算法中,替换三轴MEMS陀螺仪的输出值,以此矫正三轴MEMS 陀螺仪的漂移误差。
优选地,步骤3中所述的求解姿态的算法为四元数算法或欧拉角算法。
本发明的有益效果是:本发明中当载体存在额外加速度时,即长时间处于盘旋或平飞状态时,利用加速度计与磁传感器补偿陀螺仪的漂移误差,可以解决载体长时间处于加速运动时,陀螺仪漂移误差大、系统精度低的问题。
具体实施方式
下面通过实施例对本发明进一步说明。
步骤1:当载体做匀速直线运动时,三轴MEMS加速度计测量到载体在xyz三轴的加速度值分别为:Ax0、Ay0、Az0;计算得到载体重力加速度为:
由Ax0、Ay0、Az0与俯仰角θ和倾斜角γ的关系式:
能解算出载体做匀速直线运动时的俯仰角和倾斜角,再利用三轴磁传感器的输出与俯仰角、倾斜角和航向角的关系计算出载体做匀速直线运动时的航向角;
步骤2:当载体做非匀速直线运动时,计算俯仰角、倾斜角和航向角;
步骤2-1:三轴MEMS加速度计测量到载体在xyz三轴的加速度值分别为:Ax、 Ay、Az;计算得到载体合重力加速度为:
此时存在额外加速度ax、ay和az,Ax、Ay、Az与俯仰角θ、倾斜角γ和额外加速度 ax、ay和az的关系为:
步骤2-2:计算载体做非匀速直线运动时的俯仰角:
当载体存在额外加速度,即ax、ay和az不同时为零时,大多数情况下处于盘旋或者平飞状态,此时俯仰角θ较小,故而纵向额外加速度ay很小,认为纵轴方向加速度传感器测得的加速度Ay是因俯仰角不为零引起的,由此可解算出载体的俯仰角;
步骤2-3:计算载体做非匀速直线运动时的航向角和倾斜角;
其中,h0为地磁场水平分量,hv=hotanα,α为当地的地磁倾角;
求解式(6)得到:
当0°<γt-1<90°时,γ=γt-1;
当90°<γt-1<270°时,γ=180°-γt-1;
当270°<γt-1<360°时,γ=360°+γt-1;
步骤3:设定航向角校正精度和倾斜角校正精度Δγ;当航向角在90°或270°倾斜角γ在0°±Δγ或180°±Δγ内时,将步骤1和步骤2的计算结果分别带入求解姿态的算法中,替换三轴MEMS陀螺仪的输出值,以此矫正三轴MEMS 陀螺仪的漂移误差。
优选地,步骤3中所述的求解姿态的算法为四元数算法或欧拉角算法。
具体实施例:
在动态情况下,利用加速度计和磁传感器补偿速率陀螺。载体长时间处于非匀速直线运动状态通常是在做圆周运动,如飞机在盘旋飞行。这种情况下,载体纵轴方向的运动加速度可认为等于零,纵轴方向加速度传感器测得的加速度是因俯仰角不为零引起的,由此可解算出载体的俯仰角。利用此时的俯仰角值和磁传感器测得的磁信息解算出航向角和倾斜角。
实施例1:
1由三轴加速度计、三轴速率陀螺仪和三轴磁传感器构成航姿系统。
2在静止状态下,利用三轴加速度计的输出,计算出重力加速度g。
3对三轴加速度计的输出信号进行计算,判断载体的运动状态。当三轴加速度计计算出的载体合加速度不超过重力加速度的2%时,认为载体处于接近匀速直线运动,利用三轴加速度计解算载体的俯仰角和倾斜角,利用三轴磁传感器解算出航向角,再利用该俯仰角、倾斜角和航向角对速率陀螺解算出的俯仰角、倾斜角和航向角进行补偿。
4对三轴加速度计的输出信号进行计算,判断载体的运动状态。当三轴加速度计计算出的载体合加速度超过重力加速度的2%时,认为载体处于非匀速直线运动。
5在载体处于非匀速直线运动状态时,判断载体的航向和倾斜角值,当航向角在90°±30°,270°±30°,倾斜角在0°±30°,180°±30°范围内时,利用三轴加速度计测出的纵向加速度和重力加速度求出俯仰角;利用此俯仰角值与三轴磁传感器的输出信号解算载体的倾斜角和航向角;再利用俯仰角、倾斜角和航向角对速率陀螺解算出的俯仰角、倾斜角和航向角进行补偿。
实施例2:
本发明利用加速度计和磁传感器在动态情况下补偿陀螺仪的漂移误差。具体实施方法包括但不局限于以下步骤。
1由三轴加速度计、三轴速率陀螺仪和三轴磁传感器构成的航姿系统。
2在静止状态下,利用三轴加速度计的输出,计算出重力加速度g。
3对三轴加速度计的输出信号进行计算,判断载体的运动状态。当三轴加速度计计算出的载体合加速度误差不超过重力加速度的5%时,认为载体处于接近匀速直线运动,利用三轴加速度计解算载体的俯仰角和倾斜角,利用三轴磁传感器解算出航向角,再利用俯仰角、倾斜角和航向角对速率陀螺解算出的俯仰角、倾斜角和航向角进行补偿。
4对三轴加速度计的输出信号进行计算,判断载体的运动状态。当三轴加速度计计算出的载体合加速度误差超过重力加速度的5%时,认为载体处于非匀速直线运动。
5在载体处于非匀速直线运动状态时,判断载体的航向和倾斜角值,当航向角在90°±60°,270°±60°,倾斜角在0°±60°,180°±60°范围内时,利用三轴加速度计测出的纵向加速度和重力加速度求出俯仰角;利用此俯仰角值与三轴磁传感器的输出信号解算载体的倾斜角和航向角,再利用俯仰角、倾斜角和航向角对速率陀螺解算出的俯仰角、倾斜角和航向角进行补偿。
Claims (2)
1.一种动态情况下速率陀螺误差补偿方法,其特征在于,包括以下步骤:
步骤1:当载体做匀速直线运动时,三轴MEMS加速度计测量到载体在xyz三轴的加速度值分别为:Ax0、Ay0、Az0;计算得到载体重力加速度为:
由Ax0、Ay0、Az0与俯仰角θ和倾斜角γ的关系式:
能解算出载体做匀速直线运动时的俯仰角和倾斜角,再利用三轴磁传感器的输出与俯仰角、倾斜角和航向角的关系计算出载体做匀速直线运动时的航向角;
步骤2:当载体做非匀速直线运动时,计算俯仰角、倾斜角和航向角;
步骤2-1:三轴MEMS加速度计测量到载体在xyz三轴的加速度值分别为:Ax、Ay、Az;计算得到载体合重力加速度为:
此时存在额外加速度ax、ay和az,Ax、Ay、Az与俯仰角θ、倾斜角γ和额外加速度ax、ay和az的关系为:
步骤2-2:计算载体做非匀速直线运动时的俯仰角:
步骤2-3:计算载体做非匀速直线运动时的航向角和倾斜角;
其中,h0为地磁场水平分量,hv=hotanα,α为当地的地磁倾角;
求解式(6)得到:
当0°<γt-1<90°时,γ=γt-1;
当90°<γt-1<270°时,γ=180°-γt-1;
当270°<γt-1<360°时,γ=360°+γt-1;
2.根据权利要求1所述的一种动态情况下速率陀螺误差补偿方法,其特征在于,步骤3中所述的求解姿态的算法为四元数算法或欧拉角算法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011025235.8A CN112179380B (zh) | 2020-09-25 | 2020-09-25 | 一种动态情况下速率陀螺误差补偿方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011025235.8A CN112179380B (zh) | 2020-09-25 | 2020-09-25 | 一种动态情况下速率陀螺误差补偿方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112179380A true CN112179380A (zh) | 2021-01-05 |
CN112179380B CN112179380B (zh) | 2022-09-30 |
Family
ID=73943893
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011025235.8A Active CN112179380B (zh) | 2020-09-25 | 2020-09-25 | 一种动态情况下速率陀螺误差补偿方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112179380B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116972875A (zh) * | 2023-09-25 | 2023-10-31 | 山东建筑大学 | 一种基于陀螺仪的物体运动轨迹监测方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20070032951A1 (en) * | 2005-04-19 | 2007-02-08 | Jaymart Sensors, Llc | Miniaturized Inertial Measurement Unit and Associated Methods |
US20190390976A1 (en) * | 2018-06-25 | 2019-12-26 | CloudNav Inc. | Automatic calibration of rate gyroscope sensitivity |
CN111189473A (zh) * | 2020-01-08 | 2020-05-22 | 湖北三江航天红峰控制有限公司 | 一种基于磁传感器和加表的航姿系统陀螺误差补偿方法 |
CN111426318A (zh) * | 2020-04-22 | 2020-07-17 | 中北大学 | 基于四元数-扩展卡尔曼滤波的低成本ahrs航向角补偿方法 |
CN111551175A (zh) * | 2020-05-27 | 2020-08-18 | 北京计算机技术及应用研究所 | 一种航姿参考系统的互补滤波姿态解算方法 |
-
2020
- 2020-09-25 CN CN202011025235.8A patent/CN112179380B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20070032951A1 (en) * | 2005-04-19 | 2007-02-08 | Jaymart Sensors, Llc | Miniaturized Inertial Measurement Unit and Associated Methods |
US20190390976A1 (en) * | 2018-06-25 | 2019-12-26 | CloudNav Inc. | Automatic calibration of rate gyroscope sensitivity |
CN111189473A (zh) * | 2020-01-08 | 2020-05-22 | 湖北三江航天红峰控制有限公司 | 一种基于磁传感器和加表的航姿系统陀螺误差补偿方法 |
CN111426318A (zh) * | 2020-04-22 | 2020-07-17 | 中北大学 | 基于四元数-扩展卡尔曼滤波的低成本ahrs航向角补偿方法 |
CN111551175A (zh) * | 2020-05-27 | 2020-08-18 | 北京计算机技术及应用研究所 | 一种航姿参考系统的互补滤波姿态解算方法 |
Non-Patent Citations (3)
Title |
---|
KONOVALOV, S.F. ET AL.: "MAGNETIC COMPENSATION OF A ZERO SIGNAL IN A TWO-AXIS HYBRID R-R-R-TYPE MEMS GYRO", 《SERIES INSTRUMENT ENGINEERING》, 31 December 2013 (2013-12-31), pages 122 - 131 * |
冯文光等: "三轴磁航向传感器误差补偿", 《应用科学学报》, no. 02, 30 March 2013 (2013-03-30), pages 154 - 158 * |
刘诗斌等: "一种基于磁传感器的MEMS陀螺标定方法", 《传感技术学报》, no. 12, 15 December 2013 (2013-12-15), pages 1700 - 1703 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116972875A (zh) * | 2023-09-25 | 2023-10-31 | 山东建筑大学 | 一种基于陀螺仪的物体运动轨迹监测方法 |
CN116972875B (zh) * | 2023-09-25 | 2024-01-02 | 山东建筑大学 | 一种基于陀螺仪的物体运动轨迹监测方法 |
Also Published As
Publication number | Publication date |
---|---|
CN112179380B (zh) | 2022-09-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111678538B (zh) | 一种基于速度匹配的动态水平仪误差补偿方法 | |
CN110926468B (zh) | 基于传递对准的动中通天线多平台航姿确定方法 | |
CN109211269B (zh) | 一种双轴旋转惯导系统姿态角误差标定方法 | |
CN101793523B (zh) | 一种组合导航和光电探测一体化系统 | |
CN106052682B (zh) | 一种混合式惯性导航系统及导航方法 | |
CN102393201B (zh) | 航空遥感用位置和姿态测量系统(pos)动态杆臂补偿方法 | |
CN110954102B (zh) | 用于机器人定位的磁力计辅助惯性导航系统及方法 | |
KR101211703B1 (ko) | 시선벡터를 이용한 자장계 오차 보정방법 및 이를 이용한 통합 항법 시스템 | |
CN104697521B (zh) | 一种采用陀螺冗余斜交配置方式测量高速旋转体姿态和角速度的方法 | |
CN105892498B (zh) | 基于三轴云台的目标凝视与扫视控制系统 | |
CN109073388B (zh) | 旋磁地理定位系统 | |
CN111272158B (zh) | 复杂磁扰动场景mems电子罗盘的动态方位角解算方法 | |
CN110621961A (zh) | 低成本惯性导航系统 | |
CN114111771A (zh) | 一种双轴稳定平台的动态姿态测量方法 | |
CN105403218B (zh) | 用于四旋翼无人机的俯仰角的地磁修正方法 | |
CN111307114B (zh) | 基于运动参考单元的水面舰船水平姿态测量方法 | |
EP2638360B1 (en) | A system and method for north finding | |
CN112179380B (zh) | 一种动态情况下速率陀螺误差补偿方法 | |
CN113804170A (zh) | 带倾斜补偿的导航仪和相关方法 | |
CN110514201B (zh) | 一种惯性导航系统及适用于高转速旋转体的导航方法 | |
CN111141285A (zh) | 一种航空重力测量装置 | |
CN116242397B (zh) | 一种速度误差修正模型下的双惯导协同标定方法 | |
RU2608337C1 (ru) | Способ автономной начальной выставки стабилизированной платформы трехосного гиростабилизатора в плоскость горизонта и на заданный азимут | |
CN108593966B (zh) | 一种两轴框架摆式加速度计自标定方法和系统 | |
CN113776560B (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 |