CN114527660B - Self-adaptive tracking control method and system for unmanned helicopter yaw channel dynamics - Google Patents
Self-adaptive tracking control method and system for unmanned helicopter yaw channel dynamics Download PDFInfo
- Publication number
- CN114527660B CN114527660B CN202210164561.XA CN202210164561A CN114527660B CN 114527660 B CN114527660 B CN 114527660B CN 202210164561 A CN202210164561 A CN 202210164561A CN 114527660 B CN114527660 B CN 114527660B
- Authority
- CN
- China
- Prior art keywords
- adaptive
- signal
- law
- parameter
- estimation
- 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.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
Abstract
The invention relates to a self-adaptive tracking control method and a self-adaptive tracking control system for the dynamics of a yaw channel of an unmanned helicopter, wherein the method comprises the following steps: determining a parameterized model of the discrete non-affine nonlinear system according to a dynamic equation of a target; updating a parameter of the parameterized model, and estimating unknown parameters according to the parameter updating law to obtain estimated parameters; constructing an estimate of the signal at a future time based on the parameter update law to obtain an estimated signal; determining an adaptive implicit function equation according to the estimation parameters and the estimation signals; designing an adaptive control law with an iterative form based on the adaptive implicit function equation; the solution of the adaptive control law with iterative form is the control signal of the discrete non-affine nonlinear system. The invention constructs an analytic self-adaptive control law, realizes self-adaptive output tracking performance, and ensures that the closed-loop signal of a controlled system is bounded and practical output tracking is realized.
Description
Technical Field
The invention relates to the technical field of self-adaptive control, in particular to a self-adaptive tracking control method and a self-adaptive tracking control system for the dynamics of a yaw channel of an unmanned helicopter.
Background
The self-adaptive control of the non-affine non-linear uncertain system is always the hot spot direction of the control community. The prior literature proposes a plurality of methods to solve the problem that the control signal of the non-affine nonlinear system is difficult to solve. Many achievements have been achieved in adaptive control of a non-affine non-linear uncertain system, but how to solve the adaptive control problem of the non-affine non-linear uncertain system in a parameterized adaptive control framework is not found in relevant research. Therefore, the research on solving the adaptive control problem of the non-affine non-linear uncertain system in the parameterized adaptive control framework has important theoretical and practical significance.
In addition to the non-affine non-linearity problem, the input-output delay of a non-linear discrete system is crucial for the adaptive control law construction. When the input-output time delay d of the system is greater than 1, the causal contradiction of the control law is easily caused, and how to design the adaptive control law which accords with the causal property is the first technical problem. When the non-affine non-linear dependence bounded set condition is processed based on the neural network or the fuzzy approximation, the optimal control method generally has difficulty in having an analytic solution for processing the non-affine non-linear dependence. The dynamic nonlinearity of the system depends on the input signal, and how to design the self-adaptive control law of an analytic form is the second technical problem.
Disclosure of Invention
In order to overcome the defects of the prior art, the invention aims to provide a self-adaptive tracking control method and a self-adaptive tracking control system for the dynamics of a yaw channel of an unmanned helicopter.
In order to achieve the purpose, the invention provides the following scheme:
an adaptive tracking control method for unmanned helicopter yaw channel dynamics comprises the following steps:
determining a parameterized model of the discrete non-affine nonlinear system according to a dynamic equation of a target;
updating a parameter of the parameterized model, and estimating unknown parameters according to the parameter updating law to obtain estimated parameters;
constructing an estimate of the signal at a future time based on the parameter update law to obtain an estimated signal;
determining an adaptive implicit function equation according to the estimation parameters and the estimation signals;
designing an adaptive control law with an iterative form based on the adaptive implicit function equation; the solution of the adaptive control law with iterative form is the control signal of the discrete non-affine nonlinear system.
Preferably, the designing a parameter updating law for the parameterized model and estimating unknown parameters according to the parameter updating law to obtain estimated parameters includes:
order toDenotes theta * Is estimated, and wherein, theta * In order for the parameters to be unknown,andrespectively an output signal and an input signal of the discrete non-affine nonlinear system;is a set Lipschitz nonlinear micro-mappable; d is system input-output time delay and satisfies d is more than or equal to 1 and less than or equal to n;
defining the error as ∈ (t) ═ θ T (t)φ f (t-1)-y(t);
Designing the parameter updating law according to the errors Wherein the content of the first and second substances,Γ=diag{γ 1 ,…,γ p is the gain matrix; g (θ (t), h (t)) [ g [ 1 (θ 1 (t),h 1 (t)),…,g p (θ p (t),h p (t))] T Is a correction term based on a parametric projection technique; gamma ray i ∈(0,2);
There are known groups of bounded intervalsSatisfy the requirement ofAnd isWhereinα 0 Is an unknown normal number, X n+1 Is the n +1 variable of f;
design g i (θ i (t),h i (t)) is of the form:
Determining based on the parameter update lawθ(t+i 0 )-θ(t)∈L 2 Wherein i 0 Is any positive integer.
Preferably, the constructing an estimate of the signal at a future time based on the parameter update law to obtain an estimated signal comprises:
updating law design based on the kinetic equation and the parametersThe method specifically comprises the following steps: wherein the content of the first and second substances,for the estimation of the output signal y (t +1),is an estimate of the output signal y (t + j);is phi f (ii) an estimate of (d); wherein the content of the first and second substances,
based on obtainedAs an estimation signal; the estimated signal is known at the current time and is satisfiedWherein μ (t) ∈ L 2 And μ (t) is the general attenuated signal boundary.
Preferably, the determining an adaptive implicit function equation according to the estimation parameter and the estimation signal includes:
the estimation based on unknown parameters and the estimation structure of future output signals are consistent with the structure of the kinetic equationThe adaptive implicit function equation of (2); the adaptive implicit function equation is Wherein, y * (t + d) ═ r (t), r (t) is a reference input signal known at the current time; at each sampling instant t, the adaptive implicit function equation has a unique solution with respect to u (t), which is notedAnd satisfy Wherein, X n+1 Is phi f (t + j) th variable.
Preferably, the designing an adaptive control law having an iterative form based on the adaptive implicit function equation includes:
designing an adaptive control law of an iterative form intoWhere u0(t) is taken as the control signal value at time t-1, and γ (t) is a given time-varying parameter dependent on time t and satisfies
An adaptive tracking control system for unmanned helicopter yaw channel dynamics, comprising:
the model construction unit is used for determining a parameterized model of the discrete non-affine nonlinear system according to a dynamic equation of the target;
the parameter estimation unit is used for updating the parameter of the parameterized model and estimating unknown parameters according to the parameter updating law to obtain estimated parameters;
a signal estimation unit, configured to construct an estimation of a signal at a future time based on the parameter update law to obtain an estimation signal;
an equation determining unit, configured to determine an adaptive implicit function equation according to the estimation parameter and the estimation signal;
the control law construction unit is used for designing the self-adaptive control law with an iteration form based on the self-adaptive implicit function equation; the solution of the adaptive control law with iterative form is the control signal of the discrete non-affine nonlinear system.
According to the specific embodiment provided by the invention, the invention discloses the following technical effects:
the invention provides a self-adaptive tracking control method and a self-adaptive tracking control system for the dynamics of a yaw channel of an unmanned helicopter, wherein the method comprises the following steps: determining a parameterized model of the discrete non-affine nonlinear system according to a dynamic equation of a target; updating a parameter of the parameterized model, and estimating unknown parameters according to the parameter updating law to obtain estimated parameters; constructing an estimate of the signal at a future time based on the parameter update law to obtain an estimated signal; determining an adaptive implicit function equation according to the estimation parameters and the estimation signals; designing an adaptive control law with an iterative form based on the adaptive implicit function equation; the solution of the adaptive control law with iterative form is the control signal of the discrete non-affine nonlinear system. The invention constructs an analytic self-adaptive control law, realizes self-adaptive output tracking performance, and ensures that the closed-loop signal of a controlled system is bounded and practical output tracking is realized.
Drawings
In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings needed to be used in the embodiments will be briefly described below, and it is obvious that the drawings in the following description are only some embodiments of the present invention, and it is obvious for those skilled in the art to obtain other drawings without inventive exercise.
FIG. 1 is a flow chart of a method in an embodiment provided by the present invention;
FIG. 2 is a trace diagram of an output signal and a reference output signal according to an embodiment of the present invention;
FIG. 3 is a schematic trace diagram of a tracking error signal in an embodiment provided by the present invention;
FIG. 4 is a schematic trace diagram of a system input signal in an embodiment of the present invention;
fig. 5 is a diagram illustrating an adaptive response of an estimated parameter in an embodiment of the present invention.
Detailed Description
The technical solutions in the embodiments of the present invention will be clearly and completely described below with reference to the drawings in the embodiments of the present invention, and it is obvious that the described embodiments are only a part of the embodiments of the present invention, and not all of the embodiments. All other embodiments, which can be derived by a person skilled in the art from the embodiments given herein without making any creative effort, shall fall within the protection scope of the present invention.
Reference herein to "an embodiment" means that a particular feature, structure, or characteristic described in connection with the embodiment can be included in at least one embodiment of the application. The appearances of the phrase in various places in the specification are not necessarily all referring to the same embodiment, nor are separate or alternative embodiments mutually exclusive of other embodiments. It is explicitly and implicitly understood by one skilled in the art that the embodiments described herein may be combined with other embodiments.
The terms "first," "second," "third," and "fourth," etc. in the description and claims of this application and in the accompanying drawings are used for distinguishing between different objects and not for describing a particular order. Furthermore, the terms "include" and "have," as well as any variations thereof, are intended to cover non-exclusive inclusions. For example, the inclusion of a list of steps, processes, methods, etc. is not limited to only those steps recited, but may alternatively include additional steps not recited, or may alternatively include additional steps inherent to such processes, methods, articles, or devices.
The invention aims to provide a self-adaptive tracking control method and a self-adaptive tracking control system for the dynamics of a yaw channel of an unmanned helicopter, which construct an analytic self-adaptive control law, realize self-adaptive output tracking performance and ensure that a closed-loop signal of a controlled system is bounded and practical to output and track.
In order to make the aforementioned objects, features and advantages of the present invention comprehensible, embodiments accompanied with figures are described in further detail below.
Fig. 1 is a flowchart of a method in an embodiment provided by the present invention, and as shown in fig. 1, the present invention provides an adaptive tracking control method for the dynamics of a yaw channel of an unmanned helicopter, including:
step 100: determining a parameterized model of the discrete non-affine nonlinear system according to a dynamic equation of a target;
step 200: updating a parameter of the parameterized model, and estimating unknown parameters according to the parameter updating law to obtain estimated parameters;
step 300: constructing an estimate of the signal at a future time based on the parameter update law to obtain an estimated signal;
step 400: determining an adaptive implicit function equation according to the estimation parameters and the estimation signals;
step 500: designing an adaptive control law with an iterative form based on the adaptive implicit function equation; the solution of the adaptive control law with iterative form is the control signal of the discrete non-affine nonlinear system.
In particular, the present invention contemplates a non-linear uncertainty system of the input-output type, where y (t) θ *T f (y (T-T), y (T-2T), …, y (T-nT), u (T-dT), u (T-dT-T), …, u (T-mT)), m is larger than or equal to d, and for the sake of simplicity, the adoption is omittedThe sample period T can be:
y(t)=θ *T f(y(t-1),y(t-2),…,y(t-n),u(t-d),u(t-d-1),…,u(t-m)),m≥d …(1)。
wherein the content of the first and second substances,andrespectively the output signal and the input signal of the system, is a vector of unknown constant values and is,is known Lipschitz nonlinear micro-mappable, d is system input-output time delay and satisfies that d is more than or equal to 1 and less than or equal to n. The present invention assumes that the output y (t) of the system (1) is measurable.
Further, the control targets of the present invention are: for any given reference model y * (t)=z -d r (t) whereinIs a bounded reference input signal, an output feedback self-adaptive control law u (t) is designed, all closed-loop signals of the system (1) are bounded, and asymptotic output tracking lim (y (t) -y is realized * (t)) -0 or utility output tracking, i.e., y (t)) -y * (t) any set of small residues that converge to the origin.
The adaptive design process proposed by the present invention comprises 5 steps: firstly, designing a parameter updating law and estimating an unknown parameter theta * (ii) a Secondly, based on theta * (ii) an estimate of (d); constructing an estimate of the signal y (t + j) at the end time; wherein j is 1, 2.. d; thirdly, based on the estimation parameters and the estimation signals obtained in the first two steps, an equation theta is derived *T f(y(t-1+d),y(t-2+d),…,y(t-n+d),u(t),u(t-1),…,u(t-m+d))=y * (t + d) … · (2) an adaptive version; replacing the unknown signal and the unknown parameter in (2) with their estimates; obtaining an adaptive implicit function equation related to u (t), and proving that a unique solution exists in the equation related to u (t); fourthly, signal bounded and output tracking performance analysis of the self-adaptive closed-loop system is completed; fifthly, aiming at the situation that the adaptive implicit function equation is difficult to solve; giving an analysis self-adaptive control law in an iterative form; and the control law is proved to realize the bounded closed-loop signal and practical output tracking performance of the controlled system.
Preferably, the designing a parameter updating law for the parameterized model and estimating unknown parameters according to the parameter updating law to obtain estimated parameters includes:
order toDenotes θ * Is estimated, and wherein, theta * In order for the parameters to be unknown,andrespectively an output signal and an input signal of the discrete non-affine nonlinear system;is a set Lipschitz nonlinear micro-mappable; d is system input-output time delay and satisfies d is more than or equal to 1 and less than or equal to n;
defining an error e (t) as θ T (t)φ f (t-1)-y(t);
Designing the parameter updating law according to the errors Wherein the content of the first and second substances,Γ=diag{γ 1 ,...,γ p is the gain matrix; g (θ (t), h (t)) [ g [ 1 (θ 1 (t),h 1 (t)),...,g p (θ p (t),h p (t))] T Is a correction term based on a parametric projection technique; gamma ray i ∈(0,2);
There are known groups of bounded intervalsSatisfy the requirement ofAnd isWhereinα 0 Is an unknown normal number, X n+1 Is the n +1 variable of f;
design g i (θ i (t),h i (t)) is of the form:
Determining based on the parameter update lawθ(t+i 0 )-θ(t)∈L 2 Wherein i 0 Is any positive integer.
then the error is defined as:
∈(t)=θ T (t)φ f (t-1)-y(t)…·(4)
by using phi f (t-1) and estimation error, we design the update law of θ (t) as:
Γ=diag{γ 1 ,...,γ p is the gain matrix, g (correction term for the theta parameter projection technique, gamma) i E (0, 2). There are known groups of bounded intervalsSatisfy the requirement ofAnd is Whereinα 0 Is an unknown normal number, X n+1 Is the n +1 th variable of f.
Design g based on the above formula i (θ i (t),h i (t)) is of the form:
wherein h is i (t) is the ith component of h (t) * And h (t) is of the form:
based on the parameter update law (5), the following reasoning can be derived:
introduction 1: the parameter update law (5) guarantees the following properties,θ(t+i 0 )-θ(t)∈L 2 wherein i 0 Is any positive integer.
Preferably, the constructing an estimate of the signal at a future time based on the parameter update law to obtain an estimated signal comprises:
updating law design based on the kinetic equation and the parametersThe method specifically comprises the following steps: wherein the content of the first and second substances,for the estimation of the output signal y (t +1),is an estimate of the output signal y (t + j);is phi f (ii) an estimate of (d); wherein the content of the first and second substances,
based on obtainedAs an estimation signal; the estimated signal is known at the current time and is satisfiedWherein μ (t) ∈ L 2 And μ (t) is the general attenuated signal boundary.
Specifically, the second step of the present embodiment is the estimation of the future time signal.
The signal of the last moment is estimated. The estimation signals are designed according to the sequence of y (t +1), y (t +2), … and y (t + d-1). The reason for this order of estimation is that the design of the latter will depend on the former, as detailed below.
The invention uses symbolsAn estimate of any unknown signal X is indicated. Based on (1), (3) and (5), the design,comprises the following steps:
the following reasoning is given to reveal one basic property of the estimated signal.
Based on the estimated signals obtained in (9) and (10),is known at the present moment and satisfiesWhere μ (t) ∈ L 2 Is a general attenuated signal boundary.
Preferably, the determining an adaptive implicit function equation according to the estimation parameter and the estimation signal includes:
constructing an adaptive implicit function equation consistent with the structure of the kinetic equation based on the estimation of the unknown parameters and the estimation of the future output signals; the adaptive implicit function equation is Wherein, y * (t + d) ═ r (t), r (t) is a reference input signal known at the current time; at each sampling instant t, the adaptive implicit function equation has a unique solution with respect to u (t), which is notedAnd satisfy Wherein, X n+1 Is phi f (t + j) th variable.
Specifically, the third step in this embodiment is to construct an adaptive control law implicit function equation.
Based on the estimation of the unknown parameters and the estimation of the future output signal, we construct an adaptive implicit function equation that is structurally consistent with the nominal implicit function equation (2):
notice that y * (t + d) ═ r (t), and r (t) is the reference input signal known at the current time, so that all parameters and signals in equation (12) are known at the current time. To simplify the notation, define:
one key conclusion about equation (12) is derived below:
leading: 3 at each sampling instant t, equation (12) has a unique solution for u (t), notedAnd satisfies the following conditions:wherein X n+1 Is phi f N +1 th variable of (t + j).
Further, the fourth step in this embodiment is a closed-loop system performance analysis, and based on theorem 2 and theorem 3, we give one of the main results of the present invention:
theorem 1: the system (1) takes the solution of equation (12) as an adaptive control law, and takes (5) as a parameter updating law, so that all signals of the closed-loop system are bounded and asymptotic output tracking lim can be realized t→∞ (y(t)-y * (t))=0。
Preferably, the designing an adaptive control law with an iterative form based on the adaptive implicit function equation includes:
designing an adaptive control law of an iterative form intoWhere u0(t) is taken as the control signal value at time t-1, and γ (t) is a given time-varying parameter dependent on time t and satisfies
Specifically, in this embodiment, the fifth step is adaptive control law design in an iterative form, and for the situation where the implicit function equation (12) of the adaptive control law is difficult to solve, an analytic adaptive control law in the iterative form will be given below.
The analytic structure of the iterative adaptive control law is based on an implicit function equation (12) of the adaptive control law, and the adaptive control law in an iterative form is designed at each sampling time t as follows:
wherein u is 0 (t) is taken as the control signal value at time t-1, and gamma (t) is a given time-varying parameter dependent on time t and satisfies
About signal u i (t), the following theorem is given.
Theorem 2: for all t-1, { u i (t) } convergence on i, i.e.WhereinIs an implicit function ofA unique solution for u.
Theorem 3: the control law of the closed loop system (1) is u p And (t) the parameter updating law is (5). If u is 1 (t)=u 0 (t) taking u alone p (t)=u 0 (t); if u is 1 (t)≠u 0 (t) as long as the number of iterations p satisfies:
it can be guaranteed that all closed-loop signals are bounded and the tracking error is satisfiedWhere e is the given tolerance error and δ is the signal that decays to zero asymptotically depending on the initial value of the system.
Theorem 3: provides a specific method for constructing an adaptive control law, elucidating the input signal u applied at each moment p And (t), all closed-loop signals are guaranteed to be bounded and practical output tracking can be realized only if the iteration number p is satisfied (14).
The invention has established an output feedback self-adaptive output tracking control framework based on implicit functions aiming at a non-affine nonlinear uncertain system (1), and mainly comprises two specific methods: the adaptive control method based on implicit function equation solution can realize asymptotic tracking performance; and secondly, an analytic self-adaptive control method based on iteration can realize practical output tracking performance. The two methods each have advantages: the former can realize the convergence of the tracking error to zero; the latter does not need to solve an implicit function equation, and is convenient for practical application.
Example 2:
the unmanned helicopter yaw channel dynamics has the characteristics of high relative order, high uncertainty and the like. With the increasing performance requirements of modern aircrafts for high maneuverability, it is necessary to improve the yaw control performance of the unmanned helicopter. The applicability of the proposed method in a practical system is shown below by taking an unmanned helicopter yaw channel dynamic model as an example. (unmanned helicopter in hover and low speed flight conditions, the moment is mainly derived from the main rotor and tail rotor; simplified fuselage and vertical tail damping, the unmanned helicopter yaw path dynamics equation can be described as follows) consider the following unmanned helicopter yaw path dynamics equation:
whereinAnd r is the yaw angle and yaw rate of the helicopter, I zz Is the inertia of the helicopter about an axis, Q mr 、T tr And l tr The main rotor moment, the thrust of the tail rotor and the distance from the tail rotor to the shaft of the helicopter, b 1 And b 2 Is the damping constant.
Using blade unit method, main rotor moment Q mr Comprises the following steps:
wherein phi is v 1 /(Ωr),C l =aα,C d ≈C d0 +C d1 α+C d2 α 2 。
Where ρ, a, r, α, c, v 1 Phi and omega are the air density, lift curve slope, speed radial distance, blade element angle of attack, blade chord, induced speed, inflow angle and main rotor speed, respectively.
According to the prior art results, a main rotor torque Q is obtained mr Comprises the following steps:
wherein Q mr R and b are the pitch angle of the main rotor, the rotor radius and the number, respectively.
Similar to (16) and (17), the thrust of the tail rotor can be obtained as follows:
wherein a is tr ,c tr ,b tr ,Ω tr ,θ tr ,r tr And A tr The slope of the lift curve of the tail rotor, the chord of the blade, the number of rotors, the rotating speed of the tail rotor, the pitch angle, the radial distance and the area of a tail rotor disc are respectively shown.
By plotting the moment omega of the main rotor separately mr To the pitch angle theta mr And force T of tail rotor tr To the pitch angle theta tr Can find omega mr And theta mr And T tr And theta tr The relationship between can be approximated by a quadratic polynomial:
whereinAnddepending on the blade shape of the main rotor and the rotational speed omega.Andblade shape and rotational speed omega dependent on the tail rotor tr 。
Substituting equations (19,20) for equation (15) yields the following system model:
generally, consider θ tr =θ mr For the pitch angle of the helicopter, the system (21) can be rewritten as:
wherein k is i I is 1, …,4 is a coefficient θ tr Is the pitch angle of the helicopter, represents the control input to the system,is the yaw angle of the helicopter, representing the output signal of the system. Fully considering the saturated physical property of the pitch angle of the helicopter, the pitch angle with saturation constraint is modeled as follows:
wherein theta is trmax >0 is the maximum helicopter pitch yaw. By using h (theta) trs ) De-approximating a saturated input θ tr ,
Can easily obtain:
θ tr =sat(θ trs )=d(θ trs )+h(θ trs ) (23)
|d(θ trs )|=|sat(θ trs )-h(θ trs )|≤θ trmax (1-tanh(1))=D (24)
due to the fact that d (theta) trs ) Far greater than h (theta) trs ) So the error can be ignored and the unmanned helicopter yaw channel dynamics system is expressed as:
and setting the sampling step length as h, and obtaining a first-order Euler discretization model of the unmanned helicopter yawing channel dynamics as follows:
thus, it is easy to obtain:
order:
θ * =[1,h 2 k 4 ,h+h 2 k 1 ,h 2 k 2 ,h 2 k 3 ] T (26)
the parameterized model from which the system model (25) is derived is then:
as can be seen by the form (27) of f, f is non-linear and, in particular, the control input θ trs (t) is non-affine. When the system parameter theta * In the presence of large uncertainties, the applicability of the proposed adaptive control scheme to unmanned helicopter yaw path dynamics discrete systems (28) is demonstrated below.
The control targets for this example are: for any given reference modelWhereinIs a bounded reference input signal, and designs an output feedback self-adaptive control law theta trs (t) all closed loop signals of the system (15) are bounded and asymptotic output tracking is achievedOr utility output trackingAny set of small residues that converge to the origin.
Step 1: design of parameter updating law
Using phi f (t-1) and estimating errors, and designing an updating law of theta (t) as follows:
Γ=diag{γ 1 ,...,γ 4 is the gain matrix, g (θ (t), h (t)) [ g (t) } 1 (θ 1 (t),h 1 (t)),...,g 4 (θ 4 (t),h 4 (t))] T Is based on ginsengCorrection term, gamma, for digital projection techniques i E (0, 2). Design g i (θ i (t),h i (t)), i ═ 1, ·,4, of the form:
step 2: estimation of signals at future time instants
When the relative order d is greater than 1, in order to design a causality-compliant adaptive control law, d is greater than 1 output signals at the last moment, and the details are as follows.
and step 3: construction of adaptive control law implicit function equation
Constructing and normalizing implicit function equations based on the estimate of the unknown parameters and the estimate of the future output signalStructurally consistent adaptive implicit function equations:
note thatAnd r (t) is the reference input signal for which the current time instant is known. Thus all parameters and signals in equation (37) are known at the current time and are defined
According to the global implicit theorem, to ensure that (39) is about θ trs (t) well-defined implicit function equations, forReference output signalNeed to be inWithin the range of (1).
And 4, step 4: closed loop system performance analysis
The system (15) solves for theta in equation (37) trs And (t) is an adaptive control law, and by taking (31) as a parameter updating law, the closed-loop system has bounded signals and can realize asymptotic output tracking:
based on an implicit function equation (37) of the adaptive control law, at each sampling time t, the adaptive control law in an iterative form is designed as follows:
whereinTaking the control signal value at the time of t-1, the selection of gamma (t) meets the requirement,
About the signal theta trs (t), for all t ≧ 1, { θ trs (t) converges with respect to i, i.e. WhereinIs an implicit function of equationAbout theta trs Is determined.
{θ trs Convergence value of (t) } ofIs a limit value that is difficult to obtain in practice. To solve this problem, p iterations are obtained at each sampling instant based on the iteration formula (40)As control signals and expected to achieve practical output tracking performance, i.e.
Where e is a given tolerance and δ is a signal that decays asymptotically to zero depending on the initial value of the system, for which the following results are given.
The control law of the closed loop system (15) isThe parameter update law is (31) ifOnly need to takeIf it is notAs long as the number of iterations p satisfies:
wherein:
it can be guaranteed that all closed loop signals are bounded and the tracking error is met (42).
Example 3:
consider the following system model:
y(t)=θ *T f(y(t-1),y(t-2),y(t-3),u(t-3)), (45)
wherein:
this means that the system order n is 3 and the delay d is 3. Is provided withDenotes theta * The fourth element in (1), then:
based on (46) and (48), it can be verified that the input-output delay of the simulation example (45) is 3 and depends on the unknown parameterBased on this, for the closed interval group in (7)Only need to ensureIn the interval (0, 1.6)]The above selection ensures that the inequality (7) is always true. In this example, we chooseSelecting a parameter updating law (5) based on a closed interval group; the specific analytic form of the projection correction term g (θ (t), h (t)) can be determined, and the simulation example (31) is verified to be a minimum phase system.
Designing a self-adaptive control law: from (46) and (47), the simulation example (45) is non-affine and it is difficult to find an analytical solution of the control law, so that the reference output signal is determined to be y according to theorem 3 * (t) ═ 0.5sin (t) +1, this embodiment uses an iterative adaptive control law of the form:
Based on (9) and (10), it is possible to obtainAndthe analytic form of (2) can be used to obtain the analytic form of the update law of theta (t) based on (5); and will be omitted here.
According to theorem 3, the present embodiment uses an iterative solution u p (t) as an adaptation law. The allowable error e in equation (14) is selected to be 0.001 and the reference output signal is selected to be y * 0.5sin (t) + 1. Fig. 1 shows the trajectories of the output signal and the reference output signal, and fig. 2 plots the trajectories of the tracking error signals.
As can be shown from fig. 1 and fig. 2, the system output can track the reference output signal well, fig. 3 shows the trajectory of the system input signal, fig. 4 shows the adaptive response of the estimated parameter, and the above simulation results confirm the effectiveness of the adaptive control algorithm proposed in this embodiment.
Example 4:
the embodiment also provides an adaptive tracking control system for the dynamics of the yaw channel of the unmanned helicopter, which comprises:
the model construction unit is used for determining a parameterized model of the discrete non-affine nonlinear system according to a dynamic equation of the target;
the parameter estimation unit is used for updating the parameter of the parameterized model and estimating unknown parameters according to the parameter updating law to obtain estimated parameters;
a signal estimation unit, configured to construct an estimation of a signal at a future time based on the parameter update law to obtain an estimation signal;
an equation determining unit, configured to determine an adaptive implicit function equation according to the estimation parameter and the estimation signal;
the control law construction unit is used for designing the self-adaptive control law with an iteration form based on the self-adaptive implicit function equation; the solution of the adaptive control law with iterative form is the control signal of the discrete non-affine nonlinear system.
In the present specification, the embodiments are described in a progressive manner, each embodiment focuses on differences from other embodiments, and the same and similar parts among the embodiments are referred to each other. For the system disclosed by the embodiment, the description is relatively simple because the system corresponds to the method disclosed by the embodiment, and the relevant points can be referred to the method part for description.
The principles and embodiments of the present invention have been described herein using specific examples, which are provided only to help understand the method and the core concept of the present invention; meanwhile, for a person skilled in the art, according to the idea of the present invention, the specific embodiments and the application range may be changed. In view of the above, the present disclosure should not be construed as limiting the invention.
Claims (5)
1. An adaptive tracking control method for the dynamics of a yaw channel of an unmanned helicopter is characterized by comprising the following steps:
determining a parameterized model of the discrete non-affine nonlinear system according to a dynamic equation of a target;
the method for determining the parameterized model of the discrete non-affine nonlinear system according to the kinetic equation of the target comprises the following steps:
the formula is y (t) ═ theta *T f (y (T-T), y (T-2T), …, y (T-nT), u (T-dT), u (T-dT-T), …, u (T-mT)), m is larger than or equal to d, and the sampling period T is omitted for simplicity and convenience;
y(t)=θ *T f(y(t-1),y(t-2),…,y(t-n),u(t-d),u(t-d-1),…,u(t-m)),m≥d ····(1);
wherein the content of the first and second substances,andrespectively the output signal and the input signal of the system,is a vector of unknown constant values and is,the method is known Lipschitz nonlinear micro-mapping, wherein d is system input-output time delay and satisfies that d is more than or equal to 1 and less than or equal to n; assuming that the output y (t) of system (1) is measurable;
updating a parameter of the parameterized model, and estimating unknown parameters according to the parameter updating law to obtain estimated parameters;
the designing a parameter updating law for the parameterized model and estimating unknown parameters according to the parameter updating law to obtain estimated parameters comprises the following steps:
order toDenotes theta * Is estimated, and wherein, theta * In order for the parameters to be unknown,andrespectively an output signal and an input signal of the discrete non-affine nonlinear system;is a set Lipschitz nonlinear micro-mappable; d is system input-output time delay and satisfies d is more than or equal to 1 and less than or equal to n;
defining an error e (t) as θ T (t)φ f (t-1)-y(t);
Designing the parameter updating law according to the errors Wherein the content of the first and second substances,Γ=diag{γ 1 ,…,γ p is the gain matrix; g (θ (t), h (t)) [ g [ 1 (θ 1 (t),h 1 (t)),…,g p (θ p (t),h p (t))] T Is a correction term based on a parametric projection technique; gamma ray i ∈(0,2);
There are known groups of bounded intervalsSatisfy the requirement ofAnd is provided withWherein α 0 Is an unknown normal number, X n+1 Is the n +1 variable of f;
design g i (θ i (t),h i (t)) is of the form:
Determining based on the parameter update lawθ(t+i 0 )-θ(t)∈L 2 Wherein i 0 Is any positive integer;
constructing an estimate of the signal at a future time based on the parameter update law to obtain an estimated signal;
determining an adaptive implicit function equation according to the estimation parameters and the estimation signals;
designing an adaptive control law with an iterative form based on the adaptive implicit function equation; the solution of the adaptive control law with iterative form is the control signal of the discrete non-affine nonlinear system.
2. The method of claim 1, wherein said constructing an estimate of a signal at a future time based on said parameter update law to obtain an estimated signal comprises:
updating the law design based on the kinetic equation and the parametersThe method specifically comprises the following steps:wherein the content of the first and second substances,for the estimation of the output signal y (t +1),is an estimate of the output signal y (t + j);is phi f (ii) an estimate of (d); wherein the content of the first and second substances,
3. The method of claim 2, wherein said determining an adaptive implicit function equation from the estimated parameters and the estimated signals comprises:
constructing an adaptive implicit function equation consistent with the structure of the kinetic equation based on the estimation of the unknown parameters and the estimation of the future output signals; the adaptive implicit function equation is
4. The method of claim 3, wherein said designing an adaptive control law with an iterative form based on said adaptive implicit function equation comprises:
5. An adaptive tracking control system for unmanned helicopter yaw channel dynamics, comprising:
the model construction unit is used for determining a parameterized model of the discrete non-affine nonlinear system according to a dynamic equation of the target;
the model construction unit is used for determining a parameterized model of the discrete non-affine nonlinear system according to a dynamic equation of a target, and comprises the following steps:
the formula is y (t) ═ theta *T f (y (T-T), y (T-2T), …, y (T-nT), u (T-dT), u (T-dT-T), …, u (T-mT)), m is larger than or equal to d, and the sampling period T is omitted for simplicity and convenience;
y(t)=θ *T f(y(t-1),y(t-2),…,y(t-n),u(t-d),u(t-d-1),…,u(t-m)),m≥d ····(1);
wherein the content of the first and second substances,andrespectively the output signal and the input signal of the system,is a vector of unknown constant values and is,the method is known Lipschitz nonlinear micro-mapping, wherein d is system input-output time delay and satisfies that d is more than or equal to 1 and less than or equal to n; assuming that the output y (t) of system (1) is measurable;
the parameter estimation unit is used for updating the parameter of the parameterized model and estimating unknown parameters according to the parameter updating law to obtain estimated parameters;
the designing a parameter updating law for the parameterized model and estimating unknown parameters according to the parameter updating law to obtain estimated parameters comprises the following steps:
order toDenotes θ * Is estimated, and wherein, theta * In order for the parameters to be unknown,andrespectively an output signal and an input signal of the discrete non-affine nonlinear system;is a set Lipschitz nonlinear micro-mappable; d is the system input-output time delay and satisfies that d is more than or equal to 1 and less than or equal to n;
defining an error e (t) as θ T (t)φ f (t-1)-y(t);
Designing the parameter updating law according to the errors Wherein the content of the first and second substances,Γ=diag{γ 1 ,…,γ p is the gain matrix; g (θ (t), h (t)) [ g [ [ g ] 1 (θ 1 (t),h 1 (t)),…,g p (θ p (t),h p (t))] T Is a correction term based on a parametric projection technique; gamma ray i ∈(0,2);
There are known groups of bounded intervalsSatisfy the requirement ofAnd is provided withWherein α 0 Is an unknown normal number, X n+1 Is the n +1 variable of f;
design g i (θ i (t),h i (t)) is of the form:
Determining based on the parameter update lawθ(t+i 0 )-θ(t)∈L 2 Wherein i 0 Is any positive integer;
a signal estimation unit, configured to construct an estimation of a signal at a future time based on the parameter update law to obtain an estimation signal;
an equation determining unit, configured to determine an adaptive implicit function equation according to the estimation parameter and the estimation signal;
the control law construction unit is used for designing the self-adaptive control law with an iteration form based on the self-adaptive implicit function equation; the solution of the adaptive control law with iterative form is the control signal of the discrete non-affine nonlinear system.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210164561.XA CN114527660B (en) | 2022-02-23 | 2022-02-23 | Self-adaptive tracking control method and system for unmanned helicopter yaw channel dynamics |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210164561.XA CN114527660B (en) | 2022-02-23 | 2022-02-23 | Self-adaptive tracking control method and system for unmanned helicopter yaw channel dynamics |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114527660A CN114527660A (en) | 2022-05-24 |
CN114527660B true CN114527660B (en) | 2022-09-02 |
Family
ID=81623991
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210164561.XA Active CN114527660B (en) | 2022-02-23 | 2022-02-23 | Self-adaptive tracking control method and system for unmanned helicopter yaw channel dynamics |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114527660B (en) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116774577B (en) * | 2023-05-17 | 2024-05-17 | 中国航空工业集团公司沈阳飞机设计研究所 | Self-adaptive PI control method and system with automatic stability margin configuration function |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105068420A (en) * | 2015-05-08 | 2015-11-18 | 南昌航空大学 | Non-affine uncertain system self-adaptive control method with range restraint |
KR101933964B1 (en) * | 2017-06-21 | 2018-12-31 | 중앙대학교 산학협력단 | Control Apparatus for Arbitrarily Switched Uncertain Non-affine Nonlinear System using Adaptive Observer based Output Constrained Tracking |
CN112147896A (en) * | 2020-09-28 | 2020-12-29 | 中国科学院数学与系统科学研究院 | Adaptive control method and system for non-standard MIMO discrete nonlinear system |
CN112506045A (en) * | 2020-09-28 | 2021-03-16 | 中国科学院数学与系统科学研究院 | Adaptive control method and system of non-standard discrete time nonlinear system |
-
2022
- 2022-02-23 CN CN202210164561.XA patent/CN114527660B/en active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105068420A (en) * | 2015-05-08 | 2015-11-18 | 南昌航空大学 | Non-affine uncertain system self-adaptive control method with range restraint |
KR101933964B1 (en) * | 2017-06-21 | 2018-12-31 | 중앙대학교 산학협력단 | Control Apparatus for Arbitrarily Switched Uncertain Non-affine Nonlinear System using Adaptive Observer based Output Constrained Tracking |
CN112147896A (en) * | 2020-09-28 | 2020-12-29 | 中国科学院数学与系统科学研究院 | Adaptive control method and system for non-standard MIMO discrete nonlinear system |
CN112506045A (en) * | 2020-09-28 | 2021-03-16 | 中国科学院数学与系统科学研究院 | Adaptive control method and system of non-standard discrete time nonlinear system |
Non-Patent Citations (7)
Title |
---|
Adaptive Control for a Class of Non-affine Nonlinear Systems via Two-Layer Neural Networks;Tong Zhao;《2006 6th World Congress on Intelligent Control and Automation》;20061023;958-962 * |
Implicit function based adaptive control of non-canonical form discrete-time nonlinear systems;Zhang Yanjun等;《Automatica》;20210731;第129卷;109629 * |
一类非仿射非线性系统混合自适应模糊控制;吴勃等;《电机与控制学报》;20130515(第05期);98-102+109 * |
一类非线性离散系统的神经网络自适应控制;翟廉飞等;《东北大学学报(自然科学版)》;20091115(第11期);5-9 * |
翼伞系统在未知风场中的归航控制;陶金等;《航空学报》;20170525(第05期);191-201 * |
非仿射纯反馈不确定系统预设性能鲁棒自适应控制;王琦等;《电机与控制学报》;20170215(第02期);109-116 * |
非标准型非线性系统的自适应逼近控制技术;张言军;《中国博士学位论文全文数据库 信息科技辑》;20190215(第02(2019)期);I140-65 * |
Also Published As
Publication number | Publication date |
---|---|
CN114527660A (en) | 2022-05-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Shi et al. | Design of fractional‐order backstepping sliding mode control for quadrotor UAV | |
CN107908114B (en) | Robust nonlinear control method and robust controller system for aircraft | |
CN109541941B (en) | Self-adaptive amplification anti-interference fault-tolerant method for active section flight of vertical take-off and landing carrier | |
CN110221539B (en) | Four-rotor nonsingular terminal sliding mode control method based on linear extended observer | |
Kim et al. | A robust adaptive nonlinear control approach to missile autopilot design | |
Hu et al. | Model predictive control‐based non‐linear fault tolerant control for air‐breathing hypersonic vehicles | |
CN109358634B (en) | Robust self-adaptive control method for hypersonic aircraft | |
CN114527660B (en) | Self-adaptive tracking control method and system for unmanned helicopter yaw channel dynamics | |
CN108803647B (en) | Model-free data driving control method for spacecraft attitude control | |
Grande et al. | Experimental validation of Bayesian nonparametric adaptive control using Gaussian processes | |
Shao et al. | Input-and-measurement event-triggered control for flexible air-breathing hypersonic vehicles with asymmetric partial-state constraints | |
Bu et al. | A robust constrained control approach for flexible air‐breathing hypersonic vehicles | |
Cheng et al. | Neural-networks control for hover to high-speed-level-flight transition of ducted fan uav with provable stability | |
Pashilkar et al. | Adaptive back-stepping neural controller for reconfigurable flight control systems | |
CN110362110B (en) | Fixed self-adaptive neural network unmanned aerial vehicle track angle control method | |
CN110244768A (en) | Hypersonic aircraft modeling and anti-saturation control method based on switching system | |
CN115437406A (en) | Aircraft reentry tracking guidance method based on reinforcement learning algorithm | |
CN107831653B (en) | Hypersonic aircraft instruction tracking control method for inhibiting parameter perturbation | |
CN114491811A (en) | Ballistic design method of carrier rocket separation body | |
CN117193001B (en) | Hyperbolic approach law sliding mode control method based on integral reinforcement learning | |
CN114611416A (en) | LS-SVM modeling method for nonlinear unsteady aerodynamic characteristics of missile | |
CN111596686A (en) | Method for controlling preset performance of longitudinal system of hypersonic aircraft | |
Bouzid et al. | 3d trajectory tracking control of quadrotor UAV with on-line disturbance compensation | |
CN114489125B (en) | High-precision near-optimal deceleration control method for gliding aircraft | |
CN112034879A (en) | Standard trajectory tracking guidance method based on height-range ratio |
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 |