A three-axis inertial stabilized platform system based on a full-angle mode hemispherical resonator gyroscope and a control method thereof

Abstract

The purpose of this invention is to address the technical problems of existing hemispherical resonator gyroscopes, such as their inability to adapt to high-dynamic environments, their inability to achieve full-circumferential high-precision measurement, and their insufficient anti-interference capabilities. This invention provides a three-axis inertial stabilization platform system and its control method based on a full-angle mode hemispherical resonator gyroscope. The system adopts a three-axis, two-frame structure. The method uses a Y-axis stabilization control loop and an XZ dual-axis stabilization control loop to achieve three-axis stabilization control of the inertial stabilization platform. The stabilization control loop employs a dual-loop control method of "rate inner loop + position outer loop." The angle change information sensed by the corresponding hemispherical resonator gyroscope is calculated by a correction network to generate a drive signal, which drives the corresponding torque motor to produce an electromagnetic torque that cancels out interference torque. This method can isolate disturbances caused by carrier motion. Based on the above stabilization control loop, a hybrid mode six-position calibration method is invented. This method stabilizes the gyroscope at the optimal standing wave angle position during stable acquisition, thereby maximizing the gyroscope's measurement accuracy.

Description

Technical Field

[0001] This invention relates to a three-axis inertial stabilization platform system, specifically to a three-axis inertial stabilization platform system based on a full-angle mode hemispherical resonator gyroscope and its control method. Background Technology

[0002] An inertial navigation system is an autonomous navigation system that does not rely on external information. According to its structure, it can be divided into two main categories: platform-type and strapdown-type. Platform-type inertial navigation systems isolate the carrier's angular motion through a physically stable platform, which can effectively reduce the influence of gyroscope scaling factor errors, installation errors, etc., and theoretically have higher navigation accuracy. The gyroscope is the core component of platform-type inertial navigation systems.

[0003] Hemispherical resonant gyroscopes (HRGs) possess advantages such as simple structure, long service life, and high reliability, and have become one of the important development directions in the field of high-precision inertial sensors. However, the two typical operating modes of hemispherical resonant gyroscopes each have significant technical drawbacks: 1) In force balance mode (FTR), the hemispherical resonator gyroscope works as a rate gyroscope. Although it has high accuracy in small angular rate measurement scenarios, its dynamic range is narrow (usually no more than ±3° / s) and its bandwidth is low (generally less than 10Hz), making it difficult to adapt to the needs of high dynamic environments.

[0004] 2) In full-angle mode (WA), the hemispherical resonator gyroscope works as an integrating gyroscope. Although it theoretically has the advantages of infinite dynamic range and high bandwidth, it is prone to circumferential drift error due to the uneven damping caused by the limitations of the resonator manufacturing process. This makes the measurement accuracy of the hemispherical resonator gyroscope inconsistent at different standing wave angle positions, and it cannot achieve high-precision measurement in the full circumference.

[0005] While there are existing studies on applying hemispherical resonator gyroscopes to inertial platforms, most focus on force balance mode. Although such schemes extend the measurement range to some extent, they are limited by the inherent narrow bandwidth of this mode, resulting in slow response speed and insufficient anti-interference capability. Other studies involving full-angle mode have also failed to effectively solve the fundamental problem of inconsistent circumferential accuracy. Summary of the Invention

[0006] The purpose of this invention is to solve the technical problems of existing technologies that apply hemispherical resonant gyroscopes to inertial platforms, which are difficult to adapt to high dynamic environments, cannot achieve full-circumferential high-precision measurement, and have insufficient anti-interference capabilities. Instead, this invention provides a three-axis inertial stabilization platform system and its control method based on a full-angle mode hemispherical resonant gyroscope.

