一种半球谐振陀螺快速启动控制系统及实现方法

摘要: 本发明涉及陀螺仪,更具体地说,它涉及一种半球谐振陀螺快速启动控制系统及实现方法。背景技术:1、半球谐振陀螺是一种基于哥式效应的固态陀螺仪,具有体积、重量和功耗的...
一种半球谐振陀螺快速启动控制系统及实现方法

本发明涉及陀螺仪,更具体地说,它涉及一种半球谐振陀螺快速启动控制系统及实现方法。

背景技术:

1、半球谐振陀螺是一种基于哥式效应的固态陀螺仪,具有体积、重量和功耗的综合性能优势,能够实现高精度和高可靠性的定位和导航功能,展示出巨大的发展潜力和应用前景。目前,国内多个单位正不断加强对半球谐振陀螺控制系统的研究以进一步提升系统的精度和可靠性,快速启动作为提高其性能的关键技术之一,在高动态、强实时性、工程化的应用场景中至关重要。

2、半球谐振陀螺的快速启动要求陀螺能够在短时间内完成起振、锁相、稳幅等控制,达到稳定的全角或力平衡工作状态,输出准确可靠的测量信号。这一过程受到谐振子自身特性、起振方法及控制算法等多因素限制。首先,高q值谐振子的谐振频率受温度等因素的影响,通常呈一定范围分布,谐振子在起振前处于静止状态,在启动阶段需输入频率位于谐振频率附近的外部激励信号才能激发其振动模态。此外,在控制过程中,闭环控制算法需要不断进行迭代以达到稳定状态,控制算法的性能也制约着半球谐振陀螺的快速启动。

3、为了实现谐振陀螺系统的快速启动,提高启动阶段的稳定性和可靠性,现有研究大多从快速起振和频率追踪两方面入手。如中国专利申请cn 118168528 a公开了一种半球谐振陀螺快速起振方法,通过建立温度-频率模型得到陀螺工作温度下的谐振频率并配合锁相环进行动态频率跟踪的方法来实现谐振子快速起振;中国专利cn 112857353 b 公开了一种金属谐振陀螺快速起振系统及方法,实现了扫频搜索和锁相控制分时工作,在扫频阶段检测到有效幅值信号后迅速切换至锁相控制过程完成频率锁定,提高了起振阶段的稳定性;中国专利cn 114964198 b 公开了一种基于分时复用的谐振陀螺快速频率追踪系统及实现方法,该方法将频率驱动信号与宽频脉冲信号叠加后施加到激励电极上实现谐振子瞬态激发,并采用了分时复用技术将检测驱动阶段在时间上分离,实现了频率的准确追踪。

4、上述现有技术中,在起振阶段寻找谐振频率的方法如扫频、建立温度-频率模型存在明显不足,起振效果受限。如扫频确定谐振频率需要直接数字频率合成器不断生成不同频率的信号,扫频时长受到扫频范围及步长限制,通常需要较长时间以保证扫频过程可靠性;建立温度-频率模型需要对不同谐振陀螺均进行长时间的标定,谐振陀螺内部处于高真空状态,热传导效率较低,当环境温度变化较大时,采用外部环境温度代替谐振子温度获得的起振频率存在较大误差。且现有技术集中于研究启动阶段的频率追踪过程,缺乏对启动阶段的整体考虑。然而,启动时长还受稳幅控制、正交控制等过程的制约,仅完成频率追踪与锁相未使谐振陀螺进入稳定工作状态。

技术实现思路

1、本发明的目的在于提供一种半球谐振陀螺快速启动控制系统及实现方法,从半球谐振陀螺启动过程中的起振、锁相、稳幅阶段分别入手,通过数模转换器产生宽频起振信号激发谐振子快速产生微小振动,通过pi动态控制单元动态调整频率追踪过程实现快速锁相,通过辨识驻波方位角初始位置从而控制施加驱动力的方向实现快速稳幅。该方法能够大大缩短半球谐振陀螺的启动时间,在全角及力平衡工作模式下均适用。

2、为了实现上述目的,本发明提供如下技术方案:

3、一方面,本发明提供了一种半球谐振陀螺快速启动控制系统,由hrg表头、前端模拟电路及fpga控制平台三部分组成;

4、所述fpga控制平台包括信号解调单元、驻波方位角位置辨识单元、状态解算单元、控制单元、数控振荡器和信号调制单元,所述控制单元包括pi动态控制单元,幅值、正交、角度控制单元;

5、所述信号解调单元将采集到的振动信号与所述数控振荡器产生的解调参考信号进行混频,然后进行低通滤波得到陀螺的解调信号、、、;所述驻波方位角位置辨识单元根据解调信号来判断初始驻波方位角所在区间;所述状态解算单元根据解调信号得到陀螺现有的振型状态信息e、q、r、s、t、l并输入到各个控制单元中;所述pi动态控制单元根据振型状态信息完成pi参数的动态配置,实现快速锁相,并将相位信息传递给数控振荡器;所述幅值、正交、角度控制单元根据振型状态信息生成对应的控制信号;所述数字振荡器依据pi动态控制单元传来的相位信息产生新的参考信号;所述信号调制单元以新的参考信号为载波,将控制单元和驻波方位角位置辨识单元产生的控制信号进行调制形成新的驱动信号。

6、优选地,所述hrg表头由半球谐振子和平板电极两部分构成,所述平板电极包括x检测电极、y检测电极、x激励电极和y激励电极,所述x激励电极和y激励电极用来对谐振子施加静电驱动力,所述x检测电极和y检测电极用来检测和传递谐振子振动所产生的电容变化。

7、优选地,所述前端模拟电路中主要包括c/v转换模块、模数转换器及数模转换器,实现信号的滤波、放大及转换功能;所述c/v转换模块能够将x检测电极、y检测电极检测到的微弱电容变化转换为模拟电压信号;所述模数转换器将c/v转换模块得到的模拟电压信号转换为数字电压信号传递到fpga控制平台中;所述数模转换器将fpga控制平台输出的数字驱动力转化为模拟驱动力施加到谐振子的x激励电极、y激励电极上。

8、优选地,所述信号解调单元得到解调信号、、、的公式如式(1)所示:

9、(1)

10、式中,代表主波波腹,代表正交波波腹,代表主波波腹轴方位角,代表检测信号与参考信号之间的相位差。

11、优选地,所述驻波方位角位置辨识单元判断初始驻波方位角所在区间时,受的影响很小,,式(1)简化为式(2),所依据的判断公式如式(3)所示:

12、(2)

13、(3)

14、式中,代表驻波在x方向上的能量,代表驻波在y方向上的能量;

15、所述初始驻波方位角区间划分的方法为:以x激励电极为x轴,y激励电极为y轴建立坐标系,在坐标系中作两条斜线将坐标系分成四个区间,第一斜线为,第二斜线为,则第ⅰ区间为含x轴正方向的区间,第ⅱ区间为含y轴正方向的区间,第ⅲ区间为含x轴负方向的区间,第ⅳ区间为含y轴负方向的区间;

16、当满足且时,驻波波腹位于第ⅰ区间,将驱动力施加到x轴正方向;当满足且时,驻波波腹位于第ⅱ区间,将驱动力施加到y轴正方向;当满足且时,驻波波腹位于第ⅲ区间,将驱动力施加到x轴负方向;当满足且时,驻波波腹位于第ⅳ区间,将驱动力施加到y轴负方向。

17、优选地,所述pi动态控制单元根据振型状态信息完成pi参数的动态配置的依据是pi算法,所述pi算法的公式如(4)所示:

18、(4)

19、式中,为当前偏差量,为累计偏差量,为比例系数,为积分系数。

20、一方面,本发明还提供了一种半球谐振陀螺快速启动控制系统实现方法,包括如下步骤:

21、s1、在半球谐振子静止时,通过激励电极对谐振子施加一个短时宽频信号激励其快速起振,产生微小振动,引起激励电极与谐振子之间的电容变化;

22、s2、电容变化经前端模拟电路中的c/v转换模块转化为模拟电压信号;

23、s3、模拟电压信号通过模数转换器转换为数字信号输入到fpga控制平台中;

24、s4、在fpga控制平台中,信号解调单元对检测信号进行解调获得解调参数、、和;

25、s5、驻波方位角位置辨识单元依照解调参数、、和完成初始驻波方位角的位置判断;状态解算单元依照解调参数、、和计算振型状态信息e、q、r、s、t和l;

26、s6、pi动态控制单元依照振型状态信息实时追踪谐振子的谐振频率快速完成锁相,数控振荡器生成新的基准信号;幅值、正交、角度控制回路获取当前状态信息生成对应的控制信号;

27、s7、基准信号结合控制单元和驻波方位角位置辨识单元产生的控制信号在信号调制单元中进行调制生成新的数字驱动力;

28、s8、数字驱动力经过数模转换器转化成模拟驱动力、施加到施加到谐振子x、y激励电极上,精准快速地完成启动过程。

29、优选地,步骤s1中所述产生微小振动是通过施加宽频信号激发谐振子快速产生的,具体为按照设定的初始频率、频宽及脉宽生成宽频信号作为起振信号,从而保证起振信号的频域范围覆盖谐振子在全温域的二阶振动频率。

30、优选地,所述起振信号的时频变化关系如式(5)所示:

31、(5)

32、式中,代表起振信号初始频率,代表频率变化速率,代表时间。

33、优选地,所述起振信号的时域表达式如(6)所示:

34、(6)

35、代表信号幅值,代表信号初相位,代表直流偏置。

36、与现有技术相比,本发明的有益效果是:

37、1、本发明综合考虑半球谐振子谐振频率的变化及半球谐振陀螺系统的完整启动过程,在起振、锁相、稳幅多个阶段进行改进以缩短启动时间,提高了半球谐振陀螺启动阶段的稳定性和可靠性,实现了全温域环境中的快速启动。

38、2、本发明易实现,只需在原有方案基础上优化起振方法和软件控制程序,无需进行复杂的硬件设计和硬件电路板更换,实现成本低。该发明的控制过程较为灵活,可以对不同谐振子匹配不同起振信号及pi控制参数,对不同的谐振陀螺控制系统具有普适性。

39、3、本发明在冷启动和热启动两种启动模式下均适用。通过对谐振陀螺启动阶段的驻波方位角进行方向判断从而施加相应的驱动力,可以有效解决谐振陀螺短暂断电重启后,谐振子在残余驻波影响下激励力施加不准导致的启动时间延长的问题。