A Disturbance Compensation Control Method and Device for Target Launch Process Modeling and Smooth Transition

By constructing a target drone dynamics model and multi-source disturbance compensation control, combined with an extended state observer and a cubic Hermite smooth transition strategy, the problem of attitude divergence during target drone launch was solved, improving the robustness and safety of the target drone in complex environments.

CN123114012APending Publication Date: 2026-11-17UNIV OF SCI & TECH BEIJING
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202611021239.6
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2026-07-09
Publication Date
2026-11-17

AI Technical Summary

Technical Problem

Traditional target drones lack precise dynamic model descriptions and smooth transition control during launch, leading to attitude divergence and mechanical damage. Existing control strategies are unable to cope with interference factors in complex environments.

Method used

A multi-source disturbance compensation attitude control method is adopted. By constructing a target drone dynamic model, combining an extended state observer and a three-dimensional Hermite smooth transition strategy, an error feedback control law with group parameter scheduling is designed to achieve precise control and smooth transition during the target drone's boost launch phase.

Benefits of technology

This improves the robustness and stability of the target drone in complex environments, reduces the risk of mechanical damage, and ensures the safety and reliability of flight.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN123114012A_ABST
    Figure CN123114012A_ABST
Patent Text Reader

Abstract

This invention provides a disturbance compensation control method and apparatus for modeling and smoothing the transition during target drone launch, relating to the field of target drone flight attitude control technology. The method includes: acquiring target drone information; constructing a target drone dynamic model based on actual launch conditions and initializing it to obtain current state information; designing an extended state observer to estimate multi-source disturbances and obtain disturbance estimation compensation amounts; designing an error feedback control law for grouped parameter scheduling to compensate for multi-source disturbances based on attitude tracking errors and mode switching times; designing a smooth transition strategy for the boost separation transition interval to obtain smooth transition control law coefficients, and thus obtaining three-channel rudder deflection commands. This invention, by establishing a target drone dynamic model that conforms to actual engineering conditions and introducing a multi-source disturbance compensation control method and a multi-modal smooth transition strategy, addresses the attitude divergence problem caused by boost disturbances, improving the robustness and safety of the target drone in variable environments.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] This invention relates to the field of target drone flight attitude control technology, and in particular to a disturbance compensation control method and device for target drone launch process modeling and smooth transition. Background Technology

[0002] The boost-launch phase is one of the most complex and fault-prone stages in the entire mission profile of a target drone. Precise control and a smooth transition during this phase are prerequisites for ensuring the successful execution of subsequent flight missions. High-speed target drones typically use rocket boosters for zero-length launches. At the moment the booster finishes its work and detaches, the target drone faces drastic changes in its dynamic environment. Traditional target drone control often employs a steady-parameter rigid-body model. This simplified model ignores interference factors such as the additional torque generated by the booster thrust line and turbojet engine thrust line not passing through the center of mass, and changes in mass characteristic parameters such as the target drone's center of mass position and moment of inertia due to booster detachment. It lacks a precise description of the actual engineering conditions during the launch phase. Furthermore, traditional flight control strategies often directly switch control parameters at the moment of separation signal triggering, lacking a smooth transition process. This can easily lead to drastic changes in control surfaces, causing mechanical damage or attitude oscillations. Currently, there is no targeted solution to address the challenges of establishing a dynamic model for the target drone in complex engineering environments and ensuring a smooth transition and safe control during the launch phase. Summary of the Invention

[0003] To address the technical problem of attitude divergence caused by complex environment and conditions during the target drone launch phase, this invention provides a disturbance compensation control method and apparatus for modeling and smoothing the transition during the target drone launch process. The technical solution is as follows: On the one hand, a disturbance compensation control method for modeling and smoothing the transition of a target drone launch process is provided. This method is implemented by a multi-source disturbance compensation attitude control device, and includes: S1. Obtain the target drone's expected flight attitude, initial attitude, and initial physical state information for the current control cycle.

[0004] S2. Construct a target drone dynamics model based on the initial physical state information of the target drone and the actual launch process of the target drone.

[0005] S3. Initialize the target drone dynamics model based on the target drone's expected flight attitude information and initial attitude information to obtain the target drone's current state information; design an extended state observer based on the target drone's current state information and the actual control torque of the previous control cycle using a disturbance observer, and estimate the disturbance compensation amount based on the multi-source disturbance using the extended state observer.

[0006] S4. Define the attitude tracking error based on the target drone's expected flight attitude information and current state information. Design an error feedback control law for group parameter scheduling to compensate for multi-source interference based on the attitude tracking error and mode switching time.

[0007] S5. Define the boost-separation transition interval based on the mode switching time, and design a boost-separation transition interval based on... The control law coefficients for the smooth transition are obtained by using a continuous three-stage Hermite smooth transition strategy.

[0008] S6. Based on the error feedback control law, smooth transition control law coefficients, and disturbance estimation compensation amount of the group parameter scheduling, the three-channel rudder deflection command is obtained.

[0009] Optionally, the flight attitude expectation information in S1 includes the expected pitch angle, yaw angle, and roll angle.

[0010] Initial attitude information includes: the target drone's initial pitch angle, initial yaw angle, and initial roll angle.

[0011] Initial physical state information includes: the target drone's center of mass position, the booster's installation position and angle, and the engine's installation position.

[0012] Optionally, the target drone dynamics model in S2 is constructed based on the initial physical state information of the target drone and the actual launch process, including: S21. Construct expressions for all net external forces other than gravity in the target drone dynamics model; where net external forces other than gravity include aerodynamic forces, engine thrust, and booster thrust.

[0013] S22. Construct the target machine's center of mass dynamics equation based on the expressions for all resultant external forces except gravity.

[0014] S23. Construct the expression for the net external torque in the target drone dynamics model; where the net external torque includes aerodynamic torque, additional torque generated by the turbojet engine, and additional torque considering that the booster thrust line does not pass through the center of mass.

[0015] S24. Construct the dynamic equation of the target machine's rotation around its center of mass based on the expression of the net external torque.

[0016] S25. Analyze and model the additional disturbance torque caused by the step change in mass before and after booster separation.

[0017] Optionally, the additional disturbance torque caused by the mass step change before and after booster separation is analyzed and modeled, as shown in equations (1)-(4) below: (1) (2) (3) (4) In the formula, Indicates the mass of the target drone. Indicates the change in mass. Indicates acceleration. Represents the vector form of the net external force excluding gravity. Represents the scalar form of all net external forces except gravity. Represents the gravity vector. Represents the scalar quantity of gravity. This indicates the additional pitching moment generated by the engine thrust. Indicates the thrust of a turbojet engine. Indicates the point of application of engine thrust Axis position components, Indicates the location of the center of mass. Components in the axial direction, This indicates the change in the position of the center of mass. Components in the axial direction, Indicates the aerodynamic pitching moment. Indicates dynamic pressure. Indicates the reference area. This represents the target drone's pitching moment coefficient. Indicates the mean aerodynamic chord length. This indicates the change in the position of the center of mass. Components in the axial direction, Represents the rate of change of angular velocity. Indicates the net external torque. Represents the moment of inertia. It represents the change in moment of inertia.

[0018] Optionally, the design of the extended state observer in S3 includes: S31. Construct the three-channel attitude differential equations of the target drone.

[0019] S32. Design the spatial state equation of the extended state observer based on the three-channel attitude differential equation.

[0020] S33. Based on the spatial state equation of the extended state observer, the spatial state equation of the extended state observer in the three attitude channels is obtained as shown in the following equation (5): (5) In the formula, This is the pitch channel state observation vector. Indicates pitch angle, Represents the system matrix. Represents the control input matrix. Indicates elevator offset. Represents the observer gain matrix. This indicates the output measurement matrix. This represents the roll channel state observation vector. Indicates the roll angle. Indicates aileron deflection. This represents the yaw channel state observation vector. Indicates the yaw angle. This indicates the rudder deflection.

[0021] Optionally, S5 includes: The boost interval, boost separation transition interval, and cruise interval are defined based on the mode switching time. A first fixed control law coefficient is used for the boost interval, a second fixed control law coefficient is used for the cruise interval, and a design based on... The control law coefficients for the smooth transition are obtained by the continuous three-fold Hermite smooth transition strategy.

[0022] The control law coefficient for smooth transition is shown in equation (6) below: (6) In the formula, , The control law coefficients represent the smooth transition. Indicates the boost separation transition region. , , , , , , , Represents the coefficient.

[0023] Optionally, the three-channel rudder deflection command in S6 is as shown in equation (7): (7) In the formula, Indicates elevator offset. Indicates pitch angle, , , This indicates that the rudder offset is obtained by multiplying by the inverse of matrix B. , This represents the control law coefficient. Indicates the desired pitch angle. Indicates pitch rate, This represents the total disturbance in the pitch channel. Indicates aileron deflection. Indicates the roll angle. Indicates the expected roll angle. Indicates the roll rate. This represents the total disturbance in the roll channel. Indicates rudder deflection. Indicates the yaw angle. Indicates the desired rudder deflection. Indicates the yaw rate. This indicates the total disturbance in the yaw channel.

[0024] On the other hand, a disturbance compensation control device for target drone launch process modeling and smooth transition is provided. This device is applied to the disturbance compensation control method for target drone launch process modeling and smooth transition. The device includes: The data acquisition module is used to acquire the target drone's expected flight attitude, initial attitude, and initial physical state information during the current control cycle.

[0025] The dynamic model construction module is used to construct a dynamic model of the target drone based on the initial physical state information of the target drone and the actual situation of the target drone launch project.

[0026] The compensation quantity estimation module is used to initialize the target drone dynamics model based on the target drone's expected flight attitude information and initial attitude information to obtain the target drone's current state information. An extended state observer is designed based on the target drone's current state information and the actual control torque of the previous control cycle. The extended state observer is used to estimate the multi-source disturbances to obtain the disturbance estimation compensation quantity.

[0027] The control law design module is used to define the attitude tracking error based on the target drone's expected flight attitude information and current state information, and to design an error feedback control law for group parameter scheduling to compensate for multi-source interference based on the attitude tracking error and mode switching time.

[0028] The control law coefficient calculation module is used to define the boost-separation transition interval based on the mode switching time, and to design a boost-separation transition interval based on... The control law coefficients for the smooth transition are obtained by using a continuous three-stage Hermite smooth transition strategy.

[0029] The output module is used to obtain three-channel rudder deflection commands based on the error feedback control law, smooth transition control law coefficients, and disturbance estimation compensation amount scheduled by the grouping parameters.

[0030] On the other hand, a multi-source disturbance compensation attitude control device is provided, the multi-source disturbance compensation attitude control device comprising: a processor; a memory, the memory storing computer-readable instructions, which, when executed by the processor, implement any one of the disturbance compensation control methods for target drone launch process modeling and smooth transition as described above.

[0031] On the other hand, a computer-readable storage medium is provided, wherein at least one instruction is stored in the storage medium, the at least one instruction being loaded and executed by a processor to implement any of the above-described disturbance compensation control methods for modeling and smoothing the transition of the target launch process.

[0032] The beneficial effects of the technical solutions provided in the embodiments of the present invention include at least the following: In this invention, by establishing a precise dynamic model of the target drone based on engineering realities, the underlying modeling errors caused by traditional steady-state models can be reduced, laying a high-fidelity physical benchmark for the subsequent control system design. By employing a control law based on multi-source disturbance compensation, various disturbances encountered by the target drone during boost launch in complex environments can be observed in real time and effectively suppressed, improving the robustness of the controller and the stability of the target drone's flight. This is achieved by introducing a control law based on... The continuous three-stage Hermite smooth transition strategy avoids the control mismatch and drastic surface jumps that may occur when traditional fixed control strategy parameters are hard switched, reduces the risk of mechanical damage to the target drone, improves the active safety control capability of the target drone during the boost launch phase, and ensures flight stability and reliability. Attached Figure Description

[0033] To more clearly illustrate the technical solutions in the embodiments of the present invention, the accompanying drawings used in the description of the embodiments will be briefly introduced below. Obviously, the accompanying 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.

[0034] Figure 1 This is a flowchart of a disturbance compensation control method for modeling and smoothing the transition of a target drone launch process provided in an embodiment of the present invention; Figure 2 This is a schematic diagram of the additional torque provided in an embodiment of the present invention; Figure 3 This is a schematic diagram of the centroid position offset provided in an embodiment of the present invention; Figure 4 This is a flowchart of a control system based on multi-source disturbance compensation and smooth transition provided in an embodiment of the present invention; Figure 5 This invention provides a target drone altitude curve during actual launch, as shown in this embodiment. Figure 6 This invention provides a target drone velocity curve during actual launch. Figure 7 This invention provides a target drone elevation angle curve during actual launch, as provided in this embodiment. Figure 8 This invention provides a target drone roll angle curve during actual launch, as shown in this embodiment. Figure 9 This invention provides a target drone yaw angle curve during actual launch, as provided in this embodiment. Figure 10 This is a block diagram of a disturbance compensation control device for modeling and smoothing the transition of a target drone launch process, provided in an embodiment of the present invention. Figure 11 This is a schematic diagram of the overall system composition of a navigation and control hardware system provided in an embodiment of the present invention; Figure 12 This is a block diagram of the rudder system provided in an embodiment of the present invention; Figure 13 This is a block diagram illustrating the working principle of the rudder system provided in an embodiment of the present invention. Detailed Implementation

[0035] The technical solution of the present invention will now be described with reference to the accompanying drawings.

[0036] In embodiments of the present invention, words such as "exemplarily," "for example," etc., are used to indicate that something is an example, illustration, or description. Any embodiment or design described as "exemplary" in the present invention should not be construed as being more preferred or advantageous than other embodiments or designs. Specifically, the use of the word "exemplary" is intended to present the concept in a concrete manner. Furthermore, in embodiments of the present invention, the meaning expressed by "and / or" can be both, or either one.

[0037] In the embodiments of this invention, the terms "image" and "picture" may sometimes be used interchangeably. It should be noted that, without emphasizing the distinction between them, they convey the same meaning. Similarly, the terms "of," "corresponding (relevant)," and "corresponding" may sometimes be used interchangeably. It should be noted that, without emphasizing the distinction between them, they convey the same meaning.

[0038] In this embodiment of the invention, sometimes a subscript such as W1 may be written in a non-subscript form such as W1. When the difference is not emphasized, the meaning they express is the same.

[0039] To make the technical problems, technical solutions and advantages of the present invention clearer, a detailed description will be given below in conjunction with the accompanying drawings and specific embodiments.

[0040] This invention provides a disturbance compensation control method for modeling and smoothing the transition during target drone launch. This method can be implemented using a multi-source disturbance compensation attitude control device, which can be a terminal or a server. Figure 1 The flowchart shown is a disturbance compensation control method for modeling and smoothing the transition during target drone launch. The processing flow of this method may include the following steps: S1. Obtain the target drone's expected flight attitude, initial attitude, and initial physical state information for the current control cycle.

[0041] In one feasible implementation, the desired flight attitude information is obtained based on the flight mission of the target drone; and the initial physical state information of the target drone is obtained based on the assembly status and structural characteristics of the target drone.

[0042] Specifically, the expected flight attitude information includes: the expected pitch angle, the expected yaw angle, and the expected roll angle.

[0043] The initial physical state information of the target drone includes: the position of the target drone's center of mass, the installation position and angle of the booster, and the installation position of the engine.

[0044] The initial attitude information of the target drone includes: the initial pitch angle, the initial yaw angle, and the initial roll angle.

[0045] S2. Construct a target drone dynamics model based on the initial physical state information of the target drone and the actual launch process of the target drone.

[0046] In one feasible implementation, a dynamic model of the target drone is obtained based on the initial physical state information of the target drone and the actual launch process. The additional disturbance torque caused by the step change in mass before and after booster separation is analyzed and modeled.

[0047] Optionally, step S2 above may include the following steps S21-S25: S21. Construct expressions for all net external forces other than gravity in the target drone dynamics model; where net external forces other than gravity include aerodynamic forces, engine thrust, and booster thrust.

[0048] In one feasible implementation, the aerodynamic force in the dynamic model (taking zero-length launch against the wind, zero sideslip, and zero roll initial launch state) is... It can be represented as:

[0049] In the formula, Indicates aerodynamic force Components in the axial direction, Indicates aerodynamic force Components in the axial direction, Indicates aerodynamic force Components in the axial direction, Indicates dynamic pressure. Indicates the reference area. Indicates the target drone's drag coefficient. Indicates angle of attack. Indicates the lift coefficient of the target drone. This represents the lateral force coefficient of the target drone.

[0050] In the dynamic model (assuming the turbojet engine is installed parallel to the longitudinal axis of the target drone), the engine thrust... It can be represented as:

[0051] In the formula, Indicates engine thrust at Components in the axial direction, Indicates engine thrust at Components in the axial direction, Indicates engine thrust at Components in the axial direction, This indicates the thrust of a turbojet engine.

[0052] In the dynamic model (assuming the booster is installed at an upward angle along the thrust line on the belly of the target drone), the booster thrust... It can be represented as:

[0053] In the formula, Indicates that the booster pushes in Components in the axial direction, Indicates that the booster pushes in Components in the axial direction, Indicates that the booster pushes in Components in the axial direction, Indicates booster thrust. Indicates the installation angle.

[0054] S22. Construct the target machine's center of mass dynamics equation based on the expressions for all resultant external forces except gravity.

[0055] In one feasible implementation, the target's center of mass dynamics equation in the dynamic model is:

[0056] In the formula, Indicates the mass of the target drone. target drone Axial acceleration, Indicates pitch angular velocity, express Axial velocity, Indicates yaw rate, express Axial velocity, Represents gravitational acceleration. Indicates pitch angle, express Axial acceleration, express Axial velocity, Indicates the roll angular velocity. Indicates the roll angle. express Axial acceleration, It is a velocity vector. It is the angular velocity vector. For all external forces other than gravity, It can be represented as:

[0057] S23. Construct the expression for the net external torque in the target drone dynamics model; where the net external torque includes aerodynamic torque, additional torque generated by the turbojet engine, and additional torque considering that the booster thrust line does not pass through the center of mass.

[0058] In one feasible implementation, in the dynamic model, the aerodynamic torque It can be represented as:

[0059] In the formula, Indicates aerodynamic rolling torque. Indicates the aerodynamic pitching moment. This represents the aerodynamic yaw moment. Indicates the length of the exhibition. This represents the target drone's rolling torque coefficient. Indicates the mean aerodynamic chord length. This represents the target drone's pitching moment coefficient. This represents the target drone's yaw moment coefficient.

[0060] In the dynamic model, the additional torque generated by the turbojet engine It can be represented as:

[0061] In this context, the thrust line of the turbojet engine is taken to be parallel to and above the longitudinal axis of the target, and the centroid position vector is... The position of the engine thrust application point is fixed as follows: It is assumed that there is no lateral deviation between the engine thrust application point and the center of mass position, i.e. .

[0062] In the dynamic model, the additional torque generated by the booster thrust line not passing through the center of mass is considered. It can be represented as:

[0063] Wherein, the location of the intersection point between the booster thrust line and the line containing the center of mass is set as... ,think and Only the deviation in the direction of the total axis, i.e. Therefore, the above formula can be simplified to:

[0064] S24. Construct the dynamic equation of the target machine's rotation around its center of mass based on the expression of the net external torque.

[0065] In one feasible implementation, the dynamic equation for the target's rotation around its center of mass in the dynamic model is:

[0066] in, The moment of inertia of the target drone; To achieve the resultant external torque, It can be represented as:

[0067] S25. Analyze and model the additional disturbance torque caused by the step change in mass before and after booster separation.

[0068] In one feasible implementation, the additional disturbance torque model generated by the step change in mass before and after booster separation defines the abrupt changes in mass, center of mass position, and moment of inertia of the target after booster separation as follows: The main impacts on force balance and torque balance are analyzed as follows:

[0069] In the formula, Indicates the change in mass. Represents the gravity vector. Represents the scalar quantity of gravity. This indicates the additional pitching moment generated by the engine thrust (Note: Although...) The axis indicates lateral force, but here it refers to pitch moment. Since the direction of the moment is determined by the right-hand rule, the pitch moment is... (related to the axis) The rate of change of angular velocity, i.e., angular acceleration. The position of the centroid after the change. This represents the change in moment of inertia.

[0070] S3. Initialize the target drone dynamics model based on the target drone's expected flight attitude information and initial attitude information to obtain the target drone's current state information; design an extended state observer based on the target drone's current state information and the actual control torque of the previous control cycle using a disturbance observer, and estimate the disturbance compensation amount based on the multi-source disturbance using the extended state observer.

[0071] In one feasible implementation, the dynamic model of the target drone is initialized based on the expected information of the target drone's flight attitude and the initial attitude to obtain the current state information of the target drone. The disturbance observer is designed with an extended state observer based on the current state information of the target drone and the actual control torque of the previous control cycle to estimate the multi-source disturbance and obtain the disturbance estimate and compensation amount.

[0072] The initial attitude information of the target drone includes: the initial pitch angle, the initial yaw angle, and the initial roll angle; the current status information of the target drone includes: the current pitch angle, the current yaw angle, the current roll angle, the current pitch rate, the current yaw rate, and the current roll rate.

[0073] Optionally, the design of the extended state observer in S3 may include the following steps S31-S33: S31. Construct the three-channel attitude differential equations of the target drone:

[0074] In the formula, Represents pitch acceleration. Indicates roll acceleration. Indicates yaw acceleration. These are the total disturbances in the pitch channel, roll channel, and yaw channel, respectively; the control coefficients are respectively... ,in The pitching moment generated by the unit elevator deflection. The rolling moment generated by the unit aileron deflection, The yaw moment generated by rudder deflection in a unit direction; For elevator deflection, For aileron deflection, This refers to the rudder deflection.

[0075] S32. Design the spatial state equation of the extended state observer based on the three-channel attitude differential equation.