[0007] To achieve the above objectives, the technical solution provided by the present invention is as follows: A three-axis inertial stabilization platform system based on a full-angle mode hemispherical resonator gyroscope includes a load-bearing module, a measurement module, a drive and sensing module, and a circuit module integrated on the load-bearing module. Its unique feature is that: The load-bearing module adopts a three-axis, two-frame structure, including a base, an outer frame, an inner frame, a platform, an outer frame axis Z, an inner frame axis X, and a platform axis Y. The outer frame is rotatably connected to the base via the outer frame axis Z, the inner frame is rotatably connected to the outer frame via the inner frame axis X and nested inside the outer frame, and the platform is rotatably connected to the inner frame via the platform axis Y and nested inside the inner frame. The measurement module includes three full-angle mode hemispherical resonant gyroscopes and three quartz accelerometers fixedly mounted on the platform along the three axes; used to measure the angular velocity and acceleration signals generated by the motion of the carrier. The drive and sensing module includes three torque motors and three encoders. The three torque motors are respectively installed at the outer frame axis Z, inner frame axis X and platform axis Y to provide electromagnetic torque to maintain the frame rotation of the three-axis two-frame structure platform. The three encoders are respectively corresponding to and coaxially arranged with the three torque motors to collect the rotation angles of the outer frame axis Z, inner frame axis X and platform axis Y. The circuit module is used to acquire signals from the gyroscope, accelerometer, and encoder sensor, and control the torque motor to achieve calibration, leveling, locking, and stabilization control of the inertial stabilization platform.

[0008] Furthermore, the circuit module includes a gyroscope demodulation circuit, an analog-to-digital conversion circuit, an information processing circuit, and a motor drive circuit; The gyroscope demodulation circuit is used to convert the physical signal of the standing wave angle detected by the hemispherical resonant gyroscope into a digital signal and output it. The analog-to-digital conversion circuit is used to convert the physical quantity of acceleration detected by the quartz accelerometer into a digital signal and output it. The information processing circuit is used to process the information collected by the hemispherical resonant gyroscope, accelerometer and encoder to perform calibration, leveling and locking of the inertial stabilization platform and stabilize the control process; and the information processing circuit integrates a stabilization decomposer on the information processing path. The motor drive circuit is used to drive the torque motor to rotate the outer frame axis Z, the inner frame axis X, and the platform axis Y, thereby stabilizing, leveling, and locking the inertial stabilization platform.

[0009] Meanwhile, this invention also provides a control method for a three-axis inertial stabilization platform system based on a full-angle mode hemispherical resonator gyroscope as described above; its special feature is that it includes the following steps: Step 1, Six-position calibration of the blending mode: After the outer frame, inner frame, and platform are rotated to the designated position by locking control, the horizontal axis is leveled and the axial axis is locked. Then, a precession command is sent to the hemispherical resonant gyroscope to drive its internal standing wave angle to rotate to the preset optimal accuracy position. After that, the three-axis inertial stabilization platform system enters the three-axis stabilization control mode to collect data and rotates in a six-position sequence according to a preset plan. After all six positions have been rotated, the zero position of the hemispherical resonant gyroscope and the scaling factor and zero position of the quartz accelerometer are calculated. Step 2, the operating mode of the full-angle mode hemispherical resonator gyroscope: In the three-axis stabilization platform, the control mode includes a Y-axis stabilization control loop and an XZ dual-axis stabilization control loop. The Y-axis stabilization control loop adopts a dual-loop control method of "rate inner loop + position outer loop". By using the angle change information sensed by the hemispherical resonator gyroscope corresponding to the Y-axis of the platform, the stabilization control loop generates a drive signal for the torque motor, which drives the torque motor corresponding to the Y-axis of the platform to generate an electromagnetic torque to cancel out the interference torque. The XZ dual-axis stabilization control loop, based on the Y-axis stabilization control loop, according to the current actual attitude of the platform, decouples the angle change information sensed by the hemispherical resonator gyroscopes corresponding to the outer frame axis Z and the inner frame axis X through a stabilization decomposer, and then generates a drive signal for the torque motor through the stabilization control loop, which drives the torque motors corresponding to the outer frame axis Z and the inner frame axis X to generate an electromagnetic torque to cancel out the interference torque.

[0010] Furthermore, the Y-axis stabilization control loop in step 2 is specifically as follows: The target standing wave angle Y corresponding to the Y-axis of the platform is used as the reference input signal of the Y-axis stabilization control loop, and the actually detected standing wave angle is used as the position loop feedback signal of the Y-axis stabilization control loop. The target standing wave angle and the actually detected standing wave angle are calculated by the position loop correction network to output the position loop control quantity. The angular rate signal obtained by differentiating the actually detected standing wave angle is used as the rate loop feedback signal of the Y-axis stabilization control loop. The position loop control quantity and the angular rate signal are dynamically corrected by the rate loop correction network, and the output rate loop control quantity is used as the drive signal of the torque motor. The torque motor converts the electrical signal into an electromagnetic torque that can cancel the interference torque according to the received drive signal. The electromagnetic torque is balanced with the external interference torque, so that the Y-axis of the platform remains stable.

