A method and device for suppressing frequency interference of multi-frequency digital control system of inertial platform

By analyzing and coordinating the characteristic frequencies in the leveling circuit and the stable circuit of the inertial platform, the frequency interference problem in the multi-frequency digital control system is solved, the accuracy and stability of the system are improved, and the coordination of multiple loops is achieved Work.

CN115598962BActive Publication Date: 2024-11-08BEIJING INST OF AEROSPACE CONTROL DEVICES
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202211255863.4
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2022-10-13
Publication Date
2024-11-08
Estimated Expiration
2042-10-13

AI Technical Summary

Technical Problem

In the multi-frequency digital control system of the inertial platform, the unreasonable design of characteristic frequencies of different control loops leads to frequency interference, affecting the stability of the gyroscope's torque current and the overall system accuracy.

Method used

By systematically analyzing the adjustable characteristic frequencies in the leveling circuit and the stable circuit of the inertial platform, the mechanism of frequency interference is clarified, and based on the Nyquist sampling theorem and modulation instability theory, reasonable frequency ranges and intervals are designed to coordinate and tune The frequency in the flat loop and stabilize the loop, suppress frequency interference, and ensure that multiple loops work in a coordinated manner.

Benefits of technology

It effectively suppresses frequency interference in multi-frequency digital control system, improves the overall performance and usage accuracy of the control system, and ensures the coordinated work and mutual non-interference between each control loop.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN115598962B_ABST
    Figure CN115598962B_ABST
Patent Text Reader

Abstract

The present invention provides a method and device for suppressing frequency interference of a multi-frequency digital control system of an inertial platform, comprising: systematically analyzing a leveling loop of an inertial platform, taking a temperature control PWM frequency in a temperature control loop and a torque motor PWM frequency in a stabilization loop as adjustable characteristic frequencies, analyzing a generation mechanism of interference of a gyroscope torque current in the leveling loop of the inertial platform, clarifying whether the adjustable characteristic frequency interferes with the gyroscope torque current of the inertial platform; when there is an adjustable characteristic frequency that interferes with the gyroscope torque current in the leveling loop, coordinating and designing the adjustable characteristic frequency, suppressing frequency interference, and stabilizing the gyroscope torque current in the leveling loop.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention belongs to the technical field of frequency interference identification and interference suppression, and in particular relates to a frequency interference suppression method for an inertial platform multi-frequency digital control system. Background Art

[0002] The inertial platform is a stable platform system that measures the carrier's attitude information and apparent acceleration. It contains key components such as gyroscopes, quartz accelerometers, angle sensors, torque motors, and multiple digital control loops such as leveling loops, stabilization loops, and temperature control loops.

[0003] The inertial platform leveling loop controls the two horizontal axes of the platform to align with the local horizontal plane. The basic principle is that when the platform axis deviates from the geographic horizontal by an angle, it is sensed by the corresponding quartz accelerometer, and the output of the quartz accelerometer reflects this angle. The leveling loop uses a certain low-pass filtering algorithm to filter out the output noise of the quartz accelerometer, and then the correction network controls the torque circuit to add torque to the corresponding gyroscope, and then the stabilization loop controls the platform to rotate around the corresponding axis to the specified position.

[0004] The inertial platform stabilization loop controls the platform body to isolate the angular motion and maintain it in the inertial space. The basic principle is that when the platform is disturbed and deflected, the gyroscope senses the angular velocity signal and produces a rotation angle around its output axis. The angle sensor is sensitive to the angle information and outputs the information to the subsequent circuit part. After a series of signal processing, a control signal is generated. The control signal drives the torque motor on the platform's deflection axis to rotate in the opposite direction to balance the interference torque, thereby achieving balance.

[0005] The temperature control loop of the inertial platform gyroscope controls the temperature of the gyroscope to maintain at a specified temperature point. Its working principle is that the temperature control loop adopts a temperature measurement bridge, PID digital control, and width-adjustable heating. The temperature signal of the gyroscope is detected by a temperature control bridge composed of precision resistors, and the difference between it and the reference signal is amplified by an operational amplifier and sent to the analog-to-digital converter. The controller collects the digital quantity of the analog-to-digital converter, performs mean filtering, and completes PID digital correction. After the operation is completed, a PWM signal with a certain duty cycle is output to generate a heating current for the heating plate to achieve temperature control of the gyroscope.

[0006] When testing an inertial platform on the ground, it is usually necessary to keep the platform precisely in the geographic system. The key is to ensure that the gyro torque current control quantity generated by the leveling circuit by judging the angle of the platform's horizontal axis deviating from the geographic level can remain stable. The stability of the gyro torque current is the most direct factor in ensuring the accuracy of the inertial platform test. In a complex electromechanical system composed of multiple digital control loops, different control loops often have different characteristic frequencies. If these frequencies are not designed properly, the loops will interfere with each other, resulting in multiple loops not being able to work together normally.

[0007] For a linear time-invariant system, the frequency characteristics will not change. Therefore, spectral analysis can be used to effectively extract the frequency characteristics of the system, analyze the propagation mechanism and transmission path of frequency interference, and design a reasonable frequency range to eliminate frequency interference in the loop to ensure that multiple loops can work normally. Summary of the invention