[0076] In one feasible implementation, based on the target drone's three-channel attitude differential equations, the spatial state equation of the extended state observer is designed as follows:

[0077] in,

[0078] In the formula, , , , Both are coefficient matrices. This represents the actual control input command, i.e., the amount of deflection of the control surfaces. The observed values ​​represent the target drone's attitude angles. The observed value representing the target drone's attitude angular rate. Indicates the system control gain. This is the total disturbance estimate output by the extended state observer. For the observer bandwidth, This represents the actual attitude angle value.

[0079] S33. Based on the spatial state equation of the extended state observer, the spatial state equation of the extended state observer in the three attitude channels is obtained:

[0080] In the formula, , , This is the conventional form of state-space representation.

[0081] S4. Define the attitude tracking error based on the target drone's expected flight attitude information and current state information. Design an error feedback control law for group parameter scheduling to compensate for multi-source interference based on the attitude tracking error and mode switching time.

[0082] In one feasible implementation, based on the expected information of the target drone's flight attitude, the current state information, and the disturbance estimation compensation amount, the attitude tracking error and the mode switching time are defined, and an error feedback control law for group parameter scheduling to compensate for multi-source disturbances is designed.

[0083] Specifically, the attitude tracking error is defined based on the target drone's desired flight attitude information and current state information; an error feedback control law for group parameter scheduling is designed based on the attitude tracking error and mode switching time; and a three-channel rudder deflection command is obtained by combining the error feedback control law with the disturbance estimation compensation amount in the subsequent process.

[0084] S5. Define the boost-separation transition interval based on the mode switching time, and design a boost-separation transition interval based on... The control law coefficients for the smooth transition are obtained by using a continuous three-stage Hermite smooth transition strategy.

[0085] In one feasible implementation, a boost-separation transition interval is defined based on the control commands for mode switching timing and group parameter scheduling, and a design based on... A continuous three-stage Hermite smooth transition strategy is used to obtain the controller parameters for smooth transition.

[0086] Specifically, the grouped control parameters of the extended state observer are dynamically scheduled based on the target drone's flight phases (boost phase, transition phase, and cruise phase) using time-series control. Fixed controller parameters are used during the boost phase. The cruise segment uses fixed controller parameters. The transition section adopts a method based on The continuous three-stage Hermite smooth transition strategy dynamically transitions between two sets of controller parameters.

[0087] In one feasible implementation, the target device transition time period is defined based on the mode switching time. Its smooth transition law can be expressed as:

[0088] in,

[0089] in,

[0090] In the formula, , , , , , , , The coefficients are given by a smooth transition method based on cubic Hermite.

[0091] S6. Based on the error feedback control law, smooth transition control law coefficients, and disturbance estimation compensation amount of the group parameter scheduling, the three-channel rudder deflection command is obtained.

[0092] In one feasible implementation, the control surface deflection command is obtained based on the error feedback control law and the smooth transition controller parameters of the group parameter scheduling for compensating for multi-source interference.

[0093] Specifically, the designed control law coefficients are applied to the control law to obtain the three-attitude channel rudder deflection command (control law). , , )for:

[0094] In the formula, These are the control law parameters (controller parameters). This is the actual attitude angle. This is the desired attitude angle. Because... ,so Indicates due to Therefore, to obtain the rudder deflection value It needs to be multiplied by the inverse of matrix B. and Similarly, in the case of small attitude angles, Indicates pitch rate, Indicates the roll rate. This indicates the yaw rate.

[0095] This invention can establish an accurate target drone dynamics model based on actual engineering conditions and solve the attitude divergence problem caused by sudden mass changes and additional torque disturbances during the boost-launch phase of the target drone using traditional control methods. This method combines the target drone's flight dynamics model with real-time flight status information, employing a grouped parameter scheduling control architecture with multi-source disturbance compensation and based on... The continuous three-stage Hermite smooth transition strategy enables precise control and smooth transition during the target drone's boost-launch phase.

[0096] like Figure 2 , Figure 3 , Figure 4 As shown, this invention establishes a target drone flight dynamics model based on engineering realities, primarily considering the impact of the torques generated by the boosters and engines on the target drone's attitude; and analyzes and models the additional disturbance torques generated by the mass step change before and after booster separation. During the launch phase, a segmented parameter scheduling control method based on a multi-source interference compensation strategy is adopted, designing different controller parameters to perform precise interference compensation and safety control for different modes; based on this, a method based on... A continuous three-stage Hermite smooth transition strategy is employed to achieve smooth transition processing of the two-modal controller coefficients. This invention addresses the attitude divergence problem caused by target drone boost interference by establishing a target drone dynamics model that conforms to actual engineering conditions, and introduces a control method with multi-source disturbance compensation and a multi-modal smooth transition strategy, thereby improving the robustness and safety of the target drone in variable environments.

[0097] The effect diagram obtained during the actual flight of the target drone is as follows: Figures 5-9 As shown.

[0098] In this embodiment of the invention, by establishing a precise dynamic model of the target drone based on engineering realities, the underlying modeling errors caused by traditional steady-state models can be reduced, laying a high-fidelity physical benchmark for the subsequent control system design. By employing a control law based on multi-source disturbance compensation, various disturbances encountered by the target drone during boost launch in complex environments can be observed in real time and effectively suppressed, improving the robustness of the controller and the stability of the target drone's flight. By introducing a control law based on... The continuous three-stage Hermite smooth transition strategy avoids the control mismatch and drastic surface jumps that may occur when traditional fixed control strategy parameters are hard switched, reduces the risk of mechanical damage to the target drone, improves the active safety control capability of the target drone during the boost launch phase, and ensures flight stability and reliability.

