Loaded quad-rotor unmanned aerial vehicle surrounding control method based on nonlinear ESO under gust

Through nonlinear ESO and integral sliding mode controller, the surround control problem of quadrotor drone under gust and load interference is solved, and the more stable surround control effect of quadrotor drone is achieved, enhancing the immunity performance and control of quadrotor drone Accuracy.

CN118963400APending Publication Date: 2024-11-15TIANJIN UNIV
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411143080.6
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-20
Publication Date
2024-11-15

AI Technical Summary

Technical Problem

Quadrotor UAVs have difficulty achieving stable surround control under gusts and load interference, especially when tracking ground moving targets, resulting in increased control difficulty.

Method used

Using a nonlinear diffusion observer (ESO) combined with a hyperbolic tangent function, an integral terminal sliding mode controller and a fast terminal sliding mode controller are designed to establish a dynamic model of a quadrotor UAV, and external perturbation is estimated through nonlinear ESO. Design position and attitude controllers for enhanced immunity.

Benefits of technology

It significantly improves the immunity of the quadrotor UAV, enhances the robustness and adaptability of the control system, improves the position tracking accuracy and fast attitude control, and achieves stable surround control under gusts and load conditions.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118963400A_ABST
    Figure CN118963400A_ABST
Patent Text Reader

Abstract

The invention relates to a four-rotor unmanned aerial vehicle surrounding control method with a load based on nonlinear ESO under gust. The four-rotor unmanned aerial vehicle surrounding control method comprises the following steps that a kinetic model of a four-rotor unmanned aerial vehicle is established on the basis of external disturbance; a nonlinear ESO is designed for the four-rotor unmanned aerial vehicle according to the characteristics of wind disturbance and load disturbance; designing a position controller and an attitude controller of the quad-rotor unmanned aerial vehicle based on the nonlinear ESO; according to the method, the interference of gust and load on the quadrotor unmanned aerial vehicle is estimated and compensated by designing the nonlinear ESO, so that the anti-interference performance of the quadrotor unmanned aerial vehicle system is remarkably enhanced; a position-attitude double closed-loop control structure is adopted for the quad-rotor unmanned aerial vehicle, an integral sliding mode controller and an auxiliary controller are introduced, and the problems of stable flight and accurate control of the quad-rotor unmanned aerial vehicle in a complex environment are solved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical field:

[0001] The present invention belongs to the field of anti-disturbance control of quad-rotor unmanned aerial vehicles, and in particular relates to a quad-rotor unmanned aerial vehicle surround control method based on nonlinear ESO with load under gusts. Background technology:

[0002] Due to the flexibility and portability of quadrotor drones, they are widely used to track and surround ground moving targets. The purpose of quadrotor drone surround control is to make the quadrotor drone move in a circle with a certain expected value as the radius, with the ground moving target as the center. Quadrotor drone surround control is widely used in military operations to capture targets and air-ground coordination systems to provide a wide field of view for ground vehicles.

[0003] Compared with stationary targets on the ground, it is more difficult for a quadrotor drone to surround a moving target on the ground. The design of the heading rate controller can ensure that the quadrotor drone eventually converges to a circular orbit around the moving target. In order to provide a wide field of view for ground vehicles, a quadrotor drone is sufficient to complete the field of view of the air-ground collaborative system. However, in outdoor environments, quadrotors will inevitably be disturbed by gusts of wind, making it difficult to achieve time-varying continuous trajectory tracking for surrounding control. When there is a load, the surround control task of the quadrotor drone becomes more challenging. Summary of the invention:

[0004] The present invention adopts a nonlinear control strategy to study the surround control problem of a quadrotor drone affected by gusts and load disturbances. In view of the fact that the quadrotor drone is sensitive to external gusts and load disturbances, a nonlinear ESO is proposed to improve the anti-interference ability of the quadrotor drone. In order to reduce jitter, the hyperbolic tangent function is introduced in the nonlinear ESO. The integral terminal sliding mode controller is combined with the fast terminal sliding mode controller to design an integral terminal sliding mode controller, which is verified by experiments to achieve the expected control effect. The technical solution of the present invention is: a surround control method for a quadrotor drone with load based on nonlinear ESO under gusts, the method comprising the following steps:

[0005] Step 1: Establish the dynamic model of the quadrotor drone based on external disturbances;

[0006] Step 2: Design nonlinear ESO according to the characteristics of wind disturbance and load disturbance;

[0007] Step 3: Design position controller and attitude controller based on nonlinear ESO;

[0008] Furthermore, the dynamic model of the quad-rotor drone is established based on the external disturbance, and the specific establishment process is as follows:

[0009] According to Newton's second law and Euler's equation, the quad-rotor drone is modeled and analyzed. The dynamic model of the quad-rotor drone is as follows:

[0010]

[0011] Among them, x(t), y(t), z(t) are the positions of the quadrotor drone in space; p(t), q(t), r(t) are the angular velocities of the quadrotor drone rotating around the coordinate axes x, y, z of the ground coordinate system; I x ,I y ,I z is the moment of inertia of the quadrotor drone rotating around its axis; m is the mass of the quadrotor drone; d x (t) and d y (t) represents the external disturbance of the load and external wind force on the lateral direction of the quadrotor drone; g is the acceleration of gravity; U1(t), U2(t), U3(t), and U4(t) are the control inputs;

[0012] The control system of the quadrotor drone is divided into a position loop control system and an attitude loop control system; the attitude loop control system and the position loop control system satisfy the following conversion relationship:

[0013]

[0014] in, and q d (t) is the expected value of the attitude loop system, u1(t) and u2(t) represent the virtual control inputs of the position loop system of the quadrotor drone in the X and Y directions, respectively;

[0015] Considering that the position control model of the quadrotor drone is the same in the X and Y directions, the X direction is taken as an example for analysis; the position tracking error of the quadrotor drone in the X direction is expressed as follows:

[0016]

[0017] Among them, x d (t) is the reference position, x(t) is the real-time position, ε1(t) is the position tracking error, and ε2(t) is the velocity tracking error. The tracking error system can be expressed as follows:

[0018]

[0019] In addition, x(t) and Rewrite it as a vector The error is expressed as ε e (t)=[ε1(t),ε2(t)] T In the X direction, the kinematic model is:

[0020]

[0021] Furthermore, the nonlinear ESO is designed according to the characteristics of wind disturbance and load disturbance, and the specific process is as follows:

[0022] The state expansion system of the quadcopter's position control in the X direction is as follows:

[0023]

[0024] w(t) represents the derivative of the external disturbance, which is bounded in practice, and the upper bound is denoted by w M .

[0025] According to the above state expansion system, the nonlinear ESO is designed as follows:

[0026]

[0027] The estimated errors e1(t) and e2(t) are defined as:

[0028]

[0029] The nonlinear functions H1(e1(t)) and H2(e1(t)) are defined as:

[0030]

[0031] Therefore, the observation error system can be expressed as:

[0032]

[0033] Furthermore, the position controller and attitude controller are designed based on nonlinear ESO, and the specific process is as follows:

[0034] Combining the above state expansion system and tracking error system, the new tracking error system is as follows:

[0035]

[0036] The following sliding die surface is designed for the above tracking error system:

[0037]

[0038] Based on the sliding surface designed above, an integral sliding film controller is designed as follows:

[0039]

[0040] Finally, the attitude controller of the quadrotor drone is designed. The pitch angle q(t) of the quadrotor drone is designed, and the following attitude control model is designed.

[0041]

[0042] in Based on the above attitude control system, the following attitude error system is established

[0043]

[0044] in Represents an auxiliary control quantity, the specific form is

[0045]

[0046] According to the above error system, a posture controller based on the backstepping control algorithm is designed as follows:

[0047]

[0048] Beneficial effects:

[0049] Compared with the prior art, the present invention has the following advantages:

