CN114489105A - Novel unmanned aerial vehicle attitude system integral sliding mode control method based on disturbance observer - Google Patents
Novel unmanned aerial vehicle attitude system integral sliding mode control method based on disturbance observer Download PDFInfo
- Publication number
- CN114489105A CN114489105A CN202210089145.8A CN202210089145A CN114489105A CN 114489105 A CN114489105 A CN 114489105A CN 202210089145 A CN202210089145 A CN 202210089145A CN 114489105 A CN114489105 A CN 114489105A
- Authority
- CN
- China
- Prior art keywords
- sliding mode
- matrix
- integral sliding
- aerial vehicle
- unmanned aerial
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 41
- 238000013459 approach Methods 0.000 claims abstract description 28
- 239000011159 matrix material Substances 0.000 claims description 89
- 238000013016 damping Methods 0.000 claims description 21
- 230000006870 function Effects 0.000 claims description 17
- 230000001133 acceleration Effects 0.000 claims description 13
- 239000000126 substance Substances 0.000 claims description 12
- 238000004590 computer program Methods 0.000 claims description 11
- 238000013461 design Methods 0.000 claims description 3
- 230000004069 differentiation Effects 0.000 claims description 3
- 230000010354 integration Effects 0.000 claims description 3
- 230000001052 transient effect Effects 0.000 abstract description 5
- 230000000694 effects Effects 0.000 description 4
- 230000008569 process Effects 0.000 description 3
- 238000004088 simulation Methods 0.000 description 3
- 238000009795 derivation Methods 0.000 description 2
- 230000001360 synchronised effect Effects 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 238000004422 calculation algorithm Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 230000001629 suppression Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
- G05D1/106—Change initiated in response to external conditions, e.g. avoidance of elevated terrain or of no-fly zones
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
The application relates to a novel unmanned aerial vehicle attitude system integral sliding mode control method and device based on a disturbance observer, an unmanned aerial vehicle and a storage medium. The method comprises the following steps: acquiring parameter errors and external disturbances observed by an interference observer in real time; inputting the parameter error and the external disturbance into a novel integral sliding mode controller, and enabling the novel integral sliding mode controller to output a control signal to control the posture of the unmanned aerial vehicle according to the parameter error and the external disturbance; the novel integral sliding mode controller is constructed in the following mode: constructing an unmanned aerial vehicle attitude dynamic system model according to the dynamic characteristics of the unmanned aerial vehicle; determining an attitude angle error, and constructing an integral sliding mode surface; constructing an integral sliding mode approach law; according to the unmanned aerial vehicle attitude dynamics system model, the integral sliding mode surface and the integral sliding mode approach law, a novel integral sliding mode controller is constructed, so that the problem that the transient performance is weakened during initial control is solved.
Description
Technical Field
The application relates to the technical field of unmanned aerial vehicle attitude system control, in particular to a novel unmanned aerial vehicle attitude system integral sliding mode control method and device based on an interference observer, a computer storage medium and an unmanned aerial vehicle.
Background
Along with the development in unmanned aerial vehicle technical field, unmanned aerial vehicle can realize the collection of high resolution image, when compensateing satellite remote sensing and often sheltering from because of the cloud cover and can not acquireing from the image shortcoming, has solved traditional satellite remote sensing revisits cycle overlength, emergent untimely scheduling problem, consequently, unmanned aerial vehicle wide application in each field, if: plant protection, military, personal, forest fire suppression, and the like.
At present, aiming at the unmanned aerial vehicle, a controller is also diversified, the traditional integral sliding mode is one of the traditional integral sliding modes, the traditional integral sliding mode control method enables the system state to slide to the target state by applying a nonlinear signal, a curve through which the system state slides is called a sliding mode surface, but the traditional integral sliding mode control method can generate a larger transient performance problem during initial control.
Disclosure of Invention
Based on this, it is necessary to provide a novel unmanned aerial vehicle attitude system integral sliding mode control method, apparatus, computer device and storage medium based on a disturbance observer, which can alleviate the problem of transient performance reduction during initial control.
A novel unmanned aerial vehicle attitude system integral sliding mode control method based on a disturbance observer comprises the following steps:
acquiring parameter errors and external disturbances observed by an interference observer in real time;
inputting the parameter error and the external disturbance into a novel integral sliding mode controller, and enabling the novel integral sliding mode controller to output a control signal to control the posture of the unmanned aerial vehicle according to the parameter error and the external disturbance;
the novel integral sliding mode controller is constructed in the following mode:
constructing an unmanned aerial vehicle attitude dynamic system model according to the dynamic characteristics of the unmanned aerial vehicle;
determining an attitude angle error, and constructing an integral sliding mode surface;
constructing an integral sliding mode approach law;
and constructing a novel integral sliding mode controller according to the unmanned aerial vehicle attitude dynamics system model, the integral sliding mode surface and the integral sliding mode approach law.
In one embodiment, the disturbance observer is constructed in the following manner:
determining a corresponding interference item according to the unmanned aerial vehicle attitude dynamics system model;
and constructing a disturbance observer according to the disturbance term.
In one embodiment, the model of the unmanned aerial vehicle attitude dynamics system is:
wherein the content of the first and second substances,is the acceleration of the pitch angle,is the pitch angle rate of the blade,is the angular acceleration of the roll, and,is the angular velocity of the roll-over,is the yaw angular acceleration and is,is the yaw rate; j. the design is a squarexIs the rotary inertia of the x axis of the quad-rotor unmanned plane, JyMoment of inertia, J, for the y-axis of a quad-rotor unmanned aerial vehiclezThe moment of inertia of the z axis of the quad-rotor unmanned aerial vehicle;air damping coefficient of y-axis, KθAir damping coefficient of x-axis, KηAir damping coefficient for the z-axis; the parameter error of the pitch angle and the total disturbance of the external disturbance areThe parameter error of the roll angle and the total disturbance of the external disturbance are dθ(t) the parameter error of the yaw angle and the total disturbance of the external disturbances are dη(t), l is the length of the force arm;controller output as pitch angle, uθFor controller output of the roll angle, uηC is the constant force coefficient, which is the controller output for yaw angle.
In one embodiment, the integral sliding mode surface is:
wherein, KpIs a column entry parameter matrix, KiIs a matrix of integral term parameters, KdIs a matrix of differential term parameters, K1Is a matrix of scaling parameters that is, kpθand kpηIn order to compare the column entry parameters,kiθand kiηIn order to be the integral term parameter,kdθand kdηIn order to be a parameter of the differentiation term,k1θand k1ηIn order to scale the parameters of the image,is a matrix of the attitude error,is pitchAngle, theta is the roll angle, eta is the yaw angle,is the target value of the pitch angle, θdIs a target value of the roll angle, ηdIs the target value of the yaw angle,is the error in the angular velocity of the attitude,is the error in the pitch angle rate of the blade,is the error in the roll angular velocity,is the error of the yaw rate, tau is the time variable used for integration, s is the integral sliding mode surface matrix,sliding form surface being pitch angle, sθIs the slip form face of the roll angle, sηIs the slip-form surface of the yaw angle, e (τ) is the attitude error matrix at time τ, and t is time.
In one embodiment, the integral sliding mode approach law is as follows:
wherein the content of the first and second substances,is the derivative of the integral sliding mode surface, K2Is an exponential approximation term parameter matrix, K3For the constant-velocity-approach-term parameter matrix,k2θand k2ηIs exponential trendThe parameters of the near term are used as parameters, k3θand k3ηFor the parameters of the constant-velocity approach term,s is an integral sliding mode surface matrix.
In one embodiment, the novel integral sliding mode controller is:
wherein the content of the first and second substances,in order for the controller to output a matrix,controller output, u, representing pitch angleθController output, u, representing the roll angleηController output, K, representing yaw angle0In the form of a matrix of air damping coefficients,air damping coefficient of y-axis, KθAir damping coefficient of x-axis, KηAir damping coefficient for the z-axis;is a matrix of the attitude angular velocity,is a matrix of the angular acceleration of the attitude,is a matrix of the attitude angles and,is an unmanned aerial vehicle moment of inertia parameter matrix, JxIs the rotary inertia of the x axis of the quad-rotor unmanned plane, JyMoment of inertia, J, for the y-axis of a quad-rotor unmanned aerial vehiclezThe moment of inertia of the z axis of the quad-rotor unmanned aerial vehicle;is a matrix of total interference estimates and,is a total disturbance estimate of the pitch angle,is a total disturbance estimate of the roll angle,is a total disturbance estimate for the yaw angle,is a moment arm length matrix, l is the moment arm length, c is the constant force coefficient; kpIs a column entry parameter matrix, KiIs a matrix of integral term parameters, KdIs a matrix of differential term parameters, K1Is a matrix of scaling parameters that is,is the error of attitude angular velocity, s is the integral sliding mode surface matrix, K2Is an exponential approximation term parameter matrix, K3Is a constant velocity approach term parameter matrix.
In one embodiment, the disturbance observer is:
wherein the content of the first and second substances,is the differential of the estimate of the attitude angular velocity,is an estimate of the attitude angular velocity,is a matrix of attitude angular velocities, Z1Is the total interference estimate, Z2Is an estimate of the derivative of the total interference,is the derivative of the estimate of the total interference,is the derivative of the total interference derivative estimate, L is the moment arm length matrix, u is the controller output matrix, L0、L1、L2、L3Is a matrix of error parameters that is, L0θ、L0η、L1θ、L1η、L2θ、L2η、L3θand L3ηIs an error parameter; λ is an auxiliary parameter, λ>0, sat (x) is a saturation function,
wherein maxVal is a set maximum value of the saturation function, and R is a real number.
A novel unmanned aerial vehicle attitude system integral sliding mode control device based on a disturbance observer, the device comprises:
the information acquisition module is used for acquiring parameter errors and external disturbances observed by the interference observer in real time;
the control module is used for inputting the parameter error and the external disturbance into a novel integral sliding mode controller, so that the novel integral sliding mode controller outputs a control signal to control the posture of the unmanned aerial vehicle according to the parameter error and the external disturbance;
the novel integral sliding mode controller is constructed in the following mode:
constructing an unmanned aerial vehicle attitude dynamic system model according to the dynamic characteristics of the unmanned aerial vehicle;
determining an attitude angle error, and constructing an integral sliding mode surface;
constructing an integral sliding mode approach law;
and constructing a novel integral sliding mode controller according to the unmanned aerial vehicle attitude dynamics system model, the integral sliding mode surface and the integral sliding mode approach law.
A drone comprising a memory storing a computer program and a processor implementing the steps of the method when the processor executes the computer program.
A computer-readable storage medium, on which a computer program is stored which, when being executed by a processor, carries out the steps of the method.
According to the novel unmanned aerial vehicle attitude system integral sliding mode control method and device based on the disturbance observer, the unmanned aerial vehicle and the storage medium, the parameter error and the external disturbance observed by the disturbance observer are obtained in real time; inputting the parameter error and the external disturbance into a novel integral sliding mode controller, and enabling the novel integral sliding mode controller to output a control signal to control the posture of the unmanned aerial vehicle according to the parameter error and the external disturbance; the novel integral sliding mode controller is constructed in the following mode: constructing an unmanned aerial vehicle attitude dynamic system model according to the dynamic characteristics of the unmanned aerial vehicle; determining an attitude angle error, and constructing an integral sliding mode surface; constructing an integral sliding mode approach law; according to the unmanned aerial vehicle attitude dynamics system model, the integral sliding mode surface and the integral sliding mode approach law, a novel integral sliding mode controller is constructed, the novel integral sliding mode controller has stronger robustness, small errors can be amplified, and large errors are reduced, so that an error curve is more smooth, the problem that the transient performance is weakened during initial control is solved, and the problems that the unmanned aerial vehicle parameters are inaccurate and the control effect is influenced by external interference are further solved.
Drawings
Fig. 1 is a schematic flow chart of a novel unmanned aerial vehicle attitude system integral sliding mode control method based on a disturbance observer in one embodiment;
FIG. 2 is a graph of a target pitch angle and an actual pitch angle in software simulation;
FIG. 3 is a graph of actual disturbance values and observed disturbance values of pitch angles in software simulation;
FIG. 4 is a graph of a target roll angle and an actual roll angle in a software simulation;
FIG. 5 is a graph of an actual disturbance value of a roll angle and an observed disturbance value of the roll angle in software simulation;
FIG. 6 is a graph of target yaw angle and actual yaw angle in a software simulation;
FIG. 7 is a graph of actual yaw angle disturbance values and yaw angle disturbance observations in a software simulation.
Detailed Description
In order to make the objects, technical solutions and advantages of the present application more apparent, the present application is described in further detail below with reference to the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are merely illustrative of the present application and are not intended to limit the present application.
In one embodiment, as shown in fig. 1, a novel unmanned aerial vehicle attitude system integral sliding mode control method based on a disturbance observer is provided, which is described by taking the method as an example applied to an unmanned aerial vehicle, and includes the following steps:
step S220, acquiring the parameter error and the external disturbance observed by the disturbance observer in real time.
Wherein, the disturbance observer is used for observing unmanned aerial vehicle's parameter error and external disturbance, lets unmanned aerial vehicle control effect better.
And S240, inputting the parameter error and the external disturbance into a novel integral sliding mode controller, and outputting a control signal to control the posture of the unmanned aerial vehicle by the novel integral sliding mode controller according to the parameter error and the external disturbance.
The novel integral sliding mode controller is constructed in the following mode: constructing an unmanned aerial vehicle attitude dynamic system model according to the dynamic characteristics of the unmanned aerial vehicle; determining an attitude angle error, and constructing an integral sliding mode surface; constructing an integral sliding mode approach law; and constructing a novel integral sliding mode controller according to the unmanned aerial vehicle attitude dynamics system model, the integral sliding mode surface and the integral sliding mode approach law.
According to the novel unmanned aerial vehicle attitude system integral sliding mode control method based on the disturbance observer, the parameter error and the external disturbance observed by the disturbance observer are obtained in real time; inputting the parameter error and the external disturbance into a novel integral sliding mode controller, and enabling the novel integral sliding mode controller to output a control signal to control the posture of the unmanned aerial vehicle according to the parameter error and the external disturbance; the novel integral sliding mode controller is constructed in the following mode: constructing an unmanned aerial vehicle attitude dynamic system model according to the dynamic characteristics of the unmanned aerial vehicle; determining an attitude angle error, and constructing an integral sliding mode surface; constructing an integral sliding mode approach law; according to the unmanned aerial vehicle attitude dynamics system model, the integral sliding mode surface and the integral sliding mode approach law, a novel integral sliding mode controller is constructed, the novel integral sliding mode controller has stronger robustness, small errors can be amplified, and large errors are reduced, so that an error curve is more smooth, the problem that the transient performance is weakened during initial control is solved, and the problems that the unmanned aerial vehicle parameters are inaccurate and the control effect is influenced by external interference are further solved.
In one embodiment, the disturbance observer is constructed in a manner that: determining a corresponding interference item according to the unmanned aerial vehicle attitude dynamic system model; and constructing a disturbance observer according to the disturbance term.
In one embodiment, the model of the unmanned aerial vehicle attitude dynamics system is:
wherein the content of the first and second substances,is the acceleration of the pitch angle of the vehicle,is the pitch angle rate of the blade,is the angular acceleration of the roll, and,is the angular velocity of the roll-over,is the yaw angular acceleration and is,is the yaw rate; j. the design is a squarexIs the rotary inertia of the x axis of the quad-rotor unmanned plane, JyMoment of inertia, J, for the y-axis of a quad-rotor unmanned aerial vehiclezThe moment of inertia of the z axis of the quad-rotor unmanned aerial vehicle;air damping coefficient of y-axis, KθAir damping coefficient of x-axis, KηAir damping coefficient for the z-axis; the parameter error of the pitch angle and the total disturbance of the external disturbance areThe parameter error of the roll angle and the total disturbance of the external disturbance are dθ(t) the parameter error of the yaw angle and the total disturbance of the external disturbances are dη(t), l is the length of the force arm;controller output as pitch angle, uθFor controller output of the roll angle, uηC is the constant force coefficient, which is the controller output for yaw angle.
In one embodiment, the integral slip form surface is:
wherein, KpIs a column entry parameter matrix, KiIs a matrix of integral term parameters, KdIs a matrix of differential term parameters, K1Is a matrix of scaling parameters that is, kpθand kpηIn order to compare the column entry parameters,kiθand kiηIn order to be the integral term parameter,kdθand kdηIn order to be a parameter of the differentiation term,k1θand k1ηIn order to scale the parameters of the image,is a matrix of the attitude errors,is the pitch angle, theta is the roll angle, eta is the yaw angle,is the target value of the pitch angle, θdIs a target value of the roll angle, ηdIs the target value of the yaw angle,is the error in the angular velocity of the attitude,is the error in the pitch angle rate of the blade,is the error in the roll angular velocity,is the error of the yaw rate, tau is the time variable used for integration, s is the integral sliding mode surface matrix,sliding form surface being pitch angle, sθIs the slip form face of the roll angle, sηIs the slip-form surface of the yaw angle, e (τ) is the attitude error matrix at time τ, and t is time.
The integral term tanh (e (tau)) in the integral sliding mode surface can enlarge small errors and reduce large errors, so that an error curve is smoother.
In one embodiment, the integral sliding mode approach law is:
wherein the content of the first and second substances,is the derivative of the integral sliding mode surface, K2Is an exponential approximation term parameter matrix, K3For the constant-velocity-approach-term parameter matrix,k2θand k2ηIn order to be an exponential-approaching term parameter, k3θand k3ηFor the parameters of the constant-velocity approach term,s is an integral sliding mode surface matrix.
In one embodiment, the novel integral sliding mode controller is:
wherein the content of the first and second substances,in order for the controller to output a matrix,controller output, u, representing pitch angleθController output, u, representing the roll angleηController output, K, representing yaw angle0Is the damping coefficient of airThe matrix is a matrix of a plurality of matrices,air damping coefficient of y-axis, KθAir damping coefficient of x-axis, KηAir damping coefficient for the z-axis;is a matrix of the attitude angular velocity,is a matrix of the angular acceleration of the attitude,is a matrix of the attitude angles and,is an unmanned aerial vehicle moment of inertia parameter matrix, JxIs the rotary inertia of the x axis of the quad-rotor unmanned plane, JyMoment of inertia, J, for the y-axis of a quad-rotor unmanned aerial vehiclezThe moment of inertia of the z axis of the quad-rotor unmanned aerial vehicle;is a matrix of total interference estimates and,is a total disturbance estimate of the pitch angle,is a total disturbance estimate of the roll angle,is a total disturbance estimate for the yaw angle,is a moment arm length matrix, l is the moment arm length, c is the constant force coefficient; kpIs a column entry parameter matrix, KiIs a matrix of integral term parameters, KdIs differentialItem parameter matrix, K1Is a matrix of scaling parameters that is,is the error of attitude angular velocity, s is the integral sliding mode surface matrix, K2Is an exponential approximation term parameter matrix, K3Is a constant velocity approach term parameter matrix.
In one embodiment, the disturbance observer is:
wherein the content of the first and second substances,is the differential of the estimate of the attitude angular velocity,is an estimate of the attitude angular velocity,is a matrix of attitude angular velocities, Z1Is the total interference estimate, Z2Is an estimate of the derivative of the total interference,is the derivative of the estimate of the total interference,is the derivative of the total interference derivative estimate, L is the moment arm length matrix, u is the controller output matrix, L0、L1、L2、L3Is a matrix of error parameters that is, L0θ、L0η、L1θ、L1η、L2θ、L2η、L3θand L3ηIs an error parameter; λ is an auxiliary parameter, λ>0, sat (x) is a saturation function,
wherein maxVal is a set maximum value of the saturation function, and R is a real number.
The novel integral sliding mode controller in the novel unmanned aerial vehicle attitude system integral sliding mode control method based on the disturbance observer has stronger robustness, small errors can be amplified in the controller, and large errors can be reduced, so that an error curve is smoother; according to the novel unmanned aerial vehicle attitude system integral sliding mode control method based on the disturbance observer, the disturbance observer can observe the parameter error of the unmanned aerial vehicle and the specific value of external disturbance, and the parameter error and the specific value are integrated into a control algorithm to enable the control effect to be better. Therefore, the unmanned aerial vehicle attitude control system controls the attitude of the unmanned aerial vehicle by combining the novel integral sliding mode controller and the interference observer, so that the error between the actual attitude and the target attitude can quickly approach to zero, the unmanned aerial vehicle attitude system can quickly reach the target angle, the robustness is good, and the attitude angle of the unmanned aerial vehicle can reach the target attitude set arbitrarily.
In order to verify that the novel unmanned aerial vehicle attitude system integral sliding mode control method based on the disturbance observer has convergence, the following proving process is carried out:
for a disturbance observer:
assume that 1: in the model of the unmanned aerial vehicle attitude dynamics system,the i-th derivative of D (t) is D(i)(t) and is bounded.
Assume 2: has a constant alphai(i ═ 1, 2, 3, 4), β, a positive continuously differentiable function V, and a positive continuously differentiable function W, where R of the positive continuously differentiable function V and the positive continuously differentiable function Wn+1Approaching to real number R, Rn+1Is n +1 dimensional euclidean space, n is 0, 1, 2, 3 … ….
So that the following equation holds:
(1)α1||k||2≤V(k)≤α2||k||2,α3||k||2≤W(f)≤α4||k||2,
where k is a vector, k ═ k (k)1,k2,k3……kn+1),k1Is a first function, k2Is a second function, k3Is a third function, fiIs the ith function, fn+1Is the (n + 1) th function, | | | | |, represents Rn+1Euclidean norm of.
The disturbance observer is converted into the following formula:
where λ is small, nearly zero, and for f1,f2And f3The method comprises the following steps of (1) preparing,
wherein e isiIs error of stateDifference, xi(t) is the value of the true state,is an estimated state value, yiIs the (i) th error equation,is the derivative of the 1 st error equation,is the derivative of the total interference matrix.
According to hypothesis 1, when t>At the time of 0, the number of the first,and M is>0, M is a normal number.
then there is a list of the number of,
according to the definition of the error, the error is obtained,
thus, the disturbance observer will converge steadily when assumptions 1 and 2 are both satisfied and the parameters are properly selected.
For a sliding mode surface s, a Lyapunov function V is set1Comprises the following steps:
the derivation is carried out on the formula (13), and the derivative of the integral sliding mode surface and a novel integral sliding mode controller are brought in, so that the following steps are carried out:
because the disturbance observer can be stable, there are:
then the formula (14) has the following formula,
thus, according to Lyapunov's second theorem, the integral sliding-mode surface may converge to zero.
According to the Barbalt theorem, when t → 0,according to the integral sliding mode surface, there is,
obtained according to the formula (17),
wherein, the first and the second end of the pipe are connected with each other,is the attitude angular acceleration error.
For the error e, a corresponding Lyapunov function V is set2Comprises the following steps:
the derivation for equation (19) is:
when the formula (18) is brought into the formula (20),
thus, e can converge to zero under the control of the controller.
In summary, the novel unmanned aerial vehicle attitude system integral sliding mode control method based on the disturbance observer can stabilize the unmanned aerial vehicle attitude system.
In order to further verify the effectiveness and feasibility of the novel unmanned aerial vehicle attitude system integral sliding mode control method based on the disturbance observer, Matlab program simulation is carried out, and simulation data are as follows:
program simulation in Matlab, Jx=0.00531,Jy=0.00577,Jz=0.00808,c=1,l=0.165, λ=0.1,Theoretical analysis was verified by Matlab program simulation, and the simulation results are shown in fig. 2-7.
As can be observed from fig. 2, 4 and 6, the target value of the pitch angle is-1, the target value of the roll angle is 0, and the target value of the yaw angle is 1, under the action of the novel unmanned aerial vehicle attitude system integral sliding mode control method based on the disturbance observer, the target angle is converged from the initial angle quickly, and the error between the target angle and the actual angle is small.
As can be observed from fig. 3, 5 and 7, the errors between the estimated disturbance values of the pitch angle, the roll angle and the yaw angle obtained by the disturbance observer and the actual disturbance values are small, and the actual disturbance values can be tracked quickly at a high frequency.
In conclusion, the effectiveness and feasibility of the novel unmanned aerial vehicle attitude system integral sliding mode control method based on the disturbance observer are verified through simulation experiments.
It should be understood that, although the steps in the flowchart of fig. 1 are shown in order as indicated by the arrows, the steps are not necessarily performed in order as indicated by the arrows. The steps are not performed in the exact order shown and described, and may be performed in other orders, unless explicitly stated otherwise. Moreover, at least a portion of the steps in fig. 1 may include multiple sub-steps or multiple stages that are not necessarily performed at the same time, but may be performed at different times, and the order of performance of the sub-steps or stages is not necessarily sequential, but may be performed in turn or alternately with other steps or at least a portion of the sub-steps or stages of other steps.
In one embodiment, a novel unmanned aerial vehicle attitude system integral sliding mode control device based on a disturbance observer is provided, and includes:
the information acquisition module is used for acquiring parameter errors and external disturbances observed by the interference observer in real time;
the control module is used for inputting the parameter error and the external disturbance into a novel integral sliding mode controller, so that the novel integral sliding mode controller outputs a control signal to control the posture of the unmanned aerial vehicle according to the parameter error and the external disturbance;
the novel integral sliding mode controller is constructed in the following mode:
constructing an unmanned aerial vehicle attitude dynamic system model according to the dynamic characteristics of the unmanned aerial vehicle;
determining an attitude angle error, and constructing an integral sliding mode surface;
constructing an integral sliding mode approach law;
and constructing a novel integral sliding mode controller according to the unmanned aerial vehicle attitude dynamic system model, the integral sliding mode surface and the integral sliding mode approach law.
For specific limitation of the novel unmanned aerial vehicle attitude system integral sliding mode control device based on the disturbance observer, reference may be made to the above limitation on the novel unmanned aerial vehicle attitude system integral sliding mode control method based on the disturbance observer, and details are not repeated here. All modules in the novel unmanned aerial vehicle attitude system integral sliding mode control device based on the disturbance observer can be completely or partially realized through software, hardware and a combination of the software and the hardware. The modules can be embedded in a hardware form or independent of a processor in the computer device, and can also be stored in a memory in the computer device in a software form, so that the processor can call and execute operations corresponding to the modules.
In one embodiment, an unmanned aerial vehicle is provided, and includes a memory and a processor, where the memory stores a computer program, and the processor implements the steps of the above-described novel unmanned aerial vehicle attitude system integral sliding mode control method based on the disturbance observer when executing the computer program.
In one embodiment, a computer readable storage medium is provided, on which a computer program is stored, and the computer program, when executed by a processor, implements the steps of the above-mentioned novel unmanned aerial vehicle attitude system integral sliding mode control method based on the disturbance observer.
It will be understood by those skilled in the art that all or part of the processes of the methods of the embodiments described above can be implemented by hardware related to instructions of a computer program, which can be stored in a non-volatile computer-readable storage medium, and when executed, can include the processes of the embodiments of the methods described above. Any reference to memory, storage, database, or other medium used in the embodiments provided herein may include non-volatile and/or volatile memory, among others. Non-volatile memory can include read-only memory (ROM), Programmable ROM (PROM), Electrically Programmable ROM (EPROM), Electrically Erasable Programmable ROM (EEPROM), or flash memory. Volatile memory can include Random Access Memory (RAM) or external cache memory. By way of illustration and not limitation, RAM is available in a variety of forms such as Static RAM (SRAM), Dynamic RAM (DRAM), Synchronous DRAM (SDRAM), Double Data Rate SDRAM (DDRSDRAM), Enhanced SDRAM (ESDRAM), Synchronous Link DRAM (SLDRAM), Rambus Direct RAM (RDRAM), direct bus dynamic RAM (DRDRAM), and memory bus dynamic RAM (RDRAM).
The technical features of the above embodiments can be arbitrarily combined, and for the sake of brevity, all possible combinations of the technical features in the above embodiments are not described, but should be considered as the scope of the present specification as long as there is no contradiction between the combinations of the technical features.
The above-mentioned embodiments only express several embodiments of the present application, and the description thereof is more specific and detailed, but not construed as limiting the scope of the invention. It should be noted that, for a person skilled in the art, several variations and modifications can be made without departing from the concept of the present application, which falls within the scope of protection of the present application. Therefore, the protection scope of the present patent shall be subject to the appended claims.
Claims (10)
1. A novel unmanned aerial vehicle attitude system integral sliding mode control method based on a disturbance observer is characterized by comprising the following steps:
acquiring parameter errors and external disturbances observed by an interference observer in real time;
inputting the parameter error and the external disturbance into a novel integral sliding mode controller, and enabling the novel integral sliding mode controller to output a control signal to control the posture of the unmanned aerial vehicle according to the parameter error and the external disturbance;
the novel integral sliding mode controller is constructed in the following mode:
constructing an unmanned aerial vehicle attitude dynamic system model according to the dynamic characteristics of the unmanned aerial vehicle;
determining an attitude angle error, and constructing an integral sliding mode surface;
constructing an integral sliding mode approach law;
and constructing a novel integral sliding mode controller according to the unmanned aerial vehicle attitude dynamics system model, the integral sliding mode surface and the integral sliding mode approach law.
2. The method of claim 1, wherein the disturbance observer is constructed by:
determining a corresponding interference item according to the unmanned aerial vehicle attitude dynamics system model;
and constructing a disturbance observer according to the disturbance term.
3. The method of claim 1, wherein the drone attitude dynamics system model is:
wherein the content of the first and second substances,is the acceleration of the pitch angle,is the pitch angle rate of the blade,is the angular acceleration of the roll, and,is the angular velocity of the roll-over,is the yaw angular acceleration and is,is the yaw rate; j. the design is a squarexIs the rotary inertia of the x axis of the quad-rotor unmanned plane, JyMoment of inertia, J, for the y-axis of a quad-rotor unmanned aerial vehiclezThe moment of inertia of the z axis of the quad-rotor unmanned aerial vehicle;air damping coefficient of y-axis, KθAir damping coefficient, K, for the x-axisηAir damping coefficient for the z-axis; the parameter error of the pitch angle and the total disturbance of the external disturbance areThe parameter error of the roll angle and the total disturbance of the external disturbance are dθ(t) the parameter error of the yaw angle and the total disturbance of the external disturbances are dη(t), l is the length of the force arm;controller output as pitch angle, uθFor controller output of the roll angle, uηC is the constant force coefficient, which is the controller output for yaw angle.
4. The method of claim 1, wherein the integrating slip-form surfaces are:
wherein, KpIs a column entry parameter matrix, KiIs a matrix of integral term parameters, KdIs a matrix of differential term parameters, K1Is a matrix of scaling parameters that is, kpθand kpηIn order to compare the column entry parameters,kiθand kiηIn order to be the integral term parameter,kdθand kdηIn order to be a parameter of the differentiation term,k1θand k1ηIn order to scale the parameters of the image,is a matrix of the attitude error,is the pitch angle, theta is the roll angle, eta is the yaw angle,is the target value of the pitch angle, θdIs a target value of the roll angle, ηdIs the target value of the yaw angle,is the error in the angular velocity of the attitude,is the error in the pitch angle rate of the blade,is the error in the roll angular velocity,is the error of the yaw rate, tau is the time variable used for integration, s is the integral sliding mode surface matrix, sliding form surface being pitch angle, sθIs the slip form face of the roll angle, sηIs the slip-form surface of the yaw angle, e (τ) is the attitude error matrix at time τ, and t is time.
5. The method of claim 1, wherein the integral sliding-mode approach law is:
wherein the content of the first and second substances,is the derivative of the integral sliding mode surface, K2Is an exponential approximation term parameter matrix, K3For the constant-velocity-approach-term parameter matrix, k2θand k2ηIn order to be an exponential-approaching term parameter, k3θand k3ηFor the parameters of the constant-velocity approach term,s is an integral sliding mode surface matrix.
6. The method of claim 1, wherein the novel integral sliding-mode controller is:
wherein the content of the first and second substances,in order for the controller to output a matrix,controller output, u, representing pitch angleθController output, u, representing the roll angleηController output, K, representing yaw angle0In the form of a matrix of air damping coefficients, air damping coefficient of y-axis, KθAir damping coefficient of x-axis, KηAir damping coefficient for the z-axis;is a matrix of the attitude angular velocity,is a matrix of the angular acceleration of the attitude,is a matrix of the attitude angles and,is an unmanned aerial vehicle moment of inertia parameter matrix, JxIs the rotary inertia of the x axis of the quad-rotor unmanned plane, JyMoment of inertia, J, for the y-axis of a quad-rotor unmanned aerial vehiclezThe moment of inertia of the z axis of the quad-rotor unmanned aerial vehicle;is a matrix of total interference estimates and,is a total disturbance estimate of the pitch angle,is a total disturbance estimate of the roll angle,is a total disturbance estimate for the yaw angle,is a moment arm length matrix, l is the moment arm length, c is the constant force coefficient; kpIs a column entry parameter matrix, KiIs a matrix of integral term parameters, KdIs a matrix of differential term parameters, K1Is a matrix of scaling parameters that is,is the error of attitude angular velocity, s is the integral sliding mode surface matrix, K2Is an exponential approximation term parameter matrix, K3Is a constant velocity approach term parameter matrix.
7. The method of claim 1, wherein the disturbance observer is:
wherein the content of the first and second substances,is the differential of the estimate of the attitude angular velocity,is an estimate of the attitude angular velocity,is a matrix of attitude angular velocities, Z1Is the total interference estimate, Z2Is an estimate of the derivative of the total interference,is the derivative of the estimate of the total interference,is the derivative of the total interference derivative estimate, L is the moment arm length matrix, u is the controller output matrix, L0、L1、L2、L3Is a matrix of error parameters that is, L0θ、L0η、L1θ、L1η、L2θ、L2η、L3θand L3ηIs an error parameter; λ is an auxiliary parameter, λ>0, sat (x) is a saturation function,
wherein maxVal is a set maximum value of the saturation function, and R is a real number.
8. The utility model provides a novel unmanned aerial vehicle attitude system integral sliding mode controlling means based on disturbance observer which characterized in that, the device includes:
the information acquisition module is used for acquiring parameter errors and external disturbances observed by the interference observer in real time;
the control module is used for inputting the parameter error and the external disturbance into a novel integral sliding mode controller, so that the novel integral sliding mode controller outputs a control signal to control the posture of the unmanned aerial vehicle according to the parameter error and the external disturbance;
the novel integral sliding mode controller is constructed in the following mode:
constructing an unmanned aerial vehicle attitude dynamic system model according to the dynamic characteristics of the unmanned aerial vehicle;
determining an attitude angle error, and constructing an integral sliding mode surface;
constructing an integral sliding mode approach law;
and constructing a novel integral sliding mode controller according to the unmanned aerial vehicle attitude dynamics system model, the integral sliding mode surface and the integral sliding mode approach law.
9. A drone comprising a memory and a processor, the memory storing a computer program, characterized in that the processor, when executing the computer program, implements the steps of the method of any one of claims 1 to 7.
10. A computer-readable storage medium, on which a computer program is stored, which, when being executed by a processor, carries out the steps of the method of any one of claims 1 to 7.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210089145.8A CN114489105B (en) | 2022-01-25 | 2022-01-25 | Novel unmanned aerial vehicle attitude system integral sliding mode control method based on interference observer |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210089145.8A CN114489105B (en) | 2022-01-25 | 2022-01-25 | Novel unmanned aerial vehicle attitude system integral sliding mode control method based on interference observer |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114489105A true CN114489105A (en) | 2022-05-13 |
CN114489105B CN114489105B (en) | 2024-01-16 |
Family
ID=81474662
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210089145.8A Active CN114489105B (en) | 2022-01-25 | 2022-01-25 | Novel unmanned aerial vehicle attitude system integral sliding mode control method based on interference observer |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114489105B (en) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115562262A (en) * | 2022-09-28 | 2023-01-03 | 徐州徐工特种工程机械有限公司 | Automatic navigation control method and device for AGV |
CN116627156A (en) * | 2023-07-24 | 2023-08-22 | 南京信息工程大学 | Four-rotor unmanned aerial vehicle attitude disturbance rejection control method |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2017111971A1 (en) * | 2015-12-22 | 2017-06-29 | Intel Corporation | UNIVERSAL CONTROLLER FOR ROBUST TRAJECTORY TRACKING IN MULTIROTOR UNMANNED AERIAL VEHICLES (UAVs) |
US9694918B1 (en) * | 2016-05-26 | 2017-07-04 | Beihang University | Method for disturbance compensation based on sliding mode disturbance observer for spacecraft with large flexible appendage |
CN109188913A (en) * | 2018-10-18 | 2019-01-11 | 南京邮电大学 | A kind of robust controller of the robust control method of UAV Attitude and realization this method |
CN109343369A (en) * | 2018-11-19 | 2019-02-15 | 南京邮电大学 | A kind of quadrotor fault controller method based on nonlinear observer |
CN109521786A (en) * | 2019-01-23 | 2019-03-26 | 南京邮电大学 | Quadrotor drone Sliding Mode Attitude control method based on Proportional integral observer |
CN109901606A (en) * | 2019-04-11 | 2019-06-18 | 大连海事大学 | A kind of mixing finite time control method for quadrotor Exact trajectory tracking |
CN111176311A (en) * | 2020-01-03 | 2020-05-19 | 莆田学院 | Sliding mode delay estimation control method for attitude of quad-rotor unmanned aerial vehicle and storage medium |
CA3094757A1 (en) * | 2019-09-30 | 2021-03-30 | Bombardier Inc. | Aircraft control systems and methods using sliding mode control and feedback linearization |
CN113110554A (en) * | 2021-04-30 | 2021-07-13 | 南京航空航天大学 | Four-rotor unmanned aerial vehicle composite continuous rapid terminal sliding mode attitude control method |
CN113568419A (en) * | 2021-05-18 | 2021-10-29 | 南京邮电大学 | Fault-tolerant control method for variable-load quad-rotor unmanned aerial vehicle |
-
2022
- 2022-01-25 CN CN202210089145.8A patent/CN114489105B/en active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2017111971A1 (en) * | 2015-12-22 | 2017-06-29 | Intel Corporation | UNIVERSAL CONTROLLER FOR ROBUST TRAJECTORY TRACKING IN MULTIROTOR UNMANNED AERIAL VEHICLES (UAVs) |
US9694918B1 (en) * | 2016-05-26 | 2017-07-04 | Beihang University | Method for disturbance compensation based on sliding mode disturbance observer for spacecraft with large flexible appendage |
CN109188913A (en) * | 2018-10-18 | 2019-01-11 | 南京邮电大学 | A kind of robust controller of the robust control method of UAV Attitude and realization this method |
CN109343369A (en) * | 2018-11-19 | 2019-02-15 | 南京邮电大学 | A kind of quadrotor fault controller method based on nonlinear observer |
CN109521786A (en) * | 2019-01-23 | 2019-03-26 | 南京邮电大学 | Quadrotor drone Sliding Mode Attitude control method based on Proportional integral observer |
CN109901606A (en) * | 2019-04-11 | 2019-06-18 | 大连海事大学 | A kind of mixing finite time control method for quadrotor Exact trajectory tracking |
CA3094757A1 (en) * | 2019-09-30 | 2021-03-30 | Bombardier Inc. | Aircraft control systems and methods using sliding mode control and feedback linearization |
CN111176311A (en) * | 2020-01-03 | 2020-05-19 | 莆田学院 | Sliding mode delay estimation control method for attitude of quad-rotor unmanned aerial vehicle and storage medium |
CN113110554A (en) * | 2021-04-30 | 2021-07-13 | 南京航空航天大学 | Four-rotor unmanned aerial vehicle composite continuous rapid terminal sliding mode attitude control method |
CN113568419A (en) * | 2021-05-18 | 2021-10-29 | 南京邮电大学 | Fault-tolerant control method for variable-load quad-rotor unmanned aerial vehicle |
Non-Patent Citations (2)
Title |
---|
BO LI: "Appointed Fixed Time Observer-Based Sliding Mode Control for a Quadrotor UAV Under External Disturbances", IEEE TRANSACTIONS ON AEROSPACE AND ELECTRONIC SYSTEMS, vol. 58, no. 1, pages 290 - 303 * |
贺有源: "四旋翼无人机自适应反步滑模姿态控制器设计", 杭州电子科技大学学报, vol. 39, no. 2, pages 57 - 63 * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115562262A (en) * | 2022-09-28 | 2023-01-03 | 徐州徐工特种工程机械有限公司 | Automatic navigation control method and device for AGV |
CN116627156A (en) * | 2023-07-24 | 2023-08-22 | 南京信息工程大学 | Four-rotor unmanned aerial vehicle attitude disturbance rejection control method |
CN116627156B (en) * | 2023-07-24 | 2023-12-01 | 南京信息工程大学 | Four-rotor unmanned aerial vehicle attitude disturbance rejection control method |
Also Published As
Publication number | Publication date |
---|---|
CN114489105B (en) | 2024-01-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN114489105A (en) | Novel unmanned aerial vehicle attitude system integral sliding mode control method based on disturbance observer | |
Chowdhary et al. | Theory and flight-test validation of a concurrent-learning adaptive controller | |
US7277764B2 (en) | Adaptive output feedback apparatuses and methods capable of controlling a non-minimum phase system | |
Palumbo et al. | Modern homing missile guidance theory and techniques | |
McFarland et al. | Multilayer neural networks and adaptive nonlinear control of agile anti-air missiles | |
Acquatella et al. | Incremental backstepping for robust nonlinear flight control | |
Ghersin et al. | LPV control of a 6-DOF vehicle | |
Ma et al. | Adaptive backstepping-based neural network control for hypersonic reentry vehicle with input constraints | |
Buffington et al. | On‐line system identification for aircraft with distributed control effectors | |
Bu et al. | Robust tracking control of hypersonic flight vehicles: a continuous model-free control approach | |
McFarland et al. | Neural networks and adaptive nonlinear control of agile antiair missiles | |
Meng et al. | On characteristic modeling of a class of flight vehicles’ attitude dynamics | |
Chen et al. | Output constrained adaptive neural control for generic hypersonic vehicles suffering from non-affine aerodynamic characteristics and stochastic disturbances | |
Zhang et al. | Fixed-time disturbance observer-based nearly optimal control for reusable launch vehicle with input constraints | |
CN113064350B (en) | Missile boosting section self-adaptive dynamic surface control method and device | |
Nakamura-Zimmerer et al. | Neural network optimal feedback control with guaranteed local stability | |
Pal et al. | Star sensor based spacecraft angular rate estimation independent of attitude determination | |
Sharma et al. | Near optimal finite-time terminal controllers for space trajectories via SDRE-based approach using dynamic programming | |
Fu et al. | Integrated guidance and control with input saturation and impact angle constraint | |
Shen et al. | Nonlinear observer-based adaptive output feedback tracking control of underactuated ships with input saturation | |
CN113515142B (en) | Unmanned aerial vehicle track tracking control method and device, unmanned aerial vehicle and storage medium | |
Sekhavat et al. | UKF-based spacecraft parameter estimation using optimal excitation | |
Yucelen et al. | Derivative-free output feedback adaptive control | |
Bruyere et al. | Robust augmented lateral acceleration flight control design for a quasi-linear parameter-varying missile | |
Bruyère et al. | Robust performance study for lateral autopilot of a quasi-linear parameter-varying missile |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |