A Hemispherical Resonant Gyro Frequency Control Circuit Based on Force Balance Mode

Abstract

The invention discloses a hemispherical resonant gyro frequency control circuit based on a force balance mode, which includes a hemispherical resonant gyro head, an analog-to-digital converter and a digital-to-analog converter, and also includes CORDIC quadrature demodulation, arctangent, delayer, differential device, loop controller, frequency controller, digital frequency synthesis, digital-to-analog converter, use the CORDIC algorithm to perform quadrature demodulation and arctangent operation on the input signal to solve the phase of the input signal, use the delay device and the difference device to The calculated phase signal is differentially calculated to obtain frequency difference information, and the loop controller is used to correct the frequency difference signal to improve loop performance, and the frequency controller is used to control the frequency of the CODIC modulator. The resonant frequency of the hemispherical resonant gyroscope can be locked by using this loop, and the frequency locking precision and frequency locking rate of this loop can be adjusted through the frequency controller, and the high precision of frequency locking and the convenience of loop adjustment can be realized at the same time.

Description

technical field The invention relates to the technical field of digital control of a hemispherical resonant gyroscope, in particular to a frequency control circuit of a hemispherical resonant gyroscope based on a force balance mode. Background technique The digital control method of the hemispherical resonant gyro control system needs to generate a driving signal that is consistent with the resonant frequency of the driving mode of the hemispherical resonant gyroscope. There are two methods of open-loop and closed-loop control to generate this driving signal. The open-loop method is to use the response of the hemispherical resonant gyroscope to the noise of the drive end to generate a vibration signal consistent with the resonance frequency, and perform zero-crossing detection and frequency calculation on this signal to generate a drive signal with the same frequency to drive the hemispherical resonant gyroscope. In the closed-loop mode, the magnitude of the resonance frequ...

AI Technical Summary

Problems solved by technology

The accuracy of the frequency value of the drive signal obtained by the open-loop scheme is not high, and the relationship between the phase resonance frequency difference in the closed-loop scheme is only linear in a small area near the resonance frequency value, while in the frequency band far away from the resonance frequency point The change of the inner phase with the frequency difference is very weak, and it is difficult to adjust the parameters of the loop

Images