Unmanned aerial vehicle trajectory tracking method and device

Through the dual-ring controller based on the sliding mode surface and parameter adaptive law of the terminal at a predetermined time, the problem of convergence time dependence on the initial state in the trajectory tracking control of the quadrotor UAV is solved, and accurate tracking and robustness are achieved within the predetermined time .

CN118884992APending Publication Date: 2024-11-01INST OF AUTOMATION CHINESE ACAD OF SCI
View PDF 0 Cites 4 Cited by

Patent Information

Application Number
CN202410795538.X
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-06-19
Publication Date
2024-11-01

AI Technical Summary

Technical Problem

During flight, due to model uncertainty and external disturbance, the upper bound of the convergence time of the finite time control method depends on the initial state of the system, and the upper bound of the convergence time of the fixed time control method cannot be pre-determined by the user. , resulting in large errors in trajectory tracking control.

Method used

Using a dual-ring controller, including a position loop controller and an attitude loop controller, based on the terminal sliding mode surface, parameter adaptive law and the predetermined time adaptive non-singular terminal sliding mode control law, the expected trajectory data of the drone is obtained by obtaining the drone's expected trajectory data. Perform position and attitude tracking control to ensure the accuracy and robustness of trajectory tracking information.

Benefits of technology

The position and attitude tracking error of the four-rotor drone converge to a neighborhood where the convergence time is converged to zero within a predetermined time, and the upper bound of the convergence time can be pre-determined by the user, improving the accuracy and robustness of the trajectory tracking control.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118884992A_ABST
    Figure CN118884992A_ABST
Patent Text Reader

Abstract

The invention provides an unmanned aerial vehicle trajectory tracking method and device, and the method comprises the steps: obtaining the expected trajectory data of an unmanned aerial vehicle, carrying out the position tracking control of the unmanned aerial vehicle based on a dual-loop controller according to an expected position, and obtaining the lift force, the expected roll angle and the expected pitch angle of the unmanned aerial vehicle; performing attitude tracking control on the unmanned aerial vehicle based on a double-loop controller according to the expected roll angle, the pitch angle and the expected yaw angle to obtain a three-axis torque of the unmanned aerial vehicle; the double-loop controller is determined based on a preset time terminal sliding mode surface, a parameter adaptive law and a preset time adaptive nonsingular terminal sliding mode control law; and inputting the lift force and the three-axis torque into a kinematic model of the unmanned aerial vehicle to obtain trajectory tracking information of the unmanned aerial vehicle. According to the method, it can be ensured that the position and attitude tracking errors of the four-rotor unmanned aerial vehicle converge to the neighborhood of zero within the preset time, the upper bound of the convergence time can be given by a user in advance, and the accuracy and robustness of trajectory tracking control of the unmanned aerial vehicle are improved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of robot control, and in particular to a method and device for tracking the trajectory of an unmanned aerial vehicle. Background Art

[0002] Compared with fixed-wing UAVs, quadrotor UAVs have the advantages of vertical take-off and landing, hovering in the air, and strong load capacity, and are widely used in military and civilian fields.

[0003] Flight control system design is the key technology for quadrotor drones to achieve stable flight. However, quadrotor drones have the characteristics of underactuation, strong coupling, and high nonlinearity. In addition, during flight, quadrotor drones will inevitably be affected by model uncertainty and external disturbances, which brings great challenges to the design of quadrotor drone flight control systems.

[0004] In related technologies, convergence time is an important performance indicator of UAV posture control. The finite-time control method can ensure that the system state converges to the equilibrium position within a bounded time. However, the upper limit of the convergence time of the finite-time control method is seriously dependent on the initial state of the system, and the upper limit of the convergence time of the fixed-time control method cannot be given in advance by the user, which reduces its engineering application value to a certain extent. Summary of the invention

[0005] The present invention provides a method and device for tracking the trajectory of an unmanned aerial vehicle, which are used to solve the problem that when a finite time control method is used in the prior art, the upper limit of the control convergence time is seriously dependent on the initial state of the system, and the upper limit of the convergence time of the fixed time control method cannot be given in advance by the user, resulting in a large trajectory tracking control error, thereby improving the accuracy and robustness of the trajectory tracking control of the unmanned aerial vehicle.

[0006] The present invention provides a method for tracking a trajectory of an unmanned aerial vehicle, comprising: Acquire the expected trajectory data of the UAV, wherein the expected trajectory data includes the expected position and expected yaw angle of the UAV; perform position tracking control on the UAV according to the expected position based on the dual-loop controller to obtain the lift, expected roll angle and expected pitch angle of the UAV; perform attitude tracking control on the UAV according to the expected roll angle, the pitch angle and the expected yaw angle based on the dual-loop controller to obtain the three-axis torque of the UAV; the dual-loop controller is determined based on the predetermined time terminal sliding mode surface, the parameter adaptive law and the predetermined time adaptive non-singular terminal sliding mode control law; The lift and the three-axis torque are input into the kinematic model of the UAV to obtain the trajectory tracking information of the UAV; the trajectory tracking information includes the center of mass position, target yaw angle, target roll angle and target pitch angle of the UAV.

[0007] According to a UAV trajectory tracking method provided by the present invention, the dual-loop controller includes a position loop controller and an attitude loop controller; The position loop controller is determined based on a predetermined time terminal sliding mode surface with respect to the position, a parameter adaptive law with respect to the position, and a predetermined time adaptive non-singular terminal sliding mode control law with respect to the position; The attitude loop controller is determined based on a predetermined time terminal sliding mode surface with respect to the attitude, a parameter adaptation law with respect to the attitude, and a predetermined time adaptive non-singular terminal sliding mode control law with respect to the attitude.

