CN109827594A - 基于面内模态旋转的轴对称陀螺仪零位自补偿***及方法 - Google Patents
基于面内模态旋转的轴对称陀螺仪零位自补偿***及方法 Download PDFInfo
- Publication number
- CN109827594A CN109827594A CN201910146917.5A CN201910146917A CN109827594A CN 109827594 A CN109827594 A CN 109827594A CN 201910146917 A CN201910146917 A CN 201910146917A CN 109827594 A CN109827594 A CN 109827594A
- Authority
- CN
- China
- Prior art keywords
- gyroscope
- plane modal
- rotation
- mode control
- sensed
- 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
Landscapes
- Gyroscopes (AREA)
Abstract
本发明公开了一种基于面内模态旋转的轴对称陀螺仪零位自补偿***,包括轴对称谐振子、陀螺仪驱动与检测模态控制子***、面内模态旋转控制***,陀螺仪驱动与检测模态控制子***包括驱动模态控制部分与检测模态控制部分,驱动模态控制部分用以保持谐振子驱动方向工作于谐振状态,检测模态控制部分用于平衡哥氏效应产生的驻波进动,并将平衡电压作为角速度的测量结果进行输出。与传统IMU的旋转调制相比,本发明所述方法无需旋转机构,不额外增加陀螺仪机构复杂度,具有体积小、成本低的优势。与已有基于模态反转的轴对称陀螺仪零偏抑制技术相比,本发明所述方法无需模态反转的切换时间,可实现对外界角速度的不间断敏感。
Description
技术领域
本发明涉及陀螺仪领域,具体是一种基于面内模态旋转的轴对称陀螺仪零位自补偿***及方法。
背景技术
陀螺仪是一种测量物体旋转角速度的传感器,是惯性测量领域的核心元件,在民用和军用领域都有十分重要的应用,尤其在军用领域,陀螺仪在越来越智能化的武器设备中都是不可或缺的。零位漂移是陀螺仪面临的恶化陀螺仪精度的关键因素。目前,大多数陀螺仪都采用标定的方法进行零漂的补偿。但由于陀螺仪的零漂与环境因素的关系存在一定的不确定性,在利用一般的方法进行标定补偿时,常面临重复性的挑战,故而极大的限制了补偿的可靠性。
发明内容
发明目的:为解决上述技术问题,本发明提供一种基于面内模态旋转的轴对称陀螺仪零位自补偿***及方法。
技术方案:本发明所述的一种基于面内模态旋转的轴对称陀螺仪零位自补偿***,包括轴对称谐振子、陀螺仪驱动与检测模态控制子***、面内模态旋转控制***,陀螺仪驱动与检测模态控制子***包括驱动模态控制部分与检测模态控制部分,驱动模态控制部分用以保持谐振子驱动方向工作于谐振状态,检测模态控制部分用于平衡哥氏效应产生的驻波进动,并将平衡电压作为角速度的测量结果进行输出。
其中,所述面内模态旋转控制***包括旋转矩阵解算算法模块和面内模态旋转控制***;旋转矩阵解算算法模块用于实现电极坐标系与旋转坐标系间转换,将面内模态旋转控制***在旋转坐标系下进行设计,与陀螺仪驱动与检测模态控制子***建立直接联系,并将旋转坐标系下的输出作为***的检测输出;面内模态旋转控制***利用面内模态的正反旋转,消除面内模态旋转所引入的检测零位。
本发明还提供一种基于面内模态旋转的轴对称陀螺仪零位自补偿方法,包括以下步骤:
步骤1:在陀螺仪驱动与检测模态控制子***和面内模态旋转控制***的共同作用下,轴对称谐振子驻波运动轴向以缓慢角速度Ωr旋转;
陀螺仪谐振子运动方程为:
步骤2:利用面内模态旋转控制***中面内模态正反旋转控制器,实现面内模态旋转正反变换;
步骤3:通过面内模态旋转控制***中旋转矩阵解算算法模块,实现将陀螺仪驱动与检测模态控制子***中电极坐标系下的谐振子位移信号vx、vy转换为旋转坐标系下的谐振子位移信号rd、rs;
此时,谐振子机械误差所形成的零位为:
步骤4:利用信号解调的手段抑制由于谐振子结构误差所形成的零位漂移,消除由于面内模态旋转所引入的检测零位,并输出***测量结果。
有益效果:本发明具有以下有益效果:
(1)与传统IMU的旋转调制相比,本发明所述方法无需旋转机构,不额外增加陀螺仪机构复杂度,具有体积小、成本低的优势。
(2)与已有基于模态反转的轴对称陀螺仪零偏抑制技术相比,本发明所述方法无需模态反转的切换时间,可实现对外界角速度的不间断敏感。
附图说明
附图1是基于面内模态旋转调制的轴对称陀螺仪零位自补偿***框图;
附图2是轴对称谐振子面内模态旋转示意图(n=2);
附图3是陀螺仪驱动与检测模态控制子***;
附图4是面内模态旋转控制***。
具体实施方式
下面结合具体实施方式对本发明的技术方案作进一步的介绍。
本发明的基于面内模态旋转的轴对称陀螺仪零位自补偿***及方法,具体实施理论如下:
轴对称陀螺仪谐振子谐波数为n的运动方程可表示为:
式中,Pτ和Pω为x、y至阻尼主轴θτ和刚度主轴θω的旋转矩阵;
τ1,2和ω1,2分别是时间常数和谐振频率;η为进动系数。理想情况下,谐振子两轴参数相同,主轴方向是任意的;而加工误差以及环境因素将导致轴间耦合以及主轴方向不可控。
当谐振子驻波在施力电极控制下以缓慢角速度Ωr旋转时,谐振子的位移为:
r=PrL (2)
其中L=[x y]T是谐振子在xy坐标系下的位移,r=[rd rs]T是谐振子在旋转坐标系下的位移,Pr为xy坐标系至rd rs坐标系的变换矩阵:
结合式(1)与式(2)可得:
其中,
由式(3)易得,在面内模态旋转调制下,谐振子机械误差所形成的零位为:
故而,由上式得,通过面内模态旋转技术,谐振子结构误差所引入的零位将被调制至2nΩr频率,可有效抑制零位漂移。
具体地,如图1所示,本发明的基于面内模态旋转的轴对称陀螺仪零位自补偿***,包括轴对称谐振子1、陀螺仪驱动与检测模态控制子***2、面内模态旋转控制***3。
轴对称谐振子1适用于环型、盘型、碟形、半球型、钟型等谐振子,如图2所示即为环型谐振子(n=2)面内模态旋转的示意图,其在控制***作用下,谐振子驻波运动轴向以缓慢角速度Ωr旋转,同时驱动方向rd的振幅维持为A,检测方向rs保持静态。
陀螺仪驱动与检测模态控制子***2如图3所示,其包括陀螺仪驱动模态控制器2a和陀螺仪检测模态控制器2b两个部分。在陀螺驱动模态控制器2a中,驱动位移信号x通过C/V转换器2a1、放大滤波器2a2输出为电信号vx,再由面内模态旋转控制***3的旋转解算矩阵3b1转化为旋转坐标系rd,后重新输入陀螺仪驱动与检测模态控制子***2,经相位控制器2a3和幅度控制器2a4输出为信号r′d,再经旋转解算矩阵的转置矩阵362重新变为电极信号sx,输入电压/加速度转换器2a5中,将电信号转换为驱动激励信号ax,输入谐振子来保持谐振子驱动方向工作于谐振状态。在检测模态控制器中,驱动位移信号y通过C/V转换器2b1、放大滤波器2b2输出为电信号vy,再由面内模态旋转控制***3的旋转解算矩阵3b1转化为旋转坐标系rs,后重新输入陀螺仪驱动与检测模态控制子***2,经相敏解调器2b3、相位及正交控制器2b4输出信号r′s,再经旋转解算矩阵的转置矩阵3b2重新变为电极信号sy,输入电压/加速度转换器2b5中,将电信号转换为检测激励信号ay,输入谐振子来平衡哥氏效应产生的驻波进动,同时检测模态控制器输出角速度的测量结果。其中2a1与2b1,2a2与2b2,2a5与2b5结构相同。
面内模态旋转控制***如图4所示,其主要包括面内模态正反旋转控制器3a和旋转矩阵解算算法3b两个部分。通过旋转解算矩阵Pr,实现电极坐标系与旋转坐标系间转换,将控制***在旋转坐标系下进行设计,可与陀螺仪驱动与检测模态控制子***2建立直接联系。面内模态旋转控制***3工作时,由陀螺仪驱动与检测模态控制子***2将驱动与检测位移信号x、y经C/V转换器2a1、2b1和放大滤波器2a2、2b2后输出为电信号vx、vy,经旋转解算矩阵3b1,将电极坐标系转化为旋转坐标系rd、rs,后重新输入陀螺仪驱动与检测模态控制子***2进行后续处理,处理完后的信号r′d与r′s经旋转解算矩阵的转置矩阵3b2重新变为电极信号sx、sy,再次进入陀螺仪驱动与检测模态控制子***2进行处理,形成闭环控制。
而根据理论及仿真计算,模态旋转引入了一个仅与η,η几乎不受环境影响,以及和nΩr有关的零位,为此,引入面内模态的正反旋转机制,以抵消该误差。如图4所示,面内模态旋转控制器给出一定周期的正反旋转指令,旋转矩阵解算算法模块以此确定旋转矩阵以及旋转转置矩阵。
Claims (3)
1.一种基于面内模态旋转的轴对称陀螺仪零位自补偿***,其特征在于:包括轴对称谐振子、陀螺仪驱动与检测模态控制子***、面内模态旋转控制***,陀螺仪驱动与检测模态控制子***包括驱动模态控制部分与检测模态控制部分,驱动模态控制部分用以保持谐振子驱动方向工作于谐振状态,检测模态控制部分用于平衡哥氏效应产生的驻波进动,并将平衡电压作为角速度的测量结果进行输出。
2.根据权利要求1所述的基于面内模态旋转的轴对称陀螺仪零位自补偿***,其特征在于:所述面内模态旋转控制***包括旋转矩阵解算算法模块和面内模态旋转控制***;旋转矩阵解算算法模块用于实现电极坐标系与旋转坐标系间转换,将面内模态旋转控制***在旋转坐标系下进行设计,与陀螺仪驱动与检测模态控制子***建立直接联系,并将旋转坐标系下的输出作为***的检测输出;面内模态旋转控制***利用面内模态的正反旋转,消除面内模态旋转所引入的检测零位。
3.一种基于面内模态旋转的轴对称陀螺仪零位自补偿方法,其特征在于,包括以下步骤:
步骤1:在陀螺仪驱动与检测模态控制子***和面内模态旋转控制***的共同作用下,轴对称谐振子驻波运动轴向以缓慢角速度Ωr旋转;
陀螺仪谐振子运动方程为:
步骤2:利用面内模态旋转控制***中面内模态正反旋转控制器,实现面内模态旋转正反变换;
步骤3:通过面内模态旋转控制***中旋转矩阵解算算法模块,实现将陀螺仪驱动与检测模态控制子***中电极坐标系下的谐振子位移信号vx、vy转换为旋转坐标系下的谐振子位移信号rd、rs;
此时,谐振子机械误差所形成的零位为:
步骤4:利用信号解调的手段抑制由于谐振子结构误差所形成的零位漂移,消除由于面内模态旋转所引入的检测零位,并输出***测量结果。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910146917.5A CN109827594B (zh) | 2019-02-27 | 2019-02-27 | 基于面内模态旋转的轴对称陀螺仪零位自补偿***及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910146917.5A CN109827594B (zh) | 2019-02-27 | 2019-02-27 | 基于面内模态旋转的轴对称陀螺仪零位自补偿***及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109827594A true CN109827594A (zh) | 2019-05-31 |
CN109827594B CN109827594B (zh) | 2023-03-31 |
Family
ID=66864706
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910146917.5A Active CN109827594B (zh) | 2019-02-27 | 2019-02-27 | 基于面内模态旋转的轴对称陀螺仪零位自补偿***及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109827594B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110535372A (zh) * | 2019-09-30 | 2019-12-03 | 李南 | 一种负压动平衡的振动能量收集装置 |
CN114370886A (zh) * | 2021-11-23 | 2022-04-19 | 上海航天控制技术研究所 | 基于虚拟转动的全角模式振动陀螺测量误差自标定方法 |
CN116499497A (zh) * | 2023-06-28 | 2023-07-28 | 中国船舶集团有限公司第七〇七研究所 | 基于模态反转的半球谐振陀螺惯导***误差自校准方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104897150A (zh) * | 2015-06-16 | 2015-09-09 | 中北大学 | 一种提升硅微机械陀螺仪带宽全温性能的方法 |
CN104931034A (zh) * | 2015-06-16 | 2015-09-23 | 中北大学 | 基于偶极子补偿法的微机械陀螺仪带宽拓展方法 |
CN105258689A (zh) * | 2015-10-19 | 2016-01-20 | 北京航天控制仪器研究所 | 一种数字陀螺仪信号控制处理*** |
CN107238381A (zh) * | 2017-05-23 | 2017-10-10 | 东南大学 | 用于模态匹配状态硅微机械陀螺仪带宽拓展数字校正方法 |
CN108253952A (zh) * | 2017-12-01 | 2018-07-06 | 北京时代民芯科技有限公司 | 一种零偏自校准mems陀螺仪及其零偏自校准方法 |
CN109029498A (zh) * | 2018-06-15 | 2018-12-18 | 东南大学 | 一种用于振环硅微陀螺仪模态互易的数字测控*** |
CN109323711A (zh) * | 2018-12-04 | 2019-02-12 | 中国工程物理研究院电子工程研究所 | 一种陀螺仪模态反转零位自校正方法及*** |
-
2019
- 2019-02-27 CN CN201910146917.5A patent/CN109827594B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104897150A (zh) * | 2015-06-16 | 2015-09-09 | 中北大学 | 一种提升硅微机械陀螺仪带宽全温性能的方法 |
CN104931034A (zh) * | 2015-06-16 | 2015-09-23 | 中北大学 | 基于偶极子补偿法的微机械陀螺仪带宽拓展方法 |
CN105258689A (zh) * | 2015-10-19 | 2016-01-20 | 北京航天控制仪器研究所 | 一种数字陀螺仪信号控制处理*** |
CN107238381A (zh) * | 2017-05-23 | 2017-10-10 | 东南大学 | 用于模态匹配状态硅微机械陀螺仪带宽拓展数字校正方法 |
CN108253952A (zh) * | 2017-12-01 | 2018-07-06 | 北京时代民芯科技有限公司 | 一种零偏自校准mems陀螺仪及其零偏自校准方法 |
CN109029498A (zh) * | 2018-06-15 | 2018-12-18 | 东南大学 | 一种用于振环硅微陀螺仪模态互易的数字测控*** |
CN109323711A (zh) * | 2018-12-04 | 2019-02-12 | 中国工程物理研究院电子工程研究所 | 一种陀螺仪模态反转零位自校正方法及*** |
Non-Patent Citations (1)
Title |
---|
吕正等: "一种高Q值硅微陀螺谐振频率快速锁定方法", 《测控技术》 * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110535372A (zh) * | 2019-09-30 | 2019-12-03 | 李南 | 一种负压动平衡的振动能量收集装置 |
CN114370886A (zh) * | 2021-11-23 | 2022-04-19 | 上海航天控制技术研究所 | 基于虚拟转动的全角模式振动陀螺测量误差自标定方法 |
CN114370886B (zh) * | 2021-11-23 | 2024-01-02 | 上海航天控制技术研究所 | 基于虚拟转动的全角模式振动陀螺测量误差自标定方法 |
CN116499497A (zh) * | 2023-06-28 | 2023-07-28 | 中国船舶集团有限公司第七〇七研究所 | 基于模态反转的半球谐振陀螺惯导***误差自校准方法 |
CN116499497B (zh) * | 2023-06-28 | 2023-09-05 | 中国船舶集团有限公司第七〇七研究所 | 基于模态反转的半球谐振陀螺惯导***误差自校准方法 |
Also Published As
Publication number | Publication date |
---|---|
CN109827594B (zh) | 2023-03-31 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109827594A (zh) | 基于面内模态旋转的轴对称陀螺仪零位自补偿***及方法 | |
CN112697123B (zh) | 一种半球谐振陀螺的工作模式切换控制方法及*** | |
CN110686662B (zh) | 一种可在线自校准的双模式差分谐振式陀螺仪*** | |
CN115574798B (zh) | 一种提高半球谐振陀螺综合性能的方法 | |
CN103344226B (zh) | 一种基于mems旋转技术的寻北***及方法 | |
CN114383590B (zh) | 速率积分陀螺的相位误差辨识和补偿方法 | |
CN104697521B (zh) | 一种采用陀螺冗余斜交配置方式测量高速旋转体姿态和角速度的方法 | |
CN108710001B (zh) | 一种两轴一体陀螺加速度计及伺服控制方法 | |
CN103543636B (zh) | 一种动力调谐陀螺仪解耦伺服控制回路 | |
CN114858184A (zh) | 一种半球谐振子参数辨识方法 | |
CN114964306A (zh) | 一种半球谐振陀螺标定因数和零偏自标定方法 | |
CN117490729B (zh) | 一种半球谐振陀螺仪的正交漂移误差检测方法 | |
CN112611887A (zh) | 一种基于模型参数辨识的陀螺加速度计输出补偿方法 | |
US3463016A (en) | Vibra-rotor gyroscopes | |
CN113031668B (zh) | 一种非对称旋转扫描载荷所致干扰力矩估计方法和*** | |
CN111006665B (zh) | 一种基于磁场反馈的原子自旋陀螺仪捷联*** | |
CN116698084A (zh) | 一种对称式陀螺零偏漂移实时抑制与零偏稳定性提升方法 | |
US10648811B2 (en) | Vibrating-mass gyroscope system | |
Shen et al. | Design and realization of low-cost, fast and high-precision fog north finder | |
Bogolyubov et al. | Astatic gyrocompass based on a hybrid micromechanical gyroscope | |
Keke et al. | Research on integrated attitude determination methods based on MEMS device for quadrotor UAVs | |
CN108332734B (zh) | 测量微机械单振子三轴陀螺仪的三轴角速度的方法 | |
JPS61283814A (ja) | ジヤイロ装置 | |
RU2804762C1 (ru) | Универсальный прецизионный мехатронный стенд с инерциальными чувствительными элементами для контроля гироскопических измерителей угловой скорости | |
CN221304125U (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 |