[0008] In order to overcome the deficiencies in the prior art, the inventors have conducted intensive research and provided a method for suppressing frequency interference of a multi-frequency digital control system of an inertial platform. Aiming at the problem of multi-frequency coupling in a multi-digital control loop environment, based on the Nyquist sampling theorem and modulation instability theory, the working principle and frequency characteristics of the multi-frequency digital control system are effectively analyzed, the generation mechanism of digital control frequency interference is clarified, the frequency range and interval are reasonably designed for each digital control loop, the frequency interference is suppressed, the coordinated operation of multiple loops is ensured, the overall control performance of the control system is improved, and theoretical guidance is provided for the frequency analysis and frequency design methods of multi-frequency digital control systems.

[0009] The technical solution provided by the present invention is as follows:

[0010] In a first aspect, a method for suppressing frequency interference of a multi-frequency digital control system of an inertial platform comprises the following steps:

[0011] Conduct a systematic analysis of the leveling loop of the inertial platform, use the temperature control PWM frequency in the temperature control loop and the torque motor PWM frequency in the stability loop as adjustable characteristic frequencies, analyze the generation mechanism of the gyroscope torque current interference in the leveling loop of the inertial platform, and clarify whether the preset adjustable characteristic frequency interferes with the gyroscope torque current of the inertial platform;

[0012] When the adjustable characteristic frequency interferes with the gyroscope moment current in the leveling loop, the corresponding adjustable characteristic frequency is coordinated and designed to suppress the frequency interference and stabilize the gyroscope moment current in the leveling loop.

[0013] In a second aspect, a frequency interference suppression device for a multi-frequency digital control system of an inertial platform is characterized by comprising the following modules:

[0014] In the first module, the temperature control PWM frequency in the temperature control loop and the torque motor PWM frequency in the stability loop are used as adjustable characteristic frequencies to analyze the generation mechanism of the gyroscope torque current interference in the inertial platform leveling loop, and to clarify whether the preset adjustable characteristic frequency interferes with the inertial platform gyroscope torque current;

[0015] In the second module, when the adjustable characteristic frequency interferes with the gyroscope torque current in the leveling loop, the corresponding adjustable characteristic frequency is coordinated and designed to suppress the frequency interference and stabilize the gyroscope torque current in the leveling loop.

[0016] In a third aspect, a readable storage medium stores a computer program, which, when executed by a processor, implements the method for suppressing frequency interference of a multi-frequency digital control system of an inertial platform as described in the first aspect.

[0017] A method and device for suppressing frequency interference of a multi-frequency digital control system of an inertial platform provided by the present invention has the following beneficial effects:

[0018] (1) According to the sampling theorem, the frequency aliasing characteristics of the system are theoretically analyzed to clarify the mechanism of low-frequency interference generated by the PWM frequency of the torque motor in the stabilization loop and the temperature control PWM frequency in the leveling loop. This solves the problem of unclear multi-frequency coupling mechanism of the current inertial platform multi-frequency digital control system and provides theoretical and technical support for the comprehensive design of multi-frequency digital control systems. At the same time, without changing the existing hardware of the system, the appropriate frequency range is found based on the analysis of the influencing frequency band, and the frequency interference in the control system is suppressed, so that the control system composed of multiple control loops can work in a coordinated manner without interfering with each other.

[0019] (2) Based on the analysis of the frequency interference characteristics of multiple digital control loops, the specific frequencies in the system are rationally designed to suppress the frequency interference in the digital control system, give full play to the control accuracy of each control loop, and thus improve the use accuracy of the entire inertial platform system. BRIEF DESCRIPTION OF THE DRAWINGS

[0020] Figure 1 It is a flow chart of a frequency interference suppression method of an inertial platform multi-frequency digital control system of the present invention;

[0021] Figure 2 It is the relationship schematic diagram of the multi-frequency digital control system;

[0022] Figure 3 It is a schematic diagram of the frequency aliasing process of the original signal at a fixed sampling frequency;

[0023] Figure 4 It is a schematic diagram of modulation instability phenomenon;

[0024] Figure 5It is the principle block diagram of the stabilization loop;

[0025] Figure 6 This is the block diagram of the gyroscope temperature control principle;

[0026] Figure 7 It is a schematic diagram of the interference of temperature control frequency on the leveling circuit;

[0027] Figure 8 It is a scatter plot of the response frequency of the three gyro preamplifiers of the inertial platform changing with the temperature control frequency;

[0028] Fig. 9 The time domain (top), frequency domain (middle) and time-frequency domain (bottom) of the leveling torque current when the gyroscope is heated and not heated;

[0029] Fig.10 It is a schematic diagram of the propagation mechanism of the influence of the gyroscope temperature control frequency on the platform system;

[0030] Fig.11 It is the temperature control curve after the inertial platform changes the temperature control PWM frequency;

[0031] Fig.12 It is the gyro torque current when the inertial platform is at a temperature-controlled PWM frequency of 500 Hz (upper) and 5 Hz (lower). DETAILED DESCRIPTION

[0032] The following detailed description of the present invention will make the features and advantages of the present invention more clear and explicit.

[0033] The word "exemplary" is used exclusively herein to mean "serving as an example, embodiment, or illustration." Any embodiment described herein as "exemplary" is not necessarily to be construed as preferred or advantageous over other embodiments. Although various aspects of the embodiments are shown in the drawings, the drawings are not necessarily drawn to scale unless otherwise noted.

[0034] The present invention provides a method for suppressing frequency interference of a multi-frequency digital control system of an inertial platform. Figure 1 As shown, the following steps are included:

[0035] Step (1) conducts a systematic analysis on the leveling loop of the inertial platform, takes the temperature control PWM frequency in the temperature control loop and the torque motor PWM frequency in the stability loop as adjustable characteristic frequencies, analyzes the generation mechanism of the gyroscope torque current interference in the leveling loop of the inertial platform, and determines whether the preset adjustable characteristic frequency interferes with the gyroscope torque current of the inertial platform.

[0036] (1.1) Parameter analysis of the multi-frequency digital loop control system of the inertial platform: The inertial platform is maintained in the geographic coordinate system through the leveling loop (control frequency F1Hz, bandwidth B1Hz) and the stabilization loop (control frequency F2Hz, bandwidth B2Hz). The leveling loop generates the gyroscope torque current through the output of the sensitive quartz accelerometer. After the output noise of the quartz accelerometer is filtered out by a low-pass filter, the correction network controls the torque circuit to add torque to the corresponding gyroscope. After the gyroscope torque precession, the gyroscope preamplifier output is generated. The stabilization loop stabilizes the inertial platform in the geographic system by controlling the gyroscope preamplifier output. The torque current containing the ground speed component is used for the accuracy calculation of the inertial platform. The gyroscope needs to be temperature controlled, which will involve the temperature control loop (control frequency F3Hz, bandwidth B3Hz), such as Figure 2 The temperature control loop heating control and the stabilization loop motor control both use PWM pulse width modulation, and the temperature control PWM frequency is F P1 Hz, the torque motor PWM frequency in the stable loop is F P2 Hz. In the process of designing each digital control loop separately, its control frequency and bandwidth are basically determined according to the control accuracy and dynamic characteristics of each loop, and the PWM frequency has sufficient adjustment space, so it is necessary to match the system frequency characteristics and coordinate the design to ensure that the system composed of multiple digital control loops (temperature control loop, stability loop and leveling loop) can work together without affecting each other.

[0037] (1.2) The frequency interference in digital control loops mainly includes frequency aliasing and modulation instability:

[0038] (1.2.1) Frequency aliasing characteristics: According to the Nyquist sampling theorem, when the sampling frequency (f s ) is greater than twice the maximum frequency (f0) of the signal contained in the signal, the sampled data can describe the original signal without distortion; when the sampling frequency does not meet this condition, frequency aliasing will occur, that is, f s / 2=f N Under the condition of (Nyquist frequency) ≥ f0, the signal is not distorted.

[0039] According to the sampling theorem, if there is a frequency higher than the Nyquist frequency f in the digital control loop N frequency components, frequency aliasing will occur in the system. Assume that the signal sampling frequency of the control loop is f s , there is a frequency component of f0 in the loop. As f0 increases, at a fixed sampling frequency f s The sampled signal frequency f is obtained when c like Figure 3 As shown. It can be seen that the sampling frequency f sThe original signal frequency f0 changes continuously from 0Hz, and the sampled signal frequency f c The maximum value is f s / 2. Sampling frequency f s Can reflect f0≤f without distortion s / 2, when the original signal frequency f0>f s / 2, the sampled signal frequency f c With f s / 2 frequency point is the mirror image of the symmetry axis, decreasing until f0=f s , the signal frequency after sampling is f c is zero; thus, as the frequency f0 of the original signal increases, the sampled signal frequency f c With f s The cycle keeps repeating between 0 and f s / 2. The signal frequency after sampling is f c With the original signal frequency f0 and the sampling frequency f s The relationship between them can be expressed by the following formula (1):

[0040]

[0041] (1.2.2) Modulation instability: Modulation refers to controlling the parameters of a high-frequency carrier through a low-frequency baseband signal so that these parameters change with the baseband signal. During the modulation process, when the baseband signal and the carrier signal are close in frequency, the superposition of the two signal waveforms will cause modulation instability and a new frequency component (generally referred to as "beat frequency") will appear.

[0042] Assuming that there is a carrier signal with a frequency of f1 = 8kHz in the loop, and there is also a baseband signal with a frequency of f2 = 7kHz, then the baseband signal with a frequency of f2 is very likely to be modulated by the carrier signal with a frequency of f1, and the superposition of the two frequencies will produce modulation instability, such as Figure 4 As shown, the "beat frequency" of the modulated signal is f m =f1-f2=1kHz.

[0043] (1.3) Analysis of leveling loop characteristics: During ground testing of an inertial platform, the platform is often required to be leveled and maintained in the geographic coordinate system. The stability of the gyro torque current in the leveling loop is the most direct factor in ensuring the accuracy of the inertial platform. Therefore, when multiple digital loops work together, it is necessary to ensure that the design frequency in the loop does not affect the stability of the torque current as much as possible.