[0008] According to a UAV trajectory tracking method provided by the present invention, the dual-loop controller is a position loop controller; The dual-loop controller is used to perform position tracking control on the UAV according to the desired position to obtain the lift, desired roll angle, and desired pitch angle of the UAV, including: determining a position tracking error based on a historical tracking position of the drone and the desired position; Determine the predetermined time terminal sliding mode surface of the position loop controller with respect to the position according to the position tracking error using the following formula; Wherein, s1 is the predetermined time terminal sliding surface with respect to the position, h 11 and h 12 is the gain parameter, μ is the exponential parameter; p e is the position tracking error, For p e The amount of change over time, sig is a function; The following formula is used to determine the predetermined time adaptive non-singular terminal sliding mode control law of the position loop controller according to the predetermined time terminal sliding mode surface and the parameter adaptive law of the position: Among them, U p is the predetermined time adaptive non-singular end sliding mode control law about the position, m is the mass of the UAV, sat σ is the saturation function, k 11 and k 12 is the gain parameter, Λ 11 and Λ 12 is the matrix related to the system state, η1 is the constant related to the adaptive law; g is the gravitational acceleration, is the second-order derivative of the desired position, is the parameter adaptation law about position; The virtual position control input is solved according to the predetermined time adaptive non-singular end sliding mode control law about the position to obtain the lift, the desired roll angle and the desired pitch angle.

[0009] According to a UAV trajectory tracking method provided by the present invention, the dual-loop controller is an attitude loop controller; The dual-loop controller performs attitude tracking control on the UAV according to the roll angle, the desired pitch angle, and the desired yaw angle to obtain the three-axis torque of the UAV, including: Determine an attitude tracking error according to the historical tracking attitude and the expected attitude of the UAV, wherein the expected attitude includes the expected yaw angle, the roll angle, and the expected pitch angle; Determine the predetermined time terminal sliding mode surface of the attitude loop controller with respect to the attitude according to the attitude tracking error using the following formula; Wherein, s2 is the predetermined time terminal sliding surface with respect to the posture, h 21 and h 22 is the gain parameter, μ is the exponential parameter; Θ e is the posture tracking error, is θ e The amount of change over time, sig is a function; The following formula is used to determine the predetermined time adaptive non-singular terminal sliding mode control law of the attitude loop controller according to the predetermined time terminal sliding mode surface and the parameter adaptive law of the attitude: Wherein, τ is the predetermined time adaptive non-singular end sliding mode control law about attitude, J is the moment of inertia of the UAV, sat σ is the saturation function, k 21 and k 22 is the gain parameter, Λ 21 and Λ 22 is the matrix related to the system state, η2 is the constant related to the adaptive law, and C is the Coriolis force and centrifugal force terms; is the change of the historical tracking posture over time, is the second-order derivative of the desired attitude, is the parameter adaptation law about posture; The virtual attitude control input is solved according to the predetermined time adaptive non-singular end sliding mode control law about the attitude to obtain the three-axis torque.

[0010] According to a UAV trajectory tracking method provided by the present invention, the kinematic model of the UAV includes a position dynamics model and an attitude dynamics model; The position dynamics model is obtained by the following formula: in, is the second-order derivative of the center of mass position, m is the mass of the UAV, U is the lift of the UAV, d U is the external disturbance force on the UAV, R is the transformation matrix from the UAV body coordinate system to the inertial coordinate system, e3 = [0, 0, 1] T is the unit vector in the vertical direction; The posture dynamics model is obtained by the following formula: in, is the first-order derivative of the three-axis attitude of the UAV, is the second-order derivative of the three-axis attitude of the UAV, d τ is the external disturbance torque of the UAV, J is the moment of inertia of the UAV, C is the Coriolis force and centrifugal force, and τ is the three-axis torque of the UAV.

[0011] According to a UAV trajectory tracking method provided by the present invention, the parameter adaptive law includes a parameter adaptive law about position and a parameter adaptive law about attitude; The parameter adaptation law about the position is obtained by the following formula: in, is the first-order derivative of the parameter adaptation law about the posture, l 11 , l 12 and γ1 are both gain parameters; The parameter adaptation law about the posture is obtained by the following formula: in, is the first-order derivative of the parameter adaptation law with respect to position, l 21 , l 22 and γ2 are gain parameters.

[0012] The present invention also provides a UAV trajectory tracking device, comprising: A data acquisition module, used to acquire the expected trajectory data of the UAV, wherein the expected trajectory data includes the expected position and expected yaw angle of the UAV; A motion and attitude control module, configured to perform position tracking control on the UAV according to the desired position based on a dual-loop controller to obtain the lift, desired roll angle, and desired pitch angle of the UAV; perform attitude tracking control on the UAV according to the desired roll angle, the pitch angle, and the desired yaw angle based on the dual-loop controller to obtain the three-axis torque of the UAV; the dual-loop controller is determined based on a predetermined time terminal sliding mode surface, a parameter adaptive law, and a predetermined time adaptive non-singular terminal sliding mode control law; The output module is used to input the lift and the three-axis torque into the kinematic model of the UAV to obtain the trajectory tracking information of the UAV; the trajectory tracking information includes the center of mass position, target yaw angle, target roll angle and target pitch angle of the UAV.

