A multi-closed-loop composite gyro stabilization control method

Abstract

The invention discloses a multi-closed-loop compound gyroscope stabilization control method, including a double-closed-loop control method. The double-closed-loop control method adds a space stabilization loop for suppressing gyroscope drift, and uses a drift correction algorithm to realize drift compensation. The steps of the deviation correction compensation method include: obtaining Raw data—Using the attitude fusion module to obtain the three-dimensional attitude information of the carrier—Through the coordinate transformation between the inertial coordinate system and the carrier coordinate system—The cumulative calculation and compensation of position drift errors—Repeating the aforementioned steps; the present invention is based on the traditional double closed-loop control strategy. Increase the gyro drift suppression loop, effectively suppress the static drift, improve the static stability accuracy and anti-interference ability of the system, and effectively solve the problems of low static stability accuracy and anti-interference ability of the system that often use double-loop control or simple multi-closed-loop control in the existing technology bad question.

Description

technical field [0001] The invention relates to a multi-closed-loop composite gyro stabilization control method, which belongs to the technical field of gyro stabilization platforms. Background technique [0002] Gyro-stabilized platforms are widely used in power grids, firefighting, and emergency rescue because they can isolate carrier (aircraft, tanks, and ships) disturbances, continuously measure changes in platform attitude and position, accurately maintain dynamic attitude references, and maintain a stable state relative to inertial space. , Disaster relief and other emergency monitoring fields. However, after the gyro-stabilized platform is affected by disturbances including carrier attitude changes and motor vibrations during the carrier movement, it is easy to cause the load's boresight to vibrate or even deviate from the established target, which seriously affects the imaging quality of the task load. Therefore, low-precision stabilization The platform can no longe...

AI Technical Summary

Problems solved by technology

[0007] (1) The existing technology adopts the control method of single or double speed loop combined with the stability loop, which cannot compensate the inertial space offset of the platform caused by the random drift characteristic of the gyro, the system stability accuracy is not high, and the anti-interference ability is poor;

[0008] (2) The existing technology does not consider the suppression of the random drift of the gyro, which makes the static stability accuracy of the system low;

[0009] (3) The existing technology mostly adopts the relevant mathematical model of the gyroscope, and uses filtering technology to compensate the error of the output signal. This method needs to establish a complex mathematical model and has a large amount of calculation, and the filtered gyroscope data has a large delay This leads to poor real-time performance of the control system, which reduces the stability accuracy and fails to compensate and correct the random drift error from the root cause; there are also technologies that use the POS data of the inertial navigation module for drift suppression, but because the inertial navigation module is expensive and GPS The data will be wasted, making the equipment cost higher, and the present invention uses relatively cheap sensors for attitude data fusion to suppress gyro drift

Images