CN102706339A - 一种微机械陀螺驱动方法 - Google Patents
一种微机械陀螺驱动方法 Download PDFInfo
- Publication number
- CN102706339A CN102706339A CN2012101534967A CN201210153496A CN102706339A CN 102706339 A CN102706339 A CN 102706339A CN 2012101534967 A CN2012101534967 A CN 2012101534967A CN 201210153496 A CN201210153496 A CN 201210153496A CN 102706339 A CN102706339 A CN 102706339A
- Authority
- CN
- China
- Prior art keywords
- signal
- ratio
- driving
- micromechanical gyro
- module
- 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
Landscapes
- Gyroscopes (AREA)
Abstract
本发明公开了一种微机械陀螺驱动方法,该方法包括交流信号产生、静电驱动信号产生、信号检测、幅度和相位提取四个步骤。本发明通过对微机械陀螺内部扰动的主动补偿,能使驱动模态检测信号的频率和幅度保持恒定,并且该信号与交流驱动信号的相位差也保持恒定。本发明无需跟踪驱动模态的谐振频率,避免了微机械陀螺系统中如滤波器等与频率相关的模块对系统带来的影响,能提高系统稳定性。
Description
技术领域
本发明涉及微机械陀螺,尤其涉及一种微机械陀螺驱动方法。
背景技术
微机械陀螺因其体积小、功耗低、可批量产生等优点,逐渐在民用甚至军用领域得到重视。稳定性作为微机械陀螺系统的一个关键性能指标,受到诸多因素制约,其中驱动位移或是驱动速度信号的稳定性是最重要的因素之一。因此,好的驱动方法对提高微机械陀螺系统的稳定性至关重要。
现有技术普遍使交流驱动信号适应微机械陀螺参数的变化而变化,以保证驱动模态检测信号的幅度保持恒定。现有技术中最具代表性的方法是相位和幅度双闭环方法,该方法利用驱动模态谐振时驱动位移信号与驱动力信号具有90°相移这一特点,通过相位锁定技术将驱动模态检测信号的相位实时锁定在陀螺驱动模态谐振时的相位,并通过自动增益控制技术将驱动模态检测信号的幅度保持在一个恒定值,此时,交流驱动信号可以实时跟踪驱动模态的谐振频率,并保持驱动模态检测信号的幅度保持恒定。
现有的微机械陀螺驱动方法仅仅保证了驱动模态检测信号幅度的稳定性,而其频率是实时发生变化的,这就对微机械陀螺系统稳定性带来了影响。以相位和幅度双闭环驱动方法为例,当驱动频率发生变化时,系统中如滤波器等与频率相关的模块在不同的驱动频率下产生的相移是不一样的,这就使得通过相位锁定技术跟踪到的驱动模态谐振频率并不是真实的谐振频率,是与真实频率存在偏差的,并且该偏差随驱动频率的变化而变化,此时驱动位移信号与驱动力信号之间的相位差也随驱动频率的变化而变化,这就导致了陀螺信号检测的不稳定性。因此,现有的微机械陀螺驱动方法本身会对微机械陀螺系统带来一定的不稳定性。
发明内容
本发明的目的是克服现有技术的不足,提供一种微机械陀螺驱动方法。
微机械陀螺驱动方法的步骤如下:
1)通过交流驱动信号产生模块产生两路相互正交的信号,并将其中一路作为交流驱动信号,通过弹性系数补偿模块产生弹性系数补偿信号,通过阻尼系数补偿模块产生阻尼系数补偿信号,所述的交流驱动信号、弹性系数补偿信号和阻尼系数补偿信号经相加后作为交流信号输入至静电驱动信号产生模块;
2)静电驱动信号产生模块根据输入的交流信号和模块自身的直流偏置来产生静电驱动信号,输入至微机械陀螺以产生静电驱动力来驱动微机械陀螺振动;
3)信号检测模块检测微机械陀螺随静电力作用而产生的振动信号,将振动信号转换成可测量的电压信号,该电压信号具有与交流驱动信号相同的频率;
4)幅度和相位提取模块对信号检测模块检测的电压信号进行幅度和相位提取,得到相位信号和幅度信号,将相位信号输入至弹性系数补偿模块,将幅度信号输入至阻尼系数补偿模块。
所述的交流驱动信号具有恒定的频率和幅度。所述弹性系数补偿模块是将如步骤4)所述的相位信号与驱动模态谐振时的参考相位进行对比,得到误差信号,将误差信号通过比例-积分控制来自适应地确定反馈系数,并将该反馈系数调制在如步骤1)所述的与交流驱动信号正交的信号上,产生弹性系数补偿信号。所述弹性系数补偿模块产生的弹性系数补偿是通过反馈与驱动位移信号相位相同的静电力来实现,用以补偿弹性系数的扰动,保持微机械陀螺驱动模态的谐振频率不变。所述阻尼系数补偿模块是将如步骤4)所述的幅度信号与驱动模态谐振时的参考幅度进行对比,得到误差信号,将误差信号通过比例-积分控制来自适应地确定反馈系数,并将该反馈系数调制在如步骤1)所述的交流驱动信号上,产生阻尼系数补偿信号。所述阻尼系数补偿模块产生的阻尼系数补偿是通过反馈与驱动速度信号相位相同的静电力来实现,用以补偿阻尼系数的扰动,保持微机械陀螺驱动模态的品质因子不变。
本发明与现有技术相比具有的有益效果是:
1)本发明可在不增加硬件成本的基础上提高微机械陀螺系统的稳定性。
2)本发明可避免微机械陀螺系统中如滤波器等与频率相关的模块对系统稳定性带来的影响,提高微机械陀螺系统的稳定性。
3)本发明能使驱动模态检测信号的频率和幅度保持恒定,并且该信号与交流驱动信号的相位差也保持恒定,进一步提高了微机械陀螺系统的稳定性。
附图说明
图1是本发明中的微机械陀螺驱动方法实现框图。
图2是本发明中的弹性系数补偿的实现框图。
图3是本发明中的阻尼系数补偿的实现框图。
具体实施方式
如图1所示,微机械陀螺驱动方法的步骤如下:
1)通过交流驱动信号产生模块产生两路相互正交的信号,并将其中一路作为交流驱动信号,通过弹性系数补偿模块产生弹性系数补偿信号,通过阻尼系数补偿模块产生阻尼系数补偿信号,所述的交流驱动信号、弹性系数补偿信号和阻尼系数补偿信号经相加后作为交流信号输入至静电驱动信号产生模块,两路相互正交的信号的产生在具体实施时可通过坐标旋转数字计算机算法或是直接数字式频率合成等方法来实现;
2)静电驱动信号产生模块根据输入的交流信号和模块自身的直流偏置来产生静电驱动信号,输入至微机械陀螺以产生静电驱动力来驱动微机械陀螺振动;
3)信号检测模块检测微机械陀螺随静电力作用而产生的振动信号,将振动信号转换成可测量的电压信号,该电压信号具有与交流驱动信号相同的频率,对于位移检测方式而言,检测的电压信号反应了驱动模态的位移信息,对于速度检测方式而言,检测的电压信号反应了驱动模态的速度信息;
4)幅度和相位提取模块对信号检测模块检测的电压信号进行幅度和相位提取,得到相位信号和幅度信号,将相位信号输入至弹性系数补偿模块,将幅度信号输入至阻尼系数补偿模块,幅度和相位的提取可通过正交解调的方式得到两路输出x和y,则 反应了相位信息,反应了幅度信息。
所述的交流驱动信号具有恒定的频率和幅度。所述弹性系数补偿模块是将如步骤4)所述的相位信号与驱动模态谐振时的参考相位进行对比,得到误差信号,将误差信号通过比例-积分控制来自适应地确定反馈系数,并将该反馈系数调制在如步骤1)所述的与交流驱动信号正交的信号上,产生弹性系数补偿信号。所述弹性系数补偿模块产生的弹性系数补偿是通过反馈与驱动位移信号相位相同的静电力来实现,用以补偿弹性系数的扰动,保持微机械陀螺驱动模态的谐振频率不变,由于微机械陀螺驱动模态在谐振时,驱动位移信号与交流驱动信号之间有90°相移,因此所述的弹性系数补偿信号可用于反馈补偿弹性系数的扰动。所述阻尼系数补偿模块是将如步骤4)所述的幅度信号与驱动模态谐振时的参考幅度进行对比,得到误差信号,将误差信号通过比例-积分控制来自适应地确定反馈系数,并将该反馈系数调制在如步骤1)所述的交流驱动信号上,产生阻尼系数补偿信号。所述阻尼系数补偿模块产生的阻尼系数补偿是通过反馈与驱动速度信号相位相同的静电力来实现,用以补偿阻尼系数的扰动,保持微机械陀螺驱动模态的品质因子不变,由于微机械陀螺驱动模态在谐振时,驱动速度信号与交流驱动信号之间有180°相移,因此所述的阻尼系数补偿信号可用于反馈补偿阻尼系数的扰动。
Claims (6)
1.一种微机械陀螺驱动方法,其特征在于它的步骤如下:
1)通过交流驱动信号产生模块产生两路相互正交的信号,并将其中一路作为交流驱动信号,通过弹性系数补偿模块产生弹性系数补偿信号,通过阻尼系数补偿模块产生阻尼系数补偿信号,所述的交流驱动信号、弹性系数补偿信号和阻尼系数补偿信号经相加后作为交流信号输入至静电驱动信号产生模块;
2)静电驱动信号产生模块根据输入的交流信号和模块自身的直流偏置来产生静电驱动信号,输入至微机械陀螺以产生静电驱动力来驱动微机械陀螺振动;
3)信号检测模块检测微机械陀螺随静电力作用而产生的振动信号,将振动信号转换成可测量的电压信号,该电压信号具有与交流驱动信号相同的频率;
4)幅度和相位提取模块对信号检测模块检测的电压信号进行幅度和相位提取,得到相位信号和幅度信号,将相位信号输入至弹性系数补偿模块,将幅度信号输入至阻尼系数补偿模块。
2.根据权利要求1所述的一种微机械陀螺驱动方法,其特征在于所述的交流驱动信号具有恒定的频率和幅度。
3.根据权利要求1所述的一种微机械陀螺驱动方法,其特征在于所述弹性系数补偿模块是将如步骤4)所述的相位信号与驱动模态谐振时的参考相位进行对比,得到误差信号,将误差信号通过比例-积分控制来自适应地确定反馈系数,并将该反馈系数调制在如步骤1)所述的与交流驱动信号正交的信号上,产生弹性系数补偿信号。
4.根据权利要求1所述的一种微机械陀螺驱动方法,其特征在于所述弹性系数补偿模块产生的弹性系数补偿是通过反馈与驱动位移信号相位相同的静电力来实现,用以补偿弹性系数的扰动,保持微机械陀螺驱动模态的谐振频率不变。
5.根据权利要求1所述的一种微机械陀螺驱动方法,其特征在于所述阻尼系数补偿模块是将如步骤4)所述的幅度信号与驱动模态谐振时的参考幅度进行对比,得到误差信号,将误差信号通过比例-积分控制来自适应地确定反馈系数,并将该反馈系数调制在如步骤1)所述的交流驱动信号上,产生阻尼系数补偿信号。
6.根据权利要求1所述的一种微机械陀螺驱动方法,其特征在于所述阻尼系数补偿模块产生的阻尼系数补偿是通过反馈与驱动速度信号相位相同的静电力来实现,用以补偿阻尼系数的扰动,保持微机械陀螺驱动模态的品质因子不变。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210153496.7A CN102706339B (zh) | 2012-05-17 | 2012-05-17 | 一种微机械陀螺驱动方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210153496.7A CN102706339B (zh) | 2012-05-17 | 2012-05-17 | 一种微机械陀螺驱动方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102706339A true CN102706339A (zh) | 2012-10-03 |
CN102706339B CN102706339B (zh) | 2014-10-15 |
Family
ID=46899291
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201210153496.7A Active CN102706339B (zh) | 2012-05-17 | 2012-05-17 | 一种微机械陀螺驱动方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102706339B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102944230A (zh) * | 2012-11-14 | 2013-02-27 | 浙江大学 | 一种可调谐微机械陀螺的恒频驱动方法及其装置 |
CN103162681A (zh) * | 2013-03-19 | 2013-06-19 | 中国人民解放军国防科学技术大学 | 用于微机械陀螺的信号检测方法及装置 |
CN112747730A (zh) * | 2020-12-25 | 2021-05-04 | 浙江大学 | 一种微机械陀螺的基于自激驱动的非线性控制系统和方法 |
CN115127534A (zh) * | 2022-09-01 | 2022-09-30 | 中国船舶重工集团公司第七0七研究所 | 一种基于载波调制的石英陀螺正弦波相位检测补偿方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101261126A (zh) * | 2008-04-10 | 2008-09-10 | 上海交通大学 | 微固体模态陀螺 |
CN101819215A (zh) * | 2010-04-20 | 2010-09-01 | 浙江大学 | 一种弹性系数可调的微机械梳状栅电容加速度计 |
US20110252887A1 (en) * | 2010-04-16 | 2011-10-20 | Donato Cardarelli | Electrical Damping for Isolation and Control of Mems Sensors Experiencing High-G Launch |
-
2012
- 2012-05-17 CN CN201210153496.7A patent/CN102706339B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101261126A (zh) * | 2008-04-10 | 2008-09-10 | 上海交通大学 | 微固体模态陀螺 |
US20110252887A1 (en) * | 2010-04-16 | 2011-10-20 | Donato Cardarelli | Electrical Damping for Isolation and Control of Mems Sensors Experiencing High-G Launch |
CN101819215A (zh) * | 2010-04-20 | 2010-09-01 | 浙江大学 | 一种弹性系数可调的微机械梳状栅电容加速度计 |
Non-Patent Citations (2)
Title |
---|
郑旭东等: "《一种电容式微机械加速度计的设计》", 《传感技术学报》, vol. 21, no. 2, 28 February 2008 (2008-02-28), pages 226 - 229 * |
郑旭东等: "《一种静电驱动电容检测的微机械陀螺及其工艺改进》", 《中国机械工程》, vol. 20, no. 18, 30 September 2009 (2009-09-30), pages 2160 - 2163 * |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102944230A (zh) * | 2012-11-14 | 2013-02-27 | 浙江大学 | 一种可调谐微机械陀螺的恒频驱动方法及其装置 |
CN102944230B (zh) * | 2012-11-14 | 2015-12-16 | 浙江大学 | 一种可调谐微机械陀螺的恒频驱动方法及其装置 |
CN103162681A (zh) * | 2013-03-19 | 2013-06-19 | 中国人民解放军国防科学技术大学 | 用于微机械陀螺的信号检测方法及装置 |
CN103162681B (zh) * | 2013-03-19 | 2015-06-24 | 中国人民解放军国防科学技术大学 | 用于微机械陀螺的信号检测方法及装置 |
CN112747730A (zh) * | 2020-12-25 | 2021-05-04 | 浙江大学 | 一种微机械陀螺的基于自激驱动的非线性控制系统和方法 |
CN112747730B (zh) * | 2020-12-25 | 2022-07-12 | 浙江大学 | 一种微机械陀螺的基于自激驱动的非线性控制系统和方法 |
CN115127534A (zh) * | 2022-09-01 | 2022-09-30 | 中国船舶重工集团公司第七0七研究所 | 一种基于载波调制的石英陀螺正弦波相位检测补偿方法 |
CN115127534B (zh) * | 2022-09-01 | 2022-11-18 | 中国船舶重工集团公司第七0七研究所 | 一种基于载波调制的石英陀螺正弦波相位检测补偿方法 |
Also Published As
Publication number | Publication date |
---|---|
CN102706339B (zh) | 2014-10-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102944230B (zh) | 一种可调谐微机械陀螺的恒频驱动方法及其装置 | |
CN110108266B (zh) | 基于机械vco锁相环的陀螺实时自动闭环模态匹配方法 | |
CN102868183B (zh) | 单相并网逆变器的基于多谐振滑模面的滑模变结构控制方法 | |
CN203627092U (zh) | 变桨控制系统以及包括变桨控制系统的风力机 | |
CN102759365A (zh) | 用于硅微机械陀螺的零偏稳定性提升方法及装置 | |
CN103270691B (zh) | 无传感器式交流电动机控制器 | |
Chen et al. | Adaptive sliding mode observer-based sensorless control for SPMSM employing a dual-PLL | |
CN102706339A (zh) | 一种微机械陀螺驱动方法 | |
JP6343341B2 (ja) | 加速度計制御 | |
CN103162681B (zh) | 用于微机械陀螺的信号检测方法及装置 | |
CN102664580B (zh) | 电力系统多稳定器的混合智能控制方法 | |
CN109768753B (zh) | 新型滑模观测器的无位置传感器永磁同步电机模型预测控制方法 | |
CN103162680A (zh) | 基于力平衡闭环控制的硅微机械陀螺性能提升方法及装置 | |
CN103134484A (zh) | 调节电容式mems陀螺仪检测端谐振频率的电路和方法 | |
CN101795105B (zh) | 无轴承永磁同步电机悬浮转子等效扰动电流补偿控制装置 | |
CN105258689A (zh) | 一种数字陀螺仪信号控制处理系统 | |
CN101900554A (zh) | 一种多表头陀螺数字化驱动及检测方法 | |
Bedetti et al. | Self-adaptation of MTPA tracking controller for IPMSM and SynRM drives based on on-line estimation of loop gain | |
CN106441359B (zh) | 一种高精度的微机械陀螺现场模态匹配方法 | |
CN117629163A (zh) | 基于双模态同时激励的mems陀螺模态匹配方法和角速度读出方法 | |
Guo et al. | Direct voltage control of stand‐alone DFIG under asymmetric loads based on non‐singular terminal sliding mode control and improved extended state observer | |
Zhang et al. | Research on high frequency voltage injection method for PMSM | |
Li et al. | Hybrid sensorless control based on I/F and sliding mode observer using current nonlinear regulation for PMSM drives | |
CN104501793A (zh) | 一种高动态角速率陀螺正交误差控制方法 | |
Lei et al. | Research on novel high frequency signal extraction method based on extended Kalman filter theory |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |