一种数字式石英音叉陀螺驱动环路控制电路制造技术

一种数字式石英音叉陀螺驱动环路控制电路，涉及微机电领域。它包括FPGA模块、D/A芯片、低通滤波器、石英音叉陀螺驱动音叉、放大滤波器、A/D芯片、电源模块；FPGA模块输出数字正弦控制信号至D/二A芯片、低通滤波器，使石英音叉陀螺驱动音叉振动；石英音叉陀螺驱动音叉将振动放大滤波后，通过A/D芯片转换为数字反馈信号并发送至FPGA模块，FPGA模块对数字反馈信号进行调频和调幅，实现对石英音叉陀螺的环路控制。本发明专利技术驱动环路的频率控制精度较高、幅值控制精度好，提高了陀螺性能。

【技术实现步骤摘要】
一种数字式石英音叉陀螺驱动环路控制电路
本专利技术涉及微机电领域的石英音叉陀螺，特别涉及石英音叉陀螺驱动环路控制电路。
技术介绍
石英音叉陀螺属于微机械陀螺的一种，具有体积小、功耗低、成本低、适合批量生产等优点，广泛应用于航天器、平台姿态控制、导弹等领域。石英音叉陀螺的信号处理电路有模拟电路和数字电路两种，相对于模拟电路，数字电路有信号处理灵活，噪声小，不受外界环境影响，重复性好等优点。现有的石英音叉陀螺数字化电路，硬件上，其采用了 DSP+CPLD的双处理器结构，DSP完成数字信号处理算法，CPLD实现数模转换器，模数转换器以及通信接口的控制。算法上，其数字信号处理算法是基于C语言的顺序执行算法，采用4倍频稀疏采样的方式对驱动信号进行采集计算处理，对于IOKHz的驱动信号，要求算法执行周期为25us，加上算法中涉及到大量的三角函数运算，所以其对DSP处理器的计算性能有很高的要求。提高采样率增加每个正弦周期的采样点数，可以提高算法精度，从而提高陀螺性能，但是这就要求选用更高性能的DSP处理器或提高DSP运行主频，从而增加了系统成本和功耗。所以现有技术受制于处理器的计算能力，算法执行周期不能很快，影响算法的精度和陀螺的性能。
技术实现思路
本专利技术的技术解决问题是:克服现有技术的不足，提供了一种数字式石英音叉陀螺驱动环路控制电路，驱动环路的频率控制精度较高、幅值控制精度好，提高了陀螺性能。本专利技术的技术解决方案是:一种数字式石英音叉陀螺驱动环路控制电路，包括FPGA模块、D/A芯片、低通滤波器、石英音叉陀螺驱动音叉、放大滤波器、A/D芯片、电源模块；所述FPGA模块输出数字正弦控制信号至D/A芯片，所述D/A芯片将数字正弦控制信号转换为模拟控制信号发送至低通滤波器，所述低通滤波器滤去模拟控制信号中的高频信号并发送至石英音叉陀螺驱动音叉，使石英音叉陀螺驱动音叉振动；石英音叉陀螺驱动音叉将振动传递至放大滤波器进行放大滤波后，得到模拟反馈信号并发送至A/D芯片，A/D芯片将模拟反馈信号转换为数字反馈信号并发送至FPGA模块，FPGA模块对数字反馈信号进行调频和调幅，并发送新的数字正弦控制信号至D/A芯片，再经低通滤波器后发送至石英音叉陀螺驱动音叉，实现对石英音叉陀螺的环路控制；所述电源模块用于对环路控制电路进行供电。所述FPGA模块包括指令模块、频率控制器、正弦信号发生器、幅值控制器、乘法器、加法器；指令模块向频率控制器发送给定频率值，同时向幅值控制器发送给定幅值；所述频率控制模块接收给定频率值并进行调频后，发送至正弦信号发生器，正弦发生器产生幅值单位为I的正弦波；幅值控制器接收给定幅值并进行调幅后输出目标幅值；所述单位为I的正弦波与所述目标幅值经过乘法器相乘后发送至加法器，加法器产生偏置后得到数字正弦控制信号，发送至D/A芯片；指令模块接收数字反馈信号，并将给定频率值、给定幅值和数字反馈信号发送至加法器，加法器将数字反馈信号中的实测频率与给定频率通过加法器相减，得到调频输入值ei(k)并发送至频率控制器进行调频；正弦信号发生器接收频率控制器的调频结果并产生新的单位为I的正弦波；加法器将数字反馈信号中的实测幅值与给定幅值通过加法器相减，得到调相输入幅值e2 (k)并发送至幅值控制器进行调相，得到新的目标幅值；新的单位为I的正弦波与新的目标幅值经过乘法器相乘后发送至加法器，力口法器产生偏置后得到新的数字正弦控制信号发送，发送至D/A芯片。所述FPGA模块与上位机通过RS422接口进行通信，所述FPGA模块还与EPCS芯片连接，用于存储数据。本专利技术与现有技术相比有益效果为:(I)本专利技术基于FPGA技术，对石英音叉陀螺驱动环路进行数字化设计，突破了传统C语言设计时的速度限制，提高了陀螺驱动信号的质量和驱动环路的频率和幅值控制精度。(2)本专利技术基于FPGA技术，采用硬件描述语言实现A/D、D/A的控制，正弦信号的发生、频率控制算法、幅值控制算法等等，方便易行，简单可靠。相对于传统的DSP+CPLD双处理器的数字式石英音叉陀螺系统，专利技术可以减小系统体积，降低系统功耗。【附图说明】图1本专利技术的电路图；图2本专利技术中FPGA模块的算法原理图；图3本专利技术中正弦信号发生器原理框图；图4本专利技术中开环谐振状态时石英音叉陀螺驱动音叉的输入和输出信号示意图；图5本专利技术的环路频率全温控制曲线。【具体实施方式】如图1所示，本专利技术包括FPGA模块、D/A芯片、低通滤波器、石英音叉陀螺驱动音叉、放大滤波器、A/D芯片、电源模块；所述FPGA模块输出数字正弦控制信号至D/A芯片，所述D/A芯片将数字正弦控制信号转换为模拟控制信号发送至低通滤波器，所述低通滤波器滤去模拟控制信号中的高频信号并发送至石英音叉陀螺驱动音叉，使石英音叉陀螺驱动音叉振动；石英音叉陀螺驱动音叉将振动传递至放大滤波器进行放大滤波后，得到模拟反馈信号并发送至A/D芯片，A/D芯片将模拟反馈信号转换为数字反馈信号并发送至FPGA模块，FPGA模块对数字反馈信号进行调频和调幅，并发送新的数字正弦控制信号至D/A芯片，再经低通滤波器后发送至石英音叉陀螺驱动音叉，实现对石英音叉陀螺的环路控制，保证陀螺的驱动音叉始终以串联谐振频率做幅值恒定的振动。电源模块用于对环路控制电路进行供电。FPGA模块还与上位机通过RS422接口进行通信，FPGA模块还与EPCS芯片连接，EPCS为FPGA专用配置芯片，用于存储FPGA模块的程序数据。如图2所示，FPGA模块包括指令模块、频率控制器、正弦信号发生器、幅值控制器、乘法器、加法器；指令模块向频率控制器发送给定频率值，同时向幅值控制器发送给定幅值；所述频率控制模块接收给定频率值并进行调频后，发送至正弦信号发生器，正弦发生器产生幅值单位为I的正弦波Sinx ;幅值控制器接收给定幅值并进行调幅后输出目标幅值A ；所述单位为I的正弦波与所述目标幅值经过乘法器相乘后得到Asinx发送至加法器，加法器产生偏置b，得到数字正弦控制信号Asinx+b，发送至D/A芯片，得到模拟正弦控制信号Asinx+b,经低通滤波后加入石英音叉陀螺驱动音叉的输入端；指令模块接收数字反馈信号，并将给定频率值、给定幅值和数字反馈信号发送至加法器，加法器将数字反馈信号中的实测频率与给定频率通过加法器相减，得到调频输入值ei (k)并发送至频率控制器进行调频；正弦信号发生器接收频率控制器的调频结果并产生新的单位为I的正弦波；加法器将数字反馈信号 中的实测幅值与给定幅值通过加法器相减，得到调相输入幅值e2(k)并发送至幅值控制器进行调相，得到新的目标幅值；新的单位为I的正弦波与新的目标幅值经过乘法器相乘后发送至加法器，加法器产生偏置后得到新的数字正弦控制信号发送，发送至D/A芯片。其中，FPGA模块选用Altera公司Cyclone III系列FPGA芯片，A/D和D/A芯片采用TI公司的高速16位A/D和D/A芯片。如图3所示，正弦信号发生器包括相位累加器和正弦波查找表。利用FPGA中的RAM资源制作完成一张正弦信号查找表，采用相位累加器的输出对正弦信号查找表进行寻址，经过D/A芯片完成数模转换，再通过低通滤波器进行低通滤波后，产生频率可调的正弦波信号。因为相位累加器每个循环本文档来自技高网...

