Flight sliding mode control method of double-rotor-wing type air-submerging unmanned aerial vehicle
The sliding mode control method solves the stability of the longitudinal dual-rotor drone in a strong coupling and nonlinear environment, and realizes a simpler controller design and higher robustness, which significantly improves the drone Flight performance in high interference environments.
Patent Information
- Application Number
- CN202411124205.0
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-16
- Publication Date
- 2024-11-12
AI Technical Summary
The vertical dual-rotor UAV is difficult to maintain stability in strong coupling and nonlinear complex environments. The parameter adjustment of existing PID control methods is complex and has poor robustness. The adaptive and fuzzy control methods are complex in structure and difficult to implement engineering.
A flying sliding mode control method for a dual-rotor configuration submarine aerial vehicle was designed. By establishing a mathematical model and a sliding mode controller, using the sliding mode surface and sliding mode control law, a control signal is generated to keep the UAV in the expectation. Stable in status.
It realizes fewer controller parameters, easy to implement, and ensures stable drone attitude in high interference environments, significantly improves robustness and significantly better than the effect of PID control.
Smart Images

Figure CN118938989A_ABST
Abstract
Description
Technical Field
[0001] The invention relates to the technical field of unmanned aerial vehicle flight control, in particular to a flight sliding mode control method for a dual-rotor configuration underwater unmanned aerial vehicle. Background Art
[0002] Tandem twin-rotor UAVs combine the advantages of traditional UAVs and helicopters. They not only retain the advantages of traditional UAVs in terms of “zero casualties” and low cost, but also have the capabilities of helicopters in terms of fixed-point hovering, vertical take-off and landing, flexible flight, and low-altitude flight to avoid radar detection, playing advantages that manned helicopters and traditional UAVs do not have. However, due to the strong coupling between channels, the unique aerodynamic layout, and the difficulty in accurately calculating the mathematical model, it is very difficult to keep the body stable during the actual flight control process.
[0003] At present, the control method of tandem twin-rotor UAV is PID control. PID control plays an irreplaceable role in the flight control design of tandem twin-rotor UAV due to its advantages such as simple structure, easy implementation in engineering and low dependence on the accuracy of the mathematical model of the UAV.
[0004] However, PID control also has disadvantages such as complex parameter adjustment process and poor robustness, and the control results for strongly coupled nonlinear systems are not ideal. The tandem-rotor UAV is a complex object with strong coupling and nonlinearity. Due to its front and rear double wings, the uncertainty of the UAV's aerodynamic parameters is increased. Although the conventional PID control method can meet the basic flight functions of the tandem-rotor UAV, when the external environment is severely disturbed, the control results obtained by PID control are often unsatisfactory.
[0005] In addition, there are also more effective adaptive control and fuzzy control methods. The characteristic of the adaptive control method is that during the operation of the system, by constantly collecting information in the control process, determining the actual working state of the controlled object, continuously optimizing the performance criteria, generating adaptive control laws, and then adjusting the parameters or structure of the controller in real time, so that the system can always automatically work in the best or slightly less than the best state; the fuzzy control method uses the knowledge and experience of professionals to better understand and control the object, and can also achieve better control effects. However, the structures of these two control methods are relatively complex, and it is difficult to implement them in engineering. Summary of the invention
[0006] In view of the shortcomings of the prior art, the present invention provides a flight sliding mode control method for a dual-rotor submersible drone. The controller of the present invention has fewer adjustable parameters and is easy to implement; it can also ensure that the attitude of the drone remains stable and has high robustness.
[0007] The technical solution of the present invention is: a flight sliding mode control method for a dual-rotor submersible drone, comprising the following steps:
[0008] S1), establish a mathematical model of a tandem twin-rotor UAV;
[0009] S2), design sliding mode controller based on mathematical model of UAV;
[0010] S3), by setting the expected value of the position and attitude of the tandem twin-rotor UAV and the expected value of the speed and angular velocity x 1d ,x 2d , and the actual position, attitude value, actual speed, and angular velocity values x1, x2 of the tandem twin-rotor UAV are input into the sliding mode controller to obtain the control signal u; by applying the control signal u to the tandem twin-rotor UAV, the tandem twin-rotor UAV is controlled to remain stable in the desired state.
[0011] Preferably, in step S1), the mathematical model of the tandem twin-rotor UAV is established including a motion model and a dynamic model.
[0012] Preferably, in step S1), the expression of the motion model of the tandem twin-rotor UAV is:
[0013] ξ1=[xyz] T ;
[0014] ξ2=[φθψ] T ;
[0015] V=[uvw] T ;
[0016] W = [pqr] T ;
[0017] In the formula, ξ1,ξ2 represent the position and direction of the UAV relative to the ground coordinate system; V,W represent the components of the linear velocity and angular velocity of the UAV in the ground coordinate system in the body coordinate system; x, y, z represent the position of the UAV in the ground coordinate system, φ, θ, ψ represent the roll angle, pitch angle and yaw angle of the UAV respectively; u, v, w represent the rotation of the UAV along the body coordinate system x b ,y b ,z b The linear velocity of the axis; p, q, r are the coordinate system x of the drone. b ,y b ,z b Angular velocity of the shaft rotation.
[0018] Preferably, in step S1), the establishment of the dynamic model of the UAV comprises the following steps:
[0019] S11), construct the translation equation of the tandem twin-rotor UAV:
[0020]
[0021] In the formula, F x 、F y 、F z The total external force on the drone in the body coordinate system x b ,y b ,z b The axis component; m is the mass of the drone; g is the acceleration due to gravity, which is generally taken as 9.8m / s^2; They are respectively the coordinates of the drone along the body coordinate system x b ,y b ,z b The differential of the linear velocity of the axis; q is the coordinate system y of the drone b The angular velocity of the axis rotation; w is the angular velocity of the drone along the body coordinate system z b The linear velocity of the axis; r is the coordinate system z of the drone b The angular velocity of the axis rotation; v is the angular velocity of the drone along the body coordinate system y b u is the linear velocity of the drone along the body coordinate system x b The linear velocity of the axis; p is the coordinate system x of the drone b The angular velocity of the axis rotation; φ and θ are the roll angle and pitch angle of the drone respectively.
[0022] S12), construct the rotation equation of the tandem twin-rotor UAV:
[0023]
[0024] Where M x 、M y 、M z They are: xx ,I yy ,I zz are the moments of inertia of the drone around the x, y, and z axes, respectively, xz is the inertia product of the UAV; z is the coordinate system of the drone b The differential of the angular velocity of the shaft rotation;
[0025] S13), establish the relationship between the attitude angle and attitude angular rate of the tandem twin-rotor UAV:
[0026]
[0027] Preferably, in step S2), the sliding mode controller has two stages of motion states, and the state of the first stage is arbitrary and moves toward the sliding mode surface. Before reaching the sliding mode area of the sliding mode surface, the sliding mode surface s(x) is not 0; the control task of the first stage is: to move the sliding mode controller from an arbitrary state to the sliding mode area on the sliding mode surface within a certain period of time;
[0028] In the second stage, the sliding mode controller reaches the sliding surface and starts to move toward the sliding zone, at which time the sliding surface s(x)=0; the control task of the second stage is to ensure that the sliding surface s(x)=0 and that the state of the sliding mode controller is on the sliding surface.
[0029] Preferably, in step S2), the design of the sliding mode controller includes the design of the sliding mode surface and the sliding mode control law.
[0030] Preferably, in step S2), the sliding surface s is defined as:
[0031]
[0032] In the formula, is the error between the actual position and attitude of the tandem twin-rotor UAV and the expected value,
[0033] is the error between the actual velocity and angular velocity and the expected value, and c is the sliding surface coefficient.
[0034] Preferably, in step S2), let s=0, and obtain from formula (7):
[0035]
[0036] Solving the above, we get:
[0037]
[0038] As time goes by, e x1 、e x2 will all approach 0, and will do so in the form of an exponential function.
[0039] Preferably, in step S2), the error between the actual position and attitude of the tandem twin-rotor drone and the expected value And the error between the actual speed, angular velocity and the expected value Respectively expressed as:
[0040]
[0041] In the formula, e z , e θ 、eψ They are the error between the expected value and the actual value of the drone's height position z, the error between the expected value and the actual value of the roll angle, the error between the expected value and the actual value of the pitch angle, and the error between the expected value and the actual value of the yaw angle; e p 、e q 、e r The drones are respectively b The error between the expected value and the actual value of the axis speed, the b The error between the expected value and the actual value of the angular velocity of the axis rotation, b The error between the expected and actual angular velocity of the axis rotation and the error around z b The error between the expected and actual angular velocity of an axis.
[0042] Preferably, in step S2), the sliding mode control law is designed as follows: by deriving equation (7), the relationship between the output u of the sliding mode controller and the sliding mode surface s is obtained as follows:
[0043]
[0044] In the formula, is the reaching law; c is the sliding surface coefficient; They are the differential of the error between the actual position and attitude value of the UAV and the expected value, and the differential of the error between the actual speed and angular velocity value and the expected value; is the actual speed and angular velocity of the tandem twin-rotor UAV; ε is the reaching law coefficient; is the tangent function; k is the tangent function coefficient;
[0045] Therefore, the expression of the sliding mode controller output u is:
[0046]
[0047] By applying a control signal u to the controlled object, the controlled object will eventually remain stable in the desired state.
[0048] The beneficial effects of the present invention are:
[0049] 1. The sliding mode control method of the present invention is simpler than the traditional PID control method, has fewer adjustable parameters in the controller, and is easy to implement;
[0050] 2. The sliding mode control of the present invention can ensure that the attitude of the UAV remains stable, and its robustness is stronger than that of PID control. BRIEF DESCRIPTION OF THE DRAWINGS
[0051] Figure 1 It is a schematic diagram of the process of the present invention;
[0052] Figure 2 It is a structural framework diagram of the sliding mode controller of the present invention;
[0053] Figure 3 A comparison diagram of the height position curve of the UAV during the simulation process of the present invention;
[0054] Figure 4 A comparison diagram of the altitude error curve of the UAV during the simulation process of the present invention;
[0055] Figure 5 A comparison diagram of the roll angle curve of the UAV during the simulation process of the present invention;
[0056] Figure 6 A comparison diagram of the pitch angle curve of the UAV during the simulation process of the present invention;
[0057] Figure 7 It is a comparison diagram of the yaw angle curve of the UAV during the simulation process of the present invention. DETAILED DESCRIPTION
[0058] The specific implementation of the present invention will be further described below in conjunction with the accompanying drawings:
[0059] Example
[0060] like Figure 1 As shown, this embodiment provides a flight sliding mode control method for a dual-rotor submersible drone, comprising the following steps:
[0061] S1) Establish a mathematical model of a tandem twin-rotor UAV
[0062] This embodiment includes the establishment of a motion model and a dynamic model, wherein the expression of the motion model of the tandem twin-rotor UAV is:
[0063] ξ1=[xyz] T ;
[0064] ξ2=[φθψ] T ;
[0065] V=[uvw] T ;
[0066] W = [pqr] T ;
[0067] In the formula, ξ1,ξ2 represent the position and direction of the UAV relative to the ground coordinate system; V,W represent the components of the linear velocity and angular velocity of the UAV in the ground coordinate system in the body coordinate system; x, y, z represent the position of the UAV in the ground coordinate system, φ, θ, ψ represent the roll angle, pitch angle and yaw angle of the UAV respectively; u, v, w represent the rotation of the UAV along the body coordinate system x b ,y b ,zb The linear velocity of the axis; p, q, r are the coordinate system x of the drone. b ,y b ,z b Angular velocity of the shaft rotation.
[0068] The establishment of the dynamic model of the UAV includes the following steps:
[0069] S11), construct the translation equation of the tandem twin-rotor UAV:
[0070]
[0071] In the formula, F x 、F y 、F z The total external force on the drone in the body coordinate system x b ,y b ,z b The axis component; m is the mass of the drone; g is the acceleration due to gravity, which is generally taken as 9.8m / s^2; They are respectively the coordinates of the drone along the body coordinate system x b ,y b ,z b The differential of the linear velocity of the axis; q is the coordinate system y of the drone b The angular velocity of the axis rotation; w is the angular velocity of the drone along the body coordinate system z b The linear velocity of the axis; r is the coordinate system z of the drone b The angular velocity of the axis rotation; v is the angular velocity of the drone along the body coordinate system y b u is the linear velocity of the drone along the body coordinate system x b The linear velocity of the axis; p is the coordinate system x of the drone b The angular velocity of the axis rotation; φ and θ are the roll angle and pitch angle of the drone respectively.
[0072] S12), construct the rotation equation of the tandem twin-rotor UAV:
[0073]
[0074] Where M x 、M y 、M z They are: xx ,I yy ,I zz are the moments of inertia of the drone around the x, y, and z axes, respectively, xz is the inertia product of the UAV; z is the coordinate system of the drone b The differential of the angular velocity of the shaft rotation;
[0075] S13), establish the relationship between the attitude angle and attitude angular rate of the tandem twin-rotor UAV:
[0076]
[0077] S2) Design of sliding mode controller based on mathematical model of UAV
[0078] In this embodiment, the sliding mode controller has two stages of motion states, and the state of the first stage is arbitrary and moves toward the sliding mode surface. Before reaching the sliding mode area of the sliding mode surface, the sliding mode surface s(x) is not 0; the control task of the first stage is: to move the sliding mode controller from an arbitrary state to the sliding mode area on the sliding mode surface within a certain period of time;
[0079] In the second stage, the sliding mode controller reaches the sliding surface and starts to move toward the sliding zone, at which time the sliding surface s(x)=0; the control task of the second stage is to ensure that the sliding surface s(x)=0 and that the state of the sliding mode controller is on the sliding surface.
[0080] Therefore, in this embodiment, the design of the sliding mode controller includes the design of the sliding mode surface and the sliding mode control law; wherein,
[0081] The sliding surface s is defined as:
[0082]
[0083] In the formula, is the error between the actual position and attitude of the tandem twin-rotor UAV and the expected value,
[0084] is the error between the actual velocity and angular velocity and the expected value, and c is the sliding surface coefficient.
[0085] Let s = 0, and we can obtain from equation (7):
[0086]
[0087] Solving the above, we get:
[0088]
[0089] As time goes by, e x1 、e x2 will approach 0, and will approach it in the form of an exponential function. hour, The process of approaching zero has been completed by 63.2%. The process is almost 95% complete. By adjusting the size of c, you can change The speed at which it approaches 0. The larger c is, the faster it approaches 0. Approaching 0 indicates that the position, attitude and other state quantities of the tandem-rotor UAV can track the target command well. This means that if equation (7) is zero, the state of the system will approach zero along the sliding surface (s = 0).
[0090] The error between the actual position and attitude of the tandem dual-rotor drone and the expected value And the error between the actual speed, angular velocity and the expected value Respectively expressed as:
[0091]
[0092] In the formula, e z , e θ 、e ψ They are the error between the expected value and the actual value of the drone's height position z, the error between the expected value and the actual value of the roll angle, the error between the expected value and the actual value of the pitch angle, and the error between the expected value and the actual value of the yaw angle; e p 、e q 、e r The drones are respectively b The error between the expected value and the actual value of the axis speed, the b The error between the expected value and the actual value of the angular velocity of the axis rotation, b The error between the expected and actual angular velocity of the axis rotation and the error around z b The error between the expected and actual angular velocity of an axis.
[0093] In this embodiment, the sliding mode control law is designed as follows: By deriving equation (7), the relationship between the output u of the sliding mode controller and the sliding surface s is obtained as follows:
[0094]
[0095] In the formula, is the reaching law; c is the sliding surface coefficient; They are the differential of the error between the actual position and attitude value of the UAV and the expected value, and the differential of the error between the actual speed and angular velocity value and the expected value; is the error between the actual speed and angular velocity of the tandem twin-rotor UAV and the expected value; ε is the reaching law coefficient; is the tangent function; k is the tangent function coefficient;
[0096] Therefore, the expression of the sliding mode controller output u is:
[0097]
[0098] By applying a control signal u to the controlled object, the controlled object will eventually remain stable in the desired state.
[0099] S3), by setting the expected value of the position and attitude of the tandem twin-rotor UAV and the expected value of the speed and angular velocity x 1d ,x 2d , and the actual position, attitude value, actual speed, and angular velocity values x1, x2 of the tandem twin-rotor UAV are input into the sliding mode controller to obtain the control signal u; by applying the control signal u to the tandem twin-rotor UAV, the tandem twin-rotor UAV is controlled to remain stable in the desired state.
[0100] In this embodiment, under the influence of 1N interference force and 0.1N·m interference torque, the UAV is allowed to take off vertically to a height of 0.5m, and the actual height and expected height and attitude angle of the UAV are compared when the PID control and the sliding mode control SMC of the present invention are used respectively. Figure 3-7 ,from Figure 3-7 It can be seen that:
[0101] In the presence of disturbance forces and disturbance torques, the altitude position z of the drone can track the desired trajectory well under both PID control and sliding mode control (SMC), but the tracking performance of PID control is better than that of sliding mode control. Although the steady-state error of sliding mode control is smaller, the adjustment time is longer, and the system has obvious jitter.
[0102] In terms of attitude angle, it can be clearly found that after adopting sliding mode control, the attitude angle of the tandem twin-rotor UAV can basically be kept near the stable value, which is significantly better than the control effect of PID control. In addition, by adjusting the size of the interference force and interference torque and conducting repeated experiments, it can be found that under the interference force exceeding 4N and the interference torque of 0.2N·m, the UAV using PID control is difficult to maintain a stable state and cannot track the desired trajectory, while the UAV using sliding mode control can still maintain the attitude angle near the stable value under the interference force of 20N and the interference torque of 3N·m, and can better track the desired trajectory. The above results show that the sliding mode control is more robust and can significantly improve the anti-interference ability of the system.
[0103] The above embodiments and descriptions are only for illustrating the principles and best embodiments of the present invention. Without departing from the spirit and scope of the present invention, the present invention may be subject to various changes and improvements, all of which fall within the scope of the present invention to be protected.
Claims
1. A flight sliding mode control method for a dual-rotor submersible drone. It is characterized in that The following steps are involved: S1), establish a mathematical model of a tandem twin-rotor UAV; S2), design sliding mode controller based on mathematical model of UAV; S3), by setting the expected value of the position and attitude of the tandem twin-rotor UAV and the expected value of the speed and angular velocity x 1d , x 2d , and the actual position, attitude value, actual speed, and angular velocity value x of the tandem twin-rotor drone 1 , x 2 The sliding mode controller is input to obtain the control signal u; by applying the control signal u to the tandem twin-rotor UAV, the tandem twin-rotor UAV is controlled to remain stable in the desired state.
2. The flight sliding mode control method of a dual-rotor submersible drone according to claim 1, Features: In step S1), a mathematical model of the tandem twin-rotor UAV is established, including a motion model and a dynamic model.
3. The flight sliding mode control method of a dual-rotor submersible drone according to claim 2, Features: In step S1), the expression of the motion model of the tandem twin-rotor drone is: ξ 1 =[xyz] T 4 x 2 =[φ θ ψ] T ; V=[u v w] T ; W=[p q r] T ; In the formula, ξ 1 ,ξ 2 They represent the position and direction of the UAV relative to the ground coordinate system; V, W represent the components of the linear velocity and angular velocity of the UAV in the ground coordinate system in the body coordinate system; x, y, z represent the position of the UAV in the ground coordinate system, φ, θ, ψ represent the roll angle, pitch angle and yaw angle of the UAV respectively; u, v, w represent the rotation of the UAV along the body coordinate system x b ,y b , z b The linear velocity of the axis; p, q, r are the coordinate system x of the drone. b ,y b , z b Angular velocity of the shaft rotation.
4. The flight sliding mode control method of a dual-rotor submersible drone according to claim 2, Features: In step S1), the establishment of the dynamic model of the UAV includes the following steps: S11), construct the translation equation of the tandem twin-rotor UAV: In the formula, F x 、F y 、F z The total external force on the drone in the body coordinate system x b ,y b , z b The axis component; m is the mass of the drone; g is the acceleration due to gravity, which is generally taken as 9.8m / s^2; They are respectively the coordinates of the drone along the body coordinate system x b ,y b , z b The differential of the linear velocity of the axis; q is the coordinate system y of the drone b Angular velocity of the shaft rotation; w is the coordinate system z of the drone b The linear velocity of the axis; r is the coordinate system z of the drone b The angular velocity of the axis rotation; v is the angular velocity of the drone along the body coordinate system y b u is the linear velocity of the drone along the body coordinate system x b The linear velocity of the axis; p is the coordinate system x of the drone b The angular velocity of the axis rotation; φ and θ are the roll angle and pitch angle of the drone respectively. S12), construct the rotation equation of the tandem twin-rotor UAV: Where M x 、M y 、M z They are: xx ,I yy ,I zz are the moments of inertia of the drone around the x, y, and z axes, respectively. xz is the inertia product of the UAV; z is the coordinate system of the drone b The differential of the angular velocity of the shaft rotation: S13), establish the relationship between the attitude angle and attitude angular rate of the tandem twin-rotor UAV:
5. The flight sliding mode control method of a dual-rotor submersible drone according to claim 1, Features: In step S2), the sliding mode controller has two stages of motion states, and the state of the first stage is arbitrary and moves toward the sliding mode surface. Before reaching the sliding mode area of the sliding mode surface, the sliding mode surface s(x) is not 0; the control task of the first stage is: to move the sliding mode controller from an arbitrary state to the sliding mode area on the sliding mode surface within a certain period of time; In the second stage, the sliding mode controller reaches the sliding surface and starts to move toward the sliding zone, at which time the sliding surface s(x)=0; the control task of the second stage is to ensure that the sliding surface s(x)=0 and that the state of the sliding mode controller is on the sliding surface.
6. The flight sliding mode control method of a dual-rotor submersible drone according to claim 5, Features: In step S2), the design of the sliding mode controller includes the design of the sliding mode surface and the sliding mode control law.
7. The flight sliding mode control method of a dual-rotor submersible drone according to claim 6, Features: In step S2), the sliding surface s is defined as: In the formula, is the error between the actual position and attitude of the tandem twin-rotor UAV and the expected value, is the error between the actual velocity and angular velocity and the expected value, and c is the sliding surface coefficient.
8. The flight sliding mode control method of a dual-rotor submersible drone according to claim 7, Features: In step S2), let s = 0, and obtain from formula (7): Solving the above, we get: As time goes by, e x1 、e x2 will all approach 0, and will do so in the form of an exponential function.
9. The flight sliding mode control method of a dual-rotor submersible drone according to claim 7, Features: The design of the sliding mode control law is as follows: By deriving equation (7), the relationship between the output u of the sliding mode controller and the sliding surface s is obtained as follows: In the formula, is the reaching law; c is the sliding surface coefficient; They are the differential of the error between the actual position and attitude value of the UAV and the expected value, and the differential of the error between the actual speed and angular velocity value and the expected value; is the error between the actual speed and angular velocity of the tandem twin-rotor UAV and the expected value; ε is the reaching law coefficient; is the tangent function; k is the tangent function coefficient; Therefore, the expression of the sliding mode controller output u is: By applying a control signal u to the controlled object, the controlled object will eventually remain stable in the desired state.
10. The flight sliding mode control method of a dual-rotor submersible drone according to claim 8, Features: In step S2), the error between the actual position and attitude of the tandem-rotor UAV and the expected value is And the error between the actual speed, angular velocity and the expected value Respectively expressed as: In the formula, e z , e θ 、e ψ They are the error between the expected value and the actual value of the drone's height position z, the error between the expected value and the actual value of the roll angle, the error between the expected value and the actual value of the pitch angle, and the error between the expected value and the actual value of the yaw angle; e p 、e q 、e r The drones are respectively b The error between the expected value and the actual value of the axis speed, the b The error between the expected value and the actual value of the angular velocity of the axis rotation, b The error between the expected and actual angular velocity of the axis rotation and the error around z b The error between the expected and actual angular velocity of an axis.