[0099] Figure 10 This is a block diagram of a disturbance compensation control device for target drone launch process modeling and smooth transition, according to an exemplary embodiment. The device is used in a disturbance compensation control method for target drone launch process modeling and smooth transition. (Refer to...) Figure 10 The device includes a data acquisition module 310, a dynamic model construction module 320, a compensation quantity estimation module 330, a control law design module 340, a control law coefficient calculation module 350, and an output module 360. Among them: The data acquisition module 310 is used to acquire the target drone's expected flight attitude information, initial attitude information, and initial physical state information during the current control cycle.

[0100] The dynamic model construction module 320 is used to construct a dynamic model of the target drone based on the initial physical state information of the target drone and the actual situation of the target drone launch project.

[0101] The compensation quantity estimation module 330 is used to initialize the target drone dynamic model based on the target drone's expected flight attitude information and initial attitude information to obtain the target drone's current state information; an extended state observer is designed based on the target drone's current state information and the actual control torque of the previous control cycle using a disturbance observer, and the disturbance estimation compensation quantity is obtained by estimating the multi-source disturbances using the extended state observer.

[0102] The control law design module 340 is used to define the attitude tracking error based on the target drone's expected flight attitude information and current state information, and to design an error feedback control law for group parameter scheduling to compensate for multi-source interference based on the attitude tracking error and mode switching time.

[0103] The control law coefficient calculation module 350 is used to define the boost separation transition interval based on the mode switching time, and to design a boost separation transition interval based on... The control law coefficients for the smooth transition are obtained by using a continuous three-stage Hermite smooth transition strategy.

[0104] The output module 360 ​​is used to obtain three-channel rudder deflection commands based on the error feedback control law, smooth transition control law coefficients, and disturbance estimation compensation amount scheduled by the grouping parameters.

[0105] In this embodiment of the invention, by establishing a precise dynamic model of the target drone based on engineering realities, the underlying modeling errors caused by traditional steady-state models can be reduced, laying a high-fidelity physical benchmark for the subsequent control system design. By employing a control law based on multi-source disturbance compensation, various disturbances encountered by the target drone during boost launch in complex environments can be observed in real time and effectively suppressed, improving the robustness of the controller and the stability of the target drone's flight. By introducing a control law based on... The continuous three-stage Hermite smooth transition strategy avoids the control mismatch and drastic surface jumps that may occur when traditional fixed control strategy parameters are hard switched, reduces the risk of mechanical damage to the target drone, improves the active safety control capability of the target drone during the boost launch phase, and ensures flight stability and reliability.

[0106] In an optional embodiment, the multi-source disturbance compensation attitude control device for modeling and smoothing the transition during the target drone's boost-launch phase can be implemented using a target drone navigation and control hardware system. This hardware system provides hardware support for the data acquisition module 310, the dynamic model construction module 320, the compensation quantity estimation module 330, the control law design module 340, the control law coefficient calculation module 350, and the output module 360.

[0107] Specifically, such as Figure 11 As shown, the target drone navigation and control hardware system includes a main control unit, an inertial measurement unit, a satellite navigation unit, and a rudder system actuator. The inertial measurement unit and the satellite navigation unit are communicatively connected to the main control unit, and the main control unit is communicatively connected to the rudder system actuator. The inertial measurement unit provides the main control unit with information related to the target drone's angular velocity, acceleration, and attitude changes. The satellite navigation unit provides the main control unit with the target drone's position, velocity, or initial navigation information. The main control unit performs state calculation, integrated navigation, control law calculation, and smooth transition processing based on the data output by the inertial measurement unit and the satellite navigation unit, and outputs three-channel rudder deflection commands to the rudder system actuator. The rudder system actuator drives the corresponding rudder surfaces to deflect according to the three-channel rudder deflection commands to achieve target drone attitude control.

[0108] The main control unit is the core control hardware of the target drone navigation and control hardware system. The main control unit receives data output from the inertial measurement unit and combines it with navigation data output from the satellite navigation unit to complete aerial alignment and integrated navigation, and calculates the target drone's attitude, speed, and position information in real time. The main control unit also receives servo status information or servo surface feedback information from the servo system actuators via a communication interface, and executes the multi-source disturbance compensation attitude control method for target drone boost-launch phase modeling and smooth transition as described in this embodiment of the invention based on the aforementioned information.

[0109] Optionally, the main control unit includes a processor, a memory, and a communication interface. The processor is used to call and execute program instructions stored in the memory to achieve target drone dynamics model construction, multi-source disturbance estimation, group parameter scheduling control law calculation, and based on... The system performs three consecutive Hermite smooth transition processes and generates three-channel rudder deflection commands. The memory stores pre-launch setup information, initial physical state information of the target drone, controller parameters, mode switching times, disturbance observer parameters, and smooth transition control law coefficients. The communication interface receives data from the inertial measurement unit, satellite navigation unit, and rudder system actuators, and sends rudder control commands to the rudder system actuators.

[0110] Optionally, the startup time of the main control unit is no more than 300ms to complete program loading and initialization and respond to the communication bus; the processing capability of the main control unit meets the real-time control requirements of the target drone's boost-launch phase. The main control unit can adopt a single-processor structure or a multi-processor structure; the processor can be a central processing unit, digital signal processor, microcontroller, field-programmable gate array, application-specific integrated circuit, or other processing circuit capable of executing the control method described in the embodiments of the present invention, and the present invention does not specifically limit it in this regard.

