[发明专利]一种陀螺进动控制装置及方法

说明书

技术领域

本发明涉及陀螺进动控制技术，具体地说是一种陀螺进动控制的方法及装置，应用于频率测量和陀螺进动控制等领域。

背景技术

陀螺仪是一种能够精确地确定运动物体的方位的仪器，它是现代航空、航海、航天和工业中广泛使用的一种惯性导航仪器，它的发展对一个国家的工业和其它高科技的发展具有十分重要的意义。位置和频率测量是陀螺速度稳定控制领域当中两个输入，这两个输入是进动控制的基础。进动特性是陀螺的一个重要特性，利用该特性可以实现陀螺的定向偏转，具体可以应用在导航等领域。

在现有的系统中，通常利用惯性系作为陀螺进动的基准，当陀螺移动时会影响进动精度；采用DAC模块生成正弦波，这样增加了硬件成本；在进动控制中，采用算法计算进动方位和幅度与进动控制信号的幅度和相位的映射关系，占用微控制器的资源，算法实时性差。

发明内容

针对现有技术的不足，本发明提供一种陀螺进动控制的方法及装置。

本发明为实现上述目的所采用的技术方案是：一种陀螺进动控制装置，包括：顺序连接的预处理电路、微控制器、低通滤波器、功率放大器和陀螺驱动；预处理电路：将来自传感器的陀螺反馈信息进行放大整形后输出至微控制器；微控制器：接收上位机的进动位置信息，完成进动位置信息和进动控制信息之间的映射，利用脉宽调制技术将进动控制信息通过改变脉宽调制的占空比转换成正弦波；低通滤波器：将微控制器输出的正弦波滤掉高频成分；功率放大器：将低通滤波器的控制信号进行放大后输出至陀螺驱动使陀螺进动。

所述陀螺反馈信息包括陀螺转子的位置和转速。

所述进动控制信息包括陀螺转子的频率、幅度和相位。

所述进动控制信息中的频率根据陀螺反馈信息的转速得出。

一种陀螺进动控制方法，包括以下步骤：

1）查询陀螺转子的转动周期是否到来；

2）如果到来，则测量陀螺转子的转速；如果没到来，则返回步骤5）；

3）接收上位机的进动位置信息，包括陀螺转子的幅度和方位；

4）在进动位置信息与进动控制信息之间进行插值映射；所述进动控制信息包括陀螺转子的频率、幅度和相位。

5）查询脉宽调制间隔是否到来；

6）如果到来，则输出脉宽调制波；如未到来，则返回步骤1）；

7）脉宽调制的正弦波经低通滤波器滤掉高频成分，再通过功率放大器进行信号放大后输出至陀螺驱动使陀螺进动。

所述步骤4）对进动的位置和进动控制信息进行插值映射包括以下步骤：

A．对陀螺进动的幅度和相位数据中的特殊点做成二维表；

B．在二维表中搜索离设定的进动幅度和相位最近的两个点；

C.利用线性插值的方法进行插值，得到进动控制信息的幅度和相位。

7．根据权利要求6所述的一种陀螺进动控制方法，其特征在于：

所述特殊点为在陀螺顶面上不同半径的同心圆圆周与不同圆心角的交点。

所述脉宽调制间隔是通过定点采样设定的。

所述输出脉宽调制波包括以下步骤：

c．将映射所得的正弦波幅度转换为脉宽调制的最大占空比；

d．将映射所得的正弦波相位与陀螺反馈的位置信息中的方位进行比较，将所得相位差数字化并转换为时间差，该时间差作为脉宽调制的50%占空比时刻；

c．将陀螺反馈的转速转换成频率，作为占空比改变一个周期的频率，即可得到高频调制的正弦波。

本发明具有以下有益效果及优点：

1.本发明利用陀螺反馈信号测量陀螺转子的位置及转速作为陀螺进动的参考基准，提高了陀螺进动的控制精度。

2.本发明利用脉宽调制技术生成正弦波，节约了成本，减少了电路复杂度。

3.本发明利用线性插值技术将进动幅度和方位与进动控制信号的幅度和相位进行映射，降低了算法的复杂度。

附图说明

图1为本发明硬件原理示意图；

图2为本发明脉宽调制生成正弦波原理示意图；

图3为本发明进动幅度方位与进动控制信号映射原理示意图；

图4为本发明陀螺进动控制方法流程图。

具体实施方式

下面结合附图及实施例对本发明做进一步的详细说明。

采用信号处理技术对陀螺反馈信号进行预处理，然后将预处理过的反馈信号分别处理成速度反馈和转子反馈并输入微处理器，通过处理和计算得当前时刻陀螺的位置和转速，根据实时输入的进动方向和幅度调整进动信号，然后经过功率放大器进行输出，实现系统的进动控制。