[0011] Furthermore, the XZ dual-axis stabilization control loop in step 2 is specifically as follows: The target standing wave angles Z and X corresponding to the outer frame axis Z and inner frame axis X are respectively used as two sets of reference input signals of the XZ dual-axis stabilization control loop. The two sets of standing wave angles actually detected by the hemispherical resonator corresponding to the outer frame axis Z and inner frame axis X are coupled, solved and coordinated by the stabilization decomposer, and output two sets of standing wave angle feedback quantities corresponding to the outer frame axis Z and inner frame axis X, respectively, and both are used as the position loop feedback signals of the XZ dual-axis stabilization control loop. The standing wave angle feedback quantity and the target standing wave angle Z corresponding to the outer frame axis Z are calculated by the position loop correction network to output the Z position loop control quantity; the Z angular rate signal obtained by differentiating the standing wave angle of the corresponding outer frame axis Z is used as the rate loop feedback signal of the corresponding outer frame axis Z; the Z position loop control quantity and the Z angular rate signal are dynamically corrected by the rate loop correction network to output the Z rate loop control quantity as the drive signal of the torque motor of the corresponding outer frame axis Z; The standing wave angle feedback quantity corresponding to the inner frame axis X and the target standing wave angle X are filtered and amplified by the position loop correction network to correct the deviation, and the X position loop control quantity is output. The X angular rate signal obtained by differentiating the standing wave angle of the corresponding inner frame axis X is used as the rate loop feedback signal of the corresponding inner frame axis X. After the X position loop control quantity and the X angular rate signal are dynamically corrected by the rate loop correction network, the X rate loop control quantity is output as the drive signal of the torque motor of the corresponding inner frame axis X. The two torque motors corresponding to the outer frame axis Z and the inner frame axis X respectively convert the electrical signals into electromagnetic torques that can cancel out the interference torques according to the received drive signals. The electromagnetic torques are balanced with the external interference torques, so that both the outer frame and the inner frame remain stable.

[0012] Furthermore, the specific control method for locking in step 1 is as follows: Using the target locking angle corresponding to each axis as a reference input, the target locking angle and the actual current angle detected by the corresponding encoder are calculated by the locking correction network, and the locking control quantity corresponding to each axis is output. The locking control quantity is received by the hemispherical resonator gyroscope corresponding to each axis, and combined with its own sensitive angle change information, the standing wave angle signal corresponding to each axis is output as the input signal of the stabilization control loop, and input into the Y-axis stabilization control loop or XZ dual-axis stabilization control loop corresponding to each axis. After the corresponding stabilization control loop outputs the drive signal of the torque motor corresponding to each axis, the corresponding platform, inner frame or outer frame is controlled to rotate, so that the frame rotates to the preset angle.

[0013] Furthermore, the control loop for leveling control in step 1 is specifically as follows: Using the zero point of the quartz accelerometer corresponding to each horizontal axis as a reference input, the zero point of the quartz accelerometer and the actual acceleration signal detected by the quartz accelerometer corresponding to each horizontal axis are calculated by the leveling correction network to output the leveling control quantity of each horizontal axis. The leveling control quantity is received by the hemispherical resonator gyroscope corresponding to each horizontal axis, and combined with its own sensitive angle change information, the standing wave angle signal corresponding to each horizontal axis is output as the input signal of the stabilization loop, and input into the Y-axis stabilization control loop or XZ dual-axis stabilization control loop corresponding to each horizontal axis. After passing through the corresponding Y-axis stabilization control loop or XZ dual-axis stabilization control loop, the drive signal of the torque motor corresponding to each horizontal axis is output, thereby controlling the corresponding platform, inner frame or outer frame to perform attitude correction, thereby realizing the leveling control of the two horizontal axes.

[0014] Compared with the prior art, the present invention has the following advantages: (1) The present invention provides a three-axis inertial stabilization platform system based on a full-angle mode hemispherical resonant gyroscope. By combining the full-angle mode hemispherical resonant gyroscope with the inertial platform, the advantages of the large dynamic range and high bandwidth of the full-angle mode can be fully utilized. The system adopts a three-axis two-frame structure. The circuit module processes the angular velocity and acceleration signals generated by the carrier motion measured by the hemispherical resonant gyroscope and the quartz accelerometer and outputs control commands to control the torque motor to drive the corresponding outer frame, inner frame or platform to rotate. This achieves the position calibration of the inertial stabilization platform, the initial attitude leveling of the platform and each frame, the position locking of the platform and each frame, and the three-axis independent stabilization control to isolate external disturbances. This makes the three-axis inertial stabilization platform system highly adaptable to high dynamic environments and can achieve high-precision measurement in the full circumference. (2) The present invention provides a control method for a three-axis inertial stabilization platform system based on a full-angle mode hemispherical resonant gyroscope. Through the six-position calibration of the hybrid mode, the circumferential drift of the hemispherical resonant gyroscope during the calibration process can be effectively eliminated, thereby improving its calibration accuracy. The three-axis stabilization control mode stabilizes the hemispherical resonant gyroscope at the optimal standing wave angle position to eliminate the circumferential drift error, thereby maximizing the measurement accuracy of the hemispherical resonant gyroscope. Furthermore, the three-axis stabilization control mode enables the three-axis inertial stabilization platform system to isolate external disturbances, keeping the hemispherical resonant gyroscope stable at the optimal standing wave angle, thus providing a good operating environment for the hemispherical resonant gyroscope. (3) The present invention provides a control method for a three-axis inertial stabilization platform system based on a full-angle mode hemispherical resonator gyroscope. The method uses a stabilization decomposer to solve the inter-axis coupling problem. When there is an external disturbance, the hemispherical resonator gyroscopes corresponding to the outer frame axis Z, inner frame axis X, and platform axis Y will be sensitive to their own angle change information. The stabilization decomposer transforms and distributes these angle change information, decouples these angle change information, and then feeds it back to the position loop correction network and the rate loop correction network. This ensures that the three axes can remain in a stable state under any platform position, and realizes independent stabilization control of the three axes. Attached Figure Description

[0015] Figure 1 This is a schematic diagram of the frame structure of an embodiment of a three-axis inertial stabilization platform system based on a full-angle mode hemispherical resonant gyroscope according to the present invention; Figure 2 This is a control loop structure diagram for locking control in an embodiment of the present invention; Figure 3 This is a control loop structure diagram of the leveling control in an embodiment of the present invention; Figure 4 This is a structural diagram of the Y-axis stabilization control loop in an embodiment of the present invention; Figure 5 This is a structural diagram of the XZ dual-axis stabilization control loop in an embodiment of the present invention. Detailed Implementation

[0016] To make the objectives, technical solutions, and advantages of the present invention clearer, the present invention will be further described in detail below with reference to the accompanying drawings and specific embodiments.

[0017] As attached Figure 1 As shown, this embodiment provides a three-axis inertial stabilization platform system based on a full-angle mode hemispherical resonator gyroscope, including a carrier module, a measurement module, a drive and sensing module, and a circuit module integrated on the carrier module. The carrier module adopts a three-axis, two-frame structure, including a base, an outer frame, an inner frame, a platform, an outer frame axis Z, an inner frame axis X, and a platform axis Y. The outer frame is rotatably connected to the base via the outer frame axis Z, the inner frame is rotatably connected to the outer frame via the inner frame axis X and nested inside the outer frame, and the platform is rotatably connected to the inner frame via the platform axis Y and nested inside the inner frame. The measurement module includes three full-angle mode hemispherical resonator gyroscopes and three quartz accelerometers fixedly mounted on the platform along the three axes, respectively, for measuring the angular velocity and acceleration signals generated by the carrier motion.

[0018] The drive and sensing module includes three torque motors and three encoders. The three torque motors are respectively installed at the outer frame axis Z, inner frame axis X and platform axis Y to provide compensation torque to maintain the attitude stability of the three-axis two-frame structure platform. The three encoders are respectively corresponding to and coaxially arranged with the three torque motors to collect the relative rotation angles of the outer frame axis Z, inner frame axis X and platform axis Y. The circuit module includes a gyroscope demodulation circuit, an analog-to-digital conversion circuit, an information processing circuit, and a motor drive circuit, which are used to control the torque motor to achieve position calibration of the inertial stabilization platform, initial attitude leveling of the platform and each frame, position locking of the platform and each frame, and three-axis independent stabilization control to isolate external disturbances.

