CN114440852A - 一种半球谐振陀螺x/y通路驱动增益不对称性误差辨识方法 - Google Patents
一种半球谐振陀螺x/y通路驱动增益不对称性误差辨识方法 Download PDFInfo
- Publication number
- CN114440852A CN114440852A CN202210252915.6A CN202210252915A CN114440852A CN 114440852 A CN114440852 A CN 114440852A CN 202210252915 A CN202210252915 A CN 202210252915A CN 114440852 A CN114440852 A CN 114440852A
- Authority
- CN
- China
- Prior art keywords
- standing wave
- driving
- gain
- calculating
- hemispherical resonator
- 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
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/5776—Signal processing not specific to any of the devices covered by groups G01C19/5607 - G01C19/5719
-
- 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)
- Signal Processing (AREA)
- Gyroscopes (AREA)
Abstract
一种半球谐振陀螺X/Y通路驱动增益不对称性误差辨识方法,它属于惯性技术领域。本发明解决了由于半球谐振陀螺X/Y通路驱动增益不对称引起驻波方位角漂移及控制回路误差的问题。本发明基于存在驱动增益不对称系数k时进动速度模型,使用非线性最小二乘法对误差参数进行辨识,从而计算出驱动增益不对称误差系数,进而解决驻波方位角漂移及控制回路存在误差的问题。本发明方法可以应用于对半球谐振陀螺X/Y通路驱动增益不对称性误差进行辨识。
Description
技术领域
本发明属于惯性技术领域,具体涉及一种半球谐振陀螺X/Y通路驱动增益不对称性误差辨识方法。
背景技术
半球谐振陀螺技术是惯性领域一项变革性的颠覆技术,能够极大地提升导航与控制系统性能,对深空探测以及相关国民经济建设等方面将产生重大影响。半球谐振陀螺具有高精度,低噪声,大动态,长寿命,高可靠性等优势,是未来惯性仪表发展的主流趋势之一,尤其是面向高精度航天领域应用潜力巨大。半球谐振陀螺工作原理是当存在外界角度输入时谐振子振动驻波由于科氏力的作用产生进动,并且进动角度与输入角度成正比。通过X/Y两路信号实时检测驻波位置,可以测量出外界输入角度及角速度。但是由于两路驱动电路参数不匹配、加工制造误差、装配误差以及温度等环境因素对陀螺参数的影响,导致X/Y两路驱动信号增益不一致,进而引起驻波方位角漂移及控制回路误差等问题,降低陀螺性能。因此,提出一种半球谐振陀螺X/Y通路驱动增益不对称性误差辨识方法是非常有意义的。
发明内容
本发明的目的是为解决由于半球谐振陀螺X/Y通路驱动增益不对称引起驻波方位角漂移及控制回路误差的问题,而提出一种半球谐振陀螺X/Y通路驱动增益不对称性误差辨识方法。
本发明为解决上述技术问题所采取的技术方案是:
一种半球谐振陀螺X/Y通路驱动增益不对称性误差辨识方法,所述方法具体包括以下步骤:
步骤1、对半球谐振子进行参数激励,使得半球谐振子的振动幅值稳定;
步骤2、沿理想驻波波幅轴垂直方向施加恒定静电力使得驻波进动;
步骤3、采集与半球谐振子驻波进动相关的慢变量Cx、Sx、Cy和Sy,再对慢变量Cx、Sx、Cy和Sy进行二次组合,得到半球谐振陀螺控制系统变量E、Q、S和R;
并根据控制系统变量E、Q、S和R解算出驻波方位角θ、进动速度ωr及振动幅值A;
步骤4、给定辨识参数初值k(0)=1,H(0)=0;
步骤5、根据解算出的驻波方位角θ、进动速度ωr和振动幅值A以及辨识参数初值k(0)和H(0)计算初始时刻的值函数r(0);
步骤6、计算值函数初始时刻的雅可比矩阵Jr(0);
步骤7、根据雅可比矩阵Jr(0)计算辨识参数初始时刻的增量;
步骤8、根据步骤7中获得的增量计算下一时刻的辨识参数;
步骤9、利用步骤8计算出的下一时刻辨识参数(且下一次迭代时步骤5所利用的是上一次迭代过程中步骤8获得的辨识参数)重复执行步骤5至步骤8的过程,直至不再有控制系统变量输入时停止,并将最后一次迭代获得的驱动增益不对称系数作为输出。
进一步地,所述步骤3中,根据控制系统变量E、Q、S和R解算出驻波方位角θ、进动速度ωr及振动幅值A,其具体过程为:
施加在x、y轴电极上的驱动驻波进动静电力的参数方程为:
其中,Fx为施加在x轴电极上的驱动驻波进动静电力,Fy为施加在y轴电极上的驱动驻波进动静电力,kx、ky分别为x、y轴驱动电路增益系数,G为谐振子运动学模型,ω0为给定进动转速;
则进动速度ωr为:
进一步地,所述步骤5的具体过程为:
根据P=Aωr建立理论模型:
则值函数r(i)为:
r(i)=Pd(i)-Pr(i)
其中,Pd(i)为i时刻采集信号处理后的实际检测值,Pr(i)为i时刻根据理论模型的计算值;
根据建立的理论模型、给定的辨识初值以及值函数计算出初始时刻的值函数r(0)。
进一步地,所述步骤6的具体过程为:
进一步地,所述步骤7的具体过程为:
其中,上角标T代表矩阵的转置,上角标-1代表矩阵的逆,Δk(0)代表k在初始时刻的增量,ΔH(0)代表H在初始时刻的增量。
更进一步地,所述步骤8的具体过程为:
其中,k(1)和H(1)代表初始时刻的下一时刻的辨识参数。
本发明的有益效果是:本发明提出了一种半球谐振陀螺X/Y通路驱动增益不对称性误差辨识方法,本发明方法基于存在驱动增益不对称系数k时进动速度模型,使用非线性最小二乘法对误差参数进行辨识,从而计算出驱动增益不对称误差系数。进而解决驻波方位角漂移及控制回路存在误差的问题。
附图说明
图1为本发明方法的流程图;
图2为仿真结果图。
具体实施方式
具体实施方式一:结合图1说明本实施方式。本实施方式的一种半球谐振陀螺X/Y通路驱动增益不对称性误差辨识方法,该方法的具体过程为:
步骤1,对半球谐振子进行参数激励,使得谐振子的振动幅值稳定;
步骤2,沿理想驻波波幅轴垂直方向施加恒定静电力使驻波进动;
步骤3,采集与谐振子驻波振动相关参量Cx、Sx、Cy、Sy再进行二次组合,得到E、Q、S、R信号,解算驻波方位角θ、进动速度ωr及振动幅值A:
H=k0Gω0
其中,G为谐振子运动学模型,k0为理想x、y轴驱动电路增益系数,ω0为给定进动转速,kx、ky分别为x、y轴驱动电路增益系数,k为驱动增益不对称系数;
步骤5,计算当前时刻值函数:
当驻波波幅轴与x轴电极夹角为θ时,驱动驻波进动静电力的参数方程为:
其中,Fx、Fy分别为施加在x、y轴电极上的静电力。
当k0=kx≠ky时,驱动驻波进动静电力的参数方程为:
此时垂直于驻波波幅轴方向的进动速度为:
化简得:
此时值函数:r(i)=Pd(i)-Pr(i)
其中,P=Aωr,Pd为采集信号处理后的实际检测值,Pr为根据理论模型计算值;
步骤6,计算值函数当前时刻的雅可比矩阵:
步骤7,计算辨识参数当前时刻的增量:
步骤8,对下一时刻的辨识参数进行更新:
步骤9,判断是否还有信号E、Q、S、R输入,若有则跳到步骤5,若无则跳到步骤10;
综上,实现了对半球谐振陀螺X/Y通路驱动增益不对称性误差辨识。
步骤4到步骤10给出的是非线性最小二乘法对半球谐振陀螺X/Y通路驱动增益不对称性误差辨识,也可以采用扩展卡尔曼滤波等其他非线性辨识算法实现。
实施例
以仿真实验为例实施本发明的过程如下:
步骤1,对半球谐振子进行参数激励,使得谐振子的振动幅值稳定;
步骤2,设定采样频率为fs=100Hz,采样时间为t=100s,驱动电极增益比k=1.03。沿理想驻波波幅轴垂直方向施加恒定静电力使驻波进动;
步骤3,采集与谐振子驻波振动相关参量Cx、Sx、Cy、Sy再进行二次组合,得到E、Q、S、R信号,解算驻波方位角θ、进动速度ωr及振动幅值A:
H=k0Gω0
其中,G为谐振子运动学模型,k0为理想x、y轴驱动电路增益系数,ω0为给定进动转速,kx、ky分别为x、y轴驱动电路增益系数
步骤5,计算当前时刻值函数:
r(i)=Pd(i)-Pr(i)
其中,P=Aωr,Pd为采集信号处理后的实际检测值,Pr为根据理论模型计算值;
步骤6,计算值函数当前时刻的雅可比矩阵:
步骤7,计算辨识参数当前时刻的增量:
步骤8,对下一时刻的辨识参数进行更新:
步骤9,判断是否还有信号E、Q、S、R输入,若有则跳到步骤5,若无则跳到步骤10;
本发明的上述算例仅为详细地说明本发明的计算模型和计算流程,而并非是对本发明的实施方式的限定。对于所属领域的普通技术人员来说,在上述说明的基础上还可以做出其它不同形式的变化或变动,这里无法对所有的实施方式予以穷举,凡是属于本发明的技术方案所引伸出的显而易见的变化或变动仍处于本发明的保护范围之列。
Claims (6)
1.一种半球谐振陀螺X/Y通路驱动增益不对称性误差辨识方法,其特征在于,所述方法具体包括以下步骤:
步骤1、对半球谐振子进行参数激励,使得半球谐振子的振动幅值稳定;
步骤2、沿理想驻波波幅轴垂直方向施加恒定静电力使得驻波进动;
步骤3、采集与半球谐振子驻波进动相关的慢变量Cx、Sx、Cy和Sy,再对慢变量Cx、Sx、Cy和Sy进行二次组合,得到半球谐振陀螺控制系统变量E、Q、S和R;
并根据控制系统变量E、Q、S和R解算出驻波方位角θ、进动速度ωr及振动幅值A;
步骤4、给定辨识参数初值k(0)=1,H(0)=0;
步骤5、根据解算出的驻波方位角θ、进动速度ωr和振动幅值A以及辨识参数初值k(0)和H(0)计算初始时刻的值函数r(0);
步骤6、计算值函数初始时刻的雅可比矩阵Jr(0);
步骤7、根据雅可比矩阵Jr(0)计算辨识参数初始时刻的增量;
步骤8、根据步骤7中获得的增量计算下一时刻的辨识参数;
步骤9、利用步骤8计算出的下一时刻辨识参数重复执行步骤5至步骤8的过程,直至不再有控制系统变量输入时停止,并将最后一次迭代获得的驱动增益不对称系数作为输出。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210252915.6A CN114440852B (zh) | 2022-03-15 | 2022-03-15 | 一种半球谐振陀螺x/y通路驱动增益不对称性误差辨识方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210252915.6A CN114440852B (zh) | 2022-03-15 | 2022-03-15 | 一种半球谐振陀螺x/y通路驱动增益不对称性误差辨识方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114440852A true CN114440852A (zh) | 2022-05-06 |
CN114440852B CN114440852B (zh) | 2022-10-28 |
Family
ID=81359536
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210252915.6A Active CN114440852B (zh) | 2022-03-15 | 2022-03-15 | 一种半球谐振陀螺x/y通路驱动增益不对称性误差辨识方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114440852B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115077564A (zh) * | 2022-06-15 | 2022-09-20 | 哈尔滨工业大学 | 一种半球谐振陀螺检测通道不平衡误差辨识及补偿方法 |
CN115855121A (zh) * | 2023-02-28 | 2023-03-28 | 中国船舶集团有限公司第七〇七研究所 | 一种半球谐振陀螺的误差自校准方法 |
CN116576885A (zh) * | 2023-05-06 | 2023-08-11 | 哈尔滨工业大学 | 一种基于温度标定与补偿的半球谐振陀螺启动方法及系统 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112506040A (zh) * | 2020-11-16 | 2021-03-16 | 哈尔滨工程大学 | 一种全角半球谐振陀螺单通道控制系统及方法 |
CN113587954A (zh) * | 2021-08-06 | 2021-11-02 | 大连海事大学 | 一种全角半球谐振陀螺阻尼不均匀的补偿控制方法及系统 |
CN113670340A (zh) * | 2021-09-13 | 2021-11-19 | 哈尔滨工业大学 | 基于x/y信号相位差辨识的半球谐振陀螺驻波方位角测量方法及系统 |
CN114046804A (zh) * | 2021-11-08 | 2022-02-15 | 中国人民解放军国防科技大学 | 速率积分陀螺驱动电极误差辨识方法、装置、系统和介质 |
-
2022
- 2022-03-15 CN CN202210252915.6A patent/CN114440852B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112506040A (zh) * | 2020-11-16 | 2021-03-16 | 哈尔滨工程大学 | 一种全角半球谐振陀螺单通道控制系统及方法 |
CN113587954A (zh) * | 2021-08-06 | 2021-11-02 | 大连海事大学 | 一种全角半球谐振陀螺阻尼不均匀的补偿控制方法及系统 |
CN113670340A (zh) * | 2021-09-13 | 2021-11-19 | 哈尔滨工业大学 | 基于x/y信号相位差辨识的半球谐振陀螺驻波方位角测量方法及系统 |
CN114046804A (zh) * | 2021-11-08 | 2022-02-15 | 中国人民解放军国防科技大学 | 速率积分陀螺驱动电极误差辨识方法、装置、系统和介质 |
Non-Patent Citations (4)
Title |
---|
YAN HUO等: "Standing wave drift of hemispherical resonator with quality factor non-uniformity under a ring electrode excitation", 《CHINESE JOURNAL OF AERONAUTICS》 * |
伊国兴等: "半球谐振陀螺控制及补偿技术", 《宇航学报》 * |
李巍等: "半球谐振陀螺仪谐振子品质因数不均匀引起的误差分析", 《航空学报》 * |
王奇等: "基于主动驱动旋转的全角模式半球谐振陀螺驻波漂移补偿方法", 《中国惯性技术学报》 * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115077564A (zh) * | 2022-06-15 | 2022-09-20 | 哈尔滨工业大学 | 一种半球谐振陀螺检测通道不平衡误差辨识及补偿方法 |
CN115077564B (zh) * | 2022-06-15 | 2023-05-12 | 哈尔滨工业大学 | 一种半球谐振陀螺检测通道不平衡误差辨识及补偿方法 |
CN115855121A (zh) * | 2023-02-28 | 2023-03-28 | 中国船舶集团有限公司第七〇七研究所 | 一种半球谐振陀螺的误差自校准方法 |
CN115855121B (zh) * | 2023-02-28 | 2023-04-28 | 中国船舶集团有限公司第七〇七研究所 | 一种半球谐振陀螺的误差自校准方法 |
CN116576885A (zh) * | 2023-05-06 | 2023-08-11 | 哈尔滨工业大学 | 一种基于温度标定与补偿的半球谐振陀螺启动方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN114440852B (zh) | 2022-10-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN114440852B (zh) | 一种半球谐振陀螺x/y通路驱动增益不对称性误差辨识方法 | |
CN111578923B (zh) | 一种谐振式陀螺闭环控制方法与系统 | |
CN113670340B (zh) | 基于x/y信号相位差辨识的半球谐振陀螺驻波方位角测量方法及系统 | |
CN103256941B (zh) | 一种mems陀螺仪高阶温度补偿的方法 | |
CN113899365B (zh) | 基于半球谐振陀螺检测通路非对称性参数辨识的驻波方位角测量方法 | |
CN111536993B (zh) | 一种振动陀螺电极角度误差的辨识与补偿方法及系统 | |
CN105783899B (zh) | 具有原位偏差自校准的高带宽科里奥利振动陀螺仪(cvg) | |
CN108413986B (zh) | 一种基于Sage-Husa卡尔曼滤波的陀螺仪滤波方法 | |
CN107831660A (zh) | 微陀螺仪自适应高阶超扭曲滑模控制方法 | |
CN113252019A (zh) | 一种前向放大系数不一致时的半球谐振陀螺振型角获取方法 | |
CN115451999A (zh) | 半球谐振陀螺虚拟哥氏效应生成方法和装置 | |
CN107807527A (zh) | 微陀螺仪增益可调的自适应超扭曲滑模控制方法 | |
CN114858184A (zh) | 一种半球谐振子参数辨识方法 | |
CN107389090A (zh) | 一种提高mems陀螺抗振动特性的机械不正交闭环方法 | |
CN110262237B (zh) | 基于双反馈模糊神经网络的微陀螺仪超扭曲滑模控制方法 | |
CN114780903B (zh) | 一种半球谐振陀螺x/y通路驱动增益不对称性及电极非正交误差辨识方法 | |
Li et al. | Precision enhancement by compensation of hemispherical resonator gyroscope dynamic output errors | |
CN109917645B (zh) | 微陀螺双反馈模糊神经网络超扭曲滑模控制系统设计方法 | |
CN116698084A (zh) | 一种对称式陀螺零偏漂移实时抑制与零偏稳定性提升方法 | |
Zhu et al. | An improved initial alignment method for rocket navigation systems | |
CN116610030A (zh) | 一种全角模式下的半球谐振陀螺死区补偿与抗干扰控制回路设计方法 | |
Ma et al. | Application and comparison of two methods for alignment of FOG SINS | |
Moussa et al. | Theory of direct frequency output vibrating gyroscopes | |
Guo et al. | Research on improving the north-seeking precision of MEMS gyroscope | |
CN103822621B (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 |