专利名称：一种钟形振子式角速率陀螺振子振幅稳定方法
技术领域：
本发明属于角速率陀螺技术领域，具体涉及一种钟形振子式角速率陀螺振子振幅稳定方法。
背景技术：
陀螺作为敏感载体角运动的惯性器件，是惯性导航、制导的核心部件。基于哥氏力原理的振动陀螺具有所有的惯性品质，其在惯性技术领域的地位越来越重要，已被人们当作新一代的惯性仪表而受到广泛的关注。在科学技术发展和市场需求的推动下，各种振动陀螺相继出现。申请号为ZL201010215745. 1，发明名称为“钟形振子式角速率陀螺”的专利申请提供了一种钟形振子式角速率陀螺，该钟形振子式角速率陀螺是一种基于哥氏力原理的振动陀螺，其敏感器件为钟形谐振子。目前，基于该钟形振子式角速率陀螺振子振幅稳定方法，均是依靠经验判断法和试凑法得来的，设计的钟形振子式角速率陀螺幅值稳定回路的响应时间难以控制、调试周期长、振幅稳定能力差，截止目前，还没有一种系统描述钟形振子式角速率陀螺的振型稳定方法。
发明内容
本发明为了克服经验判断法和试凑法设计的钟形振子式角速率陀螺幅值稳定回路的响应时间难以控制、调试周期长、振幅稳定能力差等缺点，提出了一种全新的钟形振子式角速率陀螺振子振幅稳定方法。采用先进控制方法，结合状态重构、滤波器设计、自适应控制和滑模变结构控制于一体，提高了钟形振子式角速率陀螺幅值稳定程度，缩短了稳定时间，同时由于系统的自适应能力增强，大大缩短了钟形振子幅值稳定回路的研发周期，从而缩短了整个钟形振子式角速率陀螺开发的时间，为钟形振子式角速率陀螺的合理设计提供了依据。为了解决上述技术问题，本发明采用的技术方案是
利用参考模型和观测到的钟形振子Z轴向信号和_7轴向信号，计算钟形振子运行误差和误差变化率；对Z轴向信号、_7轴向信号、振子运行误差和运行误差变化率进行集中滤波与状态重构，重构出新状态Z轴向位移、轴向位移轴向位移变化率、_7轴向位移变化率、钟形振子运行误差和运行误差变化率；根据给定系统输入与重构的状态，设计自适应滑模控制器，控制钟形振子维持稳定振幅运动。除此之外，利用外界环境输入传感器，实时调整DDS输出和参考模型,增强系统的环境适应性。与现有技术相比，本发明的有益效果是
(1)本发明提供的钟形振子式角速率陀螺振幅稳定方法利用先进控制理论，设计针对钟形振子的基于模型参考状态重构的自适应滑模控制器，填补了钟形振子振幅稳定回路控制器设计的空白，为钟形振子振幅稳定回路设计奠定了理论基础；
(2)本发明提供的钟形振子式角速率陀螺振子振幅稳定方法提高了验证分析能力和准确性，为钟形振子的合理设计提供了依据；
(3)本发明提供的钟形振子式角速率陀螺振子振幅稳定方法，通过外界环境传感器，实时调整DDS输出和参考模型,增强系统的环境适应性；
(4)本发明提供的钟形振子式角速率陀螺振子振幅稳定方法，可使陀螺控制回路的自适应能力增强，大大缩短了钟形振子幅值稳定回路的研发周期，从而缩短了整个钟形振子式角速率陀螺开发的时间，为钟形振子式角速率陀螺的合理设计提供了依据。
图1为钟形振子式角速率陀螺振子结构设计方法流程具体实施例方式钟形振子式角速率陀螺的原理是利用发生谐振的钟形振子旋转时引起的振型角度的进动，来确定陀螺基座绕惯性空间旋转的角度。为使钟形振子能产生环向波数的理想振型，必须准确地控制钟形振子的激振幅值，其稳定程度，将直接影响到钟形振子式角速率陀螺的整体性能。因此我们要对钟形振子式角速率陀螺的振幅稳定回路进行合理设计，使钟形振子能够产生理想振型，从而更好的敏感输入角速率。针对上述状态方程描述，本发明提供的钟形振子式角速率陀螺振幅稳定方法，具体实施方式
如下
本发明提供的钟形振子式角速率陀螺振幅稳定方法的主要结构框图如图1所示。钟形振子式角速率的状态变量为
权利要求
1.一种钟形振子式角速率陀螺振子振幅稳定方法，该方法包括 (1)利用参考模型和观测到的钟形振子Z轴向信号和轴向信号，计算钟形振子运行误差和误差变化率； (2)对Z轴向信号、_7轴向信号、振子运行误差和运行误差变化率进行集中滤波与状态重构，重构出新状态Z轴向位移、_7轴向位移轴向位移变化率、_7轴向位移变化率、钟形振子运行误差和运行误差变化率； (3)根据给定系统输入与重构的状态，设计自适应滑模控制器，控制钟形振子维持稳定振幅运动。
2.根据权利要求1所述的钟形振子式角速率陀螺振子振幅稳定方法，其特征在于利用外界环境输入传感器，实时调整DDS输出和参考模型，以增强系统的环境适应性。
3.根据权利要求1所述的钟形振子式角速率陀螺振子振幅稳定方法，其特征在于在步骤(3)中，利用z轴向控制力误差 ,钟形振子运行误差^^和运行误差变化率匕、&，z轴向控制力]].，轴向控制力Iy 轴向位移变化率纟和_7轴向位移变化车I设计自适应滑模控制器，生成钟形振子的合成控制力，维持钟形振子幅值稳定。
4.根据权利要求3所述的钟形振子式角速率陀螺振子振幅稳定方法，其特征在于选取的控制率为:
5.根据权利要求4所述的钟形振子式角速率陀螺振子振幅稳定方法，其特征在于选取的自适应率为
全文摘要
一种钟形振子式角速率陀螺振子振幅稳定方法。该方法包括(1)利用参考模型和观测到的钟形振子x轴向信号和y轴向信号，计算钟形振子运行误差和误差变化率；(2)对x轴向信号、y轴向信号、振子运行误差和运行误差变化率进行集中滤波与状态重构，重构出新状态x轴向位移、y轴向位移、x轴向位移变化率、y轴向位移变化率、钟形振子运行误差和运行误差变化率；(3)根据给定系统输入与重构的状态，设计自适应滑模控制器，控制钟形振子维持稳定振幅运动。本发明提高了钟形振子式角速率陀螺幅值稳定程度，缩短了稳定时间，并缩短了整个钟形振子式角速率陀螺开发的时间，为钟形振子式角速率陀螺的合理设计提供了依据。
文档编号G05B13/04GK103048925SQ201210545100
公开日2013年4月17日 申请日期2012年12月17日 优先权日2012年12月17日
发明者付梦印, 苏中, 邓志红, 刘洪 , 刘宁, 李擎 申请人:北京理工大学, 北京信息科技大学