[0019] In this embodiment, the gyroscope demodulation circuit is used to convert the physical signal of the standing wave angle detected by the hemispherical resonant gyroscope into a digital signal and output it. The analog-to-digital conversion circuit is used to convert the physical quantity of acceleration detected by the quartz accelerometer into a digital signal and output it. The information processing circuit is used to collect information from the hemispherical resonant gyroscope, accelerometer and encoder, realize the correction network of the stabilization, leveling and locking control loop, and complete the six-position calibration control process, etc. The motor drive circuit is used to drive the torque motor to rotate the outer frame axis Z, the inner frame axis X, and the platform axis Y, and to perform stabilization, leveling, and locking control on the inertial stabilization platform.

[0020] Based on the aforementioned three-axis inertial stabilization platform system based on a full-angle mode hemispherical resonator gyroscope, this embodiment also provides a control method for the three-axis inertial stabilization platform system based on a full-angle mode hemispherical resonator gyroscope, comprising the following steps: Step 1, Six-position calibration of the blending mode: After the outer frame, inner frame, and platform are rotated to the designated position by locking control, the horizontal axis is leveled, the axial axis is locked, and a precession command is sent to the hemispherical resonant gyroscope to drive its internal standing wave angle to rotate to the preset optimal accuracy position. Then, the three-axis inertial stabilization platform system enters the three-axis stabilization control mode to collect data and rotates in a pre-set six-position sequence. After all six positions have been rotated, the zero position of the hemispherical resonant gyroscope and the scaling factor and zero position of the quartz accelerometer are calculated.

[0021] The control method for locking is shown in the appendix. Figure 2 As shown, specifically: Using the target locking angle corresponding to each axis as a reference input, the target locking angle and the actual current angle detected by the corresponding encoder are calculated by the locking correction network, and the locking control quantity corresponding to each axis is output. The locking control quantity is received by the hemispherical resonator gyroscope corresponding to each axis, and combined with its own sensitive angle change information, the standing wave angle signal corresponding to each axis is output as the input signal of the stabilization control loop, and input into the Y-axis stabilization control loop or XZ dual-axis stabilization control loop corresponding to each axis. After the corresponding stabilization control loop outputs the drive signal of the torque motor corresponding to each axis, the corresponding platform, inner frame or outer frame is controlled to rotate, so that the frame rotates to the preset angle.

[0022] The control loop for leveling control is shown in the attached figure. Figure 3 As shown, specifically: Using the zero point of the quartz accelerometer corresponding to each horizontal axis as a reference input, the zero point of the quartz accelerometer and the actual acceleration signal detected by the quartz accelerometer corresponding to each horizontal axis are calculated by the leveling correction network to output the leveling control quantity of each horizontal axis. The leveling control quantity is received by the hemispherical resonator gyroscope corresponding to each horizontal axis, and combined with its own sensitive angle change information, the standing wave angle signal corresponding to each horizontal axis is output as the input signal of the stabilization loop, and input into the Y-axis stabilization control loop or XZ dual-axis stabilization control loop corresponding to each horizontal axis. After passing through the corresponding Y-axis stabilization control loop or XZ dual-axis stabilization control loop, the drive signal of the torque motor corresponding to each horizontal axis is output, thereby controlling the corresponding platform, inner frame or outer frame to perform attitude correction, thereby realizing the leveling control of the two horizontal axes.

[0023] Step 2, the operating mode of the full-angle mode hemispherical resonator gyroscope: The three-axis inertial stabilization platform, in its three-axis stabilization control mode, includes a Y-axis stabilization control loop and an XZ dual-axis stabilization control loop. The Y-axis stabilization control loop employs a dual-loop control method of "rate inner loop + position outer loop." It uses the angle change information sensed by the hemispherical resonator gyroscope corresponding to the platform axis Y to generate a drive signal for a torque motor. This drive motor generates an electromagnetic torque to counteract interference torque. When the electromagnetic torque balances with the external interference torque, the platform axis remains stable. The XZ dual-axis stabilization control loop, based on the Y-axis stabilization control loop, decouples the angle change information sensed by the hemispherical resonator gyroscopes corresponding to the outer frame axis Z and inner frame axis X through a stabilization decomposer, and then generates a drive signal for a torque motor. This drive motor generates an electromagnetic torque to counteract interference torque. When the electromagnetic torque balances with the external interference torque, the outer and inner frames remain stable.