[0044] The inertial platform leveling loop uses the quartz accelerometer output as the loop input, determines the angle of the platform axis from the geographic horizontal, controls the platform axis to rotate to the target angle from the geographic horizontal, and maintains it accurately. Figure 2As shown in the figure, when the axis of the frustum deviates from the geographical horizontal by an angle, it is sensed by the corresponding quartz accelerometer. The output of the quartz accelerometer reflects this angle. After the leveling loop uses a certain low-pass filtering algorithm to filter out the output noise of the quartz accelerometer, the correction network controls the torque adding circuit to add torque to the corresponding gyroscope, and then through the action of the stabilization loop, the platform is controlled to rotate around the corresponding axis to the specified position.

[0045] Generally, the bandwidth B1 of the leveling loop is less than 1 Hz. Therefore, low-frequency interference signals will directly affect the stability of the torque adding current of the gyroscope, and further affect the test accuracy of the inertial platform system. There are generally two modes of generating low-frequency interference. One is the inherent low-frequency interference characteristics existing in the system, and the other is that the high-frequency interference existing in the system forms low-frequency interference after frequency aliasing through digital sampling. Especially for multiple digital control loop systems with different frequency standards, there are certain differences between the set frequency points in different loops and the theoretical values. When F P1 ≈N1F1 or F P2 ≈N2F1 (N1 and N2 are any positive integers), low-frequency interference is likely to be generated in the leveling loop (assuming the interference frequency is F c ), and when F c <B1, this interference frequency directly affects the stability of the torque adding current after entering the leveling loop.

[0046] (1.4) Analysis of the PWM frequency of the stabilization loop: The inertial platform stabilization loop consists of a single-degree-of-freedom integrating gyroscope, a pre-amplifier and demodulation circuit (including a pre-amplifier, a band-pass filter, a demodulator, an AD converter), a loop correction link (including a correction network, optoelectronic isolation), a power amplifier circuit, a torque motor, a platform frame structure, etc., as Figure 5 shown. When there is an interference torque at the shaft end, the gyroscope senses it and its sensor outputs a voltage signal. After pre-amplification, demodulation (including filtering), signal decomposition (only for the X and Y loops), correction network, optoelectronic isolation, and power amplification, finally, the generated PWM signal drives the torque motor to generate a corresponding control torque to counteract the interference torque, so that the body coordinate system is stabilized in the inertial space and the normal operation of the inertial platform is ensured.

[0047] Generally speaking, the bandwidth B2 (<100 Hz) of the stabilization loop is much larger than the bandwidth B1 (<1 Hz) of the leveling loop, and the control frequency F2 of the stabilization loop is also greater than the control frequency F1 of the leveling loop. Therefore, the PWM frequency F P2 of the torque motor in the stabilization loop can become the interference frequency of the leveling loop, and when F P2 ≈n1F1 (n1 is a positive integer), it aliases into a low-frequency interference F c1 in the leveling loop, and when F c1 <B1, it has a direct impact on the stability of the torque adding current of the gyroscope.

[0048] (1.5) PWM Frequency Analysis of Temperature Control Loop: The temperature control loop uses a DC bridge for detection, PID digital control, and width modulation heating. The temperature signal of the gyroscope is detected by a temperature control bridge composed of precision thermistors, amplified by an operational amplifier after being differentiated from the reference signal, and then sent to an analog-to-digital converter. The controller collects the digital quantity of the analog-to-digital converter, performs mean filtering, and completes PID digital correction. After the operation, a PWM signal with a certain duty cycle is output. The on-off of the optocoupler is controlled by using this PWM signal to control the on-off of the power stage field effect transistor, so that a heating current of a certain magnitude is applied to the gyroscope heating element to complete the temperature control function, as Figure 6 shown.

[0049] The PWM frequency of the temperature control loop directly affects the gyroscope. As Figure 7 shown, if the output of the gyroscope or the torque applied to the gyroscope is affected, and low-frequency interference enters the leveling loop after passing through the stabilization loop, it will affect the stability of the torque current of the gyroscope. Next, the influence characteristics of the temperature control PWM frequency on the output of the gyroscope preamplifier and the torque applied to the gyroscope are analyzed in turn:

[0050] (1.5.1) Gyroscope Output: The temperature control PWM frequency will be directly reflected in the output of the gyroscope. According to formula (2), let f0 = F P1 , for the stabilization loop f s = F2, then the digitized sampling frequency F c2P in the stabilization loop is expressed as follows:

[0051]

[0052] When F c2P < B2, the temperature control PWM frequency F P1 can pass through the stabilization loop and enter the leveling loop. When F c2P ≈ n2F1 (n2 is a positive integer), this frequency is further aliased into low-frequency interference F c2L in the leveling loop, and when F c2L < B1, it affects the stability of the torque current.

[0053] In addition, since the output of the gyroscope in the stabilization loop needs to pass through a high-frequency carrier modulation link first, when F P1 is close to the carrier frequency F t , "beat frequency" F m = |F P1 - F t | will be generated in the stabilization loop. The "beat frequency" F m is low-frequency, directly enters the leveling loop after passing through the stabilization loop, and when F m < B1, it affects the fluctuation characteristics of the torque current.

