CN114964306A - 一种半球谐振陀螺标定因数和零偏自标定方法 - Google Patents
一种半球谐振陀螺标定因数和零偏自标定方法 Download PDFInfo
- Publication number
- CN114964306A CN114964306A CN202210421859.4A CN202210421859A CN114964306A CN 114964306 A CN114964306 A CN 114964306A CN 202210421859 A CN202210421859 A CN 202210421859A CN 114964306 A CN114964306 A CN 114964306A
- Authority
- CN
- China
- Prior art keywords
- error
- self
- force
- calibration
- axis
- 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
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
- G01C19/56—Turn-sensitive devices using vibrating masses, e.g. vibratory angular rate sensors based on Coriolis forces
- G01C19/567—Turn-sensitive devices using vibrating masses, e.g. vibratory angular rate sensors based on Coriolis forces using the phase shift of a vibration node or antinode
- G01C19/5691—Turn-sensitive devices using vibrating masses, e.g. vibratory angular rate sensors based on Coriolis forces using the phase shift of a vibration node or antinode of essentially three-dimensional vibrators, e.g. wine glass-type vibrators
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
本发明公开了一种半球谐振陀螺标定因数和零偏自标定方法,第一步是速率半球谐振陀螺自激励。利用内部信号处理,完成虚拟哥氏力在检测模态上的施加,等效于外部角速度激励所产生哥氏力的影响;第二步是速率半球谐振陀螺误差自标定。利用基于自激励的速率半球谐振陀螺误差自标定方法,完成常值标度因数和零偏误差的免拆卸快速标定,对带有陀螺内部误差的静电反馈力输出进行补偿,以获得高精度的陀螺敏感角速度输出信号。本发明是标定方法体系上的创新,能有效解决陀螺误差参数时空动态快变性所导致的诸多瓶颈性问题。
Description
技术领域
本发明属于惯性器件技术领域,具体涉及一种陀螺标定因数和零偏自标定方法。
背景技术
陀螺仪零偏等误差参数在长期存储和使用过程中会发生漂移,严重影响其使用精度。具体表现为:在一次通电多组测试情况下,陀螺仪零偏等误差参数存在慢漂、不一致现象;在逐次或多次通电情况下,误差参数呈现时空动态快变性,且其变化规律难以确定。现有的陀螺仪标定方法是依赖于外部高精度转台的速率实验,但此方法体系未能有效解决上述问题,且陀螺仪的定期拆卸标定,对于单表来说,存在维护成本高、工作量大、使用灵活度和快速性降低等诸多问题,这些问题是各种陀螺仪高精度应用的瓶颈性问题。陀螺仪每次使用前的重新标定,将严重影响其反映速度;测试环境和实际应用环境间的差异性,陀螺仪误差参数的时空动态快变性,将导致其高精度难以维持。
发明内容
为了克服现有技术的不足,本发明提供了一种半球谐振陀螺标定因数和零偏自标定方法,第一步是速率半球谐振陀螺自激励。利用内部信号处理,完成虚拟哥氏力在检测模态上的施加,等效于外部角速度激励所产生哥氏力的影响;第二步是速率半球谐振陀螺误差自标定。利用基于自激励的速率半球谐振陀螺误差自标定方法,完成常值标度因数和零偏误差的免拆卸快速标定,对带有陀螺内部误差的静电反馈力输出进行补偿,以获得高精度的陀螺敏感角速度输出信号。本发明是标定方法体系上的创新,能有效解决陀螺误差参数时空动态快变性所导致的诸多瓶颈性问题。
本发明解决其技术问题所采用的技术方案包括如下步骤:
步骤1:半球谐振陀螺(HRG,hemispherical resonance gyroscope)的动力学模型为:
其中,x和y分别代表半球谐振子0°和45°方向检测到的振动位移信号,fx、fy分别为x和y方向驱动电极施加的静电驱动力和静电反馈力,和为哥氏效应产生的哥氏力耦合项,K为进动因子,Ω为激励角速度;τ为振荡衰减时间常数,其中τ1和τ2分别为最大和最小阻尼简正轴上谐振子的振荡衰减时间常数,为非等阻尼误差系数,θτ为最大阻尼轴与x轴之间的夹角,其中ω1和ω2分别为最大和最小“刚度简正轴”上谐振子的固有振动角频率,△ω为非等弹性误差系数,θω为最小刚度轴与x轴之间的夹角;
步骤2:速率HRG自激励实现;
步骤3:根据速率HRG误差演化模型,利用单轴正反转方法,标定误差演化模型中的标度因数和零偏误差参数,用以补偿静电反馈力输出中的误差成分,提高速率HRG敏感角速度输出精度;
解得:
本发明的有益效果如下:
本发明提出的基于自激励的速率HRG误差自标定方法,理论上可以完成陀螺误差参数的免拆卸快速自标定,在实际应用环境和每次上电前的快速自标定,是标定方法体系上的创新,能有效解决陀螺误差参数时空动态快变性所导致的诸多瓶颈性问题。
附图说明
图1为本发明方法流程图。
图2为本发明基于自激励的速率HRG误差自标定实现图。
图3为本发明实施例正向角速度激励、初始相位下的哥氏力作用效果图。
图4为本发明实施例负向角速度激励、初始相位下的哥氏力作用效果图。
图5为本发明实施例基于自激励的速率HRG误差自标定效果验证图。
具体实施方式
下面结合附图和实施例对本发明进一步说明。
本发明提出了一种基于自激励的速率HRG误差自标定方法,用于实现陀螺仪标度因数和零偏误差的免拆卸快速自标定。从本质上来看,力平衡模式下陀螺内部误差,将反映在力反馈控制回路输出的静电反馈力中,而速率HRG的敏感角速度输出,依赖于静电反馈力的输出精度。理论上有两种方式提高该类陀螺输出精度,方式一,对陀螺内部误差进行力补偿,以降低静电反馈力中包含的谐振振型漂移误差抑制力分量,保证静电反馈力与激励角速度间的稳定比例关系;方式二,利用本发明所提出的基于自激励的速率HRG误差自标定方法,完成常值标度因数和零偏误差的免拆卸快速标定,对带有陀螺内部误差的静电反馈力输出进行补偿,以获得高精度的陀螺敏感角速度输出信号。本发明对应上述解决方式二,整体实施流程如图1所示。
此方法的具体实施主要分两步,第一步,速率HRG自激励。利用内部信号处理,完成虚拟哥氏力在检测模态上的施加,等效于外部角速度激励所产生哥氏力的影响;第二步,速率HRG误差自标定。在利用自激励完成两等大反向、正/负角速度施加,获得正/负激励下的静电反馈力输出的前提下,根据速率HRG误差演化模型,利用单轴正反转方法,标定模型中的标度因数和零偏误差参数,用以补偿静电反馈力输出中的误差成分,提高速率HRG敏感角速度输出精度。
一种半球谐振陀螺标定因数和零偏自标定方法,包括如下步骤:
步骤1:半球谐振陀螺的动力学模型为:
其中,x和y分别代表半球谐振子0°和45°方向检测到的振动位移信号,fx、fy分别为x和y方向驱动电极施加的静电驱动力和静电反馈力,和为哥氏效应产生的哥氏力耦合项,K为进动因子,Ω为激励角速度;τ为振荡衰减时间常数,其中τ1和τ2分别为最大和最小“阻尼简正轴”上谐振子的振荡衰减时间常数,为非等阻尼误差系数,θτ为最大阻尼轴与x轴之间的夹角,其中ω1和ω2分别为最大和最小“刚度简正轴”上谐振子的固有振动角频率,△ω为非等弹性误差系数,θω为最小刚度轴与x轴之间的夹角;
步骤2:速率HRG自激励实现;
步骤3:根据速率HRG误差演化模型,利用单轴正反转方法,标定误差演化模型中的标度因数和零偏误差参数,用以补偿静电反馈力输出中的误差成分,提高速率HRG敏感角速度输出精度;
解得:
具体实施例:
Lynch提出的半球谐振陀螺(HRG,hemispherical resonance gyroscope)动力学模型为,
HRG自激励的实现,需要完成提取驱动模态振动速度、生成虚拟哥氏力、将虚拟哥氏力作用于检测模态三大步骤。在力平衡模式下,驱动模态被锁定在x轴方向,检测模态被锁定在y轴方向且振幅被几乎抑制为0(趋于0),因此只需要在y轴方向施加驱动力,便可实现自激励角速度施加,并将误差反映在静电反馈力中。
解得:
表1速率HRG控制系统仿真模型参数表
表1为速率HRG控制系统仿真模型参数表,基于自激励的速率HRG误差自标定实现如图2所示,图中虚拟哥氏力fc和静电反馈力fy的信号曲线均表示初始相位下的输出状态,且定义施加在谐振子上的控制力均向外为正(即沿谐振子赤道径向向外为正)、谐振信号的初始相位为余弦形式。
具体实施步骤:
1.施加正向自激励角速度(如图2(a1)步),产生沿谐振子赤道径向向外的虚拟哥氏力作用于y轴方向(如图2(b1)步),该过程作用效果如图3虚线箭头所示。在力平衡模式下,产生负向静电反馈力(如图2(c1)步),抑制由哥氏效应和谐振子非等阻尼误差引起的y轴方向振动;
2.施加负向自激励角速度(如图2(a2)步),产生沿谐振子赤道径向向内的虚拟哥氏力作用于y轴方向(如图2(b2)步),该过程作用效果如图4虚线箭头所示。在力平衡模式下,产生正向静电反馈力(如图2(c2)步),抑制由哥氏效应和谐振子非等阻尼误差引起的y轴方向振动;
3.根据单轴正反转标定公式,利用正反转自激励下的静电反馈力输出,获得速率HRG标度因数和零偏误差自标定结果(如图2(d)(e)步)。其中,标度因数理论值为-2.8933,自标定结果为-2.8935,标定误差约为69.1ppm;零偏误差理论值为-5.8071°/h,自标定结果为-5.8048°/h,标定误差约为-0.0023°/h。
利用基于自激励的速率HRG误差自标定结果,进行多种输入角速度下的静电反馈力输出补偿,评估该自标定方法对陀螺敏感角速度输出精度的提升效果。
由图5的实验结果可以看出,本发明提出的基于自激励的速率HRG误差自标定方法,能够完成自我精度提升,速率HRG输出误差降低到千分级。
Claims (1)
1.一种半球谐振陀螺标定因数和零偏自标定方法,其特征在于,包括如下步骤:
步骤1:半球谐振陀螺(HRG,hemispherical resonance gyroscope)的动力学模型为:
其中,x和y分别代表半球谐振子0°和45°方向检测到的振动位移信号,fx、fy分别为x和y方向驱动电极施加的静电驱动力和静电反馈力,和为哥氏效应产生的哥氏力耦合项,K为进动因子,Ω为激励角速度;τ为振荡衰减时间常数,其中τ1和τ2分别为最大和最小阻尼简正轴上谐振子的振荡衰减时间常数,为非等阻尼误差系数,θτ为最大阻尼轴与x轴之间的夹角,其中ω1和ω2分别为最大和最小“刚度简正轴”上谐振子的固有振动角频率,△ω为非等弹性误差系数,θω为最小刚度轴与x轴之间的夹角;
步骤2:速率HRG自激励实现;
步骤3:根据速率HRG误差演化模型,利用单轴正反转方法,标定误差演化模型中的标度因数和零偏误差参数,用以补偿静电反馈力输出中的误差成分,提高速率HRG敏感角速度输出精度;
解得:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210421859.4A CN114964306A (zh) | 2022-04-21 | 2022-04-21 | 一种半球谐振陀螺标定因数和零偏自标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210421859.4A CN114964306A (zh) | 2022-04-21 | 2022-04-21 | 一种半球谐振陀螺标定因数和零偏自标定方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114964306A true CN114964306A (zh) | 2022-08-30 |
Family
ID=82978592
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210421859.4A Pending CN114964306A (zh) | 2022-04-21 | 2022-04-21 | 一种半球谐振陀螺标定因数和零偏自标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114964306A (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115574798A (zh) * | 2022-09-30 | 2023-01-06 | 中国人民解放军火箭军工程大学 | 一种提高半球谐振陀螺综合性能的方法 |
CN116465384A (zh) * | 2023-06-20 | 2023-07-21 | 中国船舶集团有限公司第七〇七研究所 | 一种基于模态反转的半球谐振陀螺漂移误差补偿方法 |
CN116608890A (zh) * | 2023-07-21 | 2023-08-18 | 中国船舶集团有限公司第七〇七研究所 | 一种全角模式半球谐振陀螺的标度误差补偿方法 |
-
2022
- 2022-04-21 CN CN202210421859.4A patent/CN114964306A/zh active Pending
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115574798A (zh) * | 2022-09-30 | 2023-01-06 | 中国人民解放军火箭军工程大学 | 一种提高半球谐振陀螺综合性能的方法 |
CN116465384A (zh) * | 2023-06-20 | 2023-07-21 | 中国船舶集团有限公司第七〇七研究所 | 一种基于模态反转的半球谐振陀螺漂移误差补偿方法 |
CN116465384B (zh) * | 2023-06-20 | 2023-08-18 | 中国船舶集团有限公司第七〇七研究所 | 一种基于模态反转的半球谐振陀螺漂移误差补偿方法 |
CN116608890A (zh) * | 2023-07-21 | 2023-08-18 | 中国船舶集团有限公司第七〇七研究所 | 一种全角模式半球谐振陀螺的标度误差补偿方法 |
CN116608890B (zh) * | 2023-07-21 | 2023-10-13 | 中国船舶集团有限公司第七〇七研究所 | 一种全角模式半球谐振陀螺的标度误差补偿方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN114964306A (zh) | 一种半球谐振陀螺标定因数和零偏自标定方法 | |
JP5554930B2 (ja) | 自己較正を備えた容量性バルク弾性波ディスク・ジャイロスコープ | |
US7565839B2 (en) | Bias and quadrature reduction in class II coriolis vibratory gyros | |
US20070245826A1 (en) | Small Angle Bias Measurement Mechanism For MEMS Instruments | |
Alper et al. | A symmetric surface micromachined gyroscope with decoupled oscillation modes | |
CN111578923A (zh) | 一种谐振式陀螺闭环控制方法与系统 | |
Geiger et al. | MEMS IMU for ahrs applications | |
CN114858184A (zh) | 一种半球谐振子参数辨识方法 | |
CN110686662B (zh) | 一种可在线自校准的双模式差分谐振式陀螺仪系统 | |
US20120198934A1 (en) | Bias measurement for mems gyroscopes and accelerometers | |
CN115876182B (zh) | 一种半球谐振陀螺的电极误差建模方法 | |
CN116086485A (zh) | 半球谐振陀螺误差力补偿方法和装置 | |
CN113532409B (zh) | 一种高精度数字mems陀螺控制系统及方法 | |
CN114383590B (zh) | 速率积分陀螺的相位误差辨识和补偿方法 | |
Geen | A path to low cost gyroscopy | |
CN115451999A (zh) | 半球谐振陀螺虚拟哥氏效应生成方法和装置 | |
CN115388910A (zh) | 半球谐振陀螺误差自激励方法和系统 | |
CN105258689A (zh) | 一种数字陀螺仪信号控制处理系统 | |
CN115407657A (zh) | 输入饱和下的半球谐振陀螺智能控制方法 | |
CN117490729B (zh) | 一种半球谐振陀螺仪的正交漂移误差检测方法 | |
EP3043146B1 (en) | Approach for control redistribution of coriolis vibratory gyroscope ("cvg") for performance improvement | |
CN109827594B (zh) | 基于面内模态旋转的轴对称陀螺仪零位自补偿系统及方法 | |
US10648811B2 (en) | Vibrating-mass gyroscope system | |
Zhao et al. | A force rebalance and quadrature offset control method for the sense mode of MEMS gyroscopes | |
Yang et al. | Key Technologies of Hemispherical Resonant Gyro Inertial Navigation System |
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 |