A tilt feedback control method for a gravimeter
By constructing a turbulence intensity index and a dynamic fusion factor, and adjusting the PID controller parameters in real time, the problem of balancing stability and accuracy of gravimeters under disturbed environments was solved, achieving optimized control under different flight conditions, and improving the quality of exploration data and equipment safety.
Patent Information
- Application Number
- CN202511255973.4
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2025-09-04
- Publication Date
- 2026-11-17
AI Technical Summary
Existing gravimeter control systems struggle to balance high-precision measurement with stability when faced with atmospheric turbulence and maneuvering disturbances during flight. PID controllers with fixed gain parameters are prone to self-excited oscillations at high gain and cannot effectively suppress background noise at low gain, resulting in insufficient accuracy and resolution of exploration data.
By constructing a turbulence intensity index, generating a dynamic fusion factor, and synthesizing PID controller parameters in real time, a high-precision mode is adopted to ensure data quality during stable flight, while switching to a high-stability mode ensures equipment safety during strong disturbances. The normalized sigmoid function and linear interpolation are used to achieve a smooth transition of the control strategy.
It achieves adaptive control that dynamically adapts to different disturbance environments, provides high-precision measurement during stable flight, and protects equipment with high stability during strong disturbances, avoiding the impact of parameter switching on the system and significantly improving exploration efficiency and data quality.
Smart Images