[0111] The inertial measurement unit (IMU) includes a three-axis gyroscope, a three-axis accelerometer, a temperature sensor, a signal processing board, structural components, and corresponding software programs. The IMU measures the three-axis angular rate and three-axis acceleration of the target drone relative to inertial space, and outputs the error-compensated three-axis angular rate, three-axis acceleration, and temperature information to the main control unit via a communication interface according to a preset communication protocol. The error compensation includes one or more of temperature compensation, installation misalignment angle compensation, and nonlinear compensation. The data output by the IMU supports the data acquisition module 310 in acquiring the target drone's initial attitude information and current flight state information, and supports the compensation estimation module 330 in initializing and estimating the target drone's current state information.

[0112] The satellite navigation unit includes a satellite navigation receiver and a satellite antenna. The satellite navigation unit receives satellite navigation signals, obtains target drone speed information, position information, or time synchronization information, and transmits this information to the main control unit. The data output by the satellite navigation unit is used to provide initial values ​​for inertial navigation and is fused with the data output by the inertial measurement unit to obtain combined navigation information for the target drone. Optionally, the satellite navigation unit has positioning, ephemeris injection, time injection, position injection, second pulse output, and positioning data output via serial port functions.

[0113] The rudder system actuator is used to receive the three-channel rudder deflection command output by the main control unit, and drive the rudder surface to deflect according to the three-channel rudder deflection command. For example... Figure 12 As shown, the rudder system actuator includes a hull, motor, potentiometer, reducer, rudder surface, rudder surface locking-deployment mechanism, and rudder power board. The rudder system actuator also includes a rudder amplifier control circuit, power drive circuit, DC servo motor, transmission mechanism, position feedback unit, and rudder system control software.

[0114] During operation, the rudder system actuator deploys the control surfaces according to the control commands output by the main control unit. After deployment, the rudder system actuator drives the motor to rotate via power amplification and drive circuit according to the three-channel rudder deflection command. The motor, through a reducer and transmission mechanism, drives the control surfaces to deflect in accordance with the control command, thereby adjusting the target drone's flight attitude. The position feedback unit is used to collect the actual rudder deflection angle and feed it back to the rudder amplifier control circuit to form a closed-loop control of the control surfaces.

[0115] Specifically, such as Figure 13 As shown, the control signal and position feedback signal of the rudder system actuator are integrated and processed in the rudder amplifier control circuit, and then input to the power drive circuit after isolation amplification. The power drive circuit amplifies the control signal and applies the amplified drive signal to the DC servo motor, causing the rotation direction and amplitude of the DC servo motor to change with the control signal. After being reduced in speed by a reducer, the DC servo motor transmits torque to the output shaft, which drives the rudder surface to deflect, realizing angle output and torque output, thereby achieving the purpose of rudder surface servo control.

[0116] Therefore, the main control unit, inertial measurement unit, satellite navigation unit, and rudder system actuator together constitute the hardware foundation for implementing the multi-source disturbance compensation attitude control method described in this embodiment of the invention. Through the aforementioned hardware system, attitude, angular velocity, acceleration, speed, position, and rudder surface feedback information during the target drone's boost-launch phase can be acquired in real time. The three-channel rudder deflection command, generated based on the dynamic model, multi-source disturbance compensation control law, and a three-dimensional Hermite smooth transition strategy, is applied to the rudder system actuator in real time, thereby achieving attitude stability control and smooth transition control during the target drone's boost-launch phase. The above description is merely a specific embodiment of the present invention, but the scope of protection of the present invention is not limited thereto. Any variations or substitutions that can be easily conceived by those skilled in the art within the technical scope disclosed in the present invention should be included within the scope of protection of the present invention. Therefore, the scope of protection of the present invention should be determined by the scope of the claims.

Claims

1. A target aircraft launch process modeling and smooth transition disturbance compensation control method, characterized in that, The method includes: S1. Obtain the target drone's expected flight attitude, initial attitude, and initial physical state information for the current control cycle; S2. Construct a target drone dynamics model based on the initial physical state information of the target drone and the actual launch process of the target drone; S3. Initialize the target drone dynamics model based on the target drone's expected flight attitude information and initial attitude information to obtain the target drone's current state information; design an extended state observer based on the target drone's current state information and the actual control torque of the previous control cycle using a disturbance observer; estimate the disturbance compensation amount by estimating the multi-source disturbances using the extended state observer. S4. Define the attitude tracking error based on the target drone's expected flight attitude information and current state information. Design an error feedback control law for group parameter scheduling to compensate for multi-source interference based on the attitude tracking error and mode switching time. S5, defining the boost-separation transition interval according to the modal switching time, designing a third-degree Hermite smooth transition strategy based on continuity for the boost-separation transition interval, and obtaining the smooth transition control law coefficients; S6. Based on the error feedback control law, smooth transition control law coefficients, and disturbance estimation compensation amount of the group parameter scheduling, the three-channel rudder deflection command is obtained.

2. The target aircraft launch process modeling and disturbance compensation control with smooth transition method of claim 1, wherein, The expected flight attitude information in S1 includes the expected pitch angle, yaw angle, and roll angle. Initial attitude information, including: the target drone's initial pitch angle, initial yaw angle, and initial roll angle; Initial physical state information includes: the target drone's center of mass position, the booster's installation position and angle, and the engine's installation position.

3. The target aircraft launch process modeling and transition-smoothing disturbance compensation control method of claim 1, wherein, The S2 step of constructing a target drone dynamics model based on the initial physical state information of the target drone and the actual launch process includes: S21. Construct expressions for all resultant external forces other than gravity in the target drone dynamics model; where all resultant external forces other than gravity include aerodynamic forces, engine thrust, and booster thrust. S22. Construct the target machine's center of mass dynamics equation based on the expressions for all net external forces except gravity; S23. Construct the expression for the net external torque in the target drone dynamics model; where the net external torque includes aerodynamic torque, additional torque generated by the turbojet engine, and additional torque considering that the booster thrust line does not pass through the center of mass. S24. Construct the dynamic equations of the target drone's rotation around its center of mass based on the expression for the net external torque; S25. Analyze and model the additional disturbance torque caused by the step change in mass before and after booster separation.

