CN114964195B - 一种半球谐振陀螺角速度信号温度补偿方法 - Google Patents
一种半球谐振陀螺角速度信号温度补偿方法 Download PDFInfo
- Publication number
- CN114964195B CN114964195B CN202210892585.7A CN202210892585A CN114964195B CN 114964195 B CN114964195 B CN 114964195B CN 202210892585 A CN202210892585 A CN 202210892585A CN 114964195 B CN114964195 B CN 114964195B
- Authority
- CN
- China
- Prior art keywords
- angular velocity
- gyro
- gyroscope
- temperature compensation
- sequence
- 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
- 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
-
- 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/5776—Signal processing not specific to any of the devices covered by groups G01C19/5607 - G01C19/5719
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Signal Processing (AREA)
- Gyroscopes (AREA)
Abstract
Description
技术领域
本发明涉及陀螺技术领域,尤其涉及一种半球谐振陀螺角速度信号温度补偿方法。
背景技术
谐振陀螺是利用谐振子振动驻波在哥氏力作用下沿环向进动来敏感外界角速度的一种振动陀螺,具有测量精度高,稳定性和可靠性高,工作寿命长,体积小,噪声低,加速度不敏感,抗冲击、过载、辐射能力强等优点,同时具有独特的瞬间断电工作保持能力,在空间领域受到越来越多的关注和应用。
但是在陀螺运行过程中,由于陀螺加工工艺和线路设计工艺误差,陀螺会产生一定的温度变化,使造成一定程度的漂移而影响陀螺的精度。传统谐振陀螺在温度补偿时,由于陀螺漂移中包含标度误差部分、周期性漂移部分以及常值漂移部分,它们由于产生根源不同导致其随温度变化的趋势不同,很难用一组温度补偿参数对其进行补偿。因此,本专利设计一种新的工作模式分离以上不同性质的漂移,在此基础上进行温度补偿。
发明内容
本发明所要解决的技术问题是提供一种半球谐振陀螺角速度信号温度补偿方法,基于主动驱动振型正反转调制的工作模式解决陀螺输出信号中的对称性漂移和标度误差,并针对剩余常值漂移和随温度变化的特点,对角速度信号进行温度补偿,达到提高陀螺精度和稳定性的目的。
本发明是通过以下技术方案予以实现:
一种半球谐振陀螺角速度信号温度补偿方法,其包括如下步骤:
S1:按温度循环谱进行温循试验,陀螺采用驱动振型正反转进动的工作模式,通过
信号输出模块以设定的录数频率r录取陀螺输出角速度信号g1i及谐振频率信号f1i的实时
数据,并形成陀螺输出角速度信号序列及谐振频率信号序列,并将G1和F1传输给计算模块;
S2:计算模块每隔时间将陀螺输出角速度信号g1i及谐振频率信号f1i求取均值,
得到陀螺角速度信号序列及谐振频率信号序列,其中,谐振频率信号序列,j=1,2,3… t*r*3600/T,表示驻波进动一个周期的时间,r为录数
频率;
S5:计算模块再根据式(2)计算出温度补偿之后的陀螺输出角速度信号;
其中:G为陀螺角速度信号序列,Gs为拟合陀螺角速度序列,Gc为温度补偿后陀螺角速度。
进一步,试验时陀螺敏感轴指向地速为零点。
优化的,S1中录数频率r=100Hz。
优化的,步骤S1试验时间为3小时。
发明的有益效果
本发明提供的一种半球谐振陀螺角速度信号温度补偿方法,具有如下优点:1、主动施加控制力驱动陀螺振型主动进动,通过驱动振型正反调制掉陀螺周期型漂移和标度误差,提高陀螺长期稳定性。
2、该方案只需通过施加控制力控制振型进动,不需要旋转机构控制,即可达到陀螺旋转调制的功能,减小陀螺漂移,提高陀螺输出精度。
3、针对陀螺剩余常值漂移随温度变化的情况,设计了温度补偿模型,对陀螺输出角速度进行温度补偿,有效提高了振型驱动过程中的陀螺稳定性。
附图说明
图1是陀螺振型正反转调制输出示意图;
图2是陀螺频率-温度特性曲线图;
图3是陀螺频率-温度误差曲线图;
图4是温度循环普曲线示意图。
具体实施方式
一种半球谐振陀螺角速度信号温度补偿方法,其包括如下步骤:
S1:按温度循环谱进行温循试验,陀螺采用驱动振型正反转进动的工作模式,通过
信号输出模块以设定的录数频率r录取陀螺输出角速度信号g1i及谐振频率信号f1i的实时
数据,并形成陀螺输出角速度信号序列及谐振频率信号序列,并将G1和F1传输给计算模块;
通过驱动振型正反转进动的工作模式,陀螺标度误差、对称性漂移就可以被消除,使残余的误差只剩常值漂移。
S2:计算模块每隔时间将陀螺输出角速度信号g1i及谐振频率信号f1i求取均值,
得到陀螺角速度信号序列及谐振频率信号序列,其中,谐振频率信号序列,j=1,2,3… t*r*3600/T,表示驻波进动一个周期的时间,r为录数
频率;
S5: 计算模块再根据式(2)计算出温度补偿之后的陀螺输出角速度信号;即将陀螺输出角速度信号进行了温度补偿。
其中:G陀螺角速度信号序列,Gs为拟合陀螺角速度序列,Gc为温度补偿后陀螺角速度。
补偿原理如下:
由于半球谐振陀螺具有多阶振动模态,振型的进动系数(振型转过的角度与陀螺
敏感轴转过角度的比值)会随环向波数n增加而单调减小。为便于振型检测一般选用n=2的
二阶振动模态。二阶振动模态为四波腹振动,波腹和波节点在空间上相距45°。半球谐振陀
螺振型的运动方程是一个二阶线性微分方程组,方程组的两个方程分别描述了谐振子沿轴方向和与轴方向在空间上呈45°的轴方向的振动,基于Lynch的非理想谐振子
误差模型,得到半球谐振陀螺运动方程为式(3):
其中:为Paoli矩阵; 为布莱恩系
数,约等于0.27;为相互正交的检测轴,处的位移; 为谐振子受
到的控制力; 表示陀螺的频率裂解值;表示陀螺的平均频率;表示频率轴与电极
轴的夹角; 表示谐振子周向平均阻尼,表示谐振子周向
阻尼不均,将陀螺角速度信号序列和陀螺频率信号输入到式
(1),得到常值漂移的温度补偿系数,,k0、k1、k2、k3分别为温度补偿模型
中的常数项、频率一次方项、频率二次方项和频率三次方项的系数;
S5: 计算模块再根据式(2)计算出温度补偿之后的陀螺输出角速度信号;即将陀螺输出角速度信号进行了温度补偿。
其中:G陀螺角速度信号序列,Gs为拟合陀螺角速度序列,Gc为温度补偿后陀螺角速度。
补偿原理如下:
由于半球谐振陀螺具有多阶振动模态,振型的进动系数(振型转过的角度与陀螺
敏感轴转过角度的比值)会随环向波数n增加而单调减小。为便于振型检测一般选用n=2的
二阶振动模态。二阶振动模态为四波腹振动,波腹和波节点在空间上相距45°。半球谐振陀
螺振型的运动方程是一个二阶线性微分方程组,方程组的两个方程分别描述了谐振子沿轴方向和与轴方向在空间上呈45°的轴方向的振动,基于Lynch的非理想谐振子
误差模型,得到半球谐振陀螺运动方程为式(3):
其中:为Paoli矩阵; 为布莱恩系
数,约等于0.27;为相互正交的检测轴,处的位移; 为谐振子受
到的控制力; 表示陀螺的频率裂解值;表示陀螺的平均频率;表示频率轴与电极
轴的夹角; 表示谐振子周向平均阻尼,表示谐振子周向
阻尼不均,相关的周期性变化的漂移,半球谐振陀螺的漂移对角度整周期求积分可以均
和大部分的漂移。所以半球谐振陀螺可采用主动控制振型进动的工作模式激发出陀螺对称
性漂移并消除:即控制系统每一只陀螺在全角模式下,通过额外施加进动控制信号Cp,主动
地驱使陀螺谐振子驻波振型连续进动,使陀螺漂移呈现周期性变化,在整周期内的积分近
似为零,从而减小系统误差随时间的积累。
通过式(7)的陀螺漂移特性,可以分析出陀螺振型主动进动时陀螺角速度输出误差。
求取均值后,此时陀螺角速度输出中仍含有扣除主动施加的控制力后的剩余误差,其中施力标度误差为且其值会随温度和时间变化产生累积误差,因此
可以通过主动驱动振型正反旋转进动的方法来抵消标度误差的影响,即驱动驻波振型在区间内周期性的正向、反向进动,则根据式(8)可得到式(9):
从式(9)可以看出,通过驻波振型主动正反旋转进动,陀螺标度误差、对称性漂移被消除,残余的误差只剩常值漂移。而剩余常值漂移随温度的变化是影响陀螺精度的主要因素,因此,需对该常值漂移进行温度补偿。
半球谐振陀螺采用频率跟踪回路来锁定谐振子的谐振频率,可以采集到频率的变化,而陀螺谐振频率变化与温度的变化具有很强的相关性,如图2所示。因此,可以利用陀螺谐振频率的变化代替温度的变化对陀螺漂移进行补偿。
而频率补偿模型多采用多项式模型,使用最小二乘法对陀螺误差参数-频率样本进行多项式拟合,就可以得到频率补偿多项式模型如补偿过程S3中的式(1)及S5中的(2)所示:
因此,具体补偿时通过本申请的步骤S1-S3,就可以计算出常值漂移的温度补偿系
数,是一个包含参数k0、k1、k2、k3的集合,参数k0、k1、k2、k3分别为温度补
偿模型中的常数项、频率一次方项、频率二次方项和频率三次方项的系数,因此如S4-S5所
述将求出的温度补偿系数代入式(2)就可以对陀螺的角速度信号进行温度补偿而得到温度
补偿后陀螺角速度。
进一步,试验时陀螺敏感轴指向地速为零点,此时的陀螺输出角速度信号仅包含常值漂移,即对应最小二乘拟合只拟合陀螺常值漂移信号,更加方便分析补偿。
优化的,S1中录数频率r=100Hz,方便录取多个数据,形成陀螺输出角速度信号序列,并求取均值,使计算出的温度补偿系数更加准确。
优化的,步骤S1试验时间为3小时,可以使系统能够有充足的时间录取数据及计算,并对陀螺输出角速度信号进行温度补偿。
综上所述,本发明提出的一种半球谐振陀螺角速度信号温度补偿方法,通过主动驱动振型正反转调制的工作模式消除了陀螺标度误差和对称性漂移误差,并针对剩余常值漂移随温度变化的特点对陀螺角速度进行了温度补偿,最终使能够提高陀螺精度和稳定性,具有工程应用价值。
以上所述仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (5)
1.一种半球谐振陀螺角速度信号温度补偿方法,其特征在于,包括如下步骤:
S1: 按温度循环谱进行温循试验,陀螺采用驱动振型正反转进动的工作模式,通过信
号输出模块以设定的录数频率r录取陀螺输出角速度信号g1i及谐振频率信号f1i的实时数
据,并形成陀螺输出角速度信号序列及谐振频率信号序列,并将G1和F1传输给计算模块;
S2:计算模块每隔时间将陀螺输出角速度信号g1i及谐振频率信号f1i求取均值,得到
陀螺角速度信号序列及谐振频率信号序列
,其中,谐振频率信号序列,j=1,2,3… t*r*
3600/T,表示驻波进动一个周期的时间,r为录数频率;
S5: 计算模块再根据温度补偿模型式(2)计算出温度补偿之后的陀螺输出角速度信号;
其中G为陀螺角速度信号序列,Gs为拟合陀螺角速度序列,Gc为温度补偿后陀螺角速度序列。
2.根据权利要求1所述的一种半球谐振陀螺角速度信号温度补偿方法,其特征在于,试验时陀螺敏感轴指向地速为零点。
3.根据权利要求1所述的一种半球谐振陀螺角速度信号温度补偿方法,其特征在于,S1中录数频率r=100Hz。
4.根据权利要求1所述的一种半球谐振陀螺角速度信号温度补偿方法,其特征在于,步骤S1试验时间为3小时。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210892585.7A CN114964195B (zh) | 2022-07-27 | 2022-07-27 | 一种半球谐振陀螺角速度信号温度补偿方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210892585.7A CN114964195B (zh) | 2022-07-27 | 2022-07-27 | 一种半球谐振陀螺角速度信号温度补偿方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114964195A CN114964195A (zh) | 2022-08-30 |
CN114964195B true CN114964195B (zh) | 2022-10-11 |
Family
ID=82970066
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210892585.7A Active CN114964195B (zh) | 2022-07-27 | 2022-07-27 | 一种半球谐振陀螺角速度信号温度补偿方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114964195B (zh) |
Families Citing this family (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115127533B (zh) * | 2022-08-31 | 2022-11-18 | 中国船舶重工集团公司第七0七研究所 | 一种基于谐振陀螺振型旋转调制下的误差拟合补偿方法 |
CN115574798B (zh) * | 2022-09-30 | 2024-06-18 | 中国人民解放军火箭军工程大学 | 一种提高半球谐振陀螺综合性能的方法 |
CN115773741B (zh) * | 2023-02-14 | 2023-04-21 | 中国船舶集团有限公司第七〇七研究所 | 半球谐振陀螺仪自补偿控制系统及方法 |
CN115876182B (zh) * | 2023-02-27 | 2023-04-28 | 中国船舶集团有限公司第七〇七研究所 | 一种半球谐振陀螺的电极误差建模方法 |
CN116576885A (zh) * | 2023-05-06 | 2023-08-11 | 哈尔滨工业大学 | 一种基于温度标定与补偿的半球谐振陀螺启动方法及系统 |
CN116465384B (zh) * | 2023-06-20 | 2023-08-18 | 中国船舶集团有限公司第七〇七研究所 | 一种基于模态反转的半球谐振陀螺漂移误差补偿方法 |
CN116499497B (zh) * | 2023-06-28 | 2023-09-05 | 中国船舶集团有限公司第七〇七研究所 | 基于模态反转的半球谐振陀螺惯导系统误差自校准方法 |
CN116608890B (zh) * | 2023-07-21 | 2023-10-13 | 中国船舶集团有限公司第七〇七研究所 | 一种全角模式半球谐振陀螺的标度误差补偿方法 |
CN117109637B (zh) * | 2023-10-19 | 2023-12-19 | 四川图林科技有限责任公司 | 一种半球谐振陀螺仪的温漂误差修正补偿方法 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002031532A (ja) * | 2000-07-18 | 2002-01-31 | Alps Electric Co Ltd | 振動型ジャイロスコープ及びその調整方法 |
CN105222765A (zh) * | 2015-09-18 | 2016-01-06 | 工业和信息化部电子第五研究所 | Mems陀螺的温度补偿方法及系统 |
CN105892293A (zh) * | 2016-04-06 | 2016-08-24 | 苏州大学 | 一种硅微陀螺数字化驱动闭环控制系统 |
CN109211275A (zh) * | 2018-10-22 | 2019-01-15 | 中国兵器工业集团第二四研究所苏州研发中心 | 一种陀螺仪的零偏温度补偿方法 |
CN110631570A (zh) * | 2019-10-17 | 2019-12-31 | 东南大学 | 一种用于提升硅微陀螺仪标度因数温度稳定性的系统和方法 |
WO2021227013A1 (zh) * | 2020-05-11 | 2021-11-18 | 中国科学院地质与地球物理研究所 | 固态谐振陀螺自校准方法及系统 |
CN113739779A (zh) * | 2021-08-31 | 2021-12-03 | 中国船舶重工集团公司第七0七研究所 | 基于bp神经网络半球谐振陀螺多元温度补偿系统及方法 |
CN114485601A (zh) * | 2022-01-21 | 2022-05-13 | 中国人民解放军火箭军工程大学 | 一种半球谐振陀螺温度误差间接补偿方法 |
-
2022
- 2022-07-27 CN CN202210892585.7A patent/CN114964195B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002031532A (ja) * | 2000-07-18 | 2002-01-31 | Alps Electric Co Ltd | 振動型ジャイロスコープ及びその調整方法 |
CN105222765A (zh) * | 2015-09-18 | 2016-01-06 | 工业和信息化部电子第五研究所 | Mems陀螺的温度补偿方法及系统 |
CN105892293A (zh) * | 2016-04-06 | 2016-08-24 | 苏州大学 | 一种硅微陀螺数字化驱动闭环控制系统 |
CN109211275A (zh) * | 2018-10-22 | 2019-01-15 | 中国兵器工业集团第二四研究所苏州研发中心 | 一种陀螺仪的零偏温度补偿方法 |
CN110631570A (zh) * | 2019-10-17 | 2019-12-31 | 东南大学 | 一种用于提升硅微陀螺仪标度因数温度稳定性的系统和方法 |
WO2021227013A1 (zh) * | 2020-05-11 | 2021-11-18 | 中国科学院地质与地球物理研究所 | 固态谐振陀螺自校准方法及系统 |
CN113739779A (zh) * | 2021-08-31 | 2021-12-03 | 中国船舶重工集团公司第七0七研究所 | 基于bp神经网络半球谐振陀螺多元温度补偿系统及方法 |
CN114485601A (zh) * | 2022-01-21 | 2022-05-13 | 中国人民解放军火箭军工程大学 | 一种半球谐振陀螺温度误差间接补偿方法 |
Non-Patent Citations (3)
Title |
---|
A micromachined gyroscope with piezoresistance for both high performance Coriolis-effect detection and torsional vibration monitoring;Xuemeng Chen等;《The 13th International Conference on Solid-State Sensors, Actuators and Microsystems, 2005. Digest of Technical Papers. TRANSDUCERS "05》;20050609;第117-120页 * |
MEMS陀螺仪驱动谐振频率的温度补偿方法;刘玉县等;《传感器与微系统》;20190508(第05期);全文 * |
半球谐振陀螺温度补偿与实验研究;周小刚等;《宇航学报》;20100430(第04期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN114964195A (zh) | 2022-08-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN114964195B (zh) | 一种半球谐振陀螺角速度信号温度补偿方法 | |
JP5421693B2 (ja) | 自己較正型ジャイロスコープ・システム | |
US7739896B2 (en) | Self-calibration of scale factor for dual resonator class II coriolis vibratory gyros | |
JP2644067B2 (ja) | リングレーザジヤイロスコープ用デイザ駆動システム | |
US4445779A (en) | Dither system for a spring mass system | |
CN113074756B (zh) | 一种速率积分型振动陀螺的误差补偿方法和装置 | |
CN109990773A (zh) | 一种干涉型光纤陀螺环路增益的检测与闭环控制系统及控制方法 | |
CN116608890B (zh) | 一种全角模式半球谐振陀螺的标度误差补偿方法 | |
US10527419B1 (en) | Baseband control electronics for inertial wave angle gyroscope | |
CN113447047B (zh) | 速率积分陀螺检测电极误差辨识方法、装置、系统及介质 | |
CN116499497B (zh) | 基于模态反转的半球谐振陀螺惯导系统误差自校准方法 | |
CN114383590A (zh) | 速率积分陀螺的相位误差辨识和补偿方法 | |
JPH0481358B2 (zh) | ||
JPH0332918B2 (zh) | ||
CN114894221B (zh) | 一种半球谐振陀螺正交耦合误差标定方法 | |
US5337141A (en) | Method and apparatus for distortion free measurements | |
Yin et al. | A phase self-correction method for bias temperature drift suppression of MEMS gyroscopes | |
US8259302B2 (en) | Variable path length control modulation frequency | |
US5329355A (en) | Dither stripper to leave base motion | |
RU2670245C1 (ru) | Способ считывания и управления колебаниями волнового твердотельного гироскопа | |
Liu et al. | A Phase Compensation Method for MEMS Quadruple Mass Gyroscope in Zero Bias Drift | |
KR100450994B1 (ko) | 퍼지로직을 이용한 진동형 자이로스코프의 온도 바이어스드리프트 보정방법 | |
Watson et al. | Coriolis gyro configuration effects on noise and drift performance | |
Sushchenko et al. | Improvement of Inertial Sensors for Using in Stabilization Systems | |
RU2731656C1 (ru) | Инерциальное измерительное устройство с цифровым средством управления |
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 |