CN103365296B  A kind of four rotor unmanned aircraft nonlinear object feedback flight control methods  Google Patents
A kind of four rotor unmanned aircraft nonlinear object feedback flight control methods Download PDFInfo
 Publication number
 CN103365296B CN103365296B CN201310272336.9A CN201310272336A CN103365296B CN 103365296 B CN103365296 B CN 103365296B CN 201310272336 A CN201310272336 A CN 201310272336A CN 103365296 B CN103365296 B CN 103365296B
 Authority
 CN
 China
 Prior art keywords
 amp
 centerdot
 rotor unmanned
 omega
 represent
 Prior art date
Links
Abstract
Description
Technical field
The present invention relates to a kind of four rotor unmanned aircraft gesture stability.Particularly relate to a kind of four rotor unmanned aircraft nonlinear object feedback flight control methods.
Background technology
In recent years along with the development of material technology, microprocessor technology and sensor technology, four rotor unmanned aircrafts are subject to military and civilian boundary and pay close attention to widely.Have the features such as volume is little, lightweight, vertical takeoff and landing, accurately hovering due to it, four rotor unmanned aircrafts are widely used in the fields such as fire hazard monitoring, emergency response, indoor investigation.Four rotor unmanned aircrafts adopt symmetrical structure, are provided with the screw propeller of four fixing angles of attack, can be changed displacement and the attitude angle in three directions by the rotating speed of propeller blades.Reliable attitude and Altitude control can guarantee the safe flight of four rotor unmanned aircrafts, are also the bases of carrying out position of aircraft control.
Four traditional rotor unmanned aircraft gesture stability are mainly divided into two steps to complete.First, definition and description aircraft attitude in space.Then, by the method design controller of feedback of status, complete the control to four rotor unmanned aircraft attitude angle.In attitude description, generally adopt based on Eulerian angle attitude description angle method (periodical: IEEEConferenceonDecisionandControl at present; Author: TonCT, MackunisW; Publish days: 2012; Title of article: RobustAttitudeTrackingControlofaQuadrotorHelicopterinthe PresenceofUncertainty, the page number: 937942), but there is polarity problems in this method, that is when aircraft reaches some attitude, Jacobi matrix in four rotor unmanned aircraft kinematical equations will define, and therefore said method has some limitations.In Controller gain variations, typical control algolithm mainly contains two large classes at present: overallfinished housing method and output feedack method.Wherein overallfinished housing method is according to the attitude angle of aircraft in flight course and the Realtime Feedback Design of Signal controller of angular velocity, and reaches the tracing control (periodical: TheInternationalConferenceonRecentAdvancesinSpaceTechnol ogies with reference to attitude track; Author: DikmenIC, ArisoyA, TemeltasH; Publish days: 2009; Title of article: AttitudeControlofaQuadrotor, the page number: 722727).In actual applications, the prerequisite of these class methods is adopted to be accurately can measure four rotor unmanned aircraft angles and angular velocity.But, because the load capacity of four rotor unmanned aircraft bodies is limited, highprecision angularrate sensor cannot be carried, to the measurement of vehicle rate, there is very large difficulty in actual applications.From the result delivered at present, the measurement major part for aircraft angle is under indoor environment, completes by vision capture systems.The shortcoming of these class methods is that cost is higher, and can only realize under indoor environment.Output feedback ontrol method be utilize four rotor unmanned aircraft output states (concerning with gesture stability, the i.e. attitude angle of four rotor unmanned aircrafts) CONTROLLER DESIGN, make aircraft follow the tracks of predetermined attitude track (periodical: IEEETransactionsonAutomaticControl; Author: SchlanbuschM, LoriaA, KristiansenR, NicklassonPJ; Publish days: 2012; Title of article: PD+BasedOutputFeedbackAttitudeControlofRigidBodies, the page number: 21462152; ).Because four rotor unmanned aircraft power belong to nonlinear system, be not suitable for separation principle, therefore Design of Observer and stability prove to have very high difficulty, and are difficult to the control effects reaching asymptotic tracking.
Can find based on above analysis, the subject matter that the design of four rotor unmanned aircraft attitude controllers faces comprises: the polarity problems that traditional Eulerian angle attitude description method has, and is difficult to the problem of accurately the whole system state of aircraft being carried out to Measurement accuracy.Except above 2 points, four rotor unmanned aircrafts are set up also has a lot of uncertainties in kinetic model accurately, and these uncertainties mainly come from the following aspects.The first, the nonlinear resistance that aircraft is suffered in flight course and the moment of resistance, these nonlinear functions and the aircraft linear velocity in flight course is relevant with angular velocity, but is difficult to carry out accurate modeling to it.Second, parameter uncertainty is there is in four rotor unmanned aircraft kinetic models, because four rotor unmanned aircrafts are not quite similar in each load had inflight, this change can cause the change of vehicle mass and moment of inertia, and the aerodynamics damping parameter in vehicle dynamics model is also difficult to carry out accurately identification.3rd, aircraft is easily subject to the impact of the external disturbances such as wind, system noise and ground effect in flight course, and these disturbance terms further increase the uncertainty of system.In mathematics, the feature of himself is had by these systematic uncertainties of research discovery, if Online Estimation and compensation can be carried out by neural network algorithm and nonlinear robust control method to these uncertainties, then greatly can improve accuracy and the rapidity of controller.Be exactly utilize neural network algorithm to carry out online study to the nonlinear resistance square in four rotor unmanned aircraft kinetic models specifically, and as feedforward part to compensating system, this can overcome the interference of system Unmarried pregnancy to system to a certain extent.Then non linear robust algorithm is utilized to compensate the external disturbances such as wind and neural network evaluated error, the final control effects improving controller.
In recent years, minority scientific research personnel starts trial and utilizes robust control method to design four rotor unmanned aircraft output feedback controllers, and achieves some initial achievements.The people such as Zou are in 2010 employing unit quaternion attitude description methods and with Chebyshev neural network for Flight Vehicle Design output feedback controller (periodical: IEEETransactionsonNeuralNetworks; Author: ZouAM, KumarKD, HouZG; Publish days: 2010; Title of article: QuaternionBasedAdaptiveOutputFeedbackAttitudeControlofS pacecraftUsingChebyshevNeuralNetworks, the page number: 14571471).But these class methods can only realize tracking slash uniform bound follows the tracks of, and cannot realize largescale Asymptotic Stability.The people such as Mayhew utilized unit quaternion attitude description method design one class output feedack attitude controller (periodical: IEEETransactionsonAutomaticControl in 2011; Author: MayhewCG, SanfeliceRG, TeelAR; Publish days: 2011; Title of article: QuaternionBasedHybridControlforRobustGlobalAttitudeTrac king, the page number: 25552566).Obviously, the method can only realize the control to attitude, cannot simultaneously to highly carrying out tracing control.The technology report analyzing existing document at present can find polarity problems, modeling uncertainty and carry out Measurement accuracy to speed to be current four rotor unmanned aircraft attitudes and the main Problems existing of Altitude control.
Summary of the invention
Technical matters to be solved by this invention is, the four rotor unmanned aircraft nonlinear object feedback flight control methods providing a kind of output feedack based on hypercomplex number attitude description method to follow the tracks of.
The technical solution adopted in the present invention is: a kind of four rotor unmanned aircraft nonlinear object feedback flight control methods, comprise the steps:
1) kinematics model of four rotor unmanned aircrafts under inertial coordinates system and the kinetic model under body axis system is determined;
2) design four rotor unmanned aircraft attitude control systems, comprising:
(1) tracking error of four rotor unmanned aircraft attitude angles and angular velocity is defined;
(2) designing filter carries out Online Estimation to angular velocity signal and obtains the open loop dynamic equation of tracking error;
(3) adopt the unknown function in neural network feedforward divided ring dynamic equation to estimate, and design four rotor unmanned aircraft attitude system control inputs;
3) design four rotor unmanned aircraft Altitude control subsystems, comprising:
(1) height tracing error and definition auxiliary filter tracking error is defined;
(2) height subsystem Controller gain variations.
The kinematics model under inertial coordinates system described in step 1) is:
Definition effective unit hypercomplex number q (t) represents actual body axis system, and { B} is relative to the inertial coordinates system { attitude of I}.Relation between effective unit hypercomplex number q (t) and aerocraft real angular velocity omega (t) can be represented by following kinematical equation
Wherein auxiliary function and { B} is to the inertial coordinates system { coordinate conversion matrix of I} for actual body axis system can be expressed as
Definition is with reference to body axis system { B _{d}, corresponding reference units hypercomplex number q _{d}t () represents with reference to body axis system { B _{d}relative to inertial coordinates system { attitude of I}, reference angular velocities ω _{d}t () represents with reference to reference body coordinate system { B _{d}relative to inertial coordinates system { angular velocity of I}, reference units hypercomplex number q _{d}(t) and aircraft reference angular velocities ω _{d}t the relation between () can be represented by following kinematical equation
Wherein with reference to body axis system { B _{d}to the inertial coordinates system { coordinate conversion matrix of I} can be expressed as
The kinetic model under body axis system described in step 1) is:
Wherein angular velocity vector ω (t)=[ω _{1}(t) ω _{2}(t) ω _{3}(t)] ^{t}be defined in body axis system and { in B}, represent that { angular velocity of I}, matrix J represents the moment of inertia matrix of aircraft to aircraft, and S () represents an antisymmetric matrix, and its expression is relative to inertial coordinates system
Matrix N (ω) represents the nonlinear unknown moment of resistance vector relevant with angular velocity omega (t) that aircraft is subject in flight course, and u (t) represents raising force, τ (t)=[τ _{1}(t) τ _{2}(t) τ _{3}(t)] ^{t}represent the rotating torque in three directions, D _{1}(t) and D _{2}(t) represent aircraft be subject to unknown time become disturbance, its expression is
D _{1}(t)=[d _{1}(t)d _{2}(t)d _{3}(t)] ^{T}
D _{2}(t)=d _{4}(t)
Constant m represents vehicle mass, and z (t) represents aircraft altitude, k _{z}represent aerodynamics damping parameter, g=9.81m/s ^{2}represent acceleration of gravity, θ (t) and represent the angle of pitch and the roll angle of aircraft.Because aircraft exists modeling uncertainty, therefore the present invention supposes vehicle mass m, moment of inertia matrix J, aerodynamic coefficient k _{z}for unknown constant.
Step 2) described in definition four rotor unmanned aircraft attitude angle and the tracking error of angular velocity be:
e _{v}=q _{0d}q _{v}q _{0}q _{vd}+S(q _{v})q _{vd}
At actual body coordinate system, { { B} relatively and reference body coordinate system { B to define actual body coordinate system in B} _{d}angular velocity for
Wherein { B} is to reference body coordinate system { B to represent actual body coordinate system _{d}coordinate conversion matrix, its expression formula is
Tracking error with angular velocity between relation can represent with following kinematical equation
Wherein and
Step 2) described in designing filter Online Estimation is carried out to angular velocity signal and the open loop dynamic equation obtaining tracking error comprises: adopt wave filter to carry out Online Estimation to the angular velocity signal of aircraft in flight course, expression formula is
r _{f}=p(k _{2}+1)e _{v}
Wherein e _{f}(t) and represent filter output signal, represent wave filter auxiliary function, represent positive ride gain, p (t) and e _{f}t the starting condition of () is set to p (0)=0 and e respectively _{f}(0)=0.Definition auxiliary variable there is following form
Can obtain auxiliary variable η (t) differentiate
Wherein auxiliary function expression formula be
Wherein, auxiliary function with there is following form
Auxiliary function and equivalent control input be defined as
Continuously and the unknown function of bounded be defined as
Step 2) described in employing neural network feedforward divided ring dynamic equation in unknown function carry out estimation and be,
Use neural network by continuous function f _{d}t () is expressed as
f _{d}=W ^{T}σ(V ^{T}χ)+ε(χ)
Wherein bounded input with represent neural network ground floor and the second layer and the ideal weight between the second layer and third layer, σ () represents excitation function, represent approximate error;
Feedover with nerve net represent continuous function f _{d}t the estimation of (), its expression formula is
Wherein represent the Online Estimation to ideal weight W, for constant value matrix, excitation function σ () is chosen for renewal function be designed to
Wherein ξ _{1}(t) and represent auxiliary signal, with represent positive ride gain, represent that positive definite diagonal angle is with new gain matrix, for saturation function.Can be drawn by neural network expression formula and bounded.
Step 2) described in design four rotor unmanned aircraft attitude system control inputs be following form
Wherein represent positive definite, diagonal angle gain matrix, function sgn () is defined as
sgn(α)=[sg(α _{1})sgn(α _{2})sgn(α _{3})] ^{T}
For any vectorial α=[α _{1}α _{2}α _{3}] ^{t}.
Definition height tracing error described in step 3) and definition auxiliary filter tracking error are
Definition height tracing error for
e _{z}=z _{d}z
Wherein represent the desired trajectory of height.The present invention adopts the linear velocity of wave filter to four rotor unmanned aircraft short transverses to carry out Online Estimation, and designing filter has following structure
r _{fz}=p _{z}(k _{2z}+1)e _{z}
p _{z}(0)=(k _{2z}+1)e _{z}(0)
Wherein e _{fz}(t) and represent filter output signal, represent wave filter auxiliary function, represent positive ride gain.Design assistant signal there is following form
Height subsystem Controller gain variations described in step 3) is
Four rotor unmanned aircraft height subsystem kinetic models are rewritten as
Wherein equivalent control input be defined as
Mapping relations between Eulerian angle and unit quaternion can be expressed as
θ=arcsin(2(q _{0}q _{2}q _{1}q _{3}))
To auxiliary signal η _{z}(t) differentiate, and be multiplied by vehicle mass m in both members simultaneously and can obtain
Wherein auxiliary function be defined as
Design assistant function due to z _{d}(t) and for limited function, therefore, it is possible to prove N _{zd}(t) and it is limited function.Formula (39) can be rewritten as following form
Wherein auxiliary function be defined as
Design four rotor unmanned aircraft height subsystem equivalent control input u _{eq}t () has following form
u _{eq}=k _{1z}sgn(e _{z}+e _{fz})(k _{2z}+1)r _{fz}+e _{z}
Wherein k _{1z}and k _{2z}represent positive ride gain, sgn () represents standard signum function.
Four rotor unmanned aircraft nonlinear object feedback flight control methods of the present invention, adopt unit quaternion attitude description method design controller, fundamentally solve the polarity problems that traditional Eulerian angle attitude description method has; Utilize the linear velocity of wave filter to the angular velocity of four rotor unmanned aircrafts in flight course and short transverse to carry out Online Estimation, realize aircraft output feedback ontrol, solve the problem being difficult to speed be carried out to Measurement accuracy; 3, the control method adopting neural network algorithm to combine with nonlinear robust control algorithm, carries out online study and compensation for there is modeling uncertainty in four rotor unmanned aircraft kinetic models.The present invention has following features:
1, global stability.Traditional Eulerian angle controller generally carries out linearization process to system dynamics equation when designing, designed controller is linear controller, at system balancing point place, traditional linear controller has good control effects, but when system far from equilibrium point, control effects can decline to some extent, even produces wild effect.The present invention is directed to four rotor unmanned flight kinetic models and adopt unit quaternion attitude description method design gamma controller, effectively prevent polarity problems, and reach the control effects of global stability.
2, strong robustness.During traditional four rotor unmanned aircraft Controller gain variations, suppose that vehicle dynamics model is accurate known models.The present invention adopts neural network algorithm and effectively suppresses the Unmarried pregnancy existed in system dynamics model in conjunction with Robust Control Algorithm, thus has increased substantially the robust performance of system.
3, senseless control.During traditional four rotor unmanned aircraft Controller gain variations, suppose that the whole state of aircraft can Measurement accuracy, but because four rotor unmanned aircraft load capacity are limited, highprecision speed pickup cannot be carried, therefore be difficult to ensure to realize Measurement accuracy to vehicle rate and linear velocity.The present invention adopts wave filter to carry out Online Estimation to attitude of flight vehicle angular velocity and short transverse linear velocity, does not need the feedback signal of vehicle rate and short transverse linear velocity, thus significantly decreases the dependence of flight controller pair and airborne sensor.
Accompanying drawing explanation
Fig. 1 a is four rotor unmanned aircraft quaternion components 1 tracking error curve figure;
Fig. 1 b is four rotor unmanned aircraft quaternion components 2 tracking error curve figure;
Fig. 1 c is four rotor unmanned aircraft quaternion components 3 tracking error curve figure;
Fig. 1 d is four rotor unmanned aircraft quaternion components 4 tracking error curve figure;
Fig. 2 a is four rotor unmanned aircraft quaternion components 1 curve maps;
Fig. 2 b is four rotor unmanned aircraft quaternion components 2 curve maps;
Fig. 2 c is four rotor unmanned aircraft quaternion components 3 curve maps;
Fig. 2 d is four rotor unmanned aircraft quaternion components 4 curve maps;
Fig. 3 a is four rotor unmanned aircraft roll angle curve maps;
Fig. 3 b is four rotor unmanned aircraft angle of pitch curve maps;
Fig. 3 c is four rotor unmanned aircraft crab angle curve maps;
Fig. 4 a tetrarotor unmanned aircraft angular velocity in roll curve map;
Fig. 4 b tetrarotor unmanned aircraft rate of pitch curve map;
Fig. 4 c tetrarotor unmanned aircraft yaw rate curve map;
Fig. 5 a tetrarotor unmanned aircraft elevation references geometric locus figure;
Fig. 5 b tetrarotor unmanned aircraft height geometric locus figure;
Fig. 5 c tetrarotor unmanned aircraft height error curve map;
Fig. 6 a is that four rotor unmanned aircraft controllers export τ _{1}curve map;
Fig. 6 b is that four rotor unmanned aircraft controllers export τ _{2}curve map;
Fig. 6 c is that four rotor unmanned aircraft controllers export τ _{3}curve map;
Fig. 6 d is that four rotor unmanned aircraft controllers export τ _{4}curve map;
Fig. 7 a is four rotor unmanned aircraft first screw propeller propelling power curve maps;
Fig. 7 b is four rotor unmanned aircraft second screw propeller propelling power curve maps;
Fig. 7 c is four rotor unmanned aircrafts the 3rd screw propeller propelling power curve map;
Fig. 7 d is four rotor unmanned aircraft quadruple screw propeller propelling power curve maps;
Fig. 8 a is four rotor unmanned aircraft first revolution speed of propeller curve maps;
Fig. 8 b is four rotor unmanned aircraft second revolution speed of propeller curve maps;
Fig. 8 c is four rotor unmanned aircrafts the 3rd revolution speed of propeller curve maps;
Fig. 8 d is four rotor unmanned aircraft quadruple screw propeller speed curves figure;
Fig. 9 a is that neural network exports curve map;
Fig. 9 b is that neural network exports curve map;
Fig. 9 c is that neural network exports curve map.
Embodiment
Below in conjunction with embodiment and accompanying drawing, four rotor unmanned aircraft nonlinear object feedback flight control methods of the present invention are described in detail.
Four rotor unmanned aircraft nonlinear object feedback flight control methods of the present invention, comprise the steps:
1) kinematics model of four rotor unmanned aircrafts under inertial coordinates system and the kinetic model under body axis system is determined:
Kinematics model under inertial coordinates system is:
Definition effective unit hypercomplex number q (t) represents actual body axis system, and { B} is relative to the inertial coordinates system { attitude of I}.Relation between effective unit hypercomplex number q (t) and aerocraft real angular velocity omega (t) can be represented by following kinematical equation
Wherein auxiliary function and { B} is to the inertial coordinates system { coordinate conversion matrix of I} for actual body axis system can be expressed as
Definition is with reference to body axis system { B _{d}, corresponding reference units hypercomplex number q _{d}t () represents with reference to body axis system { B _{d}relative to inertial coordinates system { attitude of I}, reference angular velocities ω _{d}t () represents with reference to reference body coordinate system { B _{d}relative to inertial coordinates system { angular velocity of I}, reference units hypercomplex number q _{d}(t) and aircraft reference angular velocities ω _{d}t the relation between () can be represented by following kinematical equation
Wherein and with reference to body axis system { B _{d}to the inertial coordinates system { coordinate conversion matrix of I} can be expressed as
The described kinetic model under body axis system is:
Wherein angular velocity vector ω (t)=[ω _{1}(t) ω _{2}(t) ω _{3}(t)] ^{t}be defined in body axis system and { in B}, represent that { angular velocity of I}, matrix J represents the moment of inertia matrix of aircraft to aircraft, and S () represents an antisymmetric matrix, and its expression is relative to inertial coordinates system
Matrix N (ω) represents the nonlinear unknown moment of resistance vector relevant with angular velocity omega (t) that aircraft is subject in flight course, and u (t) represents raising force, τ (t)=[τ _{1}(t) τ _{2}(t) τ _{3}(t)] ^{t}represent the rotating torque in three directions, D _{1}(t) and D _{2}(t) represent aircraft be subject to unknown time become disturbance, its expression is
D _{1}(t)=[d _{1}(t)d _{2}(t)d _{3}(t)] ^{T}
D _{2}(t)=d _{4}(t)
Constant m represents vehicle mass, and z (t) represents aircraft altitude, k _{z}represent aerodynamics damping parameter, g=9.81m/s ^{2}represent acceleration of gravity, θ (t) and represent the angle of pitch and the roll angle of aircraft.Because aircraft exists modeling uncertainty, therefore the present invention supposes vehicle mass m, moment of inertia matrix J, aerodynamic coefficient k _{z}for unknown constant.
2) design four rotor unmanned aircraft attitude control systems, comprising:
(1) tracking error defining four rotor unmanned aircraft attitude angles and angular velocity is:
e _{v}=q _{0d}q _{v}q _{0}q _{vd}+S(q _{v})q _{vd}
At actual body coordinate system, { { B} relatively and reference body coordinate system { B to define actual body coordinate system in B} _{d}angular velocity for
Wherein { B} is to reference body coordinate system { B to represent actual body coordinate system _{d}coordinate conversion matrix, its expression formula is
Tracking error
Wherein and
(2) designing filter carries out Online Estimation to angular velocity signal and obtains the open loop dynamic equation of tracking error, comprising:
Adopt wave filter to carry out Online Estimation to the angular velocity signal of aircraft in flight course, expression formula is
r _{f}=p(k _{2}+1)e _{v}
Wherein e _{f}(t) and represent filter output signal, represent wave filter auxiliary function, represent positive ride gain, p (t) and e _{f}t the starting condition of () is set to p (0)=0 and e respectively _{f}(0)=0.Definition auxiliary variable there is following form
Can obtain auxiliary variable η (t) differentiate
Wherein auxiliary function expression formula be
2J _{ev}e _{f}N ^{*}
Wherein, auxiliary function with there is following form
Auxiliary function and equivalent control input be defined as
Continuously and the unknown function of bounded be defined as
(3) adopt the unknown function in neural network feedforward divided ring dynamic equation to estimate, and design four rotor unmanned aircraft attitude system control inputs;
It is use neural network by continuous function f that unknown function in described employing neural network feedforward divided ring dynamic equation carries out estimation _{d}t () is expressed as
f _{d}=W ^{T}σ(V ^{T}χ)+ε(χ)
Wherein bounded input
Feedover with nerve net represent continuous function f _{d}t the estimation of (), its expression formula is
Wherein represent the Online Estimation to ideal weight W, for constant value matrix, excitation function σ () is chosen for renewal function be designed to
Wherein ξ _{1}(t) and represent auxiliary signal, with represent positive ride gain, represent that positive definite diagonal angle is with new gain matrix, for saturation function.Can be drawn by neural network expression formula and bounded;
Described design four rotor unmanned aircraft attitude system control inputs is following form
Wherein represent positive definite, diagonal angle gain matrix, function sgn () is defined as
sgn(α)=[sgn(α _{1})sgn(α _{2})sgn(α _{3})] ^{T}
For any vectorial α=[α _{1}α _{2}α _{3}] ^{t}.
3) design four rotor unmanned aircraft Altitude control subsystems, comprising:
(1) define height tracing error and define auxiliary filter tracking error and be;
Definition height tracing error for e _{z}=z _{d}z
Wherein represent the desired trajectory of height.The present invention adopts the linear velocity of wave filter to four rotor unmanned aircraft short transverses to carry out Online Estimation, and designing filter has following structure
r _{fz}=p _{z}(k _{2z}+1)e _{z}
p _{z}(0)=(k _{2z}+1)e _{z}(0)
Wherein e _{fz}(t) and represent filter output signal, represent wave filter auxiliary function, represent positive ride gain.Design assistant signal there is following form
(2) height subsystem Controller gain variations is
Four rotor unmanned aircraft height subsystem kinetic models are rewritten as
Wherein equivalent control input be defined as
Mapping relations between Eulerian angle and unit quaternion can be expressed as
θ=arcsin(2(q _{0}q _{2}q _{1}q _{3}))
To auxiliary signal η _{z}(t) differentiate, and be multiplied by vehicle mass m in both members simultaneously and can obtain
Wherein auxiliary function be defined as
Design assistant function due to zd (t) and for limited function, therefore, it is possible to prove N _{zd}(t) and it is limited function.Formula (39) can be rewritten as following form
Wherein auxiliary function be defined as
Design four rotor unmanned aircraft height subsystem equivalent control input u _{eq}t () has following form
u _{eq}=k _{1z}sgn(e _{z}+e _{fz})(k _{2z}+1)r _{fz}+e _{z}
Wherein k _{1z}and k _{2z}represent positive ride gain, sgn () represents standard signum function.
For verifying that four rotor unmanned aircraft nonlinear object feedback flight control methods of the present invention are to the control effects of four rotor unmanned aircraft attitudes and height subsystem, the present invention utilizes vehicle dynamics model to carry out numerical simulation to this controller.Four rotor unmanned aircraft moment of inertia matrix are J=diag (1.25,1.25,2.5) kgm ^{2}, vehicle mass m=2kg, Aerodynamic parameter k _{z}=0.01Ns/m, the expression formula of nonlinear resistance square N (ω) is
Wherein aerodynamic coefficient g _{i}=0.065Nms/rad, i=1 ... 6.Aircraft original state is set as
z(0)=0mq _{0}(0)=0.9486
q _{v}(0)=[0.18260.18260.1826] ^{T}
Aircraft reference angular velocities ω _{d}t () is set as
ω _{d}=[0.3cos(t)0.3cos(t)0.3cos(t)] ^{T}rad/s
Elevation references track is set as step function z _{d}=2m is through firstorder filter G _{c}response curve after the process of (s)=1/ (s+1).Reference units hypercomplex number q _{d}t the starting condition of () is set as
q _{od}(0)=1q _{vd}(0)=[000] ^{T}
In kinetic model, external disturbance is set to
d _{1}=d _{2}=d _{3}=0.2sin(t)Nm
d _{4}=4sin(t)N
Ride gain is chosen for
K _{1}=diag(555)k _{2}=20k _{1z}=3k _{2z}=15
T=diag{10010010050505050502050}
In neural network feedforward renewal function, the bound of saturation function is set as 100 and100.
The Flutter Problem brought for avoiding sign function, in numerical simulation, adopts standard saturation function to replace sign function.Fig. 1 a, Fig. 1 b, Fig. 1 c, Fig. 1 d represent four rotor unmanned aircraft Attitude Tracking errors.Can be found out by figure, error e _{v}t () went to zero the 10th second time.Fig. 2 a, Fig. 2 b, Fig. 2 c, Fig. 2 d represent the attitude curve adding the rear aircraft of neural network feedforward in control inputs.Because unit quaternion attitude description method is directly perceived not, therefore the present invention utilizes the transformational relation between unit quaternion and Eulerian angle to calculate the simulation curve of Eulerian angle.Fig. 3 a, Fig. 3 b, Fig. 3 c represent the attitude angle simulation curve of four rotor unmanned aircrafts.Fig. 4 a, Fig. 4 b, Fig. 4 c represent the angular velocity curve of aircraft, can be found out by curve, and four rotor unmanned aircraft angular velocity can follow the tracks of the cosine curve that amplitude is 0.3rad.Fig. 5 a, Fig. 5 b, Fig. 5 c represent the aircraft pursuit course of four rotor unmanned aircraft short transverses, can be found out by figure, and height error went to zero at about the 10th second, and tracking error remain on ± 0.5m within the scope of.Fig. 6 a, Fig. 6 b, Fig. 6 c, Fig. 6 d represent that four rotor unmanned aircraft controllers export, because aircraft is subject to the impact of resistance and the moment of resistance in flight course shown in scheming, therefore controller exports the phenomenon with fluctuation, but four control inputs all keep in the reasonable scope.Fig. 7 a, Fig. 7 b, Fig. 7 c, Fig. 7 d represent the propelling power of four rotor unmanned aircrafts, four screw propellers, the rotating speed of Fig. 8 a, Fig. 8 b, Fig. 8 c, Fig. 8 d, expression four screw propellers, can be found out by figure, four angle of rake propelling powers of aircraft and revolution speed of propeller are all in rational scope.Fig. 9 a, Fig. 9 b, Fig. 9 c represent that neural network exports, and can be found out by figure, and neural network reached stable the 5th second time.
Above simulation result shows that the nonlinear tracking control device designed by the present invention has in the probabilistic situation of modeling, still can make four rotor unmanned aircrafts, three attitude angle and the predetermined reference locus of height tracing.Can find out from control inputs curve, four angle of rake propelling powers of aircraft and revolution speed of propeller are all in rational scope, and therefore this controller has good control effects and stronger practicality.
Claims (8)
Priority Applications (1)
Application Number  Priority Date  Filing Date  Title 

CN201310272336.9A CN103365296B (en)  20130629  20130629  A kind of four rotor unmanned aircraft nonlinear object feedback flight control methods 
Applications Claiming Priority (1)
Application Number  Priority Date  Filing Date  Title 

CN201310272336.9A CN103365296B (en)  20130629  20130629  A kind of four rotor unmanned aircraft nonlinear object feedback flight control methods 
Publications (2)
Publication Number  Publication Date 

CN103365296A CN103365296A (en)  20131023 
CN103365296B true CN103365296B (en)  20151209 
Family
ID=49366863
Family Applications (1)
Application Number  Title  Priority Date  Filing Date 

CN201310272336.9A CN103365296B (en)  20130629  20130629  A kind of four rotor unmanned aircraft nonlinear object feedback flight control methods 
Country Status (1)
Country  Link 

CN (1)  CN103365296B (en) 
Families Citing this family (33)
Publication number  Priority date  Publication date  Assignee  Title 

CN103645647B (en) *  20131204  20160330  中国航空工业第六一八研究所  A kind of space vehicle dynamic Trajectory Tracking Control method 
CN103760906B (en) *  20140129  20160601  天津大学  Neural network and nonlinear continuous depopulated helicopter attitude control method 
CN103760905B (en) *  20140129  20160601  天津大学  Based on fuzzy feedforward list rotor unmanned helicopter attitude nonlinear robust control method 
DK3111286T3 (en) *  20140530  20190225  Sz Dji Technology Co Ltd  Methods for controlling the position of an aircraft 
CN104049640B (en) *  20140627  20160615  金陵科技学院  Unmanned vehicle attitude robust fault tolerant control method based on Neural Network Observer 
CN106032166B (en) *  20150312  20181204  优利科技有限公司  Aircraft and its method for turning 
CN104898681B (en) *  20150504  20170728  浙江工业大学  A kind of quadrotor attitude acquisition method for approximately finishing card quaternary number using three ranks 
CN105005197B (en) *  20150529  20171212  北京航空航天大学  Timevarying neurodynamics system identifying method based on Chebyshev polynomials expansion 
CN105242679A (en) *  20151022  20160113  电子科技大学  Method for designing control system of four rotor aircraft 
CN105843243B (en) *  20160506  20190222  深圳一电航空技术有限公司  Control method, device and the multirotor aerocraft of multirotor aerocraft 
CN105974820B (en) *  20160513  20190913  深圳航天东方红海特卫星有限公司  A kind of pure magnetic control algorithm of spacecraft single shaft direction based on geometrical analysis 
CN106094855B (en) *  20160727  20190312  浙江工业大学  A kind of terminal cooperative control method of quadrotor drone 
CN106066648B (en) *  20160819  20170926  北京航天自动控制研究所  A kind of online planing method of program quaternary number to timevarying posture adjustment target 
CN106774373B (en) *  20170112  20191105  哈尔滨工业大学  A kind of quadrotor drone finite time Attitude tracking control method 
CN106873624B (en) *  20170326  20200303  天津大学  Fourrotor unmanned aerial vehicle suspension flight control method based on partial feedback linearization 
CN106950981B (en) *  20170425  20200211  深圳大学  Unmanned aerial vehicle height control method and system 
CN107247464B (en) *  20170623  20190709  中国科学院声学研究所  A kind of the state constraint control method and system of quadrotor unmanned vehicle 
CN107450323B (en) *  20170905  20191018  西北工业大学  Hypersonic aircraft reentry stage neural network Hybrid Learning control method 
CN107526296B (en) *  20170905  20191018  西北工业大学  Hypersonic aircraft neural network lea rning control method based on prediction modeling 
CN107479382B (en) *  20170905  20191022  西北工业大学  Hypersonic aircraft neural network control method based on online data study 
CN107390531B (en) *  20170905  20191018  西北工业大学  The hypersonic aircraft control method of parameter learning finite time convergence control 
CN107479384B (en) *  20170905  20191022  西北工业大学  The nonbackstepping control method of hypersonic aircraft neural network Hybrid Learning 
CN107632518B (en) *  20170905  20191018  西北工业大学  Hypersonic aircraft neural network Hybrid Learning control method based on Highgain observer 
CN107479383B (en) *  20170905  20191022  西北工业大学  Hypersonic aircraft neural network Hybrid Learning control method based on robust designs 
CN107450324B (en) *  20170905  20191022  西北工业大学  Consider the hypersonic aircraft adaptive fusion method of angle of attack constraint 
CN108828957B (en) *  20180820  20191105  西北工业大学  Aircraft overall situation finite time neural network control method based on handover mechanism 
CN109062049B (en) *  20180820  20190924  西北工业大学  Strict feedback systems neural network control method based on the compound estimation of lump 
CN108762098B (en) *  20180820  20191101  西北工业大学  Nonminimum phase aircraft neural network control method based on Hybrid Learning 
CN109062234B (en) *  20180820  20191105  西北工业大学  A kind of nonminimum phase aircraft Hybrid Learning slidingmode control 
CN108663940B (en) *  20180820  20190924  西北工业大学  Aircraft neural network lea rning control method based on the compound estimation of lump 
CN108897227B (en) *  20180820  20190924  西北工业大学  Nonlinear strict feedback systems overall situation finite time neural network control method 
CN109164821B (en) *  20180926  20190507  中科物栖（北京）科技有限责任公司  A kind of UAV Attitude training method and device 
CN109597303A (en) *  20181129  20190409  南京航空航天大学  A kind of composite rotor craft syntype flight control method 
Citations (2)
Publication number  Priority date  Publication date  Assignee  Title 

EP0830647B1 (en) *  19950607  20020410  Dabulamanzi Holdings, LLC  Fault tolerant automatic control system utilizing analytic redundancy 
CN102508493A (en) *  20111110  20120620  中国人民解放军92537部队  Flight control method for small unmanned aerial vehicle 

2013
 20130629 CN CN201310272336.9A patent/CN103365296B/en active IP Right Grant
Patent Citations (3)
Publication number  Priority date  Publication date  Assignee  Title 

EP0830647B1 (en) *  19950607  20020410  Dabulamanzi Holdings, LLC  Fault tolerant automatic control system utilizing analytic redundancy 
JP3967381B2 (en) *  19950607  20070829  ダブラマンツィ ホールディングス エルエルシー  Faulttolerant automatic control system using analytical redundancy. 
CN102508493A (en) *  20111110  20120620  中国人民解放军92537部队  Flight control method for small unmanned aerial vehicle 
NonPatent Citations (3)
Title 

quaternionbased hybrid control for robust global attitude tracking;Christopher G,etc;《IEEE TRANSACTIONS ON AUTOMATIC CONTROL》;20111130;第56卷(第11期);全文 * 
基于Backstepping的高超声速飞行器鲁棒自适应控制;黄喜元等;《系统工程与电子技术》;20110630;第33卷(第6期);第13221324页 * 
基于归一化神经网络的航天器自适应姿态跟踪控制;黄喜元等;《宇航学报》;20101130;第31卷(第11期);第25432545页 * 
Also Published As
Publication number  Publication date 

CN103365296A (en)  20131023 
Similar Documents
Publication  Publication Date  Title 

Salih et al.  Modelling and PID controller design for a quadrotor unmanned air vehicle  
Johnson et al.  Modeling, control, and flight testing of a smallducted fan aircraft  
Marcos et al.  An application of H∞ fault detection and isolation to a transport aircraft  
Wickenheiser et al.  Optimization of perching maneuvers through vehicle morphing  
CN102749851B (en)  Fine antiinterference tracking controller of flexible hypersonic vehicle  
Mettler et al.  System identification modeling of a modelscale helicopter  
CN103885450B (en)  Depopulated helicopter attitude nonlinear control method and verification platform  
Ryan et al.  Current and future research in active control of lightweight, flexible structures using the X56 aircraft  
Xu  Multitimescale nonlinear robust control for a miniature helicopter  
CN104460685A (en)  Control system for fourrotor aircraft and control method of control system  
Dogan et al.  Flight data analysis and simulation of wind effects during aerial refueling  
Yue et al.  Longitudinal linear parameter varying modeling and simulation of morphing aircraft  
CN102520726B (en)  Estimation method of atmosphere angle of attack and angle of sideslip in highangleofattack flight status  
Brumbaugh  Aircraft model for the AIAA controls design challenge  
ArellanoMuro et al.  Backstepping control with sliding mode estimation for a hexacopter  
Du et al.  Controllability analysis for multirotor helicopter rotor degradation and failure  
CN103760905B (en)  Based on fuzzy feedforward list rotor unmanned helicopter attitude nonlinear robust control method  
CN103760906A (en)  Control method for neural network and nonlinear continuous unmanned helicopter attitude  
Lee et al.  Hovering control of a quadrotor  
CN105759832A (en)  Fourrotor aircraft sliding mode variable structure control method based on inversion method  
CN103135553A (en)  Fourrotor aircraft faulttolerant control method  
CN102929134A (en)  Method for designing controller of multiple time lag aircraft model  
CN103853157A (en)  Aircraft attitude control method based on selfadaptive sliding mode  
CN105607473B (en)  The attitude error Fast Convergent selfadaptation control method of smallsized depopulated helicopter  
CN101441478B (en)  Smallsized unmanned aerial vehicle automatic landing leveling control method and apparatus 
Legal Events
Date  Code  Title  Description 

PB01  Publication  
C06  Publication  
SE01  Entry into force of request for substantive examination  
C10  Entry into substantive examination  
GR01  Patent grant  
C14  Grant of patent or utility model 