Figure CN123113289A_ABST
Abstract
Description
Technical Field
[0001] This invention relates to the field of gravimeter technology, and more specifically to a tilt feedback control method for gravimeters. Background Technology
[0002] Airborne gravity gradiometers are core equipment used for direct or indirect exploration of underground resources such as minerals and oil. They infer underground geological structures by measuring subtle changes in gravity gradients. However, aircraft are affected by atmospheric turbulence and maneuvering during flight, resulting in angular motion disturbances. Therefore, a high-performance tilt feedback control system is required to keep the gravity gradient sensor highly stable in relation to the Earth's gravitational field.
[0003] Existing control systems mostly use PID controllers with fixed gain parameters, which presents a fundamental technical contradiction. If high-gain, high-bandwidth parameters are used to achieve high-precision measurement, the phase margin will be reduced, and the data will be prone to self-excited oscillation and data failure when encountering strong disturbances. If conservative parameters with low gain and low bandwidth are used to ensure stability, the response speed and accuracy will be sacrificed. Background noise cannot be effectively suppressed during stable flight, and the accuracy and resolution of exploration data are far lower than theoretical indicators. It is impossible to dynamically adapt to the disturbance environment and it is difficult to balance stability and accuracy. Summary of the Invention
[0004] The purpose of this invention is to provide a tilt feedback control method for a gravimeter, which solves the problems existing in the background art.
[0005] To solve the above-mentioned technical problems, the present invention provides a tilt feedback control method for a gravimeter, the specific steps of which include: Step 1: Construct the turbulence intensity index: The system acquires the triaxial real-time acceleration measurement values output by the preset airborne inertial measurement unit, and performs high-pass filtering on the triaxial real-time acceleration measurement values to separate high-frequency components. The variance of the high-frequency component within a preset time window is calculated to obtain the three-axis wave energy; The wave energy of the three axes is weighted and summed to generate a turbulence intensity index that characterizes the severity of the current disturbance environment. Step 2: Generate dynamic fusion factors: The turbulence intensity index is compared with preset safety thresholds and alarm thresholds; When the turbulence intensity index is lower than the safety threshold, the dynamic fusion factor is determined to be a first preset value; When the turbulence intensity index is higher than the alarm threshold, the dynamic fusion factor is determined to be the second preset value; When the turbulence intensity index is between the safety threshold and the alarm threshold, the dynamic fusion factor is calculated using a preset smooth transition function; Step 3: Synthesize real-time controller parameters: Based on the dynamic fusion factor, the preset high-precision PID parameter set and high-stability PID parameter set are linearly interpolated to synthesize PID controller parameters in real time. Step 4: Implement closed-loop feedback control: Closed-loop feedback control of the attitude of the stable platform is performed by applying real-time synthesized PID controller parameters.
[0006] Preferably, the method for determining the parameters on which the turbulence intensity index is constructed in step one includes: The cutoff frequency of the high-pass filter is preset based on the bandwidth characteristics of the gravimeter control system and the spectral characteristics of typical atmospheric turbulence. The length of the time window used to calculate the variance is preset to achieve a balance between real-time response and computational stability; The three-axis weighting coefficients used in the weighted summation are assigned by analyzing historical flight data to determine the sensitivity of vibrations along different axes to the phase margin consumption of the stable platform. The axis with the highest sensitivity is given the largest weight.
[0007] Preferably, in step two, when the turbulence intensity index is between the safety threshold and the alarm threshold, the step of calculating the dynamic fusion factor using a preset smooth transition function includes: S21. Calculate the difference between the turbulence intensity index and the arithmetic mean of the safety threshold and the alarm threshold to obtain the difference value; S22. Divide the difference by half of the difference between the alarm threshold and the safety threshold to obtain the quotient. S23. The quotient is calculated using a preset normalized S-shaped transition function to generate the dynamic fusion factor whose numerical value is continuous between the first preset value and the second preset value and whose first derivative changes continuously.
[0008] Preferably, the preset turbulence intensity safety threshold and alarm threshold in step two are sourced from: Establish a mathematical model for the stable platform; Through simulation analysis, the functional relationship between the phase margin of the stable platform, the turbulence intensity index, and the PID parameters was obtained. The determination of the safety threshold includes: setting the system under a high-precision control strategy, determining the turbulence intensity index corresponding to when the phase margin decreases from the initial value to a preset first safety margin value, and using it as the safety threshold; The determination of the alarm threshold includes: setting the system under a high-precision control strategy, determining the turbulence intensity index corresponding to the phase margin decreasing to a preset critical stability margin value, and using it as the alarm threshold.
[0009] Preferably, the high-precision PID parameter set and the high-stability PID parameter set preset in step three are determined in one go during the system design stage, combining the theoretical design method of the control system with simulation experiments.
[0010] Preferably, the step of performing linear interpolation between the high-precision PID parameter set and the high-stability PID parameter set based on the dynamic fusion factor in step three specifically includes: S31. Subtract the dynamic fusion factor from 1 to obtain the difference; S32. Multiply the proportional gain parameter in the high-precision PID parameter set with the difference to obtain the first product; S33. Multiply the proportional gain parameter in the high-stability PID parameter set with the dynamic fusion factor to obtain the second product; S34. Add the first product to the second product to obtain the proportional gain parameter that takes effect in real time; S35. Using the same linear interpolation method as the proportional gain parameter, obtain the real-time effective integral gain parameter and differential gain parameter.
[0011] Preferably, through the coordinated execution of steps one to four, the phase margin of the stable platform is dynamically maintained above the critical stability margin value throughout the entire operation.
[0012] Preferably, the triaxial real-time acceleration measurement values output by the airborne inertial measurement unit originate from the inertial measurement unit installed on the aircraft fuselage. The desired attitude setting is a constant zero value, requiring the stable platform to maintain an absolute water platform attitude.
[0013] Preferably, the high-precision PID parameter set is used to optimize measurement accuracy under normal flight conditions, and the high-stability PID parameter set is used to ensure system stability under strong disturbance environments; and the step of performing closed-loop feedback control includes: S41. Obtain the real-time attitude of the platform measured by the gyroscope sensor and compare it with the desired attitude setting value to calculate the real-time attitude error; S42. Apply the real-time synthesized PID controller parameters to perform proportional, integral, and derivative operations on the real-time attitude error to generate the final control signal. S43. Output the final control signal to the torque motor to complete the closed-loop correction of the attitude of the stable platform.
[0014] Beneficial effects Compared with the prior art, the present invention has the following beneficial effects: 1. By dynamically decoupling the conflict between stability and accuracy, the control strategy can adaptively switch according to the disturbance environment. During stable flight, a high-precision mode is used to ensure data quality, while a high-stability mode is switched to ensure equipment safety when strong disturbances occur, achieving optimal control under all operating conditions while balancing stability and accuracy.
[0015] 2. By proactively managing the phase margin and setting thresholds based on system model simulation, disturbances can be detected in advance and parameters can be adjusted to keep the phase margin above the safe threshold. This effectively avoids the risk of instability caused by sudden disturbances and overcomes the defect of high-gain systems being prone to oscillation due to strong disturbances.
[0016] 3. By using normalized sigmoid functions and linear interpolation, the control strategy can be smoothly transitioned, avoiding the impact of parameter switching on the equipment, ensuring continuous data flow, and improving the physical integrity of the equipment and the reliability of the data.
[0017] 4. High-precision mode is used most of the time to suppress background noise, and precision is sacrificed only briefly when necessary, which significantly improves data quality, enhances exploration efficiency and return on investment, and avoids the problem of large precision loss due to conservative control throughout the process. Attached Figure Description
[0018] To more clearly illustrate the technical solutions in the embodiments of the present invention or the prior art, the drawings used in the description of the embodiments or the prior art will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present invention. For those skilled in the art, other drawings can be obtained based on these drawings without creative effort. Figure 1 This is a flowchart of the method of the present invention. Detailed Implementation
[0019] The technical solutions of the present invention will be clearly and completely described below with reference to the accompanying drawings of the embodiments of the present invention. Obviously, the described embodiments are only some embodiments of the present invention, and not all embodiments. All other embodiments obtained by those skilled in the art based on the embodiments of the present invention without creative effort are within the scope of protection of the present invention.
[0020] Example 1: Please see Figure 1 This invention provides a tilt feedback control method for a gravimeter, comprising the following steps: Step 1, constructing a turbulence intensity index; Step 2, generating a dynamic fusion factor; Step 3, synthesizing real-time controller parameters; and Step 4, executing closed-loop feedback control. This embodiment provides a tilt feedback control method for gravimeters, which aims to dynamically reconcile the inherent contradiction between the stability of the control system and the measurement accuracy of exploration data. This method achieves active tilt feedback control of high-precision measuring instruments such as airborne gravity gradiometers through a series of tightly coupled steps. Its core logic lies in pre-sensing external disturbances and smoothly adjusting the control strategy accordingly, thereby maintaining the best balance of system performance in ever-changing flight environments. In the step of constructing the turbulence intensity index, the system proactively quantifies the severity of the external disturbance environment; the step of generating the dynamic fusion factor makes a biased decision on the control strategy based on this quantification result; the step of synthesizing real-time controller parameters accurately translates this decision into specific PID controller parameters; finally, the step of executing closed-loop feedback control applies these dynamically adjusted parameters to perform precise closed-loop correction on the attitude of the stable platform; this series of steps work together to form a complete adaptive control closed loop, the fundamental purpose of which is to ensure that the instrument operates in high-precision mode for the vast majority of stable flight time, and only briefly switches to high-stability mode for a few periods when encountering severe turbulence, thereby maximizing both exploration data quality and equipment safety throughout the entire flight.
[0021] Example 2: According to the aforementioned method, the parameter determination method for constructing the turbulence intensity index in step one includes: the cutoff frequency of the high-pass filter is preset based on the bandwidth characteristics of the gravimeter control system and the spectral characteristics of typical atmospheric turbulence; the time window length used to calculate the variance is preset to achieve a balance between real-time response and computational stability; the three-axis weighting coefficients used for weighted summation are assigned values after analyzing historical flight data to determine the sensitivity of vibrations in different axes to the phase margin consumption of the stable platform, with the axis with the highest sensitivity being assigned the largest weight; To accurately construct the turbulence intensity index, a series of core parameters must be rigorously set; the cutoff frequency of the high-pass filter... The preset value is key to achieving effective disturbance separation. The determination of this parameter is directly based on the bandwidth characteristics of the gravimeter control system itself and the spectral characteristics of typical atmospheric turbulence. Specifically, the von Kármán turbulence spectral model, which is well-known in the field, can be referred to. Setting the cutoff frequency at the lower limit of the turbulence-dominant frequency band that poses the greatest threat to the attitude of the stable platform, such as 1Hz, can ensure that the high-pass filter accurately separates the high-frequency disturbance components, while ignoring the low-frequency normal maneuvers of the aircraft that have little impact on system stability. This is a prerequisite for achieving accurate disturbance perception.
[0022] Length of the time window used to calculate variance The preset is the result of a careful balance between real-time response and computational stability; a time window that is too short will result in excessive noise in the variance calculation results, while a time window that is too long will sacrifice the system's response speed to sudden disturbances; in this technical solution, it is usually set to 1 to 2 seconds, which ensures that the system can smooth noise and respond quickly to sudden disturbances. The three-axis weighting coefficients used in the weighted summation The assignment of values is based on in-depth analysis of historical flight data. Through simulation or real flight data analysis, the sensitivity of vibrations along different axes to the core stability index of the stable platform, namely the phase margin, can be accurately determined. The axis with the highest sensitivity will be assigned the largest weight coefficient. For example, if the disturbance along the lateral y-axis poses the greatest threat to roll stability, then the value will be set as follows: This allows the final turbulence intensity index to most sensitively reflect threats in key directions; this differentiated weighting mechanism makes the assessment of the turbulence intensity index more targeted and physically meaningful.
[0023] Example 3: According to the aforementioned method, in step two, when the turbulence intensity index is between the safety threshold and the alarm threshold, the step of calculating the dynamic fusion factor using a preset smooth transition function includes: S21, subtracting the turbulence intensity index from the arithmetic mean of the safety threshold and the alarm threshold to obtain a difference value; S22, dividing the difference value by half of the difference between the alarm threshold and the safety threshold to obtain a quotient value; S23, applying a preset normalized S-shaped transition function to the quotient value to generate the dynamic fusion factor whose numerical value is continuous between the first preset value and the second preset value and whose first derivative changes continuously; When the turbulence intensity index The value is within the preset safety threshold. With alarm threshold During this period, the system enters a transition control region; within this region, the dynamic fusion factor... The calculation is performed through a preset smooth transition function to ensure a smooth and shock-free transition of the control strategy; this calculation process is the core of achieving a smooth transition from high-precision mode to high-stability mode. The process follows the formula:
[0024] The dynamic fusion factor is the turbulence intensity index. The function, which serves as the sole output of this module, has its value range limited to 0 and 1. This indicates that a high-precision control strategy is being fully adopted. This indicates that a highly stable control strategy is being fully adopted; This represents the turbulence intensity index, which is the only input to this module and originates from the output of the disturbance feedforward sensing module. The safety threshold is a configurable scalar that represents the upper limit of negligible turbulence intensity. The alarm threshold is a configurable scalar that represents the lower limit of turbulence intensity at which strong stabilization measures must be taken; sin represents the standard sine function. This represents the constant value of pi.
[0025] The mathematical form of this formula is a normalized S-shaped transition function, which is specifically constructed using a sine function in this embodiment. This is a classic and efficient technique used in control engineering to achieve smooth parameter switching. The motivation is that the system's control strategy needs to switch between a "full precision" mode and a "full stability" mode. If a direct step switch is used, it will cause a sudden change in the control quantity, resulting in mechanical and electrical shocks to the system. Therefore, a transition function that can ensure a smooth, stepless transition must be used. The transition segment constructed using a sine function has continuous function itself and its first derivative, ensuring the smooth evolution of the control parameters, thereby avoiding any form of control abrupt change and ensuring the physical stability of the system.
[0026] In the control system, the decision module receives the real-time turbulence intensity index. Then, it will be compared with a preset threshold. and Compare; if If the value lies between the two, the above formula is immediately invoked for calculation, thus obtaining an accurate result. Value; This calculation process involves only simple condition judgments and trigonometric function operations, with extremely low computational overhead, and can be executed efficiently by a microprocessor; This method enables intelligent and smooth decision-making in control strategies. When disturbances are small, the system resolutely pursues the highest measurement accuracy; when disturbances are severe, the system decisively ensures absolute stability. Crucially, when the disturbance intensity varies between two thresholds, the system can achieve a smooth transition, avoiding a precipitous drop in performance or abrupt control switching caused by strategy switching. This refined processing method is the fundamental guarantee for maintaining the continuity and reliability of measurement data throughout the entire flight mission.
[0027] Example 4: According to the aforementioned method, the sources of the preset turbulence intensity safety threshold and alarm threshold in step two include: establishing a mathematical model of the stable platform; obtaining the functional relationship graph between the phase margin, the turbulence intensity index, and the PID parameters of the stable platform through simulation analysis; determining the safety threshold includes: setting the system under a high-precision control strategy, determining the turbulence intensity index corresponding to the point where the phase margin decreases from the initial value to a preset first safety margin value, and using this as the safety threshold; determining the alarm threshold includes: setting the system under a high-precision control strategy, determining the turbulence intensity index corresponding to the point where the phase margin decreases to a preset critical stability margin value, and using this as the alarm threshold.
[0028] In this embodiment, the safety threshold With alarm threshold The established logic is key to achieving forward-looking stability control in this invention. It originates from rigorous system model simulation analysis, rather than empirical trial and error. A precise mathematical model of the controlled stable platform must be established. Through this model, simulation analysis can be performed to obtain the system's core stability index, namely the phase margin, and the external disturbance quantification index, namely the turbulence intensity index. The graph showing the functional relationship between the PID controller parameters and the PID parameter set is crucial for setting the safety threshold. The determination process is as follows: The system simulation model is set under high-precision PID parameters, and the turbulence intensity applied to the model is gradually increased. The system's phase margin is continuously monitored; when the phase margin drops from its initial value to a preset first safety margin value, such as 15 degrees, which represents that the system still has sufficient stability reserve, the corresponding turbulence intensity index is... The value, i.e., the value determined as the safety threshold. Alarm threshold The determination process is similar: under the same high-precision PID parameter setting, the turbulence intensity is further increased. This continues until the system's phase margin drops to a preset critical stability margin value, such as 5 degrees. This value is the minimum threshold at which the system can maintain stability without self-excited oscillations. The value is then determined as the alarm threshold. This threshold setting method, based on a clear physical meaning, namely phase margin, ensures that the decision threshold has a solid theoretical foundation, greatly improving the accuracy and safety of the control system's decision-making. This is the fundamental advantage of this invention compared to traditional fixed threshold or fuzzy logic control.
[0029] Example 5: According to the aforementioned method, the high-precision PID parameter set and the high-stability PID parameter set preset in step three are determined at once during the system design stage, combining the control system theoretical design method and simulation experiment; The two core parameter libraries in this embodiment are the high-precision PID parameter sets. With high-stability PID parameter set This constitutes the basic knowledge base of the system control strategy; its source is determined in one go during the system design phase through standard control system theoretical design methods and sufficient simulation experiments. Specifically, designers employ methods such as Bode plot analysis, the Nyquist stability criterion, and the classic Ziegler-Nichols tuning method to analyze and tune the mathematical model of the controlled platform. The optimization objective of the high-precision parameter set is to minimize the steady-state error of the system and maximize its response speed, aiming to enable the system to obtain the highest quality measurement data under normal flight conditions. Conversely, the optimization objective of the high-stability parameter set is to maximize the phase margin of the system under a given worst-case disturbance model, ensuring that the system will not become unstable when encountering extreme external shocks. Once determined, these two parameter sets are fixed in the system and serve as the benchmark for subsequent real-time parameter synthesis.
[0030] Example 6: According to the aforementioned method, the step of linear interpolating the high-precision PID parameter set and the high-stability PID parameter set based on the dynamic fusion factor in step three specifically includes: S31, subtracting the dynamic fusion factor from 1 to obtain the difference; S32, multiplying the proportional gain parameter in the high-precision PID parameter set with the difference to obtain a first product; S33, multiplying the proportional gain parameter in the high-stability PID parameter set with the dynamic fusion factor to obtain a second product; S34, adding the first product and the second product to obtain the proportional gain parameter that takes effect in real time; S35, using the same linear interpolation method as the proportional gain parameter to obtain the integral gain parameter and the derivative gain parameter that take effect in real time. In obtaining dynamic fusion factors Then, the system enters the adaptive PID parameter adjustment module; this module is based on... The optimal PID controller parameters are synthesized in real time through simple linear interpolation; this step is a crucial translation link connecting upper-level decision-making and lower-level execution. The PID gain parameter that takes effect in real time Synthesized using the following formula:
[0031] These represent the PID gain parameters that take effect in real time at time t. They are the outputs of this module and serve as the inputs of the next module. This represents the dynamic fusion factor and is the only input to this module. This represents a pre-defined set of high-precision parameters; This represents a pre-defined set of highly stable parameters; p, i, d are common knowledge in the field of control engineering, representing proportional term, integral term and differential term respectively; HP and HS are custom abbreviations used in this invention, referring to high precision and high stability, respectively.
[0032] This method is the most direct and simplest implementation of the gain scheduling concept in control theory; gain scheduling is a widely used nonlinear control technique that adjusts controller parameters according to changes in the system's operating point.
[0033] We need a method with extremely low computational cost and guaranteed smooth transition for upper-level decision factors. The abstract meaning is translated into specific control parameters at the underlying level; linear interpolation is simple to calculate, has high execution efficiency, and because... The PID parameters themselves change continuously and smoothly, and the interpolated PID parameters can also remain continuous and smooth along their change path, thus ensuring that the final output control torque also changes continuously, avoiding any form of switching shock. This module receives the calculations from the upper-level decision-making module. After the value is obtained, the above three sets of linear interpolation operations are immediately executed, and the PID parameter set required for the current control cycle can be calculated immediately. when When the real-time PID parameters smoothly change from 0 to 1, they also smoothly transition from a high-precision parameter set to a high-stability parameter set on a linear path. This mechanism fundamentally ensures the continuity of control force and avoids system oscillations that may be caused by parameter switching. It makes the response behavior of the entire control system gentle and firm when facing disturbance changes, rather than abrupt and harsh. This is crucial for protecting expensive sensor equipment and ensuring the integrity of data flow.
[0034] Example 7: According to the aforementioned method, through the coordinated execution of steps one to four, the phase margin of the stable platform is dynamically maintained above the critical stability margin value throughout the entire working process. The core achievement of this invention lies in achieving a forward-looking closed-loop stability control through the close coordination and seamless execution of steps one through four. From disturbance perception, decision fusion, parameter synthesis to the final closed-loop control, the entire chain works in concert, ultimately ensuring that the core stability indicator of the stable platform, namely the phase margin, is dynamically maintained above the preset critical stability margin value throughout the entire operation. This means that no matter how harsh the external flight environment is, the system will never enter the dangerous region of instability and oscillation. This forward-looking management of the core stability indicator is the cornerstone for fundamentally ensuring the safety of expensive equipment.
[0035] Example 8: According to the aforementioned method, the triaxial real-time acceleration measurement values output by the airborne inertial measurement unit originate from the inertial measurement unit installed on the aircraft fuselage; the desired attitude setting value is a constant zero value, requiring the stable platform to maintain an absolute water platform attitude; in this embodiment, the original input signal used to construct the turbulence intensity index is the triaxial real-time acceleration measurement value. Its physical source is an airborne inertial measurement unit directly installed on the aircraft body; the purpose of installing the inertial measurement unit on the airframe rather than on a stable platform is to directly measure the external disturbances applied to the entire system, rather than the result after the platform suppresses the disturbances, which ensures the authenticity and predictability of the disturbance measurement. Furthermore, in the closed-loop feedback control stage, the desired attitude setpoint... It is set to a constant zero value; the physical meaning of this setting is that the stable platform must strive to maintain an absolutely horizontal attitude at all times, that is, perpendicular to the direction of gravity; this is the basic premise for the accurate execution of airborne gravity exploration missions.
[0036] Example 9: According to the aforementioned method, the high-precision PID parameter set is used to optimize the measurement accuracy under normal flight conditions, and the high-stability PID parameter set is used to ensure the system stability under strong disturbance conditions; and the step of performing closed-loop feedback control includes: S41, acquiring the real-time attitude of the platform measured by the gyroscope sensor and comparing it with the desired attitude set value to calculate the real-time attitude error; S42, applying the real-time synthesized PID controller parameters to perform proportional, integral, and derivative operations on the real-time attitude error to generate the final control signal; S43, outputting the final control signal to the torque motor to complete the closed-loop correction of the stable platform attitude; In the closed-loop feedback execution module, the system's behavioral logic is as follows: The real-time attitude of the platform is obtained through a high-precision gyroscope sensor installed on the stable platform. Compare this real-time attitude with the desired attitude, which is constant at zero. By comparing the results, the real-time attitude error, which is used as the input to the PID controller, is calculated:
[0037] This indicates the platform's real-time attitude error; This represents the desired posture, which is always zero. Indicates the platform's current real-time attitude; The controller uses PID parameters synthesized in real time by the upstream module. For attitude error Perform standard PID calculations to generate the final control execution signal. This operation follows the classic PID control law:
[0038] This indicates the final control execution signal output to the torque motor; This indicates the platform's real-time attitude error; For integration operations, it is a dummy variable; Indicates the current time; For real-time synthesis of proportional, integral, and differential gain.
[0039] This control signal The output is sent to the torque motor that drives the stabilizing platform. The torque motor generates a corresponding correction torque based on this signal, drives the platform to resist external disturbances, and finally completes the closed-loop correction of its attitude, so that it returns to the desired horizontal attitude. Due to the adaptiveness of the PID parameters, the closed-loop control system realizes automatic switching of working mode under different disturbance environments, and finally achieves the best balance between high precision and high stability.
[0040] The above are merely preferred embodiments of the present invention and are not intended to limit the present invention in any other way. Any person skilled in the art may make changes or modifications to the above-disclosed technical content to create equivalent embodiments that can be applied to other fields. However, any simple modifications, equivalent changes, and modifications made to the above embodiments based on the technical essence of the present invention without departing from the scope of the present invention shall still fall within the protection scope of the present invention.
Claims
1. A tilt feedback control method for a gravimeter, characterized in that, The specific steps include: Step 1: Construct the turbulence intensity index: The system acquires the triaxial real-time acceleration measurement values output by the preset airborne inertial measurement unit, and performs high-pass filtering on the triaxial real-time acceleration measurement values to separate high-frequency components. The variance of the high-frequency component within a preset time window is calculated to obtain the three-axis wave energy; The wave energy of the three axes is weighted and summed to generate a turbulence intensity index that characterizes the severity of the current disturbance environment. Step 2: Generate dynamic fusion factors: The turbulence intensity index is compared with preset safety thresholds and alarm thresholds; When the turbulence intensity index is lower than the safety threshold, the dynamic fusion factor is determined to be a first preset value; When the turbulence intensity index is higher than the alarm threshold, the dynamic fusion factor is determined to be the second preset value; When the turbulence intensity index is between the safety threshold and the alarm threshold, the dynamic fusion factor is calculated using a preset smooth transition function; Step 3: Synthesize real-time controller parameters: Based on the dynamic fusion factor, linear interpolation is performed on the preset high-precision PID parameter set and high-stability PID parameter set to synthesize PID controller parameters in real time. Step 4: Implement closed-loop feedback control: Closed-loop feedback control of the attitude of the stable platform is performed by applying real-time synthesized PID controller parameters.
2. The tilt feedback control method for a gravimeter according to claim 1, characterized in that, The parameter determination method for constructing the turbulence intensity index in step one includes: The cutoff frequency of the high-pass filter is preset based on the bandwidth characteristics of the gravimeter control system and the spectral characteristics of typical atmospheric turbulence. The length of the time window used to calculate the variance is preset to achieve a balance between real-time response and computational stability; The three-axis weighting coefficients used in the weighted summation are assigned by analyzing historical flight data to determine the sensitivity of vibrations along different axes to the phase margin consumption of the stable platform. The axis with the highest sensitivity is given the largest weight.
3. The tilt feedback control method for a gravimeter according to claim 2, characterized in that, In step two, when the turbulence intensity index is between the safety threshold and the alarm threshold, the step of calculating the dynamic fusion factor using a preset smooth transition function includes: S21. Calculate the difference between the turbulence intensity index and the arithmetic mean of the safety threshold and the alarm threshold to obtain the difference value; S22. Divide the difference by half of the difference between the alarm threshold and the safety threshold to obtain the quotient. S23. The quotient is calculated using a preset normalized S-shaped transition function to generate the dynamic fusion factor whose numerical value is continuous between the first preset value and the second preset value and whose first derivative changes continuously.
4. The tilt feedback control method for a gravimeter according to claim 3, characterized in that, The sources of the preset turbulence intensity safety threshold and alarm threshold in step two include: Establish a mathematical model for the stable platform; Through simulation analysis, the functional relationship between the phase margin of the stable platform, the turbulence intensity index, and the PID parameters was obtained. The determination of the safety threshold includes: setting the system under a high-precision control strategy, determining the turbulence intensity index corresponding to when the phase margin decreases from the initial value to a preset first safety margin value, and using it as the safety threshold; The determination of the alarm threshold includes: setting the system under a high-precision control strategy, determining the turbulence intensity index corresponding to the phase margin decreasing to a preset critical stability margin value, and using it as the alarm threshold.
5. The tilt feedback control method for a gravimeter according to claim 4, characterized in that, The high-precision PID parameter set and high-stability PID parameter set preset in step three are determined in one go during the system design stage, combining control system theoretical design methods and simulation experiments.
6. The tilt feedback control method for a gravimeter according to claim 5, characterized in that, The step three, which involves linear interpolating the high-precision PID parameter set and the high-stability PID parameter set based on the dynamic fusion factor, specifically includes: S31. Subtract the dynamic fusion factor from 1 to obtain the difference; S32. Multiply the proportional gain parameter in the high-precision PID parameter set with the difference to obtain the first product; S33. Multiply the proportional gain parameter in the high-stability PID parameter set with the dynamic fusion factor to obtain the second product; S34. Add the first product to the second product to obtain the proportional gain parameter that takes effect in real time; S35. Using the same linear interpolation method as the proportional gain parameter, obtain the real-time effective integral gain parameter and differential gain parameter.
7. The tilt feedback control method for a gravimeter according to claim 4, characterized in that, Through the coordinated execution of steps one through four, the phase margin of the stable platform is dynamically maintained above the critical stability margin value throughout the entire operation.
8. The tilt feedback control method for a gravimeter according to claim 7, characterized in that, The three-axis real-time acceleration measurement values output by the airborne inertial measurement unit originate from the inertial measurement unit installed on the aircraft fuselage. The desired attitude setting is a constant zero value, requiring the stable platform to maintain an absolute water platform attitude.
9. The tilt feedback control method for a gravimeter according to claim 1, characterized in that, The high-precision PID parameter set is used to optimize measurement accuracy under normal flight conditions, and the high-stability PID parameter set is used to ensure system stability under strong disturbance environments. The steps for performing closed-loop feedback control include: S41. Obtain the real-time attitude of the platform measured by the gyroscope sensor and compare it with the desired attitude setting value to calculate the real-time attitude error; S42. Apply the real-time synthesized PID controller parameters to perform proportional, integral, and derivative operations on the real-time attitude error to generate the final control signal. S43. Output the final control signal to the torque motor to complete the closed-loop correction of the attitude of the stable platform.