[0024] As attached Figure 4 As shown, the Y-axis stabilization control loop is as follows: The target standing wave angle Y corresponding to the Y-axis of the platform is used as the reference input signal of the Y-axis stabilization control loop, and the actually detected standing wave angle is used as the position loop feedback signal of the Y-axis stabilization control loop. The target standing wave angle and the actually detected standing wave angle are calculated by the position loop correction network to output the position loop control quantity. The angular rate signal obtained by differentiating the actually detected standing wave angle is used as the rate loop feedback signal of the Y-axis stabilization control loop. The position loop control quantity and the angular rate signal are dynamically corrected by the rate loop correction network, and the output rate loop control quantity is used as the drive signal of the torque motor. The torque motor converts the electrical signal into an electromagnetic torque that can cancel the interference torque according to the received drive signal. The electromagnetic torque is balanced with the external interference torque, so that the platform axis remains stable.

[0025] As attached Figure 5 As shown, the XZ dual-axis stabilization control loop is as follows: The target standing wave angles Z and X corresponding to the outer frame axis Z and inner frame axis X are respectively used as two sets of reference input signals of the XZ dual-axis stabilization control loop. The two sets of standing wave angles actually detected by the hemispherical resonator corresponding to the outer frame axis Z and inner frame axis X are coupled, solved and coordinated by the stabilization decomposer, and output two sets of standing wave angle feedback quantities corresponding to the outer frame axis Z and inner frame axis X, respectively, and both are used as the position loop feedback signals of the XZ dual-axis stabilization control loop. The standing wave angle feedback quantity and the target standing wave angle Z corresponding to the outer frame axis Z are calculated by the position loop correction network to output the Z position loop control quantity; the Z angular rate signal obtained by differentiating the standing wave angle of the corresponding outer frame axis Z is used as the rate loop feedback signal of the corresponding outer frame axis Z; the Z position loop control quantity and the Z angular rate signal are dynamically corrected by the rate loop correction network to output the Z rate loop control quantity as the drive signal of the torque motor of the corresponding outer frame axis Z; The standing wave angle feedback quantity corresponding to the inner frame axis X and the target standing wave angle X are filtered and amplified by the position loop correction network to correct the deviation, and the X position loop control quantity is output. The X angular rate signal obtained by differentiating the standing wave angle of the corresponding inner frame axis X is used as the rate loop feedback signal of the corresponding inner frame axis X. After the X position loop control quantity and the X angular rate signal are dynamically corrected by the rate loop correction network, the X rate loop control quantity is output as the drive signal of the torque motor of the corresponding inner frame axis X. The two torque motors corresponding to the outer frame axis Z and the inner frame axis X respectively convert the electrical signals into electromagnetic torques that can cancel out the interference torques according to the received drive signals. The electromagnetic torques are balanced with the external interference torques, so that both the outer frame and the inner frame remain stable.

[0026] Simulation tests conducted on this embodiment show that the three-axis stabilization control mode of this embodiment can enable the system to reach a stable state within 0.2s with zero steady-state error.

[0027] The above are merely embodiments of the present invention and are not intended to limit the invention. Various modifications and variations can be made to the invention by those skilled in the art. Any modifications, equivalent substitutions, or improvements made within the scope of the technical solution of the present invention should be included within the protection scope of the present invention. Furthermore, it should be noted that the accompanying drawings are merely illustrative and are not drawn to scale, and should not be construed as limiting the actual scope of protection claimed by the present invention.

Claims

