CN115855121A - 一种半球谐振陀螺的误差自校准方法 - Google Patents
一种半球谐振陀螺的误差自校准方法 Download PDFInfo
- Publication number
- CN115855121A CN115855121A CN202310172136.XA CN202310172136A CN115855121A CN 115855121 A CN115855121 A CN 115855121A CN 202310172136 A CN202310172136 A CN 202310172136A CN 115855121 A CN115855121 A CN 115855121A
- Authority
- CN
- China
- Prior art keywords
- error
- hemispherical resonator
- self
- time
- calibration
- 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
Images
Landscapes
- Gyroscopes (AREA)
Abstract
Description
技术领域
本发明涉及陀螺技术领域,尤其涉及一种半球谐振陀螺的误差自校准方法。
背景技术
半球谐振陀螺是哥式振动陀螺仪中的一种具有惯导级性能的高精度陀螺仪,它具有很高的测量精度、超强的稳定性和可靠性、良好的抗冲击振动性及温度性能,还特别具有独特的关机抗辐射能力,其随机漂移可达到10º/hr量级,寿命高达15年。半球谐振陀螺由激励电极、检测电极和半球谐振子构成,半球谐振子是半球谐振陀螺的核心部件,其性能决定了半球谐振陀螺的性能。在半球谐振陀螺制作加工过程中,半球谐振子的工艺控制已经比较成熟,但是半球谐振陀螺的性能除了受到半球谐振子的加工工艺缺陷等的影响之外,半球谐振陀螺由于使用离散电极进行控制,会导致不同电极之间的增益不一致误差,也会造成半球谐振陀螺的输出存在误差,如果不及时对半球谐振陀螺的输出误差进行自校准,半球谐振陀螺将会产生漂移,从而影响半球谐振陀螺的稳定性。
发明内容
本发明所要解决的技术问题是提供一种半球谐振陀螺的误差自校准方法,通过各条回路之间控制信号的耦合关系规律,计算出半球谐振陀螺由于使用离散电极进行控制导致不同电极之间的增益不一致误差,并将误差补偿到电极中,以减小半球谐振陀螺的漂移,提高半球谐振陀螺的性能。
本发明是通过以下技术方案予以实现:
一种半球谐振陀螺的误差自校准方法,其包括如下步骤:
其中:表示序列号,/>为滤波增益矩阵,/>为协方差矩阵,/>为对应矩阵的转置,为电极线路增益误差,/>是/>时刻频率回路信号/>的监测值/>,/>是/>时刻的监测矩阵,/>为单位矩阵,/>表示初始/>时刻的协方差矩阵,/>表示/>时刻的滤波增益矩阵,/>表示/>时刻的协方差矩阵,/>表示/>时刻的电极线路增益误差的预测值,/>表示/>时刻协方差矩阵的预测值,/>表示/>时刻电极线路增益误差的预测值;
优化的,半球谐振陀螺工作时,每间隔两个小时重复一次步骤S1-S4进行误差自校准。
进一步,每次误差自校准完成后,半球谐振陀螺自动切换回工作模式,等待下次自校准指令。
发明的有益效果:
本发明针对回路耦合漂移,实时估计增益误差,并通过反馈补偿到检测信号中,完成半球谐振陀螺漂移的自标定与补偿,从而减少半球谐振陀螺漂移,提高半球谐振陀螺的性能。
附图说明
图1是电极线路增益误差估计曲线图。
具体实施方式
一种半球谐振陀螺的误差自校准方法,其包括如下步骤:
其中:表示序列号,/>为滤波增益矩阵,/>为协方差矩阵,/>为对应矩阵的转置,/>为电极线路增益误差,/>是/>时刻频率回路信号/>的监测值/>,/>是/>时刻的监测矩阵,/>为单位矩阵,/>表示初始/>时刻的协方差矩阵,/>表示/>时刻的滤波增益矩阵,/>表示/>时刻的协方差矩阵,/>表示/>时刻的电极线路增益误差的预测值,/>表示/>时刻协方差矩阵的预测值,/>表示/>时刻电极线路增益误差的预测值;
半球谐振陀螺是哥氏振动陀螺的一种,基于哥氏效应敏感外部角速度。理想的半球谐振陀螺正常工作在二阶振动模态下的振动为四波腹运动振动。然而,谐振子生产制造过程受制于目前工艺的局限,造成谐振子周向的刚度、质量和阻尼不一致,导致半球谐振陀螺出现阻尼不均和频率裂解,造成半球谐振陀螺漂移,基于平均法推导出存在谐振子误差的半球谐振陀螺运动方程如式(2):
对式(2)求解可得非理想谐振子下半球谐振陀螺的控制闭环情况下固有频率以及控制信号随振型角的变化:即式(3):
其中分别为泡利自旋矩阵中的一个矩阵,/>表示陀螺的平均频率,/>,/>表示谐振子的最大谐振频率,/>表示谐振子的最小谐振频率,/>为布莱恩系数,约等于0.27;/>为相互正交的检测轴/>,/>处的位移,/>为/>的一阶导数,/>为/>的二阶导数,/>为振型角;/>为谐振子受到的控制力,/>为谐振子施力轴/>施加的控制力,/>为谐振子施力轴/>施加的控制力;/>表示半球谐振陀螺振型角控制信号,/>表示半球谐振陀螺正交控制信号;/>表示半球谐振陀螺的频率裂解值;/>表示频率轴与电极轴的夹角;/>表示谐振子平均时间常数,/>表示最大阻尼轴时间常数;/>表示最小尼轴时间常数;/>表示阻尼轴与电极轴的夹角;/>表示谐振子周向平均阻尼,/>表示谐振子周向阻尼不均,/>为外部输入角速度,/>为外部输入角速度的一阶导数,/>表示振动相位,/>表示振动相位的一阶导数,/>为谐振子模态质量。
在实际半球谐振陀螺工作中,不仅存在谐振子非理想误差,在半球谐振陀螺通过电极进行信号的施力和检测以及相关线路设计上同样存在误差,这会导致半球谐振陀螺四条回路控制信号的互相耦合,造成半球谐振陀螺输出存在误差。
对于理想检测坐标系向非理想检测坐标系的电极误差矩阵A,有式(4):
将式(4)带入非理想谐振子的运动方程(2),得到半球谐振陀螺存在电极线路误差和谐振子误差的运动方程为式(5):
通过平均法带入分析后,忽略二阶小量,可以得到半球谐振陀螺频率回路最终输出表达式(6):
对比式(3)和式(6)可知,增益不一致误差可导致和/>之间的耦合,因此可以使用/>和/>耦合的方法估计/>,由于/>是振型位置的函数,考虑半球谐振陀螺将振型角度控制在/>进行误差估计,此时增益误差达到最大值式(7):
由于电极及线路之间的增益误差并非定值,会随着时间温度等环境发生变化,为了能够实时的估计出误差并反馈补偿,进一步消除二阶小量的影响,建立最小二乘模型如式(8),
递归最小二乘模型就可以得到式(1)。
因此,只要实时监测半球谐振陀螺输出的稳幅回路信号及频率回路信号/>,并将监测值传输给上位机,上位机将收到的信号传输给计算模块,计算模块根据式(1),进行迭代计算并收敛,得到收敛的电极线路增益误差预测值/>即为半球谐振陀螺电极及线路增益不一致误差/>,具体电极线路增益误差估计曲线图如附图1所示。
S3:重复S2,迭代计算、/>、/>,观察/>(k=0,1,2,..)序列直至收敛;收敛值即半球谐振陀螺电极及线路增益不一致误差/>,可以使半球谐振陀螺电极及线路增益不一致误差/>对应变化小于0.001,当收敛值达到0.001时系统通过上位机控制进入工作模式,重新计时,同时进行误差补偿,即进行S4的步骤。
S4:计算模块将收敛的误差值发送给激励模块,激励模块将误差值补偿到半球谐振陀螺电极中,完成误差自校准。
这样通过计算模块计算并收敛得到半球谐振陀螺电极及线路增益不一致误差,并将其补偿到半球谐振陀螺电极中,就可以减少半球谐振陀螺由于使用离散电极进行控制导致不同电极之间的增益不一致误差,达到半球谐振陀螺误差自校准的目的,从而减小半球谐振陀螺漂移,提高半球谐振陀螺性能。
优化的,半球谐振陀螺工作时,每间隔两个小时重复一次步骤S1-S4进行误差自校准。
可以通过上位机设定校准时间间隔,优选间隔时间为两小时,这样可以及时对半球谐振陀螺由于使用离散电极进行控制导致不同电极之间的增益不一致误差进行补偿,从而保证半球谐振陀螺的性能。
因为在时,两条回路之间的耦合量达到最大,因此选择在此位置进行自校准,可以更好地使半球谐振陀螺由于使用离散电极进行控制导致不同电极之间的增益不一致误差得到补偿,并且在此位置工作时间为五分钟,可以充分保证在此时间内完成自校准。
进一步,每次自校准完成后,半球谐振陀螺自动切换回工作模式,等待下次自校准指令。半球谐振陀螺通过上位机控制,可以在工作模式和自校准模式下自动切换,自校准更加方便快捷。
综上所述,本发明提出的一种半球谐振陀螺的误差自校准方法,针对回路耦合漂移,实时估计增益误差,并通过反馈补偿到检测信号中,完成半球谐振陀螺漂移的自标定与补偿,从而减少半球谐振陀螺漂移,提高半球谐振陀螺的性能。
以上所述仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (5)
1.一种半球谐振陀螺的误差自校准方法,其特征在于,包括如下步骤:
其中:表示序列号,/>为滤波增益矩阵,/>为协方差矩阵,/>为对应矩阵的转置,/>为电极线路增益误差,/>是/>时刻频率回路信号/>的监测值/>,/>是/>时刻的监测矩阵,/>为单位矩阵,/>表示初始/>时刻的协方差矩阵,/>表示/>时刻的滤波增益矩阵,表示/>时刻的协方差矩阵,/>表示/>时刻的电极线路增益误差的预测值,/>表示时刻协方差矩阵的预测值,/>表示/>时刻电极线路增益误差的预测值;
3.根据权利要求1所述的一种半球谐振陀螺的误差自校准方法,其特征在于,半球谐振陀螺工作时,每间隔两个小时重复一次步骤S1-步骤S4进行误差自校准。
5.根据权利要求4所述的一种半球谐振陀螺的误差自校准方法,其特征在于,每次误差自校准完成后,半球谐振陀螺自动切换回工作模式,等待下次自校准指令。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310172136.XA CN115855121B (zh) | 2023-02-28 | 2023-02-28 | 一种半球谐振陀螺的误差自校准方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310172136.XA CN115855121B (zh) | 2023-02-28 | 2023-02-28 | 一种半球谐振陀螺的误差自校准方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115855121A true CN115855121A (zh) | 2023-03-28 |
CN115855121B CN115855121B (zh) | 2023-04-28 |
Family
ID=85659180
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202310172136.XA Active CN115855121B (zh) | 2023-02-28 | 2023-02-28 | 一种半球谐振陀螺的误差自校准方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115855121B (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116046027A (zh) * | 2023-03-31 | 2023-05-02 | 中国船舶集团有限公司第七〇七研究所 | 三轴旋转式惯导位置误差无源自主校准方法及系统 |
CN116465384A (zh) * | 2023-06-20 | 2023-07-21 | 中国船舶集团有限公司第七〇七研究所 | 一种基于模态反转的半球谐振陀螺漂移误差补偿方法 |
CN116625410A (zh) * | 2023-07-20 | 2023-08-22 | 中国船舶集团有限公司第七〇七研究所 | 一种半球谐振陀螺激励电极增益校准方法 |
CN117029882A (zh) * | 2023-10-10 | 2023-11-10 | 北京航空航天大学 | 一种全角半球谐振陀螺检测增益不对称误差的标定方法 |
CN117272695A (zh) * | 2023-11-21 | 2023-12-22 | 中国船舶集团有限公司第七〇七研究所 | 一种半球谐振陀螺绝缘子的刚度设计方法 |
CN117490729A (zh) * | 2024-01-03 | 2024-02-02 | 四川图林科技有限责任公司 | 一种半球谐振陀螺仪的正交漂移误差检测方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113074756A (zh) * | 2021-03-31 | 2021-07-06 | 中国人民解放军国防科技大学 | 一种速率积分型振动陀螺的误差补偿方法和装置 |
CN113447047A (zh) * | 2021-08-31 | 2021-09-28 | 中国人民解放军国防科技大学 | 速率积分陀螺检测电极误差辨识方法、装置、系统及介质 |
CN114440852A (zh) * | 2022-03-15 | 2022-05-06 | 哈尔滨工业大学 | 一种半球谐振陀螺x/y通路驱动增益不对称性误差辨识方法 |
CN114543843A (zh) * | 2022-03-14 | 2022-05-27 | 中国船舶重工集团公司第七0七研究所 | 一种谐振陀螺仪通道误差标定校正方法 |
CN114838741A (zh) * | 2022-07-04 | 2022-08-02 | 中国船舶重工集团公司第七0七研究所 | 一种全角半球谐振陀螺激励电极误差补偿方法 |
CN115077564A (zh) * | 2022-06-15 | 2022-09-20 | 哈尔滨工业大学 | 一种半球谐振陀螺检测通道不平衡误差辨识及补偿方法 |
CN115615463A (zh) * | 2022-11-22 | 2023-01-17 | 中国船舶集团有限公司第七〇七研究所 | 一种半球谐振陀螺质量-刚度联合修调方法 |
-
2023
- 2023-02-28 CN CN202310172136.XA patent/CN115855121B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113074756A (zh) * | 2021-03-31 | 2021-07-06 | 中国人民解放军国防科技大学 | 一种速率积分型振动陀螺的误差补偿方法和装置 |
CN113447047A (zh) * | 2021-08-31 | 2021-09-28 | 中国人民解放军国防科技大学 | 速率积分陀螺检测电极误差辨识方法、装置、系统及介质 |
CN114543843A (zh) * | 2022-03-14 | 2022-05-27 | 中国船舶重工集团公司第七0七研究所 | 一种谐振陀螺仪通道误差标定校正方法 |
CN114440852A (zh) * | 2022-03-15 | 2022-05-06 | 哈尔滨工业大学 | 一种半球谐振陀螺x/y通路驱动增益不对称性误差辨识方法 |
CN115077564A (zh) * | 2022-06-15 | 2022-09-20 | 哈尔滨工业大学 | 一种半球谐振陀螺检测通道不平衡误差辨识及补偿方法 |
CN114838741A (zh) * | 2022-07-04 | 2022-08-02 | 中国船舶重工集团公司第七0七研究所 | 一种全角半球谐振陀螺激励电极误差补偿方法 |
CN115615463A (zh) * | 2022-11-22 | 2023-01-17 | 中国船舶集团有限公司第七〇七研究所 | 一种半球谐振陀螺质量-刚度联合修调方法 |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116046027A (zh) * | 2023-03-31 | 2023-05-02 | 中国船舶集团有限公司第七〇七研究所 | 三轴旋转式惯导位置误差无源自主校准方法及系统 |
CN116046027B (zh) * | 2023-03-31 | 2023-06-16 | 中国船舶集团有限公司第七〇七研究所 | 三轴旋转式惯导位置误差无源自主校准方法及系统 |
CN116465384A (zh) * | 2023-06-20 | 2023-07-21 | 中国船舶集团有限公司第七〇七研究所 | 一种基于模态反转的半球谐振陀螺漂移误差补偿方法 |
CN116465384B (zh) * | 2023-06-20 | 2023-08-18 | 中国船舶集团有限公司第七〇七研究所 | 一种基于模态反转的半球谐振陀螺漂移误差补偿方法 |
CN116625410A (zh) * | 2023-07-20 | 2023-08-22 | 中国船舶集团有限公司第七〇七研究所 | 一种半球谐振陀螺激励电极增益校准方法 |
CN116625410B (zh) * | 2023-07-20 | 2023-09-19 | 中国船舶集团有限公司第七〇七研究所 | 一种半球谐振陀螺激励电极增益校准方法 |
CN117029882A (zh) * | 2023-10-10 | 2023-11-10 | 北京航空航天大学 | 一种全角半球谐振陀螺检测增益不对称误差的标定方法 |
CN117029882B (zh) * | 2023-10-10 | 2023-12-22 | 北京航空航天大学 | 一种全角半球谐振陀螺检测增益不对称误差的标定方法 |
CN117272695A (zh) * | 2023-11-21 | 2023-12-22 | 中国船舶集团有限公司第七〇七研究所 | 一种半球谐振陀螺绝缘子的刚度设计方法 |
CN117272695B (zh) * | 2023-11-21 | 2024-01-30 | 中国船舶集团有限公司第七〇七研究所 | 一种半球谐振陀螺绝缘子的刚度设计方法 |
CN117490729A (zh) * | 2024-01-03 | 2024-02-02 | 四川图林科技有限责任公司 | 一种半球谐振陀螺仪的正交漂移误差检测方法 |
CN117490729B (zh) * | 2024-01-03 | 2024-03-19 | 四川图林科技有限责任公司 | 一种半球谐振陀螺仪的正交漂移误差检测方法 |
Also Published As
Publication number | Publication date |
---|---|
CN115855121B (zh) | 2023-04-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN115855121A (zh) | 一种半球谐振陀螺的误差自校准方法 | |
CN111896026B (zh) | 固态谐振陀螺自校准方法及系统 | |
CN110865580A (zh) | 基于时分复用的半球谐振陀螺全差分控制系统及控制方法 | |
US9689678B2 (en) | MEMS balanced inertial angular sensor and method for balancing such a sensor | |
US9869551B2 (en) | Inertial angular sensor of balanced MEMS type and method for balancing such a sensor | |
KR102487462B1 (ko) | 인-시투 바이어스 자가-교정을 갖는 고대역폭 코리올리 진동식 자이로스코프(cvg) | |
CN115876182B (zh) | 一种半球谐振陀螺的电极误差建模方法 | |
RU2476823C2 (ru) | Способ измерения при помощи гироскопической системы | |
CN114838741B (zh) | 一种全角半球谐振陀螺激励电极误差补偿方法 | |
CN115773741B (zh) | 半球谐振陀螺仪自补偿控制系统及方法 | |
CN116608890B (zh) | 一种全角模式半球谐振陀螺的标度误差补偿方法 | |
CN111578966A (zh) | 一种基于lms算法的半球谐振子特征参数辨识方法 | |
CN114440933A (zh) | 一种谐振陀螺仪旋转调制标度自校正系统 | |
CN115420269B (zh) | 谐振结构频率裂解辨识与修调方法及平台 | |
CN115077564B (zh) | 一种半球谐振陀螺检测通道不平衡误差辨识及补偿方法 | |
CN116465384B (zh) | 一种基于模态反转的半球谐振陀螺漂移误差补偿方法 | |
CN114046804B (zh) | 速率积分陀螺驱动电极误差辨识方法、装置、系统和介质 | |
CN115406426B (zh) | 一种mems陀螺接口电路及调制方法 | |
CN109633205B (zh) | 一种石英谐振加速度计温度补偿方法 | |
CN116698084A (zh) | 一种对称式陀螺零偏漂移实时抑制与零偏稳定性提升方法 | |
CN112556688A (zh) | 测量装置 | |
Ma et al. | Factor graph localization algorithm based on robust estimation | |
CN110440779B (zh) | 一种高动态mems谐振式陀螺仪力平衡控制方法 | |
US8997567B2 (en) | Method of angular measurement by means of a vibrating sensor to which modulated controls are applied | |
CN106595709B (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 |