[0050] 1. The present invention realizes the surround control of the quad-rotor UAV by building an air-ground experimental platform and taking the real-time motion position of the Kalman car as the input reference trajectory, thereby enhancing the robustness of the control system and expanding the application scope of the control system;

[0051] 2. The present invention fully considers the interference of gusts and actual loads on the flight process of the quadrotor drone, designs nonlinear ESO estimation disturbance and compensates it in the controller, significantly enhances the anti-disturbance performance of the system, and improves the autonomy and adaptability of the system to the position and environment;

[0052] 3. The present invention adopts a position-attitude dual closed-loop control structure for the quadrotor UAV. The integral term introduced in the integral sliding mode controller improves the tracking accuracy of the position control of the quadrotor UAV, and the auxiliary controller in the attitude controller improves the rapidity of the attitude control of the quadrotor UAV. Description of the drawings:

[0053] Figure 1 It is a schematic diagram of the open-air experimental platform of the present invention;

[0054] Figure 2 It is a schematic diagram of the structure of the quad-rotor drone of the present invention;

[0055] Figure 3 It is a schematic diagram of the nonlinear ESO disturbance estimation result of the present invention;

[0056] Figure 4 It is a schematic diagram of the nonlinear ESO disturbance estimation error of the present invention;

[0057] Figure 5 This is a control structure block diagram of the quad-rotor drone of the present invention;

[0058] Figure 6 It is a schematic diagram of the plane trajectory of the quad-rotor drone and the surrounding Kalman car of the present invention;

[0059] Figure 7 Schematic diagram of the planar position tracking error of the quadrotor drone of the present invention. Specific implementation method:

[0060] The present invention is described in detail below with reference to the accompanying drawings and specific embodiments.

[0061] The present invention provides a surround control method for a loaded quad-rotor unmanned aerial vehicle based on nonlinear ESO under gusts. Figure 1 The figure is a schematic diagram of the air-ground experimental platform of the present invention. First, the expected trajectory of the quad-rotor drone is planned by the real-time trajectory of the Kalman car, and then the position control of the quad-rotor drone is realized through the cooperation of the wireless data transmission unit and the positioning device, and finally the backstepping controller is used to further control the posture of the quad-rotor drone. Specifically, the following steps are included:

[0062] Step 1: Establish the dynamic model of the quadrotor drone. The external disturbance mainly considers the influence of wind force and quadrotor drone load. Figure 2 The figure is a basic structural diagram of the quad-rotor drone of the present invention. The figure introduces the six degrees of freedom of the quad-rotor drone in the translation and rotation process. According to Newton's second law and Euler's equation, the quad-rotor drone is modeled and analyzed. The dynamic model of the quad-rotor drone is as follows:

[0063]

[0064] Among them, x(t), y(t), z(t) are the positions of the quadrotor drone in space; d x (t) and d y (t) represents the external disturbance of the load and external wind force on the lateral direction of the quadrotor drone; p(t), q(t), r(t) are the angular velocities of the quadrotor drone rotating around the coordinate axes x, y, and z of the ground coordinate system; I x ,I y ,I z is the moment of inertia of the quadrotor drone rotating around its axis; m is the mass of the quadrotor drone; g is the acceleration of gravity; U1(t), U2(t), U3(t), and U4(t) are the control inputs;

[0065] The control of quadrotor drones is divided into position loop control and attitude loop control. The position control and attitude control of quadrotor drones have the following coupling relationship:

[0066]

[0067] in, and θ d (t) is the expected value of the attitude loop system of the quadrotor drone, and u1(t) and u2(t) represent the virtual control inputs of the position loop system of the quadrotor drone in the X and Y directions, respectively. Considering that the position control model of the quadrotor drone is the same in the X and Y directions, the X direction is taken as an example for analysis; the position tracking error of the quadrotor drone in the X direction is expressed as follows:

[0068]

[0069] Among them, x d (t) is the reference position, x(t) is the real-time position, ε1(t) is the position tracking error, and ε2(t) is the velocity tracking error. The tracking error system can be expressed as follows:

[0070]

[0071] In addition, x(t) and Rewrite it as a vector The error is expressed as ε e (t)=[ε1(t),ε2(t)] T In the X direction, the kinematic model is:

[0072]

[0073] Step 2: In this step, a nonlinear ESO is designed according to the characteristics of the disturbance caused by wind disturbance and the load of the quadrotor drone. Considering the position disturbance caused by external wind and load on the quadrotor drone in the present invention, a nonlinear ESO is designed to estimate the wind disturbance and load disturbance. The state expansion system of the quadrotor drone is as follows:

[0074]

[0075] w(t) represents the derivative of the external disturbance, which is bounded in practice, and the upper bound is denoted by w M .

[0076] According to the above state expansion system, a nonlinear ESO is designed as follows:

[0077]

[0078] The estimated errors e1(t) and e2(t) are defined as:

[0079]

[0080] The nonlinear functions H1(e1(t)) and H2(e1(t)) are defined as:

[0081]

[0082] The observation error system is expressed as:

[0083]

[0084] Figure 3 The disturbance estimation results of the nonlinear ESO in the experiment of the present invention are shown, showing the time-varying disturbances in the X and Y directions of the quadrotor drone during the actual flight process; Figure 4 The disturbance estimation error of nonlinear ESO is shown, showing the difference between the actual disturbance and the estimated disturbance of the quadrotor in the X and Y directions.

[0085] Step 3: Design position controller and attitude controller based on nonlinear ESO.

[0086] Figure 5 The control structure block diagram of the quadcopter in the invention. The trajectory of the Kalman car is used as the control input of the quadcopter, and the nonlinear ESO is used to estimate the total disturbance caused by wind disturbance and load to the quadcopter. The position control of the quadcopter in the invention adopts an integral sliding mode controller, and the attitude control uses a backstepping controller.

[0087] In view of the above nonlinear ESO, the next step is to design the position controller of the quadrotor drone. Combining the above state expansion system and tracking error system, the new tracking error system is obtained as follows:

[0088]

[0089] The following sliding die surface is designed for the above tracking error system:

[0090]

[0091] Based on the sliding surface designed above, the integral sliding mode controller is designed as follows:

[0092]

[0093] Finally, the inner loop controller of the quadcopter is designed. Taking the pitch angle q of the quadcopter as an example, consider the following attitude control model

[0094]

[0095] in Based on the above attitude control system, the following attitude error system is established

[0096]

[0097] in Represents an auxiliary control quantity, the specific form is

[0098]

[0099] According to the above error system, a posture controller based on the backstepping control algorithm is designed as follows:

[0100]

[0101] Figure 6 The plane trajectory diagram of the quad-rotor UAV and the surrounding Kalman car of the present invention shows the surrounding control effect of the quad-rotor UAV on the ground moving target in the present invention; Figure 7 This is the trajectory tracking error diagram of the quadrotor drone in the present invention.

[0102] Example

[0103] The air-ground experimental platform implemented by the present invention is mainly composed of the following hardware: a quad-rotor drone, an Ackerman vehicle, a computer host, a control console, an ultra-wideband positioning system, a quad-rotor drone remote control, and a data transmission device. The Ackerman vehicle is mainly used as a ground moving target tracked by the quad-rotor drone. The host computer is used to log in and control the vehicle movement. The specific schematic diagram of the air-ground experimental platform is shown in Figure 1 Displayed in.

[0104] During the air-ground experiment, the ground moving target tracked a circular trajectory with a radius of 1m. The flight path of the quadcopter drone was centered on the ground moving target and had a radius of 1m. The height of the quadcopter drone was stably controlled at 1.3 meters. The quadcopter drone obtained the real-time position of the ground moving target through the ultra-wideband positioning system. Figure 6 Demonstrated the surround control effect of a quad-rotor drone on a moving target on the ground. Figure 7 From the quadrotor UAV trajectory tracking error diagram, it can be seen that the nonlinear control strategy designed by the present invention can limit the position tracking error of the quadrotor UAV to a very small range. Figure 3 and Figure 4 It can be seen from the results in that the nonlinear ESO proposed in the present invention is effective in estimating and compensating for wind disturbance and load disturbance in the quadrotor UAV model.