[0013] The present invention also provides an electronic device, comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein when the processor executes the program, the drone trajectory tracking method described above is implemented.

[0014] The present invention also provides a non-transitory computer-readable storage medium having a computer program stored thereon, and when the computer program is executed by a processor, the method for tracking the trajectory of a drone as described in any one of the above is implemented.

[0015] The present invention also provides a computer program product, comprising a computer program, wherein when the computer program is executed by a processor, the computer program implements any of the above-mentioned drone trajectory tracking methods.

[0016] The unmanned aerial vehicle trajectory tracking method and device provided by the present invention perform position tracking control on the unmanned aerial vehicle according to the expected position through a dual-loop controller to obtain the lift, expected roll angle and expected pitch angle of the unmanned aerial vehicle; perform attitude tracking control on the unmanned aerial vehicle according to the expected roll angle, pitch angle and expected yaw angle through the dual-loop controller to obtain the three-axis torque of the unmanned aerial vehicle, and then input the lift and three-axis torque into the kinematic model of the unmanned aerial vehicle to obtain the trajectory tracking information of the unmanned aerial vehicle, which can ensure that the position and attitude tracking errors of the quad-rotor unmanned aerial vehicle converge to a neighborhood of zero within a predetermined time, and the upper limit of the convergence time can be given in advance by the user, so as to ensure the accuracy and robustness of the unmanned aerial vehicle trajectory tracking control. BRIEF DESCRIPTION OF THE DRAWINGS

[0017] In order to more clearly illustrate the technical solutions in the present invention or the prior art, the following briefly introduces the drawings required for use in the embodiments or the description of the prior art. Obviously, the drawings described below are some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.

[0018] Figure 1This is one of the flow charts of the UAV trajectory tracking method provided by the present invention; Figure 2 This is the second flow chart of the UAV trajectory tracking method provided by the present invention; Figure 3 It is a structural schematic diagram of the UAV trajectory tracking device provided by the present invention; Figure 4 It is a structural schematic diagram of the electronic device provided by the present invention. DETAILED DESCRIPTION

[0019] In order to make the purpose, technical solution and advantages of the present invention clearer, the technical solution of the present invention will be clearly and completely described below in conjunction with the drawings of the present invention. Obviously, the described embodiments are part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.

[0020] Combine the following Figure 1-Figure 3 The present invention describes a method and device for tracking the trajectory of a drone.

[0021] Figure 1 FIG. 1 is one of the flow charts of the UAV trajectory tracking method provided by the present invention, such as Figure 1 As shown, the UAV trajectory tracking method includes the following steps: Step 110: Obtain expected trajectory data of the UAV, where the expected trajectory data includes an expected position and an expected yaw angle of the UAV.

[0022] In this step, the drone can be a quad-rotor drone or other types of multi-rotor drones.

[0023] In this step, the expected trajectory data may be generated by a preset expected trajectory generator.

[0024] For example, the expected trajectory generator may be a UAV motion trajectory simulation system, which is used to perform flight simulation based on the flight data of the UAV and output an expected flight position and an expected yaw angle, etc.

[0025] Step 120: Based on the dual-loop controller, the position of the UAV is tracked and controlled according to the desired position to obtain the lift, desired roll angle and desired pitch angle of the UAV; based on the dual-loop controller, the attitude of the UAV is tracked and controlled according to the desired roll angle, pitch angle and desired yaw angle to obtain the three-axis torque of the UAV; the dual-loop controller is determined based on the predetermined time terminal sliding mode surface, the parameter adaptive law and the predetermined time adaptive non-singular terminal sliding mode control law.

[0026] In this embodiment, the dual-loop controller design adopts a dual-loop control architecture of a position loop and an attitude loop.

[0027] In this embodiment, the dual-loop controller includes a position loop controller and an attitude loop controller; the position loop controller is determined based on a predetermined time terminal sliding mode surface regarding the position, a parameter adaptive law regarding the position, and a predetermined time adaptive non-singular terminal sliding mode control law regarding the position; the attitude loop controller is determined based on a predetermined time terminal sliding mode surface regarding the attitude, a parameter adaptive law regarding the attitude, and a predetermined time adaptive non-singular terminal sliding mode control law regarding the attitude.

[0028] Specifically, this embodiment designs a position controller based on a predetermined time adaptive non-singular terminal sliding mode control method to achieve tracking of the desired position of the quadrotor drone and obtain the lift and roll angle θ d and the pitch angle φ d Then, the attitude controller is designed based on the predetermined time adaptive non-singular terminal sliding mode control method to achieve the desired attitude Θ d =[φ d ,θ d , ψ d ] T By tracking, we can get the three-axis torque τ.

[0029] In this embodiment, the trajectory data of the UAV includes the position and attitude of the UAV; the process of using the dual-loop controller to track the actual trajectory of the UAV according to the expected trajectory data includes: first determining the trajectory tracking error according to the historical trajectory and the expected trajectory of the UAV, and then calculating the corresponding predetermined time terminal sliding surface according to the trajectory tracking error; finally, determining the predetermined time adaptive non-singular terminal sliding mode control law of the UAV according to the predetermined time terminal sliding surface and the parameter adaptive law, and then solving the corresponding lift and three-axis torque.

[0030] Step 130: Input the lift and three-axis torque into the kinematic model of the UAV to obtain the trajectory tracking information of the UAV; the trajectory tracking information includes the center of mass position of the UAV, the target yaw angle, the target roll angle and the target pitch angle.

