硅微陀螺数字化双闭环驱动控制方法  

Digital double-closed-loop drive control method for silicon microgyroscope

作　　者：罗兵[1] 王安成[1] 吴美平[1] 于化鹏[1] 

机构地区：[1]国防科技大学机电工程与自动化学院,长沙410073

出　　处：《中国惯性技术学报》2010年第6期747-750,共4页Journal of Chinese Inertial Technology

基　　金：国家863项目(2006AA12Z319)

摘　　要：为了提高硅微机械陀螺的性能,基于FPGA设计并实现了一种数字化双闭环驱动控制电路。介绍了通过相位控制实现频率跟踪和直流控制实现幅值稳定的驱动控制原理,采用FPGA扩展ADC、DAC的方法设计出相应控制回路。分别采用扫频和直流扫描测试的方法确定回路中相位偏差到频率调整量与幅度偏差到电平调整量的转换系数。利用Xilinx ISE软件设计了硬件接口、参数解算、滤波处理、信号生成等逻辑;利用EDK软件设计了数据存取、控制算法、扫频测试、串口通讯等程序。试验结果表明,系统稳定工作后,频率跟踪误差与幅度控制相对稳定性分别在10-6和10-4量级上。A digital double-closed-loop drive control circuit was designed and realized based on FPGA to improve the performance of silicon microgyroscope.The principles of the drive control scheme were presented,in which phase control loop was used to track drive mode resonant frequency,and direct current control loop was used to stabilize the amplitude of vibration displacement.The two closed-loops were designed based on FPGA assisting ADC and DAC.By means of frequency sweeping and direct current scanning test,the conversion coefficients from phase error to frequency adjustment in phase control loop and that from amplitude error to direct current adjustment in direct current control loop were obtained.Using Xilinx ISE and EDK software,the logics for devices interfaces,parameters solution,digital filters,signal generation and the programs for data access,control algorithms,sweeping test,serial communication were designed respectively.Experiments show that the relative tracking error of drive mode resonant frequency is up to an order of 10-6 and amplitude stability up to an order of 10-4 after the system is stable.

关 键 词：硅微陀螺 驱动控制 频率跟踪 稳幅 

分 类 号：U666.1[交通运输工程—船舶及航道工程]