CN109827594B - 基于面内模态旋转的轴对称陀螺仪零位自补偿***及方法 - Google Patents
基于面内模态旋转的轴对称陀螺仪零位自补偿***及方法 Download PDFInfo
- Publication number
- CN109827594B CN109827594B CN201910146917.5A CN201910146917A CN109827594B CN 109827594 B CN109827594 B CN 109827594B CN 201910146917 A CN201910146917 A CN 201910146917A CN 109827594 B CN109827594 B CN 109827594B
- Authority
- CN
- China
- Prior art keywords
- rotation
- gyroscope
- plane
- modal
- driving
- 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
- 238000000034 method Methods 0.000 title claims abstract description 14
- 230000000694 effects Effects 0.000 claims abstract description 4
- 238000001514 detection method Methods 0.000 claims description 21
- 239000011159 matrix material Substances 0.000 claims description 20
- 238000006073 displacement reaction Methods 0.000 claims description 10
- 238000004422 calculation algorithm Methods 0.000 claims description 8
- 238000005259 measurement Methods 0.000 claims description 5
- 230000009471 action Effects 0.000 claims description 3
- 238000006243 chemical reaction Methods 0.000 claims description 3
- 230000009466 transformation Effects 0.000 claims description 3
- 230000007246 mechanism Effects 0.000 abstract description 5
- 238000005516 engineering process Methods 0.000 abstract description 3
- 230000035945 sensitivity Effects 0.000 abstract description 2
- 230000001629 suppression Effects 0.000 abstract description 2
- 238000004364 calculation method Methods 0.000 description 4
- 230000003321 amplification Effects 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 238000003199 nucleic acid amplification method Methods 0.000 description 3
- 238000012545 processing Methods 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 2
- 230000007613 environmental effect Effects 0.000 description 2
- 230000005284 excitation Effects 0.000 description 2
- 241000252229 Carassius auratus Species 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 238000013016 damping Methods 0.000 description 1
- 230000022233 establishment of spindle orientation Effects 0.000 description 1
- 238000007429 general method Methods 0.000 description 1
- 238000003754 machining Methods 0.000 description 1
- 230000003252 repetitive effect Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 230000017105 transposition Effects 0.000 description 1
Images
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 (1)
1.一种基于面内模态旋转的轴对称陀螺仪零位自补偿方法,其特征在于:包括轴对称谐振子、陀螺仪驱动与检测模态控制子***、面内模态旋转控制***,陀螺仪驱动与检测模态控制子***包括驱动模态控制部分与检测模态控制部分,驱动模态控制部分用以保持谐振子驱动方向工作于谐振状态,检测模态控制部分用于平衡哥氏效应产生的驻波进动,并将平衡电压作为角速度的测量结果进行输出;
所述面内模态旋转控制***包括旋转矩阵解算算法模块和面内模态旋转控制***;旋转矩阵解算算法模块用于实现电极坐标系与旋转坐标系间转换,将面内模态旋转控制***在旋转坐标系下进行设计,与陀螺仪驱动与检测模态控制子***建立直接联系,并将旋转坐标系下的输出作为***的检测输出;面内模态旋转控制***利用面内模态的正反旋转,消除面内模态旋转所引入的检测零位;
该方法包括以下步骤:
步骤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 CN109827594A (zh) | 2019-05-31 |
CN109827594B true 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) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110535372B (zh) * | 2019-09-30 | 2024-07-12 | 李南 | 一种负压动平衡的振动能量收集装置 |
CN114370886B (zh) * | 2021-11-23 | 2024-01-02 | 上海航天控制技术研究所 | 基于虚拟转动的全角模式振动陀螺测量误差自标定方法 |
CN116499497B (zh) * | 2023-06-28 | 2023-09-05 | 中国船舶集团有限公司第七〇七研究所 | 基于模态反转的半球谐振陀螺惯导***误差自校准方法 |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104931034B (zh) * | 2015-06-16 | 2017-07-14 | 中北大学 | 基于偶极子补偿法的微机械陀螺仪带宽拓展方法 |
CN104897150B (zh) * | 2015-06-16 | 2017-08-25 | 中北大学 | 一种提升硅微机械陀螺仪带宽全温性能的方法 |
CN105258689B (zh) * | 2015-10-19 | 2018-08-21 | 北京航天控制仪器研究所 | 一种数字陀螺仪信号控制处理*** |
CN107238381A (zh) * | 2017-05-23 | 2017-10-10 | 东南大学 | 用于模态匹配状态硅微机械陀螺仪带宽拓展数字校正方法 |
CN108253952B (zh) * | 2017-12-01 | 2020-08-04 | 北京时代民芯科技有限公司 | 一种零偏自校准mems陀螺仪及其零偏自校准方法 |
CN109029498B (zh) * | 2018-06-15 | 2021-09-28 | 东南大学 | 一种用于振环硅微陀螺仪模态互易的数字测控*** |
CN109323711B (zh) * | 2018-12-04 | 2020-07-28 | 中国工程物理研究院电子工程研究所 | 一种陀螺仪模态反转零位自校正方法及*** |
-
2019
- 2019-02-27 CN CN201910146917.5A patent/CN109827594B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN109827594A (zh) | 2019-05-31 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111578923B (zh) | 一种谐振式陀螺闭环控制方法与*** | |
CN109827594B (zh) | 基于面内模态旋转的轴对称陀螺仪零位自补偿***及方法 | |
CN112697123B (zh) | 一种半球谐振陀螺的工作模式切换控制方法及*** | |
CN111536993B (zh) | 一种振动陀螺电极角度误差的辨识与补偿方法及*** | |
CN101968360B (zh) | 一种钟形振子式角速率陀螺的电路*** | |
CN113686356B (zh) | 基于rbf网络的谐振陀螺零偏在线自补偿***及方法 | |
CN114383590B (zh) | 速率积分陀螺的相位误差辨识和补偿方法 | |
CN110631570B (zh) | 一种用于提升硅微陀螺仪标度因数温度稳定性的***和方法 | |
CN112066968B (zh) | 一种微机电多环陀螺实时模态自动匹配*** | |
CN116086485A (zh) | 半球谐振陀螺误差力补偿方法和装置 | |
CN115451999A (zh) | 半球谐振陀螺虚拟哥氏效应生成方法和装置 | |
CN111024056A (zh) | 一种高动态输入的mems陀螺带宽扩展闭环控制方法 | |
CN105841685B (zh) | 硅微机械陀螺快速热启动实现方法 | |
CN114964306A (zh) | 一种半球谐振陀螺标定因数和零偏自标定方法 | |
CN112611887A (zh) | 一种基于模型参数辨识的陀螺加速度计输出补偿方法 | |
CN117490729B (zh) | 一种半球谐振陀螺仪的正交漂移误差检测方法 | |
CN116026298B (zh) | 一种基于振型操纵的振动陀螺测控方法与装置 | |
WO2023226560A1 (zh) | 一种用于检测角速度的装置、方法和*** | |
Fan et al. | High performance MEMS disk gyroscope with force-to-rebalance operation mode | |
CN108332732B (zh) | 微机械单振子三轴陀螺仪的驱动和检测装置 | |
Bo et al. | Research on a new decoupled dual-mass micro-gyroscope | |
CN108318019B (zh) | 测量微机械单振子三轴陀螺仪的三轴角速度的方法 | |
Bogolyubov et al. | Astatic gyrocompass based on a hybrid micromechanical gyroscope | |
CN110823249A (zh) | 一种硅微陀螺自动模态匹配控制结构和方法 | |
CN112444239A (zh) | 一种几何补偿式的(100)硅微机械环形谐振陀螺 |
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 |