Digital Double-Closed-loop Drive Control Method for Silicon Microgyroscope

LUO Bing,WANG An-cheng,WU Mei-ping,YU Hua-peng

DOI: https://doi.org/10.13695/j.cnki.12-1222/o3.2010.06.013

2010-01-01

Abstract: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.