Dual-axis indexing mechanism control system, control method and strapdown inertial group self-calibration method

Abstract

The invention discloses a system and method for control of a biaxial transposition mechanism and a method for self-calibration of a strapdown inertial group. The control system includes an angular position sensor, an analog-to-digital converter, a DSP microprocessor, an FPGA processor, a motor driver circuit and a motor which are connected in sequence. The control method includes the steps of collecting and analyzing an angular position signal, generating a digital control quantity after a closed-loop control based on an analysis result, and driving the motor to rotate through output of the digital control quantity. The self-calibration method utilizes the above control system or control method for calibration. The control system, the control method and the self-calibration method can realize high-precision acquisition of angular position data of the biaxial transposition mechanism and high-precision closed-loop control of the biaxial transposition mechanism, effectively realize the high-precision control of a speed loop and the position loop of the biaxial transposition mechanism, and further achieve self-calibration function of the strapdown inertial group.

Description

technical field [0001] The present invention relates to the technical field of inertial navigation, and more specifically, the present invention relates to a dual-axis indexing mechanism control system, a control method and a strapdown inertial group self-calibration method. Background technique [0002] At present, the vehicle positioning and orientation equipment based on the dual-axis indexing strapdown inertial group can provide the vehicle with orientation, attitude and positioning information without relying on external information. However, there is system parameter drift in the traditional strapdown inertial group. Therefore, in order to maintain the accuracy of positioning and orientation, it is necessary to calibrate the inertial devices in the strapdown inertial group on a regular basis (about one year). [0003] The conventional calibration method is: the strapdown inertial set is removed from the vehicle and then calibrated separately. This method leads to very ...

AI Technical Summary

Problems solved by technology

[0005] In order to solve the problems of complicated equipment maintenance or low calibration accuracy existing in the existing strapdown inertial group calibration method, the present invention innovatively discloses a dual-axis indexing mechanism control system, control method and strapdown inertial group self-calibration method , through high-precision real-time angular position acquisition and high-precision PID control algorithm, the angular position and angular rate control of the biaxial indexing mechanism is realized, and the self-calibration of the laser strapdown inertial group with high precision and high reliability is further realized, which effectively solves the above problems

Images