[0054] (1.5.2) Gyroscopic torque addition: If the temperature control PWM frequency F P1 directly affects the gyroscopic torque addition. When F P1 ≈n3F1 (n3 is a positive integer), this frequency enters the leveling loop after passing through the stabilization loop and is aliased into a low-frequency interference F c3 , and at F c3 <B1, it has a significant impact on the gyroscopic torque addition current.

[0055] Therefore, whether it is the torque motor PWM frequency or the temperature control PWM frequency, there is a possibility of generating low-frequency interference signals, which enter the leveling loop and affect the gyroscopic torque addition current. Therefore, only by reasonably designing these two typical frequencies can the coordinated operation of multiple control loops in the multi-frequency digital control system be ensured.

[0056] Step (2): When the adjustable characteristic frequency interferes with the gyroscopic torque addition current in the leveling loop, perform coordinated design on the corresponding adjustable characteristic frequency, implement the suppression of frequency interference, and stabilize the gyroscopic torque addition current in the leveling loop.

[0057] If the temperature control PWM frequency interferes with the gyroscopic torque addition current in the leveling loop, take measures to suppress the frequency interference of the multi-frequency digital control system. Without changing the hardware technical state of the digital control loop, the setting of the temperature control PWM frequency can be achieved through the software parameter binding method to achieve the purpose of suppressing frequency interference.

[0058] The basic principles for designing the temperature control PWM frequency are as follows:

[0059] (i) It has no interference or very little influence on the stabilization loop;

[0060] (ii) It has no interference on the leveling loop;

[0061] (iii) It is far from the modulation instability range;

[0062] (iv) Avoid high energy generation at high frequencies;

[0063] (v) Ensure the continuity of the temperature control system regulation.

[0064] Design of the temperature control PWM frequency: The adjustable range of the temperature control PWM frequency is relatively large, but it must be ensured that it has as little impact as possible on the gyroscope output and gyroscopic torque addition.

[0065] First of all, the temperature control PWM frequency F P1 should be far from the carrier frequency F t to prevent the occurrence of "beat frequency" in the stabilization loop. Generally speaking, set F P1 <F t / 2 or F P1 >2F t .

[0066] After that, the temperature control PWM frequency F P1 The frequency F after digital sampling in the stabilization loop c2P The expression is shown in formula (2). When the basic condition F is met c2P ≠n2F1 (n2 is a positive integer), adjust the temperature control PWM frequency according to the control characteristics of the temperature control loop. The temperature control PWM frequency is an interference frequency for both the stabilization loop and the leveling loop, so it is necessary to avoid setting it too high to produce high energy and affect the entire system. At the same time, the continuity of the temperature control PWM adjustment should also be considered. Setting it too low is also not appropriate. Therefore, the temperature control PWM frequency setting range: F1 / 2F3≤F P1 ≤F2 / 3.

[0067] Of course, if the interference source of the gyro torque current in the leveling circuit is the torque motor PWM frequency F P2 The basic principles for torque motor PWM frequency design are as follows:

[0068] (i) The dynamic characteristics of the stable loop meet the functional and performance requirements;

[0069] (ii) No interference with the leveling circuit;

[0070] (iii) Ensure the continuity of the torque motor control by the stabilization loop.

[0071] Torque motor PWM frequency F P2 design:

[0072] According to formula (1), let f0 = F P2 , for a stable loop f s = F1, then the digital sampling frequency F in the leveling loop c3P It is expressed as follows:

[0073]

[0074] Adjust the torque motor PWM frequency according to the control characteristics of the stabilization loop. The torque motor PWM frequency may interfere with the frequency of the leveling loop. Therefore, under the premise that the dynamic characteristics of the stabilization loop meet the functional and performance requirements, ensure that there is no interference with the leveling loop. Finally, the torque motor PWM frequency setting range is determined as follows: 0.1F1≤F c3P ≤0.9F1.

[0075] Through the frequency interference suppression technology of the inertial platform multi-frequency digital control system, the matching and coordinated design of the system frequency characteristics can effectively solve the problem of mutual frequency interference of multiple digital control loops, ensuring that multiple digital control loops can work together without affecting each other.

[0076] According to a second aspect of the present invention, there is also provided a frequency interference suppression device for a multi-frequency digital control system of an inertial platform, comprising the following modules:

[0077] In the first module, the temperature control PWM frequency in the temperature control loop and the torque motor PWM frequency in the stability loop are used as adjustable characteristic frequencies to analyze the generation mechanism of the gyroscope torque current interference in the inertial platform leveling loop, and to clarify whether the adjustable characteristic frequency interferes with the gyroscope torque current of the inertial platform;

[0078] In the second module, when the adjustable characteristic frequency interferes with the gyroscope torque current in the leveling loop, the corresponding adjustable characteristic frequency is coordinated and designed to suppress the frequency interference and stabilize the gyroscope torque current in the leveling loop.

[0079] According to a third aspect of the present invention, there is further provided a readable storage medium having a computer program stored thereon, which, when executed by a processor, implements the frequency interference suppression method for a multi-frequency digital control system of an inertial platform as described in the first aspect.