[0031] In this step, the kinematic model of the UAV includes a dynamic model and an attitude dynamics model; the position subsystem of the dynamic model receives the lift output by the position loop of the dual-loop controller, and determines the center of mass position of the UAV according to the external disturbance force; the attitude subsystem of the dynamic model receives the three-axis torque output by the attitude loop of the dual-loop controller, and determines the target yaw angle, target roll angle and target pitch angle of the UAV according to the external disturbance torque.

[0032] In this embodiment, the kinematic model of the drone includes a position dynamics model and an attitude dynamics model; the position dynamics model is obtained by the following formula: in, is the second-order derivative of the center of mass position, m is the mass of the drone, U is the lift of the drone, and d U is the external disturbance force on the UAV, R is the transformation matrix from the UAV body coordinate system to the inertial coordinate system, e3 = [0, 0, 1] T is the unit vector in the vertical direction; the attitude dynamics model is obtained by the following formula: in, is the first-order derivative of the three-axis attitude of the UAV, is the second-order derivative of the three-axis attitude of the UAV, d τ is the external disturbance torque of the UAV, J is the moment of inertia of the UAV, C is the Coriolis force and centrifugal force, and τ is the three-axis torque of the UAV.

[0033] In this embodiment, the position and attitude dynamics model of the above-mentioned quadrotor drone can be established according to the Euler Lagrangian modeling principle; wherein p = [x, y, z] T and Θ = [φ, θ, ψ] T The center of mass position and three-axis attitude of the quadrotor drone; the following parameters can be set: d U =[0.01sin(0.3t), 0.03cos(0.3t), 0.02sin(0.2t)] T N; d τ =[0.02sin(0.2t), 0.03cos(0.2t), 0.02sin(0.3t)] T Nm; Among them, I=diag{I x , I y , I z =diag{0.4, 0.4, 0.8}kg / m 2 ; In addition, C is the Coriolis force and centrifugal force term, which can be calculated by the following formula: In this embodiment, the lift U and the three-axis torque τ are set as the control input of the quadrotor drone; let U p =URe3 is the virtual control input; set m=m0+m Δ 、J=J0+J Δ and C=C0+C Δ , where m0 = 0.9m, J0 = 0.9J and C0 = 0.9C are nominal values, mΔ =0.1m, J Δ = 0.1 J and C Δ =0.1C is an uncertain value; through the above settings, the position and attitude dynamics models of the quadrotor drone can be transformed into the following formulas: in, and is the lumped uncertainty; assuming that the lumped uncertainty δ U and δ τ is bounded, that is, there is an unknown constant b U >0 and b τ >0 makes ||δ U ||≤b U and ||δ τ ||≤b τ .

[0034] In this embodiment, the center of mass position is outputted by the above-mentioned deformed position dynamics model, and the center of mass position can also be sent to the position loop controller to be used as the expected position for the next calculation of the position tracking error; the target yaw angle, target roll angle and target pitch angle are outputted by the above-mentioned deformed attitude dynamics model, and the target yaw angle can also be sent to the attitude loop controller to be used as the expected yaw angle for the next calculation of the attitude tracking error.

[0035] The UAV trajectory tracking method provided by the embodiment of the present invention performs position tracking control on the UAV according to the expected position through a dual-loop controller to obtain the lift, expected roll angle and expected pitch angle of the UAV; performs attitude tracking control on the UAV according to the expected roll angle, pitch angle and expected yaw angle through the dual-loop controller to obtain the three-axis torque of the UAV, and then inputs the lift and three-axis torque into the kinematic model of the UAV to obtain the trajectory tracking information of the UAV, which can ensure that the position and attitude tracking errors of the quad-rotor UAV converge to a neighborhood of zero within a predetermined time, and the upper limit of the convergence time can be given in advance by the user, so as to ensure the accuracy and robustness of the UAV trajectory tracking control.

[0036] In some embodiments, the dual-loop controller is a position loop controller; performing position tracking control on the UAV according to the desired position based on the dual-loop controller to obtain the lift, desired roll angle, and desired pitch angle of the UAV includes: determining a position tracking error according to the historical tracking position and the desired position of the UAV; determining a predetermined time terminal sliding surface of the position loop controller with respect to the position according to the position tracking error using the following formula; Where s1 is the predetermined time terminal sliding surface with respect to the position, h 11 and h 12 is the gain parameter, μ is the exponential parameter; pe is the position tracking error, For p e The change over time, sig is a function; the following formula is used to determine the predetermined time adaptive non-singular terminal sliding mode control law of the position loop controller according to the predetermined time terminal sliding mode surface of the position and the parameter adaptive law of the position: Among them, U p is the predetermined time adaptive non-singular end sliding mode control law about the position, m is the mass of the UAV, sat σ is the saturation function, k 11 and k 12 is the gain parameter, Λ 11 and Λ 12 is the matrix related to the system state, η1 is the constant related to the adaptive law; g is the gravitational acceleration, is the second-order derivative of the desired position, is a parameter adaptive law about the position; according to the predetermined time adaptive non-singular end sliding mode control law about the position, the virtual position control input is solved to obtain the lift, the desired roll angle and the desired pitch angle.

[0037] In this embodiment, let p d =[0.5cos(0.5t), 0.5sin(0.5t), 2+0.1t] T m is the expected position of the quadrotor drone, and the position tracking error is defined as p e =pp d , and construct the above-mentioned predetermined time terminal sliding surface about the position.

[0038] in, μ=2 / 11,T c1 =10, α=1, β=1; given a set of column vectors ζ=[ζ1, ζ2, ..., ζ n ] T and scalar q, function sig q (ζ) is defined as sig q (ζ)=[|ζ1| q sgn(ζ1),|ζ2| q sgn(ζ2),...,|ζ n | q sgn(ζ n )] T .

[0039] The predetermined time adaptive non-singular terminal sliding mode control law with respect to the position is constructed by the predetermined time terminal sliding mode surface with respect to the position.

[0040] in, T c2 =10, η1=0.5, σ=10, Λ 11 =diag{|x e | -μ ,|y e | -μ ,|z e | -μ},Λ 12 =diag{|x e | μ ,|y e | μ ,|z e | μ}; For Estimates; given a set of column vectors ζ = [ζ1, ζ2, ..., ζ n ] T , saturation function sat σ (ζ) is defined as: sat σ (ζ)=[sat σ (ζ1), sat σ (ζ2),...,sat σ (ζ n )] T ; Among them, sat σ (ζ i ) can be expressed as: In this embodiment, the parameter adaptive law includes a parameter adaptive law about the position, and the parameter adaptive law about the position is obtained by the following formula: in, is the first-order derivative of the parameter adaptation law about the posture, l 11 , l 12 and γ1 are both gain parameters; In this embodiment, γ1=1, The initial value of is set to 0.

[0041] In this embodiment, the virtual control input U p =[U1,U2,U3] T Expand and solve to obtain lift U and roll angle θ d and the pitch angle φ d The expression is:

[0042] In some embodiments, the dual-loop controller is an attitude loop controller; performing attitude tracking control on the UAV based on the dual-loop controller according to the roll angle, the expected pitch angle and the expected yaw angle, and obtaining the three-axis torque of the UAV includes: determining an attitude tracking error according to the historical tracking attitude and the expected attitude of the UAV, the expected attitude including the expected yaw angle period, the expected roll angle and the expected pitch angle; using the following formula to determine the predetermined time terminal sliding mode surface of the attitude loop controller according to the attitude tracking error; Where s2 is the predetermined time terminal sliding surface of the posture, l 21 , l 22 and γ2 are gain parameters; Θ e is the posture tracking error, is θ e The change over time, sig is a function; the following formula is used to determine the attitude loop controller's predetermined time adaptive non-singular terminal sliding mode control law according to the predetermined time terminal sliding mode surface and the attitude parameter adaptive law: Wherein, τ is the predetermined time adaptive non-singular end sliding mode control law about attitude, J is the moment of inertia of the UAV, sat σ is the saturation function, k 21 and k 22 is the gain parameter, Λ 21 and Λ 22 is the matrix related to the system state, η2 is the constant related to the adaptive law, and C is the Coriolis force and centrifugal force terms; is the change of historical tracking posture over time, is the second-order derivative of the desired attitude, is the parameter adaptation law about the attitude; according to the predetermined time adaptive non-singular end sliding mode control law about the attitude, the virtual attitude control input is solved to obtain the three-axis torque.

[0043] In this embodiment, given the desired yaw angle ψ d =π / 3rad, let Θ d =[φ d ,θ d , ψ d ] T is the desired attitude of the quadrotor drone, and the attitude tracking error is defined as Θ e =Θ-Θ d , and construct the above-mentioned predetermined time terminal sliding surface about the posture.

[0044] in, T c3 =4.

[0045] The predetermined time terminal sliding mode surface about the posture is used to construct the predetermined time adaptive non-singular terminal sliding mode control law about the posture.

[0046] in, T c4 =4,η2=0.5,Λ 21 =diag{|φ e | -μ ,|θ e | -μ ,|ψ e | -μ},Λ 22 =diag{|φ e | μ ,|θ e | μ ,|ψ e | μ}, For Estimates.

[0047] In this embodiment, the parameter adaptive law also includes a parameter adaptive law about posture, and the parameter adaptive law about posture is obtained by the following formula: The parameter adaptive law about posture is obtained by the following formula: in, is the first-order derivative of the parameter adaptation law with respect to position, l 21 , l 22 and γ2 are gain parameters.

[0048] In this embodiment, γ2=1, The initial value of is set to 0.

[0049] In this embodiment, a position controller with a predetermined time is used to ensure that the position and speed tracking errors of the quadrotor drone are within the predetermined time T. U =max{T c1 , T c2} converges to zero in the neighborhood; the attitude controller with a predetermined time can ensure that the attitude and angular velocity tracking errors of the quadrotor drone are within the predetermined time T τ =max{T c1 , T c2 , T c3 , T c4}converges to zero in the neighborhood, the above controller adopts an adaptive non-singular terminal sliding mode control method, which is highly robust to model uncertainties and external disturbances; in addition, the parameter adaptive law is used to estimate the square of the upper bound of the lumped uncertainty term, replacing the sign switching term in the traditional sliding mode controller, so that the entire controller is smooth and can greatly reduce the chattering phenomenon without losing control accuracy.

[0050] In this embodiment, the controller in the trajectory tracking control method proposed in this application is easy to implement, has good tracking performance, is suitable for tasks such as logistics distribution, agricultural measurement, and environmental monitoring, and has a wide range of applications.

[0051] Figure 2 This is the second flow chart of the UAV trajectory tracking method provided by the present invention. Figure 2 In the embodiment shown, the expected position p is generated by the expected trajectory generator d and the desired yaw angle ψ d , p d Input to the position loop controller to obtain the fixed time terminal sliding surface s1, and transform s1 and the parameter adaptive law The lift U and the desired roll angle θ are obtained by the fixed-time non-singular terminal sliding mode control law. d and the desired pitch angle φ d , and then input U into the position subsystem of the position dynamics model, and output the center of mass position p of the UAV in combination with the disturbance force; d ,θ d and φ d Input to the attitude loop controller to obtain the fixed time terminal sliding surface s2, and transform s2 and the parameter adaptive law The three-axis torque τ is obtained through the fixed-time non-singular terminal sliding mode control law, and then τ is input into the attitude subsystem of the attitude dynamics model. Combined with the disturbance torque, the target attitude Θ (including target yaw angle, target roll angle and target pitch angle) of the UAV is output; in addition, the center of mass position p of the UAV can be used as the expected position of the position dynamics model in the next calculation of the position tracking error, and the target attitude Θ of the UAV can be used as the expected position of the attitude dynamics model in the next calculation of the attitude tracking error.

[0052] The drone trajectory tracking device provided by the present invention is described below. The drone trajectory tracking device described below and the drone trajectory tracking method described above can be referenced to each other.

[0053] Figure 3 : is a schematic diagram of the structure of the UAV trajectory tracking device provided by the present invention, such as Figure 3 As shown, the UAV trajectory tracking device includes: a data acquisition module 310, a motion and posture control module 320 and an output module 330.

[0054] The data acquisition module 310 is used to acquire the expected trajectory data of the UAV, where the expected trajectory data includes the expected position and expected yaw angle of the UAV; The motion and attitude control module 320 is used to perform position tracking control on the UAV according to the desired position based on the dual-loop controller to obtain the lift, desired roll angle and desired pitch angle of the UAV; perform attitude tracking control on the UAV according to the desired roll angle, pitch angle and desired yaw angle based on the dual-loop controller to obtain the three-axis torque of the UAV; the dual-loop controller is determined based on the predetermined time terminal sliding mode surface, the parameter adaptive law and the predetermined time adaptive non-singular terminal sliding mode control law; The output module 330 is used to input the lift and three-axis torque into the kinematic model of the UAV to obtain the trajectory tracking information of the UAV; the trajectory tracking information includes the center of mass position of the UAV, the target yaw angle, the target roll angle and the target pitch angle.

[0055] The unmanned aerial vehicle trajectory tracking device provided by the embodiment of the present invention performs position tracking control on the unmanned aerial vehicle according to the expected position through a dual-loop controller to obtain the lift, expected roll angle and expected pitch angle of the unmanned aerial vehicle; performs attitude tracking control on the unmanned aerial vehicle according to the expected roll angle, pitch angle and expected yaw angle through the dual-loop controller to obtain the three-axis torque of the unmanned aerial vehicle, and then inputs the lift and three-axis torque into the kinematic model of the unmanned aerial vehicle to obtain the trajectory tracking information of the unmanned aerial vehicle, which can ensure that the position and attitude tracking errors of the quad-rotor unmanned aerial vehicle converge to a neighborhood of zero within a predetermined time, and the upper limit of the convergence time can be given in advance by the user, so as to ensure the accuracy and robustness of the unmanned aerial vehicle trajectory tracking control.

[0056] The present invention also provides an electronic device, comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein when the processor executes the program, any one of the above-mentioned drone trajectory tracking methods is implemented.

[0057] Figure 4 is a schematic diagram of the structure of the electronic device provided by the present invention, such as Figure 4As shown, the electronic device may include: a processor (Processor) 410, a communication interface (Communications Interface) 420, a memory (Memory) 430 and a communication bus 440, wherein the processor 410, the communication interface 420, and the memory 430 communicate with each other through the communication bus 440. The processor 410 can call the logic instructions in the memory 430 to execute the UAV trajectory tracking method, which includes: obtaining the expected trajectory data of the UAV, the expected trajectory data including the expected position and expected yaw angle of the UAV; based on the dual-loop controller, performing position tracking control on the UAV according to the expected position to obtain the lift, expected roll angle and expected pitch angle of the UAV; based on the dual-loop controller, performing attitude tracking control on the UAV according to the expected roll angle, pitch angle and expected yaw angle to obtain the three-axis torque of the UAV; the dual-loop controller is determined based on the predetermined time terminal sliding mode surface, the parameter adaptive law and the predetermined time adaptive non-singular terminal sliding mode control law; the lift and three-axis torque are input into the kinematic model of the UAV to obtain the trajectory tracking information of the UAV; the trajectory tracking information includes the center of mass position, target yaw angle, target roll angle and target pitch angle of the UAV.

[0058] In addition, the logic instructions in the above-mentioned memory 430 can be implemented in the form of a software functional unit and can be stored in a computer-readable storage medium when it is sold or used as an independent product. Based on such an understanding, the technical solution of the present invention, in essence, or the part that contributes to the prior art or the part of the technical solution, can be embodied in the form of a software product, and the computer software product is stored in a storage medium, including a number of instructions for a computer device (which can be a personal computer, a server, or a network device, etc.) to perform all or part of the steps of the method described in each embodiment of the present invention. The aforementioned storage medium includes: U disk, mobile hard disk, read-only memory (ROM, Read-Only Memory), random access memory (RAM, Random Access Memory), disk or optical disk and other media that can store program codes.

[0059] On the other hand, the present invention also provides a computer program product, which includes a computer program, and the computer program can be stored on a non-transitory computer-readable storage medium. When the computer program is executed by a processor, the computer can execute the UAV trajectory tracking method provided by the above methods, and the method includes: obtaining the expected trajectory data of the UAV, the expected trajectory data includes the expected position and expected yaw angle of the UAV; based on the dual-loop controller, the position tracking control of the UAV is performed according to the expected position to obtain the lift, expected roll angle and expected pitch angle of the UAV; based on the dual-loop controller, the attitude tracking control of the UAV is performed according to the expected roll angle, pitch angle and expected yaw angle to obtain the three-axis torque of the UAV; the dual-loop controller is determined based on the predetermined time terminal sliding mode surface, the parameter adaptive law and the predetermined time adaptive non-singular terminal sliding mode control law; the lift and three-axis torque are input into the kinematic model of the UAV to obtain the trajectory tracking information of the UAV; the trajectory tracking information includes the center of mass position, target yaw angle, target roll angle and target pitch angle of the UAV.

[0060] On the other hand, the present invention also provides a non-transitory computer-readable storage medium having a computer program stored thereon, which is implemented when the processor executes the UAV trajectory tracking method provided by the above methods, the method comprising: obtaining the expected trajectory data of the UAV, the expected trajectory data including the expected position and expected yaw angle of the UAV; performing position tracking control on the UAV according to the expected position based on a dual-loop controller to obtain the lift, expected roll angle and expected pitch angle of the UAV; performing attitude tracking control on the UAV according to the expected roll angle, pitch angle and expected yaw angle based on the dual-loop controller to obtain the three-axis torque of the UAV; the dual-loop controller is determined based on a predetermined time terminal sliding mode surface, a parameter adaptive law and a predetermined time adaptive non-singular terminal sliding mode control law; the lift and three-axis torque are input into the kinematic model of the UAV to obtain the trajectory tracking information of the UAV; the trajectory tracking information includes the center of mass position, target yaw angle, target roll angle and target pitch angle of the UAV.

[0061] The device embodiments described above are merely illustrative, wherein the units described as separate components may or may not be physically separated, and the components displayed as units may or may not be physical units, that is, they may be located in one place, or they may be distributed on multiple network units. Some or all of the modules may be selected according to actual needs to achieve the purpose of the scheme of this embodiment. Ordinary technicians in this field can understand and implement it without paying creative labor.

[0062] Through the description of the above implementation methods, those skilled in the art can clearly understand that each implementation method can be implemented by means of software plus a necessary general hardware platform, and of course, it can also be implemented by hardware. Based on this understanding, the above technical solution is essentially or the part that contributes to the prior art can be embodied in the form of a software product, and the computer software product can be stored in a computer-readable storage medium, such as ROM / RAM, a disk, an optical disk, etc., including a number of instructions for a computer device (which can be a personal computer, a server, or a network device, etc.) to execute the methods described in each embodiment or some parts of the embodiments.

[0063] Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present invention, rather than to limit it. Although the present invention has been described in detail with reference to the aforementioned embodiments, those skilled in the art should understand that they can still modify the technical solutions described in the aforementioned embodiments, or make equivalent replacements for some of the technical features therein. However, these modifications or replacements do not deviate the essence of the corresponding technical solutions from the spirit and scope of the technical solutions of the embodiments of the present invention.

Claims

1. A method for tracking the trajectory of an unmanned aerial vehicle, characterized in that: include: Acquire expected trajectory data of the UAV, wherein the expected trajectory data includes an expected position and an expected yaw angle of the UAV; Based on the dual-loop controller, the position tracking control of the UAV is performed according to the desired position to obtain the lift, desired roll angle and desired pitch angle of the UAV; based on the dual-loop controller, the attitude tracking control of the UAV is performed according to the desired roll angle, the pitch angle and the desired yaw angle to obtain the three-axis torque of the UAV; the dual-loop controller is determined based on the predetermined time terminal sliding mode surface, the parameter adaptive law and the predetermined time adaptive non-singular terminal sliding mode control law; The lift and the three-axis torque are input into the kinematic model of the UAV to obtain the trajectory tracking information of the UAV; the trajectory tracking information includes the center of mass position, target yaw angle, target roll angle and target pitch angle of the UAV.

2. The method for tracking the trajectory of a UAV according to claim 1, characterized in that: The dual-loop controller includes a position loop controller and a posture loop controller; The position loop controller is determined based on a predetermined time terminal sliding mode surface with respect to the position, a parameter adaptive law with respect to the position, and a predetermined time adaptive non-singular terminal sliding mode control law with respect to the position; The attitude loop controller is determined based on a predetermined time terminal sliding mode surface with respect to the attitude, a parameter adaptation law with respect to the attitude, and a predetermined time adaptive non-singular terminal sliding mode control law with respect to the attitude.

3. The method for tracking the trajectory of a UAV according to claim 1, characterized in that: The dual-loop controller is a position loop controller; The dual-loop controller is used to perform position tracking control on the UAV according to the desired position to obtain the lift, desired roll angle, and desired pitch angle of the UAV, including: determining a position tracking error based on a historical tracking position of the drone and the desired position; Determine the predetermined time terminal sliding mode surface of the position loop controller with respect to the position according to the position tracking error using the following formula; Wherein, s1 is the predetermined time terminal sliding surface with respect to the position, h 11 and h 12 is the gain parameter, μ is the exponential parameter; p e is the position tracking error, For p e The amount of change over time, sig is a function; The following formula is used to determine the predetermined time adaptive non-singular terminal sliding mode control law of the position loop controller according to the predetermined time terminal sliding mode surface and the parameter adaptive law of the position: Among them, U p is the predetermined time adaptive non-singular end sliding mode control law about the position, m is the mass of the UAV, sat σ is the saturation function, k 11 and k 12 is the gain parameter, Λ 11 and Λ 12 is the matrix related to the system state, η1 is the constant related to the adaptive law; g is the gravitational acceleration, is the second-order derivative of the desired position, is the parameter adaptation law about position; The virtual position control input is solved according to the predetermined time adaptive non-singular end sliding mode control law about the position to obtain the lift, the desired roll angle and the desired pitch angle.

4. The method for tracking the trajectory of a UAV according to claim 1, characterized in that: The dual-loop controller is a posture loop controller; The dual-loop controller performs attitude tracking control on the UAV according to the roll angle, the desired pitch angle, and the desired yaw angle to obtain the three-axis torque of the UAV, including: Determine an attitude tracking error according to the historical tracking attitude and the expected attitude of the UAV, wherein the expected attitude includes the expected yaw angle, the roll angle, and the expected pitch angle; Determine the predetermined time terminal sliding mode surface of the attitude loop controller with respect to the attitude according to the attitude tracking error using the following formula; Wherein, s2 is the predetermined time terminal sliding surface with respect to the posture, h 21 and h 22 is the gain parameter, μ is the exponential parameter; Θ e is the posture tracking error, is θ e The amount of change over time, sig is a function; The following formula is used to determine the predetermined time adaptive non-singular terminal sliding mode control law of the attitude loop controller according to the predetermined time terminal sliding mode surface and the parameter adaptive law of the attitude: Wherein, τ is the predetermined time adaptive non-singular end sliding mode control law about attitude, J is the moment of inertia of the UAV, sat σ is the saturation function, k 21 and k 22 is the gain parameter, Λ 21 and Λ 22 is the matrix related to the system state, η2 is the constant related to the adaptive law, and C is the Coriolis force and centrifugal force terms; is the change of the historical tracking posture over time, is the second-order derivative of the desired attitude, is the parameter adaptation law about posture; The virtual attitude control input is solved according to the predetermined time adaptive non-singular end sliding mode control law about the attitude to obtain the three-axis torque.

5. The method for tracking the trajectory of a UAV according to claim 1, characterized in that: The kinematic model of the UAV includes a position dynamics model and an attitude dynamics model; The position dynamics model is obtained by the following formula: in, is the second-order derivative of the center of mass position, m is the mass of the UAV, U is the lift of the UAV, d U is the external disturbance force on the UAV, R is the transformation matrix from the UAV body coordinate system to the inertial coordinate system, e3 = [0, 0, 1] T is the unit vector in the vertical direction; The posture dynamics model is obtained by the following formula: in, is the first-order derivative of the three-axis attitude of the UAV, is the second-order derivative of the three-axis attitude of the UAV, d τ is the external disturbance torque of the UAV, J is the moment of inertia of the UAV, C is the Coriolis force and centrifugal force, and τ is the three-axis torque of the UAV.

6. The UAV trajectory tracking method according to any one of claims 2 to 4, wherein the parameter adaptive law comprises a parameter adaptive law about position and a parameter adaptive law about attitude; The parameter adaptation law about the position is obtained by the following formula: in, is the first-order derivative of the parameter adaptation law about the posture, l 11 , l 12 and γ1 are both gain parameters; The parameter adaptation law about the posture is obtained by the following formula: in, is the first-order derivative of the parameter adaptation law with respect to position, l 21 , l 22 and γ2 are gain parameters.

7. A drone trajectory tracking device, characterized in that: include: A data acquisition module, used to acquire the expected trajectory data of the UAV, wherein the expected trajectory data includes the expected position and expected yaw angle of the UAV; A motion and attitude control module, configured to perform position tracking control on the UAV according to the desired position based on a dual-loop controller to obtain the lift, desired roll angle, and desired pitch angle of the UAV; perform attitude tracking control on the UAV according to the desired roll angle, the pitch angle, and the desired yaw angle based on the dual-loop controller to obtain the three-axis torque of the UAV; the dual-loop controller is determined based on a predetermined time terminal sliding mode surface, a parameter adaptive law, and a predetermined time adaptive non-singular terminal sliding mode control law; The output module is used to input the lift and the three-axis torque into the kinematic model of the UAV to obtain the trajectory tracking information of the UAV; the trajectory tracking information includes the center of mass position, target yaw angle, target roll angle and target pitch angle of the UAV.

8. An electronic device comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein: When the processor executes the program, the drone trajectory tracking method as described in any one of claims 1 to 6 is implemented.

9. A non-transitory computer-readable storage medium having a computer program stored thereon, characterized in that: When the computer program is executed by a processor, the drone trajectory tracking method according to any one of claims 1 to 6 is implemented.

10. A computer program product, comprising a computer program, characterized in that When the computer program is executed by a processor, the drone trajectory tracking method according to any one of claims 1 to 6 is implemented.

Citation Information

Cited By

  • Adaptive trajectory tracking control method for deformable unmanned aerial vehicle

    CN121433304A

  • Anti-disturbance unmanned aerial vehicle trajectory tracking control method, system, equipment and medium

    CN121596898A

  • Unmanned aerial vehicle adaptive sliding mode control method, system, device and medium

    CN121957080A

  • An unmanned aerial vehicle adaptive sliding mode control method, system, device and medium

    CN121957080B