CN107063307B - 基于虚拟哥氏力的微机械陀螺仪自标定方法 - Google Patents
基于虚拟哥氏力的微机械陀螺仪自标定方法 Download PDFInfo
- Publication number
- CN107063307B CN107063307B CN201710265744.XA CN201710265744A CN107063307B CN 107063307 B CN107063307 B CN 107063307B CN 201710265744 A CN201710265744 A CN 201710265744A CN 107063307 B CN107063307 B CN 107063307B
- Authority
- CN
- China
- Prior art keywords
- signal
- virtual
- force
- coriolis force
- shi
- 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
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
Abstract
本发明涉及微机械陀螺仪的标定方法,具体是一种基于虚拟哥氏力的微机械陀螺仪自标定方法。本发明解决了现有微机械陀螺仪标定方法标定过程繁琐、标定结果精度低、应用范围受限的问题。基于虚拟哥氏力的微机械陀螺仪自标定方法,该方法是采用如下步骤实现的:1)获取哥氏信号幅值;2)施加高精度虚拟哥氏力信号;3)更新由输入角速率产生的哥氏力信号和由虚拟哥氏力产生的信号;4)标定微机械陀螺仪的参数。本发明适用于微机械陀螺仪的标定。
Description
技术领域
本发明涉及微机械陀螺仪的标定方法,具体是一种基于虚拟哥氏力的微机械陀螺仪自标定方法。
背景技术
微机械陀螺仪是一种采用哥氏效应原理敏感载体输入角速率信息的传感器,其具有体积小、功耗低、重量轻、成本低、抗过载特性强、易于集成化和批量生产等优点,并广泛应用于诸多领域(比如惯性导航、汽车安全、工业控制、消费电子等)。如图1-图3示,微机械陀螺仪包括陀螺结构、陀螺测控电路。所述陀螺结构包括驱动轴向结构、检测轴向结构。所述检测轴向结构包括检测力反馈结构、哥氏质量、检测位移提取结构。所述陀螺测控电路包括驱动闭环回路、检测自标定回路。所述检测自标定回路包括前级放大接口、次级放大器、解调器、低通滤波器、力反馈控制器、调制器、直流信号叠加装置、信号分离模块、自标定模块。所述自标定模块包括高精度虚拟哥氏力信号产生模块、叠加器、参数计算模块、哥氏力输出模块。微机械陀螺仪的工作模态包含驱动模态和检测模态。
微机械陀螺仪在经历长时间存储、温度影响、冲击振动等环境变化时,其参数(例如标度因数、零偏等)会发生较大变化,但微机械陀螺仪的参数通常已经装填在相关的系统(例如惯性导航系统、姿态测量系统等)中,因此为了保证系统的测量和控制精度,需要时刻对微机械陀螺仪的参数进行标定。目前,微机械陀螺仪的标定通常采用转台进行。实践表明,此种标定方法存在如下问题:其一,在标定过程中,需要反复进行微机械陀螺仪与台面之间的安装和拆卸,由此导致标定过程繁琐。其二,转台在运行中产生的误差和干扰会对标定结果造成直接和间接的影响,由此导致标定结果精度低。其三,在实际应用条件下(例如野外环境),往往很难提供转台,由此导致标定无法开展,从而导致应用范围受限。基于此,有必要发明一种全新的微机械陀螺仪标定方法,以解决现有微机械陀螺仪标定方法存在的上述问题。
发明内容
本发明为了解决现有微机械陀螺仪标定方法标定过程繁琐、标定结果精度低、应用范围受限的问题,提供了一种基于虚拟哥氏力的微机械陀螺仪自标定方法。
本发明是采用如下技术方案实现的:
基于虚拟哥氏力的微机械陀螺仪自标定方法,该方法是采用如下步骤实现的:
1)获取哥氏信号幅值;具体获取步骤如下:
1.1)检测位移提取结构产生检测位移信号;将检测位移信号送入前级放大接口,前级放大接口将检测位移信号转化为电压信号,并对电压信号进行初步放大;次级放大器对前级放大接口的输出信号进行进一步放大;
1.2)驱动闭环回路产生驱动模态激励信号;将驱动模态激励信号送入解调器,解调器以驱动模态激励信号为基准,将次级放大器的输出信号解调为哥氏信号和二倍频信号;
1.3)将哥氏信号和二倍频信号均送入低通滤波器,低通滤波器将二倍频信号滤除,由此得到哥氏信号幅值;
2)施加高精度虚拟哥氏力信号;具体施加步骤如下:
2.1)将哥氏信号幅值送入力反馈控制器,力反馈控制器根据哥氏信号幅值产生检测信号;将检测信号分别送入信号分离模块和叠加器,信号分离模块将检测信号分离为由输入角速率产生的哥氏力信号和由虚拟哥氏力产生的信号;
2.2)高精度虚拟哥氏力信号产生模块产生高精度虚拟哥氏力信号;
2.3)将高精度虚拟哥氏力信号送入叠加器,高精度虚拟哥氏力信号和检测信号在叠加器中叠加形成哥氏反馈低频信号;将哥氏反馈低频信号和驱动模态激励信号均送入调制器,调制器以驱动模态激励信号为基准,将哥氏反馈低频信号调制为控制信号;将控制信号和高精度直流基准信号均送入直流信号叠加装置,控制信号和高精度直流基准信号在直流信号叠加装置中叠加形成反馈力信号;将反馈力信号送入检测力反馈结构,检测力反馈结构根据反馈力信号分别产生反馈力和虚拟哥氏力;
3)更新由输入角速率产生的哥氏力信号和由虚拟哥氏力产生的信号;具体更新步骤如下:
3.1)赋予高精度虚拟哥氏力信号特征信息;
3.2)重新执行步骤2.3),由此得到更新的反馈力和虚拟哥氏力;
3.3)重新执行步骤1),由此得到更新的哥氏信号幅值;
3.4)重新执行步骤2.1),由此得到更新的由输入角速率产生的哥氏力信号和由虚拟哥氏力产生的信号;
4)标定微机械陀螺仪的参数;具体标定步骤如下:
4.1)将更新的由虚拟哥氏力产生的信号送入参数计算模块,更新的由虚拟哥氏力产生的信号和带有特征信息的高精度虚拟哥氏力信号在参数计算模块中进行同步解算,并通过拟合算法得到微机械陀螺仪的参数;
4.2)将更新的由输入角速率产生的哥氏力信号送入哥氏力输出模块,哥氏力输出模块对更新的由输入角速率产生的哥氏力信号进行进一步滤波和优化,由此得到最终输出信号。
与现有微机械陀螺仪标定方法相比,本发明所述的基于虚拟哥氏力的微机械陀螺仪自标定方法不再采用转台,而是通过施加高精度虚拟哥氏力信号实现了微机械陀螺仪的标定,由此具备了如下优点:其一,本发明无需进行微机械陀螺仪与台面之间的安装和拆卸,由此有效简化了标定过程。其二,本发明有效避免了转台的误差和干扰对标定结果造成的影响,由此有效提高了标定结果精度。其三,本发明在各种应用条件下(例如野外环境)均可对微机械陀螺仪进行标定,由此使得应用范围不再受限。
本发明有效解决了现有微机械陀螺仪标定方法标定过程繁琐、标定结果精度低、应用范围受限的问题,适用于微机械陀螺仪的标定。
附图说明
图1是微机械陀螺仪的结构示意图。
图2是微机械陀螺仪的检测自标定回路的结构示意图。
图3是微机械陀螺仪的自标定模块的结构示意图。
具体实施方式
基于虚拟哥氏力的微机械陀螺仪自标定方法,该方法是采用如下步骤实现的:
1)获取哥氏信号幅值;具体获取步骤如下:
1.1)检测位移提取结构产生检测位移信号YV;将检测位移信号YV送入前级放大接口,前级放大接口将检测位移信号YV转化为电压信号,并对电压信号进行初步放大;次级放大器对前级放大接口的输出信号进行进一步放大;
1.2)驱动闭环回路产生驱动模态激励信号XS;将驱动模态激励信号XS送入解调器,解调器以驱动模态激励信号XS为基准,将次级放大器的输出信号解调为哥氏信号和二倍频信号;
1.3)将哥氏信号和二倍频信号均送入低通滤波器,低通滤波器将二倍频信号滤除,由此得到哥氏信号幅值;
2)施加高精度虚拟哥氏力信号VC;具体施加步骤如下:
2.1)将哥氏信号幅值送入力反馈控制器,力反馈控制器根据哥氏信号幅值产生检测信号Ff;将检测信号Ff分别送入信号分离模块和叠加器,信号分离模块将检测信号Ff分离为由输入角速率产生的哥氏力信号CR和由虚拟哥氏力产生的信号CV;
2.2)高精度虚拟哥氏力信号产生模块产生高精度虚拟哥氏力信号VC;
2.3)将高精度虚拟哥氏力信号VC送入叠加器,高精度虚拟哥氏力信号VC和检测信号Ff在叠加器中叠加形成哥氏反馈低频信号CS;将哥氏反馈低频信号CS和驱动模态激励信号XS均送入调制器,调制器以驱动模态激励信号XS为基准,将哥氏反馈低频信号CS调制为控制信号ACS;将控制信号ACS和高精度直流基准信号DR均送入直流信号叠加装置,控制信号ACS和高精度直流基准信号DR在直流信号叠加装置中叠加形成反馈力信号YS;将反馈力信号YS送入检测力反馈结构,检测力反馈结构根据反馈力信号YS分别产生反馈力和虚拟哥氏力;
3)更新由输入角速率产生的哥氏力信号CR和由虚拟哥氏力产生的信号CV;具体更新步骤如下:
3.1)赋予高精度虚拟哥氏力信号VC特征信息;
3.2)重新执行步骤2.3),由此得到更新的反馈力和虚拟哥氏力;
3.3)重新执行步骤1),由此得到更新的哥氏信号幅值;
3.4)重新执行步骤2.1),由此得到更新的由输入角速率产生的哥氏力信号CR和由虚拟哥氏力产生的信号CV;
4)标定微机械陀螺仪的参数Cout;具体标定步骤如下:
4.1)将更新的由虚拟哥氏力产生的信号CV送入参数计算模块,更新的由虚拟哥氏力产生的信号CV和带有特征信息的高精度虚拟哥氏力信号VC在参数计算模块中进行同步解算,并通过拟合算法得到微机械陀螺仪的参数Cout;
4.2)将更新的由输入角速率产生的哥氏力信号CR送入哥氏力输出模块,哥氏力输出模块对更新的由输入角速率产生的哥氏力信号CR进行进一步滤波和优化,由此得到最终输出信号Gout。
具体实施时,所述步骤4.1)中,同步解算包括相除和解调,拟合算法为最小二乘法。
Claims (2)
1.一种基于虚拟哥氏力的微机械陀螺仪自标定方法,其特征在于:该方法是采用如下步骤实现的:
1)获取哥氏信号幅值;具体获取步骤如下:
1.1)检测位移提取结构产生检测位移信号(YV);将检测位移信号(YV)送入前级放大接口,前级放大接口将检测位移信号(YV)转化为电压信号,并对电压信号进行初步放大;次级放大器对前级放大接口的输出信号进行进一步放大;
1.2)驱动闭环回路产生驱动模态激励信号(XS);将驱动模态激励信号(XS)送入解调器,解调器以驱动模态激励信号(XS)为基准,将次级放大器的输出信号解调为哥氏信号和二倍频信号;
1.3)将哥氏信号和二倍频信号均送入低通滤波器,低通滤波器将二倍频信号滤除,由此得到哥氏信号幅值;
2)施加高精度虚拟哥氏力信号(VC);具体施加步骤如下:
2.1)将哥氏信号幅值送入力反馈控制器,力反馈控制器根据哥氏信号幅值产生检测信号(Ff);将检测信号(Ff)分别送入信号分离模块和叠加器,信号分离模块将检测信号(Ff)分离为由输入角速率产生的哥氏力信号(CR)和由虚拟哥氏力产生的信号(CV);
2.2)高精度虚拟哥氏力信号产生模块产生高精度虚拟哥氏力信号(VC);
2.3)将高精度虚拟哥氏力信号(VC)送入叠加器,高精度虚拟哥氏力信号(VC)和检测信号(Ff)在叠加器中叠加形成哥氏反馈低频信号(CS);将哥氏反馈低频信号(CS)和驱动模态激励信号(XS)均送入调制器,调制器以驱动模态激励信号(XS)为基准,将哥氏反馈低频信号(CS)调制为控制信号(ACS);将控制信号(ACS)和高精度直流基准信号(DR)均送入直流信号叠加装置,控制信号(ACS)和高精度直流基准信号(DR)在直流信号叠加装置中叠加形成反馈力信号(YS);将反馈力信号(YS)送入检测力反馈结构,检测力反馈结构根据反馈力信号(YS)分别产生反馈力和虚拟哥氏力;
3)更新由输入角速率产生的哥氏力信号(CR)和由虚拟哥氏力产生的信号(CV);具体更新步骤如下:
3.1)赋予高精度虚拟哥氏力信号(VC)特征信息;
3.2)重新执行步骤2.3),由此得到更新的反馈力和虚拟哥氏力;
3.3)重新执行步骤1),由此得到更新的哥氏信号幅值;
3.4)重新执行步骤2.1),由此得到更新的由输入角速率产生的哥氏力信号(CR)和由虚拟哥氏力产生的信号(CV);
4)标定微机械陀螺仪的参数(Cout);具体标定步骤如下:
4.1)将更新的由虚拟哥氏力产生的信号(CV)送入参数计算模块,更新的由虚拟哥氏力产生的信号(CV)和带有特征信息的高精度虚拟哥氏力信号(VC)在参数计算模块中进行同步解算,并通过拟合算法得到微机械陀螺仪的参数(Cout);
4.2)将更新的由输入角速率产生的哥氏力信号(CR)送入哥氏力输出模块,哥氏力输出模块对更新的由输入角速率产生的哥氏力信号(CR)进行进一步滤波和优化,由此得到最终输出信号(Gout)。
2.根据权利要求1所述的基于虚拟哥氏力的微机械陀螺仪自标定方法,其特征在于:所述步骤4.1)中,同步解算包括相除和解调,拟合算法为最小二乘法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710265744.XA CN107063307B (zh) | 2017-04-21 | 2017-04-21 | 基于虚拟哥氏力的微机械陀螺仪自标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710265744.XA CN107063307B (zh) | 2017-04-21 | 2017-04-21 | 基于虚拟哥氏力的微机械陀螺仪自标定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107063307A CN107063307A (zh) | 2017-08-18 |
CN107063307B true CN107063307B (zh) | 2019-01-01 |
Family
ID=59600532
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710265744.XA Active CN107063307B (zh) | 2017-04-21 | 2017-04-21 | 基于虚拟哥氏力的微机械陀螺仪自标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107063307B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110542437B (zh) * | 2019-09-21 | 2020-12-29 | 中北大学 | 驱动-检测模态互换的微机械陀螺机械灵敏度自补偿方法 |
CN111551162B (zh) * | 2020-04-28 | 2022-01-28 | 东南大学 | 一种用于常压封装mems陀螺仪解调相角补偿的系统和方法 |
CN112611889B (zh) * | 2020-12-08 | 2022-04-05 | 中国人民解放军陆军步兵学院石家庄校区 | 基于静电等效力的微机械加速度计自标定方法 |
CN112379128B (zh) * | 2020-12-08 | 2022-07-05 | 中北大学 | 基于虚拟惯性力的谐振式微机械加速度计自标定补偿方法 |
CN114370886B (zh) * | 2021-11-23 | 2024-01-02 | 上海航天控制技术研究所 | 基于虚拟转动的全角模式振动陀螺测量误差自标定方法 |
CN114370887B (zh) * | 2021-11-23 | 2023-10-20 | 上海航天控制技术研究所 | 基于虚拟转动的力平衡模式振动陀螺零位自标定方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102353384B (zh) * | 2011-05-24 | 2013-06-26 | 北京大学 | 微机械陀螺带宽与标度因子的测量方法及系统 |
-
2017
- 2017-04-21 CN CN201710265744.XA patent/CN107063307B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN107063307A (zh) | 2017-08-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107063307B (zh) | 基于虚拟哥氏力的微机械陀螺仪自标定方法 | |
CN111578923B (zh) | 一种谐振式陀螺闭环控制方法与系统 | |
CN108253952B (zh) | 一种零偏自校准mems陀螺仪及其零偏自校准方法 | |
EP2447671B1 (en) | Angular velocity sensor, and synchronous detection circuit used therein | |
Cao et al. | An improved interface and noise analysis of a turning fork microgyroscope structure | |
Hu et al. | A parametrically amplified MEMS rate gyroscope | |
CN111536993B (zh) | 一种振动陀螺电极角度误差的辨识与补偿方法及系统 | |
CN105571576B (zh) | 一种mems陀螺模态匹配电压自动测试方法 | |
CA2460977A1 (en) | Micromechanical inertial sensor having increased pickoff resonance damping | |
CN110426025B (zh) | 一种微机械陀螺实时自动模态匹配方法 | |
AU2002334586A1 (en) | Micromechanical inertial sensor having increased pickoff resonance damping | |
CN106969785B (zh) | 陀螺仪自校准装置及方法 | |
CN104567849A (zh) | 一种硅微机械线振动式陀螺及其带宽拓展方法 | |
CN110482479B (zh) | 一种简化的mems多环谐振陀螺自适应闭环控制方法 | |
CN105841685B (zh) | 硅微机械陀螺快速热启动实现方法 | |
TW201740084A (zh) | 用於處理信號的方法與裝置 | |
CN111024056A (zh) | 一种高动态输入的mems陀螺带宽扩展闭环控制方法 | |
CN112066968A (zh) | 一种微机电多环陀螺实时模态自动匹配系统 | |
CN103983257B (zh) | 一种能消除微机械陀螺仪正交误差的信号处理方法 | |
JP7010656B2 (ja) | コリオリ振動ジャイロスコープに関するジャイロ・レート計算のためのシステムおよび方法 | |
CN113765516B (zh) | 一种mems谐振器闭环控制方法及控制结构 | |
CN113639734A (zh) | Mems电容式陀螺仪的数字馈通取消系统 | |
US20090007662A1 (en) | Force rebalance control system and method using automatic gain control loop | |
EP2933602B1 (en) | Microelectromechanical rate sensor | |
Feng et al. | Differential pickup circuit design of a kind of Z-axis MEMS quartz gyroscope |
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 |