[0080] Those skilled in the art can clearly understand that, for the convenience and brevity of description, the specific working process of the device described above can refer to the corresponding process in the aforementioned method embodiment, and will not be repeated here.

[0081] Example 1

[0082] The inertial platform leveling loop control frequency F1 = 50Hz, bandwidth B1 = 0.2Hz, the stability loop control frequency F2 = 1kHz, bandwidth B2 = 80Hz, the temperature control loop control frequency F3 = 5Hz, bandwidth B3 = 40Hz, the temperature control PWM frequency F P1 The PWM frequency of the stable loop motor is 500Hz. P2 Based on the analysis of the frequency interference characteristics of the multi-frequency digital control system, it is believed that the current temperature control PWM frequency F P1 After passing through the stabilization loop, it is close to n2F1 (n2 is a positive integer), which is most likely to become an interference source. Therefore, the temperature control PWM frequency is analyzed.

[0083] For the stabilization loop, we first analyze whether the temperature control PWM frequency will appear in the gyro output. Since the sampling frequency of the inertial platform monitoring data is 50Hz, it can reflect the spectrum below 25Hz without distortion. Therefore, the temperature control PWM frequency range is adjusted between 5Hz and 25Hz. The influence of the temperature control frequency on the preamplifier in the gyro is analyzed by the power spectrum estimation method. The response frequency points in the three gyro preamplifiers change with the temperature control frequency. Figure 8As shown. It can be seen that the temperature-controlled PWM frequency of 5Hz to 25Hz corresponds to the gyro preamplifier response frequency one by one, indicating that the change of the temperature-controlled PWM frequency will indeed affect the gyro output. The temperature-controlled frequency value of 500Hz, which is the initial setting, affects the gyro output by the same mechanism; this frequency enters the stabilization loop, and for the stabilization loop with a control frequency of 1kHz, this frequency can be reflected without distortion; but since the bandwidth of the stabilization loop is 80Hz, the 500Hz temperature-controlled frequency has limited effect on the stabilization loop.

[0084] For the leveling circuit, the random signals during the precise leveling of the inertial platform are detected, and the changes in the torque current in the non-heating state and the gyroscope-only heating state are compared, such as Fig. 9 As shown in the figure, the power spectrum estimation is used to analyze the frequency spectrum characteristics of the torque current in each stage, and the short-time Fourier analysis is used to analyze the time-frequency characteristics of the torque current in the whole process. In the time domain, the torque current oscillation in the heating stage is chaotic, which is obviously different from the non-heating stage; in the frequency domain, the power spectrum of the two stages contains an oscillation frequency of 0.32Hz, but there are a series of low-frequency components such as 0.13Hz and 0.15Hz in the heating stage; in the time-frequency domain, it can also be clearly seen that there are multiple low-frequency oscillations superimposed in the heating stage, while the non-heating stage is mainly periodic oscillations of 0.3Hz and 0.6Hz.

[0085] Therefore, by comparing the leveling torque current under different temperature control conditions, it can be seen that:

[0086] (I) When the temperature is controlled, the fluctuation of the gyroscope torque current is larger than that when the temperature is not controlled;

[0087] (II) When there is no temperature control, the fluctuation frequency of the gyroscope torque current is 0.3 Hz and its multiples. When the temperature is controlled, the fluctuation frequency of the torque current is more chaotic. In addition to 0.3 Hz and its multiples, there are also a series of low-frequency interferences, mainly concentrated around 0.15 Hz.

[0088] (III) During temperature control, the torque current will be significantly disturbed, resulting in large fluctuations and irregular waveforms.

[0089] Based on the analysis of the frequency characteristics of different loops, the frequency interference source is determined. It is believed that the 500Hz temperature-controlled PWM gyroscope itself has a significant impact; if this frequency affects the gyroscope torque, the frequency component will be directly introduced into the leveling loop. For the leveling loop with a control frequency of 50Hz, when the 500Hz temperature control frequency enters, it can be directly aliased and distorted into a low-frequency component near the frequency of 0Hz; for the leveling loop with a bandwidth of 0.2Hz, this aliasing frequency cannot be filtered out, which will cause abnormal fluctuations in the torque current. Therefore, the impact of the temperature control frequency on the platform system stability loop and leveling loop can be summarized into the following two propagation paths (such as Fig.10 ): On the one hand, the temperature control frequency will affect the output of the gyroscope itself, and enter the stabilization loop through the gyroscope preamplifier to produce an impact; on the other hand, the temperature control frequency will affect the gyroscope torque and directly affect the leveling loop.

[0090] Based on the analysis of the frequency characteristics of the digital control loop, it is believed that the initial setting of the temperature control PWM frequency is unreasonable and the frequency aliasing interval (integer multiples of 50Hz) must be avoided. Therefore, the temperature control PWM frequency is designed and adjusted. The comparison table of the influence of the temperature control PWM frequency on the stabilization loop and the leveling loop in different intervals is as follows:

[0091] Table 1 Temperature control PWM frequency selection comparison table

[0092]