Claims

1. Surround control method of quadrotor drone with load based on nonlinear ESO under gusts, It is characterized in that It includes the following steps: Step 1: Establish the dynamic model of the quadrotor drone based on external disturbances; Step 2: Design nonlinear ESO according to the characteristics of external disturbance; Step 3: Design the position controller and attitude controller of the quadrotor drone based on nonlinear ESO.

2. The method for controlling a quadrotor drone with load based on nonlinear ESO under gusts according to claim 1, It is characterized in that In step 1, the dynamic model of the quadrotor drone is established based on the external disturbance, and the specific establishment process is as follows: According to Newton's second law and Euler's equation, the quad-rotor drone is modeled and analyzed. The dynamic model of the quad-rotor drone is as follows: Among them, x(t), y(t), z(t) are the positions of the quadrotor drone in space; p(t), q(t), r(t) are the angular velocities of the quadrotor drone rotating around the coordinate axes x, y, z of the ground coordinate system; I x ,I y ,I z is the moment of inertia of the quadrotor drone rotating around its axis; m is the mass of the quadrotor drone; d x (t) and d y (t) represents the external disturbance of the load and external wind force on the lateral direction of the quadrotor drone; g is the gravitational acceleration; U 1 (t), U 2 (t), U 3 (t), U 4 (t) is the control input; The control system of the quadrotor drone is divided into a position loop control system and an attitude loop control system; the attitude loop control system and the position loop control system satisfy the following conversion relationship: in, and q d (t) is the expected value of the attitude loop system of the quadrotor drone, u 1 (t) and u 2 (t) represents the virtual control input of the position loop system of the quadrotor drone in the X and Y directions respectively; considering that the position control model of the quadrotor drone is the same in the X and Y directions, the X direction is taken as an example for subsequent analysis; the position tracking error of the quadrotor drone in the X direction is expressed as follows: Among them, x d (t) is the reference position, x(t) is the real-time position, e 1 (t) is the position tracking error, e 2 (t) is the velocity tracking error; the tracking error system can be expressed as follows: In addition, rewrite x(t) and x(t) in the X direction as a vector The error is expressed as e e (t) = [e 1 (t),e 2 (t)] T ; In the X direction, the kinematic model of the quadrotor drone is expressed as:

3. According to claim 2, a quadrotor drone surround control method based on nonlinear ESO with load under gusts, It is characterized in that The nonlinear ESO is designed according to the characteristics of wind disturbance and load disturbance. The specific process is as follows: The state expansion system of the quadcopter position control in the X direction is as follows: w(t) represents the derivative of the external disturbance, which is bounded in practice, and the upper bound is denoted by w M ; According to the above state expansion system, the nonlinear ESO is designed as follows: The estimated error e 1 (t) and e 2 (t) is defined as: Nonlinear function H 1 (e 1 (t)) and H 2 (e 1 (t)) is defined as: Therefore, the observation error system can be expressed as:

4. According to claim 3, a quadrotor drone surround control method based on nonlinear ESO with load under gusts, It is characterized in that The position controller and attitude controller of the quadrotor drone are designed based on nonlinear ESO. The specific process is as follows: Combining the above state expansion system and tracking error system, the new tracking error system is as follows: The following sliding surface is designed for the above tracking error system: Based on the sliding surface designed above, the integral sliding mode controller is designed as follows: Finally, the attitude controller of the quadrotor drone is designed. The pitch angle of the quadrotor drone is q(t). The following attitude control model is designed in Based on the above attitude control system, the following attitude error system is designed in Represents an auxiliary control quantity, the specific form is According to the above error system, the attitude controller based on the backstepping control algorithm is designed as follows: