CN104121930B - 一种基于加表耦合的mems陀螺漂移误差的补偿方法 - Google Patents
一种基于加表耦合的mems陀螺漂移误差的补偿方法 Download PDFInfo
- Publication number
- CN104121930B CN104121930B CN201410367924.5A CN201410367924A CN104121930B CN 104121930 B CN104121930 B CN 104121930B CN 201410367924 A CN201410367924 A CN 201410367924A CN 104121930 B CN104121930 B CN 104121930B
- Authority
- CN
- China
- Prior art keywords
- error
- gyro
- regulating
- carrier
- coordinate system
- 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
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
Abstract
本发明公开了一种基于加表耦合的MEMS陀螺漂移误差的补偿方法,包括下述步骤:(1)根据加表实时测得的载体加速度信息获得陀螺漂移误差量Δω(t);(2)建立误差调节模型ωC(t)=ΔωP+ΔωI;根据公式ΔωP=KP*Δω(t)和ΔωI=ΔωI+KI*dt*Δω(t)以及所述陀螺漂移误差量Δω(t)获得第一误差调节控制量ΔωP和第二误差调节控制量ΔωI;将第一误差调节控制量ΔωP和第二误差调节控制量ΔωI代入误差调节模型中获得陀螺漂移误差补偿量ωC(t);(3)根据所述陀螺漂移误差补偿量对陀螺数据进行误差补偿并获得补偿后的陀螺信息。本发明解决了由MEMS陀螺精度低、累积漂移误差大所导致的姿态解算精度较低,不能满足工程化应用的问题;可以抑制MEMS陀螺漂移,提高姿态解算精度;具有较高的工程化应用价值和推广价值。
Description
技术领域
本发明属于惯性导航技术领域,更具体地,涉及一种基于加表耦合的MEMS陀螺漂移误差的补偿方法。
背景技术
在惯性导航系统中,陀螺和加速度计(加表)的信息的处理直接关系到载体姿态的解算精度,而姿态是反映载体运动的一个重要参数,其精度对载体的速度、位置计算、识别跟踪、运动轨迹、性能分析等有重要影响。通常姿态解算是根据陀螺的数据和载体的速度、位置信息实时计算载体姿态矩阵,实现导航坐标系对地理坐标系的实时跟随以及载体姿态的解算。但是由于陀螺和加速度计的精度有限,并且随着时间的增加漂移误差会不断的积累增大,尤其是低成本的MEMS陀螺漂移误差更大,使系统的姿态解算精度越来越低,不能够满足工程技术要求。
发明内容
针对现有技术的缺陷,本发明的目的在于提供一种基于加表耦合的MEMS陀螺漂移误差的补偿方法,旨在解决现有技术中由于MEMS陀螺精度低、漂移误差大导致姿态解算精度较低的技术问题。
本发明提供的基于加表耦合的MEMS陀螺漂移误差的补偿方法,包括下述步骤:
(1)根据加表实时测得的载体加速度信息获得陀螺漂移误差量Δω(t);
(2)建立误差调节模型ωC(t)=ΔωP+Δω'I;
根据公式ΔωP=KP*Δω(t)和Δω'I=ΔωI+KI*dt*Δω(t)以及所述陀螺漂移误差量Δω(t)获得第一误差调节控制量ΔωP和第二误差调节控制量ΔωI;
将所述第一误差调节控制量ΔωP和第二误差调节控制量Δω'I代入所述误差调节模型中获得陀螺漂移误差补偿量ωC(t);其中,KP、KI分别为第一、二误差调节系数;dt为采样周期;ΔωI为进行第二误差调节前的控制量,初值为0;Δω'I为进行第二误差调节后的控制量;Δω(t)为陀螺漂移误差量;ωC(t)为陀螺漂移误差补偿量;
(3)根据所述陀螺漂移误差补偿量对陀螺数据进行误差补偿并获得补偿后的陀螺信息。
其中,步骤(1)具体包括:
(1.1)选择东北天地理坐标系作为导航坐标系并获得载体加速度信息其中ax ay az分别为东北天地理坐标系下载体在X轴、Y轴、Z轴的加速度;
(1.2)根据公式获得所述载体的三维加速度的模值;
(1.3)根据所述模值和公式将所述载体的三维加速度信息转换为单位向量;
(1.4)获得东北天地理坐标系下所述载体加速度信息中三个方向的重力投影
(1.5)根据公式将重力在东北天地理坐标系下的投影转换为载体坐标系下的重力投影;其中,为初始化得到的姿态矩阵;g为当地重力加速度;
(1.6)将步骤(1.3)中的单位向量与步骤(1.5)中的重力投影进行叉乘后,获得陀螺漂移误差量其中Δω(t)为根据加速度计求取的陀螺漂移误差量;为单位化后的载体加速度参考量;为重力加速度在载体坐标系下的投影。
其中,步骤(3)具体包括:
(3.1)在载体坐标系下获得陀螺信息ωgyro(t)=[ωx ωy ωz]T;其中ωxωyωz分别为三个陀螺的输出信息;
(3.2)建立陀螺漂移误差调节模型ω(t)=ωgyro(t)+ωC(t);其中ω(t)为陀螺补偿以后的输出;ωgyro(t)为陀螺补偿前的输出;ωC(t)为陀螺漂移误差补偿量;
(3.3)将所述陀螺漂移误差补偿量ωC(t)以及载体坐标系下的陀螺信息代入所述陀螺漂移误差调节模型中,获得补偿后的陀螺信息。
本发明提供的基于加表耦合的MEMS陀螺漂移误差的补偿方法,以陀螺和加速度计为基本数据传感器,并用加速度计的信息对陀螺的漂移进行有效补偿,降低陀螺的漂移误差,从而提高惯导系统的姿态解算精度,对惯性导航领域的姿态解算有较大贡献,本发明简单巧妙,符合实际需求进步显著且实用性强,能够大规模推广使用。
附图说明
图1是本发明实施例提供的基于加表耦合的MEMS陀螺漂移误差的补偿方法实现流程图。
图2是补偿前俯仰角随时间的变化示意图。
图3是补偿后俯仰角随时间的变化示意图。
图4是补偿前横滚角随时间的变化示意图。
图5是补偿后横滚角随时间的变化示意图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。
本发明提供的基于加表耦合的MEMS陀螺漂移误差的补偿方法,解决了由MEMS陀螺精度低、漂移误差大所导致的姿态解算精度较低,不能满足工程化应用的问题。
如图1所示,本发明实施例提供的基于加表耦合的MEMS陀螺漂移误差的补偿方法,包括以下几个步骤:
步骤1:根据加表测得的载体加速度信息计算陀螺漂移误差量;
步骤2:根据陀螺漂移误差量,建立误差调节控制器,求取陀螺漂移误差补偿量;
步骤3:根据陀螺漂移误差补偿量对陀螺数据进行误差补偿。
作为本发明的一个实施例,步骤1中根据读取的三维加速度信息计算陀螺漂移误差补偿量,具体通过以下步骤实现:
(1a)设系统选取东北天地理坐标系为导航坐标系,则读取的载体加速度信息为其中,ax ay az分别为载体的加速度信息;
(1b)求取三维加速度的模值
(1c)根据公式将三维加速度信息转为单位向量;
(1d)在地理坐标系下,东北天三个方向的重力投影为
(1e)根据公式将重力在地理坐标系下的投影转到载体坐标系下;其中,为初始化得到的姿态矩阵;g为当地重力加速度;
(1f)将单位化后的载体加速度参考量和重力加速度在载体坐标系下的投影做叉乘就可以得到加速度计求取的陀螺漂移误差量,即其中,Δω(t)为根据加速度计求取的陀螺漂移误差量;为单位化后的载体加速度参考量;为重力加速度在载体坐标系下的投影。
作为本发明的另一个实施例,步骤2中根据陀螺漂移误差量,建立误差调节控制器,求取陀螺漂移误差补偿量,具体通过以下步骤实现:
(2a)建立误差调节模型ωC(t)=ΔωP+Δω'I;其中,ωC(t)为陀螺漂移误差补偿量;ΔωP、Δω'I分别为第一误差调节控制量、第二误差调节控制量;
(2b)求取误差调节控制量,则ΔωP=KP*Δω(t);Δω'I=ΔωI+KI*dt*Δω(t);其中,KP、KI分别为第一、二误差调节系数;该系数与器件精度有关,可通过试验得到;dt为系统采样周期;ΔωI为进行第二误差调节前的控制量,初值为0;Δω'I为进行第二误差调节后的控制量;Δω(t)为根据加速度计求取的陀螺漂移误差量。
作为本发明的一个实施例,步骤3中根据陀螺漂移误差补偿量对陀螺数据进行误差补偿,具体通过以下步骤实现:
(3a)设在载体坐标系下,读取的陀螺信息为:ωgyro(t)=[ωx ωy ωz]T;其中,ωxωy ωz分别为三个陀螺的输出信息;
(3b)建立陀螺漂移误差调节模型ω(t)=ωgyro(t)+ωC(t);其中,ω(t)为陀螺补偿以后的输出;ωgyro(t)为陀螺补偿前的输出;ωC(t)为陀螺漂移误差补偿量;
其中,qk为k时刻的四元数;qk-1为k-1时刻的四元数;M为陀螺角增量的反对称矩阵;其中,为载体坐标系到导航坐标系的姿态转换矩阵;q0,q1,q2,q3为四元数;θ,r分别表示载体的方位角、俯仰角与横滚角;θ=arcsin(T32);
通过上述公式就可以得到通过加速度计补偿以后的陀螺数据,利用补偿后的陀螺数据对四元数和姿态矩阵进行更新,通过更新后的姿态矩阵根据公式求解载体的实时姿态信息。
本发明所实现的一种基于加表耦合的MEMS陀螺漂移误差的补偿方法,以陀螺和加速度计为基本数据传感器,并用加速度计的信息对陀螺的漂移进行有效补偿,降低陀螺的漂移误差,从而提高惯导系统的姿态解算精度,对惯性导航领域的姿态解算有较大贡献,本发明简单巧妙,符合实际需求进步显著且实用性强,能够大规模推广使用。
针对本实施例,进行一次简单的实验验证,实验步骤如下:
(a)将MEMS惯性导航系统固定在三轴隔振转台上,确认无误后通电,静止不动,采集数据10min;
(b)然后将航向顺时针转一周,再逆时针转动一周回到起始位置;
(c)将俯仰顺时针转动20°,再逆时针转动20°回到起始位置;
(d)将横滚顺时针转动40°,再逆时针转动40°回到起始位置后,再静止测试10min,断电停止实验。实验结果如下:
从图2~图5可以看出,MEMS惯导的姿态误差变化较快,使用该补偿算法后,MEMS惯导不仅能够准确敏感俯仰角和横滚角的变化,而且能够有效地抑制俯仰角和横滚角漂移带来的误差。
本领域的技术人员容易理解,以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。
Claims (3)
1.一种基于加表耦合的MEMS陀螺漂移误差的补偿方法,其特征在于,包括下述步骤:
(1)根据加表实时测得的载体加速度信息获得陀螺漂移误差量△ω(t);
(2)建立误差调节模型ωC(t)=△ωP+△ω'I;
根据公式△ωP=KP*△ω(t)和△ω'I=△ωI+KI*dt*△ω(t)以及所述陀螺漂移误差量△ω(t)获得第一误差调节控制量△ωP和第二误差调节控制量△ω'I;
将所述第一误差调节控制量△ωP和第二误差调节控制量△ω'I代入所述误差调节模型中获得陀螺漂移误差补偿量ωC(t);其中,KP、KI分别为第一、二误差调节系数;dt为采样周期;△ωI为进行第二误差调节前的控制量,初值为0;△ω'I为进行第二误差调节后的控制量;△ω(t)为陀螺漂移误差量;ωC(t)为陀螺漂移误差补偿量;
(3)根据所述陀螺漂移误差补偿量对陀螺数据进行误差补偿并获得补偿后的陀螺信息。
2.如权利要求1所述的补偿方法,其特征在于,步骤(1)具体包括:
(1.1)选择东北天地理坐标系作为导航坐标系并获得载体加速度信息其中ax ay az分别为东北天地理坐标系下载体在X轴、Y轴、Z轴的加速度;
(1.2)根据公式获得所述载体的三维加速度的模值;
(1.3)根据所述模值和公式将所述载体的三维加速度信息转换为单位向量;
(1.4)获得东北天地理坐标系下所述载体加速度信息中三个方向的重力投影
(1.5)根据公式将重力在东北天地理坐标系下的投影转换为载体坐标系下的重力投影;其中,为初始化得到的姿态矩阵;g为当地重力加速度;
(1.6)将步骤(1.3)中的单位向量与步骤(1.5)中的重力投影进行叉乘后,获得陀螺漂移误差量其中△ω(t)为根据加速度计求取的陀螺漂移误差量;为单位化后的载体加速度参考量;为重力加速度在载体坐标系下的投影。
3.如权利要求1或2所述的补偿方法,其特征在于,步骤(3)具体包括:
(3.1)在载体坐标系下获得陀螺信息ωgyro(t)=[ωx ωy ωz]T;其中ωxωyωz分别为三个陀螺的输出信息;
(3.2)建立陀螺漂移误差调节模型ω(t)=ωgyro(t)+ωC(t);其中ω(t)为陀螺补偿以后的输出;ωgyro(t)为陀螺补偿前的输出;ωC(t)为陀螺漂移误差补偿量;
(3.3)将所述陀螺漂移误差补偿量ωC(t)以及载体坐标系下的陀螺信息代入所述陀螺漂移误差调节模型中,获得补偿后的陀螺信息。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410367924.5A CN104121930B (zh) | 2014-07-29 | 2014-07-29 | 一种基于加表耦合的mems陀螺漂移误差的补偿方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410367924.5A CN104121930B (zh) | 2014-07-29 | 2014-07-29 | 一种基于加表耦合的mems陀螺漂移误差的补偿方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104121930A CN104121930A (zh) | 2014-10-29 |
CN104121930B true CN104121930B (zh) | 2016-10-05 |
Family
ID=51767441
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410367924.5A Active CN104121930B (zh) | 2014-07-29 | 2014-07-29 | 一种基于加表耦合的mems陀螺漂移误差的补偿方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104121930B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107655472B (zh) * | 2017-08-30 | 2019-11-01 | 杨华军 | 一种基于深度学习的高精度惯性导航设备误差补偿方法 |
CN111323047B (zh) * | 2018-12-17 | 2022-09-09 | 北京华航无线电测量研究所 | 一种基于加速度计的陀螺零位误差动态补偿方法 |
CN111189473A (zh) * | 2020-01-08 | 2020-05-22 | 湖北三江航天红峰控制有限公司 | 一种基于磁传感器和加表的航姿系统陀螺误差补偿方法 |
CN112197791B (zh) * | 2020-09-15 | 2022-09-30 | 武汉华中天纬测控有限公司 | 一种隔离开关监测设备漂移误差修正方法 |
CN115077520B (zh) * | 2022-08-22 | 2022-11-01 | 中国船舶重工集团公司第七0七研究所 | 一种基于谐振惯导系统的姿态补偿方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4823626A (en) * | 1986-06-30 | 1989-04-25 | Bodenseewerk Geratetechnik Gmbh | Inertial sensor arrangement |
CN101078627A (zh) * | 2007-06-28 | 2007-11-28 | 北京航空航天大学 | 一种基于陀螺全站仪-激光标靶的盾构机自动导向系统的在线标定方法 |
CN101617199A (zh) * | 2007-01-09 | 2009-12-30 | C2Sat通讯股份公司 | 一种用于补偿位置测量设备中的漂移的方法 |
CN102538821A (zh) * | 2011-12-17 | 2012-07-04 | 东南大学 | 一种快速、参数分段式捷联惯性导航系统自对准方法 |
-
2014
- 2014-07-29 CN CN201410367924.5A patent/CN104121930B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4823626A (en) * | 1986-06-30 | 1989-04-25 | Bodenseewerk Geratetechnik Gmbh | Inertial sensor arrangement |
CN101617199A (zh) * | 2007-01-09 | 2009-12-30 | C2Sat通讯股份公司 | 一种用于补偿位置测量设备中的漂移的方法 |
CN101078627A (zh) * | 2007-06-28 | 2007-11-28 | 北京航空航天大学 | 一种基于陀螺全站仪-激光标靶的盾构机自动导向系统的在线标定方法 |
CN102538821A (zh) * | 2011-12-17 | 2012-07-04 | 东南大学 | 一种快速、参数分段式捷联惯性导航系统自对准方法 |
Non-Patent Citations (3)
Title |
---|
双轴平台动力调谐陀螺漂移补偿技术;李磊磊等;《火力与指挥控制》;20060131;第31卷(第1期);全文 * |
基于最小分辨率的MEMS陀螺漂移抑制方法研究;翁海诠等;《仪器仪表学报》;20111031;第32卷(第10期);全文 * |
无人机姿态测算及其误差补偿研究;张秋阳;《中国优秀硕士学位论文全文数据库工程科技Ⅱ辑》;20111215;全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN104121930A (zh) | 2014-10-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104121930B (zh) | 一种基于加表耦合的mems陀螺漂移误差的补偿方法 | |
CN106990426B (zh) | 一种导航方法和导航装置 | |
CN104019828A (zh) | 高动态环境下惯性导航系统杆臂效应误差在线标定方法 | |
CN106052716B (zh) | 惯性系下基于星光信息辅助的陀螺误差在线标定方法 | |
CN105371844B (zh) | 一种基于惯性/天文互助的惯性导航系统初始化方法 | |
CN105184002B (zh) | 一种数传天线指向角度的仿真分析方法 | |
CN103852085B (zh) | 一种基于最小二乘拟合的光纤捷联惯导系统现场标定方法 | |
CN102853833B (zh) | 捷联惯性导航系统快速阻尼方法 | |
CN103575299A (zh) | 利用外观测信息的双轴旋转惯导系统对准及误差修正方法 | |
CN104121928B (zh) | 一种适用于低精度有方位基准单轴转位设备的惯性测量单元标定方法 | |
CN104280022A (zh) | 视觉辅助惯性测量单元的数字头盔显示设备跟踪系统 | |
CN105929836B (zh) | 用于四旋翼飞行器的控制方法 | |
CN107063244B (zh) | 一种飞行器飞行过程模拟方法 | |
CN103913168A (zh) | 一种双轴旋转式捷联惯导系统转位方法 | |
CN105136166B (zh) | 一种指定惯导位置精度的捷联惯导系统误差模型仿真方法 | |
CN103900566B (zh) | 一种消除地球自转角速度对旋转调制型捷联惯导系统精度影响的方法 | |
CN105352502B (zh) | 一种微惯性航姿参考系统的姿态获取方法 | |
CN100559190C (zh) | 一种对加速度计零位偏差进行在轨标定的方法 | |
CN103712623A (zh) | 基于角速率输入的光纤陀螺惯导系统姿态优化方法 | |
CN100491204C (zh) | 一种利用定轨数据标定加速度计的方法 | |
CN101183004A (zh) | 一种在线实时消除光纤陀螺捷联惯导系统振荡误差的方法 | |
CN105865455A (zh) | 一种利用gps与加速度计计算飞行器姿态角的方法 | |
CN103900607A (zh) | 一种基于惯性系的旋转式捷联惯导系统转位方法 | |
CN105180728A (zh) | 基于前数据的旋转制导炮弹快速空中对准方法 | |
CN102645223A (zh) | 一种基于比力观测的捷联惯导真空滤波修正方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |