CN115077561A - 一种自适应补偿半球谐振子阻尼各向异性的方法及系统 - Google Patents
一种自适应补偿半球谐振子阻尼各向异性的方法及系统 Download PDFInfo
- Publication number
- CN115077561A CN115077561A CN202210673897.9A CN202210673897A CN115077561A CN 115077561 A CN115077561 A CN 115077561A CN 202210673897 A CN202210673897 A CN 202210673897A CN 115077561 A CN115077561 A CN 115077561A
- Authority
- CN
- China
- Prior art keywords
- control
- precession
- hemispherical
- anisotropy
- damping
- 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
- 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
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02E—REDUCTION OF GREENHOUSE GAS [GHG] EMISSIONS, RELATED TO ENERGY GENERATION, TRANSMISSION OR DISTRIBUTION
- Y02E40/00—Technologies for an efficient electrical power generation, transmission or distribution
- Y02E40/40—Arrangements for reducing harmonics
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
技术领域
本发明属于智能化仪器仪表技术领域,尤其涉及一种自适应补偿半球谐振子阻尼各向异性的方法及系统。
背景技术
半球谐振陀螺是一种基于科里奥利效应的振动陀螺仪。当没有外界角速度输入时,驻波的振型固定在半球谐振子的某一位置。当有外界角速度输入时,科里奥利力会使得驻波振型与半球谐振子发生相对位移,且相对转动角速度与外界输入角速度之比为定值,称作进动因子。半球谐振陀螺在实际工作过程中,首先敏感振型的位移信号,然后将位移信号转换为电压信号,再进一步解算得到驻波旋转角度并结合进动因子计算出半球谐振陀螺的转动角速度,最终完成测量要求。
由于加工工艺的限制,半球谐振子通常会存在表面裂纹、金属镀膜不均匀、周向质量分布不均匀等情况,主要表现为刚度各向异性和阻尼各向异性。其中,刚度各向异性可以通过调频和正交控制进行解决,而阻尼各向异性的存在会导致陀螺在低转速输入情况下产生角度自锁效应,在高转速输入的情况下依然存在角度漂移误差。目前,尚缺乏有效手段对半球谐振子的阻尼各向异性进行补偿。为此,本发明提出了一种便于实施且能自适应补偿半球谐振子阻尼各向异性的方法及系统。
发明内容
为解决上述技术问题,本发明提出了一种自适应补偿半球谐振子阻尼各向异性的方法及系统,具有对大多数全角模式振动陀螺的适用性,补偿效果好,可靠性强。
一方面为实现上述目的,本发明提供了一种自适应补偿半球谐振子阻尼各向异性的方法,包括如下步骤:
获得半球谐振子的运动方程;
基于所述运动方程,对所述半球谐振子施加能量控制、正交控制、初始自进动控制和相位控制,获得所述半球谐振子的稳定工作状态;
基于所述稳定工作状态,对所述能量控制进行偏微分运算,并与所述初始自进动控制叠加,获得最终自进动控制;
基于所述最终自进动控制,消除所述半球谐振子的阻尼各向异性。
可选地,所述运动方程为:
其中,E表示能量信号,Q表示正交信号,表示阻尼各向异性,θτ表示阻尼失准角,Δω表示刚度各向异性,θω表示刚度失准角,Ω表示外界输入角速度,θ表示陀螺进动角度,γ表示陀螺进动因子,δ表示陀螺振动信号与参考信号之间的相位差,表示能量信号的微分,为正交信号的微分,为陀螺进动角度的微分,为陀螺振动信号与参考信号之间的相位差的微分。
可选地,所述最终自进动控制fqs的计算公式为:
其中,fqs0为初始自进动控制,fas为能量控制,ω表示半球谐振子的平均谐振频率。
可选地,基于所述最终自进动控制,消除所述半球谐振子的阻尼各向异性的方法为:
将所述最终自进动控制施加到陀螺进动角度的微分方程,获得角度信号与外界输入角速度的变化关系,消除消除所述半球谐振子的阻尼各向异性。
可选地,角度信号与外界输入角速度的变化关系的计算公式为:
另一方面为实现上述目的,本发明提供了一种自适应补偿半球谐振子阻尼各向异性的系统,包括:第一获得模块、第二获得模块、第三获得模块和消除模块;
所述第一获得模块用于获得半球谐振子的运动方程;
所述第二获得模块用于基于所述运动方程,对所述半球谐振子施加能量控制、正交控制、初始自进动控制和相位控制,获得所述半球谐振子的稳定工作状态;
所述第三获得模块用于基于所述稳定工作状态,对所述能量控制进行偏微分运算,并与所述初始自进动控制叠加,获得最终自进动控制;
所述消除模块用于基于所述最终自进动控制,消除所述半球谐振子的阻尼各向异性。
可选地,所述运动方程为:
其中,E表示能量信号,Q表示正交信号,表示阻尼各向异性,θτ表示阻尼失准角,Δω表示刚度各向异性,θω表示刚度失准角,Ω表示外界输入角速度,θ表示陀螺进动角度,γ表示陀螺进动因子,δ表示陀螺振动信号与参考信号之间的相位差,表示能量信号的微分,为正交信号的微分,为陀螺进动角度的微分,为陀螺振动信号与参考信号之间的相位差的微分。
可选地,所述最终自进动控制fqs的计算公式为:
其中,fqs0为初始自进动控制,fas为能量控制,ω表示半球谐振子的平均谐振频率。
可选地,基于所述最终自进动控制,消除所述半球谐振子的阻尼各向异性的过程为:
将所述最终自进动控制施加到陀螺进动角度的微分方程,获得角度信号与外界输入角速度的变化关系,消除消除所述半球谐振子的阻尼各向异性。
可选地,角度信号与外界输入角速度的变化关系的计算公式为:
与现有技术相比,本发明具有如下优点和技术效果:
1、能够在全角模式下自适应补偿半球谐振子阻尼各向异性带来的角度漂移误差;
2、对全角半球谐振陀螺高转速输入和低转速输入的应用场景均有良好的效果;
3、本发明具有对大多数全角模式振动陀螺的适用性,补偿效果好,可靠性强。
附图说明
构成本申请的一部分的附图用来提供对本申请的进一步理解,本申请的示意性实施例及其说明用于解释本申请,并不构成对本申请的不当限定。在附图中:
图1为本发明实施例一的一种自适应补偿半球谐振子阻尼各向异性方法流程示意图;
图2为本发明实施例一的一种自适应补偿半球谐振子阻尼各向异性方法的信号处理框图。
具体实施方式
需要说明的是,在不冲突的情况下,本申请中的实施例及实施例中的特征可以相互组合。下面将参考附图并结合实施例来详细说明本申请。
需要说明的是,在附图的流程图示出的步骤可以在诸如一组计算机可执行指令的计算机系统中执行,并且,虽然在流程图中示出了逻辑顺序,但是在某些情况下,可以以不同于此处的顺序执行所示出或描述的步骤。
实施例一
如图1所示,本发明提供一种自适应补偿半球谐振子阻尼各向异性的方法,包括如下步骤:
步骤1:当非理想半球谐振陀螺处于正常工作状态时,非理想半球谐振子在椭圆坐标系下进行运动,得到运动方程;
进一步地,非理想半球谐振子在椭圆坐标系下按照下列微分方程进行运动:
其中,E表示能量信号,Q表示正交信号,表示阻尼各向异性,θτ表示阻尼失准角,Δω表示刚度各向异性,θω表示刚度失准角,Ω表示外界输入角速度,θ表示陀螺进动角度,γ表示陀螺进动因子,δ表示陀螺振动信号与参考信号之间的相位差,表示能量信号的微分,为正交信号的微分,为陀螺进动角度的微分,为陀螺振动信号与参考信号之间的相位差的微分。
步骤2:对陀螺施加能量控制fas、正交控制fqc、初始自进动控制fqs0、相位控制fac;
进一步地,在全角模式下,对半球谐振陀螺施加能量控制fas、正交控制fqc、初始自进动控制fqs0、相位控制fac,非理想半球谐振子在椭圆坐标系下按照下列微分方程进行运动:
步骤3:在陀螺稳定工作状态下,对能量控制fas进行偏微分运算,与fqs0叠加得到最终自进动控制fqs;
进而得到:
此时有:
由公式可知:
式中,不能为0,且在外界输入角速度较低的情况下,无法确定全角半球谐振陀螺能否突破自锁效应,故上述方法在低转速条件下不成立或误差很大。因此还需要额外叠加初始的fqs0令半球谐振子维持稳定的自进动状态,随后对能量控制fas进行偏微分运算,与fqs0叠加得到新的fqs,最终实现对阻尼各向异性的消除,即fqs表示为:
步骤4:利用自进动控制消除半球谐振子阻尼各向异性。
进一步地,对陀螺施加自进动控制fqs,令:
由图2所示:由半球谐振子检测电极收集X模态轴和Y模态轴的两路信号,经过模数转换及信号解调后,将两路信号解调为cx、sx、cy、sy四种信号;再代入椭圆参数解算方程中分别得到能量信号E、正交信号Q、角度信号θ、相位信号δ;将四种信号分别引入能量控制fas、正交控制fqc、自进动控制fqs、相位控制fac。由驱动信号生成模块调制生成对驱动电极的驱动信号,经过数模转换,发送到驱动电极中控制半球谐振子运动,以上整个过程即为自适应补偿半球谐振子阻尼各向异性控制解算框图。
进一步地,以对半球谐振陀螺阻尼各向异性带来的陀螺漂移进行补偿作为实施例,验证本发明所提出的一种自适应补偿半球谐振子阻尼各向异性方法的有效性。
非理想半球谐振子在椭圆坐标系下按照下列微分方程进行运动:
将能量控制fas对进动角度θ的偏微分引入到自进动控制fqs:
本发明还提供了一种自适应补偿半球谐振子阻尼各向异性的系统,包括:第一获得模块、第二获得模块、第三获得模块和消除模块;
第一获得模块用于获得半球谐振子的运动方程;
第二获得模块用于基于运动方程,对半球谐振子施加能量控制、正交控制、初始自进动控制和相位控制,获得半球谐振子的稳定工作状态;
第三获得模块用于基于稳定工作状态,对能量控制进行偏微分运算,并与初始自进动控制叠加,获得最终自进动控制;
消除模块用于基于最终自进动控制,消除半球谐振子的阻尼各向异性。
进一步地,运动方程为:
其中,E表示能量信号,Q表示正交信号,表示阻尼各向异性,θτ表示阻尼失准角,Δω表示刚度各向异性,θω表示刚度失准角,Ω表示外界输入角速度,θ表示陀螺进动角度,γ表示陀螺进动因子,δ表示陀螺振动信号与参考信号之间的相位差,表示能量信号的微分,为正交信号的微分,为陀螺进动角度的微分,为陀螺振动信号与参考信号之间的相位差的微分。
进一步地,最终自进动控制fqs的计算公式为:
其中,fqs0为初始自进动控制,fas为能量控制,ω表示半球谐振子的平均谐振频率。
进一步地,基于最终自进动控制,消除半球谐振子的阻尼各向异性的过程为:
将最终自进动控制施加到陀螺进动角度的微分方程,获得角度信号与外界输入角速度的变化关系,消除消除半球谐振子的阻尼各向异性。
进一步地,角度信号与外界输入角速度的变化关系的计算公式为:
以上,仅为本申请较佳的具体实施方式,但本申请的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本申请揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本申请的保护范围之内。因此,本申请的保护范围应该以权利要求的保护范围为准。
Claims (10)
1.一种自适应补偿半球谐振子阻尼各向异性的方法,其特征在于,包括以下步骤:
获得半球谐振子的运动方程;
基于所述运动方程,对所述半球谐振子施加能量控制、正交控制、初始自进动控制和相位控制,获得所述半球谐振子的稳定工作状态;
基于所述稳定工作状态,对所述能量控制进行偏微分运算,并与所述初始自进动控制叠加,获得最终自进动控制;
基于所述最终自进动控制,消除所述半球谐振子的阻尼各向异性。
4.根据权利要求1所述的自适应补偿半球谐振子阻尼各向异性的方法,其特征在于,基于所述最终自进动控制,消除所述半球谐振子的阻尼各向异性的方法为:
将所述最终自进动控制施加到陀螺进动角度的微分方程,获得角度信号与外界输入角速度的变化关系,消除消除所述半球谐振子的阻尼各向异性。
6.一种自适应补偿半球谐振子阻尼各向异性的系统,其特征在于,包括:第一获得模块、第二获得模块、第三获得模块和消除模块;
所述第一获得模块用于获得半球谐振子的运动方程;
所述第二获得模块用于基于所述运动方程,对所述半球谐振子施加能量控制、正交控制、初始自进动控制和相位控制,获得所述半球谐振子的稳定工作状态;
所述第三获得模块用于基于所述稳定工作状态,对所述能量控制进行偏微分运算,并与所述初始自进动控制叠加,获得最终自进动控制;
所述消除模块用于基于所述最终自进动控制,消除所述半球谐振子的阻尼各向异性。
9.根据权利要求6所述的自适应补偿半球谐振子阻尼各向异性的系统,其特征在于,基于所述最终自进动控制,消除所述半球谐振子的阻尼各向异性的过程为:
将所述最终自进动控制施加到陀螺进动角度的微分方程,获得角度信号与外界输入角速度的变化关系,消除消除所述半球谐振子的阻尼各向异性。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210673897.9A CN115077561B (zh) | 2022-06-15 | 2022-06-15 | 一种自适应补偿半球谐振子阻尼各向异性的方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210673897.9A CN115077561B (zh) | 2022-06-15 | 2022-06-15 | 一种自适应补偿半球谐振子阻尼各向异性的方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115077561A true CN115077561A (zh) | 2022-09-20 |
CN115077561B CN115077561B (zh) | 2023-03-10 |
Family
ID=83251594
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210673897.9A Active CN115077561B (zh) | 2022-06-15 | 2022-06-15 | 一种自适应补偿半球谐振子阻尼各向异性的方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115077561B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115824263A (zh) * | 2023-02-13 | 2023-03-21 | 中国船舶集团有限公司第七〇七研究所 | 基于半球谐振陀螺的阻尼修调方法及系统 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111578966A (zh) * | 2020-04-09 | 2020-08-25 | 哈尔滨工程大学 | 一种基于lms算法的半球谐振子特征参数辨识方法 |
CN112146637A (zh) * | 2020-08-24 | 2020-12-29 | 南京理工大学 | 一种微机电陀螺的全角模式电路增益误差自补偿系统 |
CN113074756A (zh) * | 2021-03-31 | 2021-07-06 | 中国人民解放军国防科技大学 | 一种速率积分型振动陀螺的误差补偿方法和装置 |
CN113587954A (zh) * | 2021-08-06 | 2021-11-02 | 大连海事大学 | 一种全角半球谐振陀螺阻尼不均匀的补偿控制方法及系统 |
CN114509057A (zh) * | 2022-03-14 | 2022-05-17 | 中国船舶重工集团公司第七0七研究所 | 一种谐振陀螺仪全角模式控制方法 |
CN114608612A (zh) * | 2022-03-11 | 2022-06-10 | 中国船舶重工集团公司第七0七研究所 | 全角模式谐振陀螺阻尼不均漂移在线补偿系统及方法 |
-
2022
- 2022-06-15 CN CN202210673897.9A patent/CN115077561B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111578966A (zh) * | 2020-04-09 | 2020-08-25 | 哈尔滨工程大学 | 一种基于lms算法的半球谐振子特征参数辨识方法 |
CN112146637A (zh) * | 2020-08-24 | 2020-12-29 | 南京理工大学 | 一种微机电陀螺的全角模式电路增益误差自补偿系统 |
CN113074756A (zh) * | 2021-03-31 | 2021-07-06 | 中国人民解放军国防科技大学 | 一种速率积分型振动陀螺的误差补偿方法和装置 |
CN113587954A (zh) * | 2021-08-06 | 2021-11-02 | 大连海事大学 | 一种全角半球谐振陀螺阻尼不均匀的补偿控制方法及系统 |
CN114608612A (zh) * | 2022-03-11 | 2022-06-10 | 中国船舶重工集团公司第七0七研究所 | 全角模式谐振陀螺阻尼不均漂移在线补偿系统及方法 |
CN114509057A (zh) * | 2022-03-14 | 2022-05-17 | 中国船舶重工集团公司第七0七研究所 | 一种谐振陀螺仪全角模式控制方法 |
Non-Patent Citations (2)
Title |
---|
郭杰等: "半球谐振陀螺阻尼不均匀误差补偿方法", 《飞控与探测》 * |
郭锞琛等: "全角模式半球谐振陀螺阻尼误差补偿方法研究", 《自动化仪表》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115824263A (zh) * | 2023-02-13 | 2023-03-21 | 中国船舶集团有限公司第七〇七研究所 | 基于半球谐振陀螺的阻尼修调方法及系统 |
CN115824263B (zh) * | 2023-02-13 | 2023-05-02 | 中国船舶集团有限公司第七〇七研究所 | 基于半球谐振陀螺的阻尼修调方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN115077561B (zh) | 2023-03-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US7565839B2 (en) | Bias and quadrature reduction in class II coriolis vibratory gyros | |
CN110865580A (zh) | 基于时分复用的半球谐振陀螺全差分控制系统及控制方法 | |
CN110108266B (zh) | 基于机械vco锁相环的陀螺实时自动闭环模态匹配方法 | |
CN110686662B (zh) | 一种可在线自校准的双模式差分谐振式陀螺仪系统 | |
WO2018157118A1 (en) | Calibration system and method for whole angle gyroscope | |
JP2003507728A (ja) | 振動形回転角レートセンサのためのバイアス電圧を発生する装置 | |
CN115574798B (zh) | 一种提高半球谐振陀螺综合性能的方法 | |
JP2005514609A (ja) | 回転速度センサ | |
CN115388910A (zh) | 半球谐振陀螺误差自激励方法和系统 | |
CN115077561B (zh) | 一种自适应补偿半球谐振子阻尼各向异性的方法及系统 | |
CN116086485A (zh) | 半球谐振陀螺误差力补偿方法和装置 | |
CN114858184A (zh) | 一种半球谐振子参数辨识方法 | |
CN115451999A (zh) | 半球谐振陀螺虚拟哥氏效应生成方法和装置 | |
JP5352671B2 (ja) | 振動型ジャイロスコープによるジャイロ測定 | |
CN116026299B (zh) | 谐振陀螺静电修调控制方法及系统 | |
CN114383590A (zh) | 速率积分陀螺的相位误差辨识和补偿方法 | |
CN116772818A (zh) | 基于驻波伪进动的全角模式陀螺阻尼失配补偿方法及系统 | |
CN114964306A (zh) | 一种半球谐振陀螺标定因数和零偏自标定方法 | |
CN114964197A (zh) | 一种谐振陀螺相位基准自补偿系统及补偿方法 | |
US10718615B2 (en) | Reducing a gyroscope-bias component in a determined value of angular velocity with simultaneous sensor operation | |
CN116576886B (zh) | 一种半球谐振陀螺阻尼不均匀辨识方法 | |
CN115407657A (zh) | 输入饱和下的半球谐振陀螺智能控制方法 | |
Ruan et al. | In-run automatic mode-matching of whole-angle micro-hemispherical resonator gyroscope based on standing wave self-precession | |
CN106289209A (zh) | 一种适用于宽量程的陀螺仪控制方法和控制系统 | |
JP6559327B2 (ja) | ジャイロ装置およびジャイロ装置の制御方法 |
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 |