CN102679968A - 一种微机械陀螺捷联***误差参数的辨识方法 - Google Patents
一种微机械陀螺捷联***误差参数的辨识方法 Download PDFInfo
- Publication number
- CN102679968A CN102679968A CN2012101522955A CN201210152295A CN102679968A CN 102679968 A CN102679968 A CN 102679968A CN 2012101522955 A CN2012101522955 A CN 2012101522955A CN 201210152295 A CN201210152295 A CN 201210152295A CN 102679968 A CN102679968 A CN 102679968A
- Authority
- CN
- China
- Prior art keywords
- gyro
- error
- omega
- identification
- turntable
- 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.)
- Pending
Links
Images
Landscapes
- Gyroscopes (AREA)
Abstract
本发明提供的是一种微机械陀螺捷联***误差参数的辨识方法。根据姿态误差数学模型,完成卡尔曼滤波器的设计,并对所述卡尔曼滤波器进行初始参数设置;将转台设定到预定位置1,在静态条件下对陀螺零偏进行辨识,对陀螺的误差参数进行辨识;将转台设定到预定位置2,加入垂直轴角速度,对陀螺的误差参数进行辨识;将转台设定到预定位置3,加入垂直轴角速度,对陀螺的误差参数进行辨识;将转台设定到预定位置4,加入垂直轴角速度,对陀螺的误差参数进行辨识。本发明降低了观测矩阵的维数;提高了实时计算速度;保证了滤波结果收敛;缩短了辨识时间;增强了***辨识的实时性。
Description
技术领域
本发明涉及的是一种微机械陀螺捷联***误差参数的辨识方法。
背景技术
和平台惯导***不同,微机械陀螺捷联惯性导航***中惯性仪器是直接安装在运载体上,极端动力学环境,如冲击、振动、过载以及机动等都会给惯性仪器和捷联惯导***带来动态误差。惯性仪器标定精度对微机械陀螺捷联惯导***的精度有着重要的影响,误差补偿技术是提高微机械捷联惯性导航***导航精度的有效途径之一,能否对捷联惯导***进行误差辨识,是对其进行误差补偿的前提。因此,对惯性仪表误差辨识技术进行研究有着重要的意义。
根据辨识观测量不同,可将辨识方法分为***级辨识法和分立辨识法。直接用陀螺和加速度计的输出作观测量,将陀螺和加速度计分别辨识的方法叫分立辨识法。其中包括针对微机械陀螺的速率试验和针对加速度计的多位置试验,该方法有如下一些缺点:数据量大、耗时、对转台精度要求高、事后处理、实时性不强、以及抑制有色噪声的能力有限等,这些缺点限制了分立辨识法的精度。***级辨识首先要对惯性仪表的误差进行建模,得到导航输出误差与惯性仪表误差参数之间的关系,并且结合已有的实验手段分析惯性仪表误差参数的可辨识性和实验位置编排的原则,设计相应的辨识路径,实现微机械陀螺和加速度计误差参数的滤波估计,从而完成***的辨识。目前,分立辨识方法的理论研究已较为成熟,而***级辨识方法的研究工作刚刚起步,正在逐步深入。
***级辨识方法通常是使用速度误差作为观测量,其最大的缺点就是可观性差,而且计算量大,滤波效果也不好。***级辨识方法利用导航误差辨识出惯性测量单元(IMU)误差,有文献提出利用速度误差作为观测量,利用双轴位置转台辨识捷联***的误差参数,该方法的优点是不需要高精度的转台,但是由于只利用速度误差作为观测量,部分参数的可观性很差,辨识结果不理想,而且采用多位置转动方案,操作复杂,辨识时间较长。因此,提出一种新的辨识方法就显得十分必要。
发明内容
本发明的目的在于提供一种能够降低观测矩阵的维数、提高实时计算速度、增强***辨识的实时性的微机械陀螺捷联***误差参数的辨识方法。
本发明的目的是这样实现的:
本发明是这样实现的:
步骤一:微机械捷联惯导***以及转台进行预热准备;
步骤二:微机械捷联惯导***进行初始对准,惯导***进入导航状态;
步骤三:根据姿态误差数学模型,完成卡尔曼滤波器的设计,并对所述卡尔曼滤波器进行初始参数设置;
步骤四:将转台设定到预定位置1,在静态条件下对陀螺零偏进行辨识,对陀螺的误差参数bgx,bgy,bgz进行辨识;
步骤五:将转台设定到预定位置2,加入垂直轴角速度,对陀螺的误差参数Egxz,Sgy,Egzx进行辨识;
步骤六:将转台设定到预定位置3,加入垂直轴角速度,对陀螺的误差参数Egyz,Sgx,Egzy进行辨识;
步骤七:将转台设定到预定位置4,加入垂直轴角速度,对陀螺的误差参数Egxy,Sgz,Egyx进行辨识。
为了解决分立辨识法事后处理、实时性不强、数据量大、需要记录的数据多而且随着辨识参数的增加,数据量剧增、耗时,以及***级辨识方法通常使用速度误差作为观测量,维数多、可观性差、计算量大、滤波效果不好的缺点,本发明以三轴实验转台为依据,以姿态误差角为观测量,对陀螺误差参数进行辨识。
本发明具有以下优点:
一、本发明首次实现将陀螺误差参数***级辨识与加速度计***级辨识分离开,从而降低了观测矩阵的维数。
二、计算量由于观测矩阵维数的降低而大大的减少了,从而提高了实时计算速度。
三、由于观测矩阵的维数降低,使***可观测性分析难度降低,有利于设计简单合理的辨识路径,提高***可观测度,从而保证了滤波结果收敛。
四、***可观测性提高,使参数滤波收敛速度快,有效的缩短了辨识时间。
五、在辨识过程中,对滤波模型进行了合理化简,从而提高了计算效率,增强了***辨识的实时性。
附图说明
图1为辨识原理框图;
图2为辨识流程图。
具体实施方式
下面举例对本发明作更详细的描述:
步骤一:完成捷联惯导***以及转台的预热准备,时间约为2个小时;
步骤二:完成微机械捷联惯导***的初始对准,惯导***进入导航状态;
步骤三:根据姿态误差数学模型,完成卡尔曼滤波器的设计,并对卡尔曼滤波器进行初始参数设置;
假设陀螺的脉冲输出为Ng,如果不存在刻度因子、安装误差、零偏误差和随机漂移等误差项,则由陀螺的脉冲输出可得对应的角速度为:
由于误差项的存在,实际的角速度为
忽略二阶小量后
则陀螺的输出误差为
在公式(1)-公式(4)中:
Kg为陀螺的刻度因数
bg=[bgx bgy bgz]T为陀螺的零偏误差
在静基座条件下,捷联惯导***所处的地理位置是精确己知的,我们只需要进行姿态解算,不需要对导航回路进行解算,这样姿态误差只与陀螺误差有关,与加速度计的误差无关,因此可以将加速度计误差和陀螺误差分开,也就是加速度计的误差不会耦合到姿态误差。在陀螺漂移驱动下,姿态误差的动力学方程为:
将(5)写成状态方程的形式为:
εx,εy,εz为投影到地理坐标系的三个轴上的等效陀螺漂移。
卡尔曼滤波器的***方程和量测方程设计如下所示。
(l)***方程
陀螺仪的误差模型状态变量为:
则有状态方程:
其中:
(2)观测方程
其中,
为计算的载体坐标系到地理坐标系的转换矩阵
取观测量 则观测方程可以写为
因此,***状态方程和观测方程为
将***方程离散化,
式中,
Φ(k+1,k)=I+A(t)Δt+0(Δt2)
应用标准卡尔曼滤波方程:
如果并不了解初始情况的统计特性,常令
其中α为很大的正数,在此情况下,滤波器的估计不能保证是无偏的。事实上,如果***是一致完全随机可控和一致完全随机可观测的,则卡尔曼滤波器一定是一致渐进稳定的,随着滤波步数的增加,选取滤波初始值对滤波值的影响减弱直至消失,估计逐渐趋向无偏。
为了避免导航姿态解算周期与转台姿态输出周期的不同步造成的影响,将滤波周期设定为解算周期与转台输出周期的最小公倍数。将公式(4)展开,可得:
上面三个方程共有12个未知数,只需要转台有四种转动状态就可以分离出所有的参数,一般可选择表1所示的四种状态。
表1对陀螺仪误差参数辨识路径
步骤四:对陀螺bgx,bgy,bgz进行辨识。将转台在状态1下静止360秒,对陀螺输出进行数据采集。将采集的数据带入捷联惯导解算方程中,解算姿态角与转台输出姿态角的差值带入***滤波方程中,进行卡尔曼滤波,得到bgx,bgy,bgz的辨识结果。
步骤五:对陀螺Egxz,Sgy,Egzx进行辨识。陀螺测量组件调整到状态2所示位置,使转台绕y轴方向以1度/秒的角速度转动360秒。
(1)由于转台的转动只给***提供了沿y轴的角速度输入,因此在不考虑地球自转的条件下,可以对卡尔曼滤波方程进行化简,
由于只有y转动,因此方向余弦矩阵为:
其中,θ为y轴转过的角度,则导航坐标系下的等效陀螺漂移为:
取状态变量
则滤波器状态方程为:
其中:
采集陀螺的输出信号,并带入捷联惯导方程姿态解算回路中,解算得到***姿态角。
(2)采集转台姿态角信息,与解算后***姿态角比较得到的姿态误差作为卡尔曼滤波方程的观测量,经滤波辨识得到陀螺的Egxz,Sgy,Egzx。
步骤六:对陀螺Egyz,Sgx,Egzy进行辨识。
陀螺测量组件调整到状态3所示位置,使转台绕x轴方向以1度/秒的角速度转动360秒。转台的转动给***提供了沿x轴的角速度输入,陀螺Egyz,Sgx,Egzy在角速度输入的激励下带来较大的陀螺等效漂移误差,仿照步骤五的(1)中对滤波方程进行化简,采集陀螺的输出信号,并带入捷联惯导方程姿态解算回路中,解算得到***姿态角。重复步骤五的(1),辨识出陀螺Egyz,Sgx,Egzy。
步骤七:对陀螺Egxy,Sgz,Egyx进行辨识。
陀螺测量组件调整到状态4所示位置,使转台绕z轴方向以1度/秒的角速度转动360秒。转台的转动给***提供了沿z轴的角速度输入,陀螺Egxy,Sgz,Egyx在角速度输入的激励下带来较大的陀螺等效漂移误差,仿照步骤五的(1)中对滤波方程进行化简,采集陀螺的输出信号,并带入捷联惯导方程姿态解算回路中,解算得到***姿态角。重复步骤五的(1),辨识出陀螺Egxy,Sgz,Egyx。
Claims (1)
1.一种微机械陀螺捷联***误差参数的辨识方法,其特征是:
步骤一:微机械捷联惯导***以及转台进行预热准备;
步骤二:微机械捷联惯导***进行初始对准,惯导***进入导航状态;
步骤三:根据姿态误差数学模型,完成卡尔曼滤波器的设计,并对所述卡尔曼滤波器进行初始参数设置;
步骤四:将转台设定到预定位置1,在静态条件下对陀螺零偏进行辨识,对陀螺的误差参数bgx,bgy,bgz进行辨识;
步骤五:将转台设定到预定位置2,加入垂直轴角速度,对陀螺的误差参数Egxz,Sgy,Egzx进行辨识;
步骤六:将转台设定到预定位置3,加入垂直轴角速度,对陀螺的误差参数Egyz,Sgx,Egzy进行辨识;
步骤七:将转台设定到预定位置4,加入垂直轴角速度,对陀螺的误差参数Egxy,Sgz,Egyx进行辨识。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2012101522955A CN102679968A (zh) | 2012-05-17 | 2012-05-17 | 一种微机械陀螺捷联***误差参数的辨识方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2012101522955A CN102679968A (zh) | 2012-05-17 | 2012-05-17 | 一种微机械陀螺捷联***误差参数的辨识方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN102679968A true CN102679968A (zh) | 2012-09-19 |
Family
ID=46812255
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2012101522955A Pending CN102679968A (zh) | 2012-05-17 | 2012-05-17 | 一种微机械陀螺捷联***误差参数的辨识方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102679968A (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102829803A (zh) * | 2012-09-27 | 2012-12-19 | 重庆华渝电气仪表总厂 | 惯导设备与转台同步测试装置 |
CN103954304A (zh) * | 2014-05-21 | 2014-07-30 | 北京航天自动控制研究所 | 一种应用于mems惯组的零偏长短期变化值测试方法 |
CN108168574A (zh) * | 2017-11-23 | 2018-06-15 | 东南大学 | 一种基于速度观测的8位置捷联惯导***级标定方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20030006671A1 (en) * | 2001-07-09 | 2003-01-09 | Nils Hiedenstierna | Off-set elimination system for a vibrating gyroscope |
US20050193816A1 (en) * | 2004-03-03 | 2005-09-08 | Stewart Robert E. | Oscillation of vibrating beam in a first direction for a first time period and a second direction for a second time period to sense angular rate of the vibrating beam |
-
2012
- 2012-05-17 CN CN2012101522955A patent/CN102679968A/zh active Pending
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20030006671A1 (en) * | 2001-07-09 | 2003-01-09 | Nils Hiedenstierna | Off-set elimination system for a vibrating gyroscope |
US20050193816A1 (en) * | 2004-03-03 | 2005-09-08 | Stewart Robert E. | Oscillation of vibrating beam in a first direction for a first time period and a second direction for a second time period to sense angular rate of the vibrating beam |
Non-Patent Citations (2)
Title |
---|
徐博: "舰船高精度光纤捷联惯性导航***技术研究", 《中国优秀博士学位论文全文数据库信息科技辑》 * |
杨晓霞等: "激光捷联惯导***的一种***级标定方法", 《中国惯性技术学报》 * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102829803A (zh) * | 2012-09-27 | 2012-12-19 | 重庆华渝电气仪表总厂 | 惯导设备与转台同步测试装置 |
CN102829803B (zh) * | 2012-09-27 | 2015-12-09 | 重庆华渝电气仪表总厂 | 惯导设备与转台同步测试装置 |
CN103954304A (zh) * | 2014-05-21 | 2014-07-30 | 北京航天自动控制研究所 | 一种应用于mems惯组的零偏长短期变化值测试方法 |
CN103954304B (zh) * | 2014-05-21 | 2016-09-21 | 北京航天自动控制研究所 | 一种应用于mems惯组的零偏长短期变化值测试方法 |
CN108168574A (zh) * | 2017-11-23 | 2018-06-15 | 东南大学 | 一种基于速度观测的8位置捷联惯导***级标定方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN1330935C (zh) | 安装误差角与标度因数解耦的微惯性测量单元精确标定方法 | |
CN101290326B (zh) | 石英挠性加速度计测量组件的参数辨识标定方法 | |
CN102486377B (zh) | 一种光纤陀螺捷联惯导***初始航向的姿态获取方法 | |
CN101514900B (zh) | 一种单轴旋转的捷联惯导***初始对准方法 | |
CN102980577B (zh) | 一种微型捷联航姿***及其工作方法 | |
CN101706287B (zh) | 一种基于数字高通滤波的旋转捷联***现场标定方法 | |
CN101975872B (zh) | 石英挠性加速度计组件零位偏置的标定方法 | |
CN103575299B (zh) | 利用外观测信息的双轴旋转惯导***对准及误差修正方法 | |
CN100516778C (zh) | 一种捷联mems陀螺动态误差标定方法 | |
CN106969783B (zh) | 一种基于光纤陀螺惯性导航的单轴旋转快速标定技术 | |
CN107655493B (zh) | 一种光纤陀螺sins六位置***级标定方法 | |
CN103900608B (zh) | 一种基于四元数ckf的低精度惯导初始对准方法 | |
CN100559189C (zh) | 一种惯性测量单元的无定向多位置高精度标定方法 | |
CN104165638B (zh) | 一种双轴旋转惯导***多位置自主标定方法 | |
CN110108300B (zh) | 一种基于卧式三轴转台的imu正六面体标定方法 | |
CN101706284B (zh) | 提高船用光纤陀螺捷联惯导***定位精度的方法 | |
CN101290229A (zh) | 硅微航姿***惯性/地磁组合方法 | |
CN103076025B (zh) | 一种基于双解算程序的光纤陀螺常值误差标定方法 | |
CN103453917A (zh) | 一种双轴旋转式捷联惯导***初始对准与自标校方法 | |
CN103852085B (zh) | 一种基于最小二乘拟合的光纤捷联惯导***现场标定方法 | |
CN103323625B (zh) | 一种mems-imu中加速度计动态环境下的误差标定补偿方法 | |
CN103900613B (zh) | 一种基于磁力计n阶距检测的mems***误差估计方法 | |
CN101713666B (zh) | 一种基于单轴转停方案的系泊估漂方法 | |
CN112595350B (zh) | 一种惯导***自动标定方法及终端 | |
CN101738203B (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 | ||
C12 | Rejection of a patent application after its publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20120919 |