4. The target aircraft launch process modeling and transition-smoothing disturbance compensation control method of claim 3, wherein, The additional disturbance torque caused by the mass step change before and after booster separation is analyzed and modeled as shown in equations (1)-(4): (1) (2) (3) (4) In the formula, Indicates the mass of the target drone. Indicates the change in mass. Indicates acceleration. This represents the vector form of the net external force excluding gravity. Scalar form representing all net external forces other than gravity. Represents the gravity vector. Represents the scalar quantity of gravity. This represents the additional pitching moment generated by the engine thrust. Indicates the thrust of a turbojet engine. Indicates the point of application of engine thrust Axis position components, Indicates the location of the center of mass. Components in the axial direction, This indicates the change in the position of the center of mass. Components in the axial direction, Indicates the aerodynamic pitching moment. Indicates dynamic pressure. Indicates the reference area. This represents the target drone's pitching moment coefficient. Indicates the mean aerodynamic chord length. This indicates the change in the position of the center of mass. Components in the axial direction, Represents the rate of change of angular velocity. Indicates the net external torque. Indicates the moment of inertia. It represents the change in moment of inertia.

5. The disturbance compensation control method for target drone launch process modeling and smooth transition according to claim 1, characterized in that, The design extension state observer in S3 includes: S31. Construct the three-channel attitude differential equations of the target drone; S32. Design the spatial state equation of the extended state observer based on the three-channel attitude differential equation; S33. Based on the spatial state equation of the extended state observer, the spatial state equation of the extended state observer in the three attitude channels is obtained as shown in the following equation (5): (5) In the formula, This is the pitch channel state observation vector. Indicates pitch angle, Represents the system matrix. Represents the control input matrix. Indicates elevator offset. Represents the observer gain matrix. This indicates the output measurement matrix. This represents the roll channel state observation vector. Indicates the roll angle. Indicates aileron deflection. This represents the yaw channel state observation vector. Indicates the yaw angle. This indicates the rudder deflection.

6. The disturbance compensation control method for target drone launch process modeling and smooth transition according to claim 1, characterized in that, The S5 includes: The boost interval, boost separation transition interval, and cruise interval are defined based on the mode switching time. A first fixed control law coefficient is used for the boost interval, a second fixed control law coefficient is used for the cruise interval, and a design based on... The control law coefficients for the smooth transition are obtained by using a continuous three-stage Hermite smooth transition strategy; The control law coefficient for smooth transition is shown in equation (6) below: (6) In the formula, , The control law coefficients represent the smooth transition. Indicates the boost separation transition region. , , , , , , , Represents the coefficient.

7. The disturbance compensation control method for target drone launch process modeling and smooth transition according to claim 1, characterized in that, The three-channel rudder deflection command in S6 is shown in the following formula (7): (7) In the formula, Indicates elevator offset. Indicates pitch angle, , , This indicates that the rudder offset is obtained by multiplying by the inverse of matrix B. , This represents the control law coefficient. Indicates the desired pitch angle. Indicates pitch rate, This represents the total disturbance in the pitch channel. Indicates aileron deflection. Indicates the roll angle. Indicates the expected roll angle. Indicates the roll rate. This represents the total disturbance in the roll channel. Indicates rudder deflection. Indicates the yaw angle. Indicates the desired rudder deflection. Indicates the yaw rate. This indicates the total disturbance in the yaw channel.

8. A disturbance compensation control device for target drone launch process modeling and smooth transition, wherein the disturbance compensation control device for target drone launch process modeling and smooth transition is used to implement the disturbance compensation control method for target drone launch process modeling and smooth transition as described in any one of claims 1-7, characterized in that, The device includes: The data acquisition module is used to acquire the target drone's expected flight attitude, initial attitude, and initial physical state information during the current control cycle. The dynamic model construction module is used to construct a dynamic model of the target drone based on the initial physical state information of the target drone and the actual situation of the target drone launch project. The compensation quantity estimation module is used to initialize the target drone dynamics model based on the target drone's expected flight attitude information and initial attitude information to obtain the target drone's current state information. An extended state observer is designed based on the target drone's current state information and the actual control torque of the previous control cycle. The extended state observer is used to estimate the multi-source disturbances to obtain the disturbance estimation compensation quantity. The control law design module is used to define the attitude tracking error based on the target drone's expected flight attitude information and current state information, and to design an error feedback control law for group parameter scheduling to compensate for multi-source interference based on the attitude tracking error and mode switching time. The control law coefficient calculation module is used to define the boost-separation transition interval based on the mode switching time, and to design a boost-separation transition interval based on... The control law coefficients for the smooth transition are obtained by using a continuous three-stage Hermite smooth transition strategy; The output module is used to obtain three-channel rudder deflection commands based on the error feedback control law, smooth transition control law coefficients, and disturbance estimation compensation amount scheduled by the grouping parameters.

9. A multi-source disturbance compensation attitude control device, characterized in that, The multi-source disturbance compensation attitude control device includes: processor; A memory storing computer-readable instructions that, when executed by the processor, implement the method as described in any one of claims 1 to 7.

10. A computer-readable storage medium, characterized in that, The computer-readable storage medium contains program code that can be invoked by a processor to execute the method as described in any one of claims 1 to 7.