【技术保护点】
一种数字式石英音叉陀螺驱动环路控制电路，其特征在于：包括FPGA模块、D/A芯片、低通滤波器、石英音叉陀螺驱动音叉、放大滤波器、A/D芯片、电源模块；所述FPGA模块输出数字正弦控制信号至D/A芯片，所述D/A芯片将数字正弦控制信号转换为模拟控制信号发送至低通滤波器，所述低通滤波器滤去模拟控制信号中的高频信号并发送至石英音叉陀螺驱动音叉，使石英音叉陀螺驱动音叉振动；石英音叉陀螺驱动音叉将振动传递至放大滤波器进行放大滤波后，得到模拟反馈信号并发送至A/D芯片，A/D芯片将模拟反馈信号转换为数字反馈信号并发送至FPGA模块，FPGA模块对数字反馈信号进行调频和调幅，并发送新的数字正弦控制信号至D/A芯片，再经低通滤波器后发送至石英音叉陀螺驱动音叉，实现对石英音叉陀螺的环路控制；所述电源模块用于对环路控制电路进行供电。

【技术特征摘要】
1.一种数字式石英音叉陀螺驱动环路控制电路，其特征在于:包括FPGA模块、D/A芯片、低通滤波器、石英音叉陀螺驱动音叉、放大滤波器、A/D芯片、电源模块；所述FPGA模块输出数字正弦控制信号至D/A芯片，所述D/A芯片将数字正弦控制信号转换为模拟控制信号发送至低通滤波器，所述低通滤波器滤去模拟控制信号中的高频信号并发送至石英音叉陀螺驱动音叉，使石英音叉陀螺驱动音叉振动；石英音叉陀螺驱动音叉将振动传递至放大滤波器进行放大滤波后，得到模拟反馈信号并发送至A/D芯片，A/D芯片将模拟反馈信号转换为数字反馈信号并发送至FPGA模块，FPGA模块对数字反馈信号进行调频和调幅，并发送新的数字正弦控制信号至D/A芯片，再经低通滤波器后发送至石英音叉陀螺驱动音叉，实现对石英音叉陀螺的环路控制；所述电源模块用于对环路控制电路进行供电。2.根据权利要求1所述的一种数字式石英音叉陀螺驱动环路控制电路，其特征在于:所述FPGA模块包括指令模块、频率控制器、正弦信号发生器、幅值控制器、乘法器、加法器；指令模块向频率控制器发送给定频率值，同时向幅值控制器发送给定幅值；所述...

【专利技术属性】
技术研发人员：阙兴涛，刘海涛，汪守利，金小锋，王松，王磊，陶晋，杨丹，
申请(专利权)人：北京遥测技术研究所， 航天长征火箭技术有限公司，
类型：发明
国别省市：北京;11