1. A control method for a three-axis inertial stabilization platform system based on a full-angle mode hemispherical resonator gyroscope; characterized in that, Includes the following steps: Step 1, Six-position calibration of the blending mode: After the outer frame, inner frame, and platform are rotated to the designated position by locking control, the horizontal axis is leveled and the axial axis is locked. Then, a precession command is sent to the hemispherical resonant gyroscope to drive its internal standing wave angle to rotate to the preset optimal accuracy position. After that, the three-axis inertial stabilization platform system enters the three-axis stabilization control mode to collect data and rotates in a six-position sequence according to a preset plan. After all six positions have been rotated, the zero position of the hemispherical resonant gyroscope and the scaling factor and zero position of the quartz accelerometer are calculated. Step 2, the operating mode of the full-angle mode hemispherical resonator gyroscope: In the three-axis stabilization platform, the control mode includes a Y-axis stabilization control loop and an XZ dual-axis stabilization control loop. The Y-axis stabilization control loop adopts a dual-loop control method of "rate inner loop + position outer loop". By using the angle change information sensed by the hemispherical resonator gyroscope corresponding to the Y-axis of the platform, the stabilization control loop generates a drive signal for the torque motor, which drives the torque motor corresponding to the Y-axis of the platform to generate an electromagnetic torque to cancel out the interference torque. The XZ dual-axis stabilization control loop, based on the Y-axis stabilization control loop, according to the actual attitude of the platform, decouples the angle change information sensed by the hemispherical resonator gyroscopes corresponding to the outer frame axis Z and the inner frame axis X through a stabilization decomposer, and then generates a drive signal for the torque motor through the stabilization control loop, which drives the torque motors corresponding to the outer frame axis Z and the inner frame axis X to generate an electromagnetic torque to cancel out the interference torque. The Y-axis stabilization control loop is specifically as follows: The target standing wave angle Y corresponding to the Y-axis of the platform is used as the reference input signal of the Y-axis stabilization control loop, and the actual detected standing wave angle is used as the position loop feedback signal of the Y-axis stabilization control loop. The target standing wave angle and the actual detected standing wave angle are calculated by the position loop correction network to output the position loop control quantity. The angular rate signal obtained by differentiating the actual detected standing wave angle is used as the rate loop feedback signal of the Y-axis stabilization control loop. The position loop control quantity and the angular rate signal are dynamically corrected by the rate loop correction network, and the output rate loop control quantity is used as the drive signal of the torque motor. The torque motor converts the received drive signal into an electromagnetic torque that can counteract the interference torque. The electromagnetic torque is balanced with the external interference torque, so that the Y-axis of the platform remains stable. The XZ dual-axis stabilization control loop is specifically as follows: The target standing wave angles Z and X corresponding to the outer frame axis Z and inner frame axis X are respectively used as two sets of reference input signals of the XZ dual-axis stabilization control loop. The two sets of standing wave angles actually detected by the hemispherical resonator corresponding to the outer frame axis Z and inner frame axis X are coupled, solved and coordinated by the stabilization decomposer, and output two sets of standing wave angle feedback quantities corresponding to the outer frame axis Z and inner frame axis X, respectively, and both are used as the position loop feedback signals of the XZ dual-axis stabilization control loop. The standing wave angle feedback quantity and the target standing wave angle Z corresponding to the outer frame axis Z are calculated by the position loop correction network to output the Z position loop control quantity; the Z angular rate signal obtained by differentiating the standing wave angle of the corresponding outer frame axis Z is used as the rate loop feedback signal of the corresponding outer frame axis Z; the Z position loop control quantity and the Z angular rate signal are dynamically corrected by the rate loop correction network to output the Z rate loop control quantity as the drive signal of the torque motor of the corresponding outer frame axis Z; The standing wave angle feedback quantity corresponding to the inner frame axis X and the target standing wave angle X are filtered and amplified by the position loop correction network to correct the deviation, and the X position loop control quantity is output. The X angular rate signal obtained by differentiating the standing wave angle of the corresponding inner frame axis X is used as the rate loop feedback signal of the corresponding inner frame axis X. After the X position loop control quantity and the X angular rate signal are dynamically corrected by the rate loop correction network, the X rate loop control quantity is output as the drive signal of the torque motor of the corresponding inner frame axis X. The two torque motors corresponding to the outer frame axis Z and the inner frame axis X respectively convert the electrical signals into electromagnetic torques that can cancel out the interference torques according to the received drive signals. The electromagnetic torques are balanced with the external interference torques, so that both the outer frame and the inner frame remain stable.

2. The control method for a three-axis inertial stabilization platform system based on a full-angle mode hemispherical resonator gyroscope according to claim 1, characterized in that, The specific control method for locking in step 1 is as follows: Using the target locking angle corresponding to each axis as a reference input, the target locking angle and the actual current angle detected by the corresponding encoder are calculated by the locking correction network, and the locking control quantity corresponding to each axis is output. The locking control quantity is received by the hemispherical resonator gyroscope corresponding to each axis, and combined with its own sensitive angle change information, the standing wave angle signal corresponding to each axis is output as the input signal of the stabilization control loop, and input into the Y-axis stabilization control loop or XZ dual-axis stabilization control loop corresponding to each axis. After the corresponding stabilization control loop outputs the drive signal of the torque motor corresponding to each axis, the corresponding platform, inner frame or outer frame is controlled to rotate, so that the frame rotates to the preset angle.

