CN103048925B - 一种钟形振子式角速率陀螺振子振幅稳定方法 - Google Patents
一种钟形振子式角速率陀螺振子振幅稳定方法 Download PDFInfo
- Publication number
- CN103048925B CN103048925B CN201210545100.3A CN201210545100A CN103048925B CN 103048925 B CN103048925 B CN 103048925B CN 201210545100 A CN201210545100 A CN 201210545100A CN 103048925 B CN103048925 B CN 103048925B
- Authority
- CN
- China
- Prior art keywords
- bell
- shaped vibrator
- rate
- vibrator
- angular rate
- 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.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims abstract description 30
- 238000006073 displacement reaction Methods 0.000 claims abstract description 31
- 230000006641 stabilisation Effects 0.000 claims abstract description 10
- 238000011105 stabilization Methods 0.000 claims abstract description 10
- 238000001914 filtration Methods 0.000 claims abstract description 4
- 230000007613 environmental effect Effects 0.000 claims description 3
- 239000011159 matrix material Substances 0.000 claims description 2
- 238000013461 design Methods 0.000 abstract description 12
- 230000003044 adaptive effect Effects 0.000 abstract description 2
- 230000000087 stabilizing effect Effects 0.000 description 16
- 238000011161 development Methods 0.000 description 4
- 230000005284 excitation Effects 0.000 description 4
- 238000012827 research and development Methods 0.000 description 3
- 238000004904 shortening Methods 0.000 description 3
- 230000007547 defect Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 239000008358 core component Substances 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000010355 oscillation Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
Landscapes
- Gyroscopes (AREA)
Abstract
一种钟形振子式角速率陀螺振子振幅稳定方法。该方法包括：（1）利用参考模型和观测到的钟形振子<i>x</i>轴向信号和<i>y</i>轴向信号，计算钟形振子运行误差和误差变化率；（2）对<i>x</i>轴向信号、<i>y</i>轴向信号、振子运行误差和运行误差变化率进行集中滤波与状态重构，重构出新状态<i>x</i>轴向位移、<i>y</i>轴向位移、<i>x</i>轴向位移变化率、<i>y</i>轴向位移变化率、钟形振子运行误差和运行误差变化率；（3）根据给定系统输入与重构的状态，设计自适应滑模控制器，控制钟形振子维持稳定振幅运动。本发明提高了钟形振子式角速率陀螺幅值稳定程度，缩短了稳定时间，并缩短了整个钟形振子式角速率陀螺开发的时间，为钟形振子式角速率陀螺的合理设计提供了依据。
Description
技术领域
本发明属于角速率陀螺技术领域，具体涉及一种钟形振子式角速率陀螺振子振幅稳定方法。
背景技术
陀螺作为敏感载体角运动的惯性器件，是惯性导航、制导的核心部件。基于哥氏力原理的振动陀螺具有所有的惯性品质，其在惯性技术领域的地位越来越重要，已被人们当作新一代的惯性仪表而受到广泛的关注。在科学技术发展和市场需求的推动下，各种振动陀螺相继出现。
申请号为：ZL201010215745.1，发明名称为“钟形振子式角速率陀螺”的专利申请提供了一种钟形振子式角速率陀螺，该钟形振子式角速率陀螺是一种基于哥氏力原理的振动陀螺，其敏感器件为钟形谐振子。目前，基于该钟形振子式角速率陀螺振子振幅稳定方法，均是依靠经验判断法和试凑法得来的，设计的钟形振子式角速率陀螺幅值稳定回路的响应时间难以控制、调试周期长、振幅稳定能力差，截止目前，还没有一种系统描述钟形振子式角速率陀螺的振型稳定方法。
发明内容
本发明为了克服经验判断法和试凑法设计的钟形振子式角速率陀螺幅值稳定回路的响应时间难以控制、调试周期长、振幅稳定能力差等缺点，提出了一种全新的钟形振子式角速率陀螺振子振幅稳定方法。采用先进控制方法，结合状态重构、滤波器设计、自适应控制和滑模变结构控制于一体，提高了钟形振子式角速率陀螺幅值稳定程度，缩短了稳定时间，同时由于系统的自适应能力增强，大大缩短了钟形振子幅值稳定回路的研发周期，从而缩短了整个钟形振子式角速率陀螺开发的时间，为钟形振子式角速率陀螺的合理设计提供了依据。
为了解决上述技术问题，本发明采用的技术方案是：
利用参考模型和观测到的钟形振子x轴向信号和y轴向信号，计算钟形振子运行误差和误差变化率；对x轴向信号、y轴向信号、振子运行误差和运行误差变化率进行集中滤波与状态重构，重构出新状态x轴向位移、y轴向位移、x轴向位移变化率、y轴向位移变化率、钟形振子运行误差和运行误差变化率；根据给定系统输入与重构的状态，设计自适应滑模控制器，控制钟形振子维持稳定振幅运动。除此之外，利用外界环境输入传感器，实时调整DDS输出和参考模型，增强系统的环境适应性。
与现有技术相比，本发明的有益效果是：
（1）本发明提供的钟形振子式角速率陀螺振幅稳定方法利用先进控制理论，设计针对钟形振子的基于模型参考状态重构的自适应滑模控制器，填补了钟形振子振幅稳定回路控制器设计的空白，为钟形振子振幅稳定回路设计奠定了理论基础；
（2）本发明提供的钟形振子式角速率陀螺振子振幅稳定方法提高了验证分析能力和准确性，为钟形振子的合理设计提供了依据；
（3）本发明提供的钟形振子式角速率陀螺振子振幅稳定方法，通过外界环境传感器，实时调整DDS输出和参考模型，增强系统的环境适应性；
（4）本发明提供的钟形振子式角速率陀螺振子振幅稳定方法，可使陀螺控制回路的自适应能力增强，大大缩短了钟形振子幅值稳定回路的研发周期，从而缩短了整个钟形振子式角速率陀螺开发的时间，为钟形振子式角速率陀螺的合理设计提供了依据。
附图说明
图1为钟形振子式角速率陀螺振子结构设计方法流程图；
具体实施方式
钟形振子式角速率陀螺的原理是利用发生谐振的钟形振子旋转时引起的振型角度的进动，来确定陀螺基座绕惯性空间旋转的角度。为使钟形振子能产生环向波数n=2的理想振型，必须准确地控制钟形振子的激振幅值，其稳定程度，将直接影响到钟形振子式角速率陀螺的整体性能。因此我们要对钟形振子式角速率陀螺的振幅稳定回路进行合理设计，使钟形振子能够产生理想振型，从而更好的敏感输入角速率。
针对上述状态方程描述，本发明提供的钟形振子式角速率陀螺振幅稳定方法，具体实施方式如下：
本发明提供的钟形振子式角速率陀螺振幅稳定方法的主要结构框图如图1所示。钟形振子式角速率的状态变量为：
，。
状态空间模型如下：
其中，x为x轴向输出位移；y为y轴向输出位移；为x轴向输出位移的导数；为y轴向输出位移的导数；为x轴向控制力；为y轴向控制力；，，。
在钟形振子式角速率陀螺工作之前，要根据环境传感器（1-11），利用之前对钟形振子（1-13）进行的环境试验得出的幅值频率表（1-21），确定DDS（1-1）的振动幅值和频率（1-2）、参考模型（1-14）的振动幅值和频率（1-12）。确定的参考模型（1-14）为：
其状态空间表述为：
其中，，。与（1-12）为参考模型（1-14）的振动幅值和频率，均由幅值频率表（1-21）提供；参考信号（1-16）为参考模型（1-14）给出的钟形振子x轴向期望输出位移；参考信号（1-17）为参考模型（1-14）给出的钟形振子y轴向期望输出位移。振子在x轴向电极激励信号（1-5）和y轴向电极激励信号（1-7）的综合作用下开始振动，通常在初始情况下，x轴向电极激励信号（1-5）为频率是6635.5Hz，峰峰值为20V的正弦信号；y轴向电极激励信号（1-7）为0V直流电压。
当钟形振子开始振动后，通过钟形振子式角速率陀螺的位移敏感器，采集钟形振子x轴向位移信号（1-15）和y轴向位移信号（1-19）。利用参考信号（1-16）和x轴向位移信号（1-15），求得钟形振子（1-13）x轴向位移的运行误差（1-18）；利用参考信号（1-17）和x轴向位移信号（1-19），求得钟形振子（1-13）y轴向位移的运行误差（1-19）。
设计滤波与状态重构器（1-20），在对观测到的状态进行滤波的同时，重构出新状态：x轴向控制力（1-4）、y轴向控制力（1-7）、x轴向位移变化率和y轴向位移变化率（1-8）、钟形振子运行误差、和运行误差变化率、（1-10）。
根据外部给定的DDS输出x轴控制力（1-3）和重构x轴向控制力（1-4），求得x轴向控制力误差（1-5）。
利用x轴向控制力误差（1-5），钟形振子运行误差、和运行误差变化率、（1-10），x轴向控制力（1-4），y轴向控制力（1-7），x轴向位移变化率和y轴向位移变化率（1-8）设计自适应滑模控制器，生成钟形振子（1-9）的合成控制力（1-9），维持钟形振子幅值稳定。其中，选取的控制率为：
选取的自适应率为：
，
选取的滑模面为：
其中，为钟形振子运行误差、的向量表示，为给定常值，为给定常值矩阵。
由此，便可实现对钟形振子的幅值稳定控制。
本发明提出的钟形振子式角速率陀螺振幅稳定方法，目的是为了克服经验判断法和试凑法设计的钟形振子式角速率陀螺幅值稳定回路的响应时间难以控制、调试周期长、振幅稳定能力差等缺点，提出了一种全新的钟形振子式角速率陀螺振子振幅稳定方法。采用先进控制方法，结合状态重构、滤波器设计、自适应控制和滑模变结构控制于一体，提高了钟形振子式角速率陀螺幅值稳定程度，缩短了稳定时间，同时由于系统的自适应能力增强，大大缩短了钟形振子幅值稳定回路的研发周期，从而缩短了整个钟形振子式角速率陀螺开发的时间，为钟形振子式角速率陀螺的合理设计提供了依据。
最后应说明的是，以上实施例仅用以说明本发明的技术方案而非限制，尽管参照较佳实施例对本发明进行了详细说明，本领域的普通技术人员应当理解，可以对本发明的技术方案进行修改或者等同替换，而不脱离本发明技术方案的精神和范围，其均应涵盖在本发明的权利要求范围当中。
Claims (3)
1.一种钟形振子式角速率陀螺振子振幅稳定方法，该方法包括：
（1）利用参考模型和观测到的钟形振子x轴向信号和y轴向信号，计算钟形振子运行误差和误差变化率；
（2）对x轴向信号、y轴向信号、振子运行误差和运行误差变化率进行集中滤波与状态重构，重构出新状态x轴向位移、y轴向位移、x轴向位移变化率、y轴向位移变化率、钟形振子运行误差和运行误差变化率；
（3）根据给定系统输入与重构的状态，设计自适应滑模控制器，控制钟形振子维持稳定振幅运动；
在步骤（3）中，利用x轴向控制力误差，钟形振子运行误差、和运行误差变化率、，x轴向控制力，y轴向控制力，x轴向位移变化率和y轴向位移变化率，设计自适应滑模控制器，生成钟形振子的合成控制力，维持钟形振子幅值稳定。
2.根据权利要求1所述的钟形振子式角速率陀螺振子振幅稳定方法，其特征在于：利用外界环境输入传感器，实时调整DDS输出和参考模型，以增强系统的环境适应性。
3.根据权利要求1所述的钟形振子式角速率陀螺振子振幅稳定方法，其特征在于，选取的控制率为：；其中：选取的自适应率为：，，选取的滑模面为：为状态变量的时域表示，为给定常值，为给定常值矩阵,，，，，为钟形振子运行误差、的向量表示。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201210545100.3A CN103048925B (zh) | 2012-12-17 | 2012-12-17 | 一种钟形振子式角速率陀螺振子振幅稳定方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201210545100.3A CN103048925B (zh) | 2012-12-17 | 2012-12-17 | 一种钟形振子式角速率陀螺振子振幅稳定方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN103048925A CN103048925A (zh) | 2013-04-17 |
| CN103048925B true CN103048925B (zh) | 2016-05-11 |
Family
ID=48061608
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201210545100.3A Expired - Fee Related CN103048925B (zh) | 2012-12-17 | 2012-12-17 | 一种钟形振子式角速率陀螺振子振幅稳定方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN103048925B (zh) |
Families Citing this family (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108303881A (zh) * | 2018-01-19 | 2018-07-20 | 南通大学 | 带误差限定的微陀螺滑模控制方法 |
| CN108241299A (zh) * | 2018-01-19 | 2018-07-03 | 南通大学 | 带误差限定的微陀螺自适应滑模控制方法 |
Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101968359A (zh) * | 2010-07-02 | 2011-02-09 | 北京理工大学 | 钟形振子式角速率陀螺 |
| CN102298322A (zh) * | 2011-06-21 | 2011-12-28 | 河海大学常州校区 | 基于模型参考自适应控制微陀螺仪的方法 |
| CN102298315A (zh) * | 2011-06-21 | 2011-12-28 | 河海大学常州校区 | 基于rbf神经网络滑模控制的mems陀螺仪的自适应控制系统 |
-
2012
- 2012-12-17 CN CN201210545100.3A patent/CN103048925B/zh not_active Expired - Fee Related
Patent Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101968359A (zh) * | 2010-07-02 | 2011-02-09 | 北京理工大学 | 钟形振子式角速率陀螺 |
| CN102298322A (zh) * | 2011-06-21 | 2011-12-28 | 河海大学常州校区 | 基于模型参考自适应控制微陀螺仪的方法 |
| CN102298315A (zh) * | 2011-06-21 | 2011-12-28 | 河海大学常州校区 | 基于rbf神经网络滑模控制的mems陀螺仪的自适应控制系统 |
Non-Patent Citations (4)
| Title |
|---|
| "A Novel Design of Adaptive Sliding Mode Observer";Juntao Fei 等;《Proceedings of the 8th World Congress on Intelligent Control and Automation》;20100731;全文 * |
| "SLIDING MODE CONTROL OF A SIMULATED MEMS GYROSCOPE";C. Batur 等;《2005 American Control Conference》;20051231;全文 * |
| "基于自适应滑模观测器的故障诊断";胡芬巧 等;《福州大学学报（自然科学版）》;20080930;第36卷;全文 * |
| "基于观测器的传感器故障重构方法及其应用";何静 等;《兵工学报》;20090630;第30卷(第6期);全文 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN103048925A (zh) | 2013-04-17 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN106052667B (zh) | 振动陀螺仪中谐振器和科里奥利轴控制的系统、装置、方法 | |
| CN104682871B (zh) | 时钟信号生成电路、检测装置、电子设备及移动体 | |
| CN105258689B (zh) | 一种数字陀螺仪信号控制处理系统 | |
| CN102254058B (zh) | 钟形振子式角速率陀螺振子结构设计方法 | |
| CN106027043A (zh) | 电路装置、电子设备以及移动体 | |
| CN106248078B (zh) | 机抖激光陀螺敏感轴动态偏移误差参数估计与补偿方法 | |
| CN104634337B (zh) | 检测装置、传感器、电子设备以及移动体 | |
| CN115451999A (zh) | 半球谐振陀螺虚拟哥氏效应生成方法和装置 | |
| CN115388910A (zh) | 半球谐振陀螺误差自激励方法和系统 | |
| CN103048925B (zh) | 一种钟形振子式角速率陀螺振子振幅稳定方法 | |
| RU2011118234A (ru) | Способ и система для гироскопических измерений с использованием вибрационного гироскопа | |
| CN108663071A (zh) | 电路装置、物理量检测装置、电子设备以及移动体 | |
| CN103047978B (zh) | 一种钟形振子式角速率陀螺谐振子频率裂解抑制方法 | |
| CN116465384B (zh) | 一种基于模态反转的半球谐振陀螺漂移误差补偿方法 | |
| CN104501793A (zh) | 一种高动态角速率陀螺正交误差控制方法 | |
| Bu et al. | Noise model considering electrical feed-through under force rebalance closed-loop detection of MEMS gyroscope | |
| CN102982211B (zh) | 一种钟形振子式角速率陀螺控制回路仿真方法 | |
| Fedorov et al. | Development of deflection angle stabilizing system for balancing robot | |
| Yin et al. | Structure-decoupled dual-mass MEMS gyroscope with self-adaptive closed-loop detection | |
| CN104011619A (zh) | 频率发生器 | |
| CN103017748B (zh) | 一种钟形振子式角速率陀螺信号提取方法 | |
| Wang et al. | Research and experiment on the drive frequency control of the MEMS gyroscope | |
| Xia et al. | A digitized decoupled dual-axis micro dynamically tuned gyroscope with three equilibrium rings | |
| Sung et al. | A novel control loop design and its application to the force balance of vibratory rate sensor | |
| Lin et al. | Digital closed-loop controller design of a micromachined gyroscope based on auto frequency swept |
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 | ||
| CF01 | Termination of patent right due to non-payment of annual fee | ||
| CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20160511 Termination date: 20211217 |