[0093] Therefore, the temperature control PWM frequency of 500Hz is changed to 5Hz (carrier frequency F t =8kHz). For the stabilization loop, although this frequency can be sensitive to the gyro preamplifier, its energy is very low and far away from the modulation unstable frequency band, so its influence can be completely ignored. For the leveling loop, the 5Hz temperature control frequency will not produce lower-frequency aliasing distortion. After low-pass filtering with a cutoff frequency of 0.2Hz, the frequency influence can be completely eliminated.

[0094] After taking frequency interference suppression measures and changing the temperature control PWM frequency, the temperature control situation of the inertial platform is analyzed, such as Fig.11 As shown in the figure, TGX, TGY and TGZ are the X, Y and Z gyroscope temperatures respectively. It can be seen that after reducing the temperature control PWM frequency, the gyroscope temperature fluctuation is less than ±0.05℃, and the temperature control accuracy can meet the design index requirements.

[0095] Compare the torque current fluctuations before and after the temperature control PWM frequency is improved. Fig.12 It can be seen that after changing the temperature control PWM frequency, the gyroscope torque current waveform is more regular, the fluctuation magnitude is significantly reduced, and the torque current stability is significantly improved.

[0096] The present invention has been described in detail above in conjunction with specific implementations and exemplary examples, but these descriptions cannot be understood as limiting the present invention. Those skilled in the art understand that, without departing from the spirit and scope of the present invention, a variety of equivalent substitutions, modifications or improvements may be made to the technical solution of the present invention and its implementation methods, all of which fall within the scope of the present invention. The scope of protection of the present invention shall be subject to the attached claims.

[0097] The contents not described in detail in the specification of the present invention belong to the common knowledge of those skilled in the art.

Claims

1. A method for suppressing frequency interference in a multi-frequency digital control system of an inertial platform, characterized in that: The steps include: Conduct a systematic analysis of the leveling loop of the inertial platform, use the temperature control PWM frequency in the temperature control loop and the torque motor PWM frequency in the stability loop as adjustable characteristic frequencies, determine the generation mechanism of the gyroscope torque current interference in the leveling loop of the inertial platform, and clarify whether the preset adjustable characteristic frequency interferes with the gyroscope torque current of the inertial platform; When the adjustable characteristic frequency interferes with the gyro moment current in the leveling loop, the corresponding adjustable characteristic frequency is coordinated and designed to suppress the frequency interference and stabilize the gyro moment current in the leveling loop; In the step of analyzing the generation mechanism of the gyro torque current interference in the inertial platform leveling loop by taking the temperature control PWM frequency in the temperature control loop as the adjustable characteristic frequency, it includes the analysis of the influence of the temperature control PWM frequency on the output of the gyro preamplifier: the temperature control PWM frequency F P1 The frequency after digital sampling by the stabilization loop is set as F c2P , when F c2P < B2, the temperature control PWM frequency F P1 enters the leveling loop through the stabilization loop, and when F c2P ≈ n2F1, this frequency F c2P is aliased into a low-frequency interference F c2L in the leveling loop, and when F c2L < B1, it directly affects the stability of the torque current, where F1 is the control frequency of the leveling loop, n2 is a positive integer, B1 is the bandwidth of the leveling loop, and B2 is the bandwidth of the stabilization loop; In the step of analyzing the generation mechanism of the gyro torque current interference in the inertial platform leveling loop by taking the temperature control PWM frequency in the temperature control loop as the adjustable characteristic frequency, the temperature control PWM frequency F P1 is close to the carrier frequency F in the stable loop t When this happens, it causes a "beat frequency" F to be generated in the stable loop m , F m = |F P1 - F t |, F m After passing through the stable loop, it directly enters the leveling loop, and when F m < B1, it affects the fluctuation characteristics of the torque current, where B1 is the bandwidth of the leveling loop; In the step of analyzing the generation mechanism of the gyro torque current interference in the inertial platform leveling loop by using the temperature control PWM frequency in the temperature control loop as the adjustable characteristic frequency, it also includes the analysis of the influence of the temperature control PWM frequency on the gyro torque: When the temperature control PWM frequency F P1 ≈n3 F1, this temperature control PWM frequency enters the leveling loop after passing through the stabilization loop and is aliased into a low-frequency interference F c3 . When F c3 <B1, it has an impact on the gyro torque current, where F1 is the control frequency of the leveling loop, n3 is a positive integer, and B1 is the bandwidth of the leveling loop; When the adjustable characteristic frequency that interferes with the gyroscope torque current in the leveling loop is a temperature-controlled PWM frequency, the temperature-controlled PWM frequency meets the following requirements: P1 <F t / 2 or F P1 >2F t ; and F1 / 2F3≤F P1 ≤F2 / 3; where F P1 is the temperature control PWM frequency, F t is the carrier frequency in the stabilizing loop, F1 is the control frequency of the leveling loop, F2 is the control frequency of the stabilizing loop, and F3 is the control frequency of the temperature control loop; When the adjustable characteristic frequency that interferes with the gyro torque current in the leveling loop is the torque motor PWM frequency, the torque motor PWM frequency meets the following requirements: the torque motor PWM frequency F P2 The frequency after digital sampling by the leveling loop is set to F c3P , 0.1F1≤F c3P ≤0.9F1; where F1 is the control frequency of the leveling loop.