3. The control method for a three-axis inertial stabilization platform system based on a full-angle mode hemispherical resonator gyroscope according to claim 1, characterized in that, The control loop for leveling control in step 1 is as follows: Using the zero point of the quartz accelerometer corresponding to each horizontal axis as a reference input, the zero point of the quartz accelerometer and the actual acceleration signal detected by the quartz accelerometer corresponding to each horizontal axis are calculated by the leveling correction network to output the leveling control quantity of each horizontal axis. The leveling control quantity is received by the hemispherical resonator gyroscope corresponding to each horizontal axis, and combined with its own sensitive angle change information, the standing wave angle signal corresponding to each horizontal axis is output as the input signal of the stabilization loop, and input into the Y-axis stabilization control loop or XZ dual-axis stabilization control loop corresponding to each horizontal axis. After passing through the corresponding Y-axis stabilization control loop or XZ dual-axis stabilization control loop, the drive signal of the torque motor corresponding to each horizontal axis is output, thereby controlling the corresponding platform, inner frame or outer frame to perform attitude correction, thereby realizing the leveling control of the two horizontal axes.

4. The control method for a three-axis inertial stabilization platform system based on a full-angle mode hemispherical resonator gyroscope according to claim 1, characterized in that: The reference input signal is the standing wave angle corresponding to the optimal measurement accuracy achieved by using a hemispherical resonant gyroscope.

5. A three-axis inertial stabilization platform system based on a full-angle mode hemispherical resonator gyroscope, used to implement the control method of the three-axis inertial stabilization platform system based on a full-angle mode hemispherical resonator gyroscope as described in any one of claims 1-4, comprising a support module, a measurement module, a drive and sensing module, and a circuit module integrated on the support module, characterized in that: The load-bearing module adopts a three-axis, two-frame structure, including a base, an outer frame, an inner frame, a platform, an outer frame axis Z, an inner frame axis X, and a platform axis Y. The outer frame is rotatably connected to the base via the outer frame axis Z, the inner frame is rotatably connected to the outer frame via the inner frame axis X and nested inside the outer frame, and the platform is rotatably connected to the inner frame via the platform axis Y and nested inside the inner frame. The measurement module includes three full-angle mode hemispherical resonant gyroscopes and three quartz accelerometers fixedly mounted on the platform along the three axes; used to measure the angular velocity and acceleration signals generated by the motion of the carrier. The drive and sensing module includes three torque motors and three encoders; Three torque motors are respectively installed at the outer frame axis Z, inner frame axis X, and platform axis Y to provide compensation torque to maintain the attitude stability of the three-axis two-frame structure platform; three encoders are respectively corresponding to and coaxially arranged with the three torque motors to collect the relative rotation angles of the outer frame axis Z, inner frame axis X, and platform axis Y. The circuit module is used to acquire signals from the gyroscope, accelerometer, and encoder sensor, and control the torque motor to achieve calibration, leveling, locking, and stabilization control of the inertial stabilization platform.

6. A three-axis inertial stabilization platform system based on a full-angle mode hemispherical resonator gyroscope according to claim 5, characterized in that: The circuit module includes a gyroscope demodulation circuit, an analog-to-digital conversion circuit, an information processing circuit, and a motor drive circuit; The gyroscope demodulation circuit is used to convert the physical signal of the standing wave angle detected by the hemispherical resonant gyroscope into a digital signal and output it. The analog-to-digital conversion circuit is used to convert the physical quantity of acceleration detected by the quartz accelerometer into a digital signal and output it. The information processing circuit is used to process the information collected by the hemispherical resonant gyroscope, accelerometer and encoder to perform calibration, leveling and locking of the inertial stabilization platform and stabilize the control process; and the information processing circuit integrates a stabilization decomposer on the information processing path. The motor drive circuit is used to drive the torque motor to rotate the outer frame axis Z, the inner frame axis X, and the platform axis Y, thereby stabilizing, leveling, and locking the inertial stabilization platform.

Images