2. The frequency interference suppression method for an inertial platform multi-frequency digital control system according to claim 1, characterized in that: In the step of carrying out a systematic analysis on the leveling loop of the inertial platform, based on the bandwidth of the leveling loop, it is determined that the low-frequency interference with a signal frequency lower than the bandwidth of the leveling loop directly affects the stability of the gyroscope torque current; the low-frequency interference with a signal frequency lower than the bandwidth of the leveling loop includes two modes, one is the inherent low-frequency interference existing in the leveling loop, and the other is the low-frequency interference formed by frequency aliasing after digital sampling of the high-frequency interference existing in the leveling loop.

3. The frequency interference suppression method for an inertial platform multi-frequency digital control system according to claim 1, characterized in that: In step 1, in the step of analyzing the generation mechanism of the torque current interference of the inertial platform gyroscope by using the PWM frequency of the torque motor in the stabilization loop as the adjustable characteristic frequency, the PWM frequency F of the torque motor in the stabilization loop P2 ≈ n1F1, it is aliased as a low-frequency interference F in the leveling loop c1 , and when F c1 < B1, it has a direct impact on the stability of the gyroscope torque current, where F1 is the control frequency of the leveling loop, n1 is a positive integer, and B1 is the bandwidth of the leveling loop.

4. A frequency interference suppression device for a multi-frequency digital control system of an inertial platform, characterized in that: Includes the following modules: In the first module, the temperature control PWM frequency in the temperature control loop and the torque motor PWM frequency in the stability loop are used as adjustable characteristic frequencies to analyze the generation mechanism of the gyroscope torque current interference in the inertial platform leveling loop, and to clarify whether the preset adjustable characteristic frequency interferes with the inertial platform gyroscope torque current; Taking the temperature control PWM frequency in the temperature control loop as the adjustable characteristic frequency, analyze the generation mechanism of the gyro torque current interference in the inertial platform leveling loop, including the analysis of the influence of the temperature control PWM frequency on the output of the gyro preamplifier: the temperature control PWM frequency F P1 The frequency after digital sampling by the stabilization loop is set as F c2P , when F c2P < B2, the temperature control PWM frequency F P1 enters the leveling loop through the stabilization loop, and when F c2P ≈ n2F1, this frequency F c2P aliases into a low-frequency interference F c2L in the leveling loop, and when F c2L < B1, it directly affects the stability of the torque current, where F1 is the control frequency of the leveling loop, n2 is a positive integer, B1 is the bandwidth of the leveling loop, and B2 is the bandwidth of the stabilization loop; In the analysis of the generation mechanism of the gyro torque current interference in the inertial platform leveling loop by using the temperature control PWM frequency in the temperature control loop as the adjustable characteristic frequency, the temperature control PWM frequency F P1 is close to the carrier frequency F in the stable loop t When it is, it causes a "beat frequency" F to be generated in the stable loop m , F m = |F P1 - F t |, F m After passing through the stable loop, it directly enters the leveling loop, and when F m < B1, it affects the fluctuation characteristics of the torque current, where B1 is the bandwidth of the leveling loop; Using the temperature control PWM frequency in the temperature control loop as the adjustable characteristic frequency, analyzing the generation mechanism of the gyro torque current interference in the inertial platform leveling loop, further including the analysis of the influence of the temperature control PWM frequency on the gyro torque: When the temperature control PWM frequency F P1 ≈n3 F1, this temperature control PWM frequency enters the leveling loop after passing through the stabilization loop and is aliased into a low-frequency interference F c3 , when F c3 <B1, it has an impact on the gyro torque current, where F1 is the control frequency of the leveling loop, n3 is a positive integer, and B1 is the bandwidth of the leveling loop; In the second module, when the adjustable characteristic frequency interferes with the gyroscope moment current in the leveling loop, the corresponding adjustable characteristic frequency is coordinated and designed to suppress the frequency interference and stabilize the gyroscope moment current in the leveling loop; When the adjustable characteristic frequency that interferes with the gyroscope torque current in the leveling loop is a temperature-controlled PWM frequency, the temperature-controlled PWM frequency meets the following requirements: P1 <F t / 2 or F P1 >2F t ; and F1 / 2F3≤F P1 ≤F2 / 3; where F P1 is the temperature control PWM frequency, F t is the carrier frequency in the stabilizing loop, F1 is the control frequency of the leveling loop, F2 is the control frequency of the stabilizing loop, and F3 is the control frequency of the temperature control loop; When the adjustable characteristic frequency that interferes with the gyro torque current in the leveling loop is the torque motor PWM frequency, the torque motor PWM frequency meets the following requirements: the torque motor PWM frequency F P2 The frequency after digital sampling by the leveling loop is set to F c3P , 0.1F1≤F c3P ≤0.9F1; where F1 is the control frequency of the leveling loop.

5. A readable storage medium, characterized in that: A computer program is stored thereon, and when the program is executed by a processor, the method for suppressing frequency interference of a multi-frequency digital control system of an inertial platform as claimed in any one of claims 1 to 3 is implemented.