CN104793629B - A kind of contragradience neural network control method of dirigible Three-dimensional Track tracking - Google Patents

A kind of contragradience neural network control method of dirigible Three-dimensional Track tracking Download PDF

Info

Publication number
CN104793629B
CN104793629B CN201510221276.7A CN201510221276A CN104793629B CN 104793629 B CN104793629 B CN 104793629B CN 201510221276 A CN201510221276 A CN 201510221276A CN 104793629 B CN104793629 B CN 104793629B
Authority
CN
China
Prior art keywords
mrow
msub
mtd
mover
msup
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
Application number
CN201510221276.7A
Other languages
Chinese (zh)
Other versions
CN104793629A (en
Inventor
杨跃能
闫野
朱正龙
刘二江
徐博婷
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
National University of Defense Technology
Original Assignee
National University of Defense Technology
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by National University of Defense Technology filed Critical National University of Defense Technology
Priority to CN201510221276.7A priority Critical patent/CN104793629B/en
Publication of CN104793629A publication Critical patent/CN104793629A/en
Application granted granted Critical
Publication of CN104793629B publication Critical patent/CN104793629B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Feedback Control In General (AREA)
  • Medicines Containing Antibodies Or Antigens For Use As Internal Diagnostic Agents (AREA)
  • Other Investigation Or Analysis Of Materials By Electrical Means (AREA)

Abstract

The present invention relates to a kind of contragradience neural network control method of dirigible Three-dimensional Track tracking.For the Track In Track control problem of dirigible, the present invention establishes the non-linear dynamic model of dirigible;As controll plant, non-linear dynamic model is decomposed into two subsystems, Backstepping is used to design Lyapunov functions and intermediate virtual controlled quentity controlled variable for each subsystem, by determining appropriate virtual feedback, so that the front position of system reaches Asymptotic Stability, " reversely deduce " to whole system always, so as to realize the Asymptotic Stability of whole system;For dirigible kinetic model uncertain problem, unknown dirigible kinetic model is accurately estimated using neural network approximator, to improve control accuracy and systematic function.The closed-loop system controlled by this method can any given parametrization of high precision tracking instruct flight path, and with good stability, adaptability, robustness and dynamic property, the Project Realization for dirigible flight tracking control provides effective scheme.

Description

A kind of contragradience neural network control method of dirigible Three-dimensional Track tracking
Technical field
The present invention relates to a kind of flight control method of field of aerospace, it provides a kind of contragradience for dirigible Track In Track Neural network control method, belongs to automatic control technology field.
Background technology
Dirigible refers to that a kind of dependence is lighter than the quiet buoyancy lift-off of gas (such as helium, hydrogen) offer of air, by automatic Flight control system realizes resident and low-speed maneuver the aircraft of fixed point, and with hang time length, energy consumption is low, efficiency-cost ratio is high and determines The advantages of point is resident, is widely used in the fields such as reconnaissance and surveillance, earth observation, environmental monitoring, emergency disaster relief, scientific exploration, has There is significant application value and wide application prospect, currently turn into the study hotspot of aviation field.
Track In Track refers to dirigible from given original state and tracks the boat of the instruction under given inertial coodinate system Mark.The spatial movement of dirigible have the coupling of non-linear, passage, it is uncertain, easily by external disturbance the features such as, therefore, flight tracking control One of key technology controlled as airship flight.Numerous researchers are directed to the Track In Track problem of dirigible, it is proposed that PID is controlled The methods such as system, feedback control, sliding formwork control, robust control, the technical side for being available for reference is provided for dirigible Track In Track Case.But above-mentioned flight tracking control method not yet effectively solves the problems, such as two categories below:One is that dirigible kinetic model is not known, and is existed Modeling error and Unmarried pregnancy;Two be that dirigible flight path control system is a complicated nonlinear multivariable systems, flight bag The stability of closed-loop control system is difficult to ensure that in line.
The content of the invention
In view of the deficienciess of the prior art, it is an object of the invention to provide a kind of contragradience god of dirigible Three-dimensional Track tracking Through network control method.
The present invention is directed to dirigible Three-dimensional Track tracking problem, establishes the non-linear dynamic model of dirigible;As by Object is controlled, non-linear dynamic model is decomposed into two subsystems, uses Backstepping to design Li Yapunuo for each subsystem Husband's (Lyapunov) function and intermediate virtual controlled quentity controlled variable, by determining appropriate virtual feedback so that the front position of system reaches To Asymptotic Stability, " reversely deduce " to whole system always, so as to realize the Asymptotic Stability of whole system;For dirigible dynamics Model uncertain problem, unknown dirigible kinetic model is accurately approached using neutral net, to improve control accuracy and system Performance.Advantages of the present invention is shown:1. designed using Backstepping and cause Liapunov (Lyapunov) function and control law Design process systematization, structuring, it is ensured that the stability of system;2. the uncertain of dirigible is accurately approached using neutral net Model so that Track In Track control system has strong adaptability and strong robustness.
The technical scheme is that:The flight tracking control margin of error is calculated by given instruction flight path and actual flight path first, Then using Backstepping techniques design flight tracking control rule, flight tracking control amount is calculated;To solve dirigible kinetic model uncertain problem, Unknown ambiguous model is accurately approached using neutral net.In practical application, dirigible flight path is measured by integrated navigation system Arrive, obtained controlled quentity controlled variable will be calculated by this method transmit to executing agency flight tracking control function can be achieved.
Specifically, a kind of contragradience neural network control method of dirigible Three-dimensional Track tracking, comprises the following steps:
Step one:Given instruction flight path:ηd=[xd,yd,zdddd]T
Wherein:Described instruction flight path is generalized coordinates ηd=[xd,yd,zdddd]T, xd、yd、zd、θd、ψdAnd φd Respectively instruct x coordinate, instruction y-coordinate, instruction z coordinate, the instruction angle of pitch, instruction yaw angle and instruct roll angle, subscript T tables Show the transposition of vector or matrix.
Step 2:The flight tracking control margin of error is calculated:The flight tracking control margin of error between computations flight path and actual flight path e;
The computational methods of the flight tracking control margin of error e are:
E=ηd- η=[xd-x,yd-y,zd-z,θd-θ,ψd-ψ,φd-φ]T (1)
Wherein:η=[x, y, z, θ, ψ, φ]TFor actual flight path, x, y, z, θ, ψ, φ are respectively the x coordinate of actual flight path, y Coordinate, z coordinate, the angle of pitch, yaw angle and roll angle.
Step 3:Flight tracking control rule design:Lypaunov functions and intermediate virtual controlled quentity controlled variable are chosen, is designed using Backstepping Flight tracking control is restrained, and is calculated flight tracking control amount u, is specifically included following steps:
1) kinetic model of dirigible is set up
The coordinate system and kinematic parameter of dirigible spatial movement are defined as follows:Using earth axes oexeyezeSat with carrier Mark system obxbybzbSpatial movement to dirigible is described, and CV is centre of buoyancy, and CG is center of gravity, and the vector of centre of buoyancy to center of gravity is rG= [xG,yG,zG]T.Kinematic parameter is defined:Position P=[x, y, z]T, x, y, z is respectively axial direction, the displacement of lateral and vertical direction; Attitude angle Ω=[θ, ψ, φ]T, θ, ψ, φ are respectively the angle of pitch, yaw angle and roll angle;Speed v=[u, v, w]T, u, v, w points Not Wei in carrier coordinate system axially, the speed of lateral and vertical direction;Angular velocity omega=[p, q, r]T, p, q, r be respectively rolling, Pitching and yaw rate.Remember generalized coordinates η=[x, y, z, θ, ψ, φ]T, generalized velocity is V=[u, v, w, p, q, r]T
The kinetic model of dirigible is described as follows:
In formula
Wherein
In formula, m is dirigible quality, m11、m22、m33For additional mass, I11、I22、I33For additional inertial, Λ is dirigible body Product;Q is dynamic pressure, and α is the angle of attack, and β is yaw angle, CX、CY、CZ、Cl、Cm、CnFor Aerodynamic Coefficient;Ix、Iy、IzRespectively around obxb、 obyb、obzbPrincipal moments;Ixy、Ixz、IyzRespectively on plane obxbyb、obxbzb、obybzbProduct of inertia;T is that thrust is big Small, μ is thrust vectoring and obxbzbAngle between face, provides it in obxbzbThe left side in face is just, υ is thrust vectoring in obxbzb The projection in face and obxbAngle between axle, provides that it is projected in obxbIt is just under axle;lx、ly、lzRepresent thrust point away from Origin obDistance.
Formula (3) is the expression formula on generalized velocity V, it is necessary to transform it into the expression formula on generalized coordinates η.
It can be obtained by formula (2):
In formula, J-1(η) is J (η) inverse matrix.
To formula (16) differential, it can obtain
In formula
Formula (19) premultiplicationIt can obtain
Composite type (3), formula (19) and formula (21) can be obtained:
In formula
Mη(η)=RTMR (23)
Γ=RTτ (26)
Make x1=η,Then kinetic simulation pattern (22) can be written as following form:
In formula,Representing matrix MηInverse matrix;MηIt is MηThe abbreviation of (η);
Using the mathematical modeling described by formula (27) as controlled device, using Backstepping techniques design flight tracking control rule.
2) design flight tracking control rule
According to the flight tracking control margin of error e between instruction flight path and actual flight path, virtual amount is defined as follows:
In formula, α1For virtual amount, k1For adjustable control parameter.
The virtual amount α of definition1With x2Between error e ':
E '=x21 (29)
Formula (29) to time diffusion and substitutes into formula (27), can obtain:
Order
Then formula (31) is represented by:
Choose liapunov function (Lyapunov functions) V1
Formula (33) is substituted into time diffusion, and by formula (32), can be obtained:
According to formula (34), following flight tracking control rule is designed:
3) stability analysis
Flight tracking control rule formula (35) is substituted into formula (34), can be obtained:
Formula (36) shows:The stability that (35) ensure that closed-loop system is restrained using flight tracking control.
Step 4:Neural network approximator is designed:With flight tracking control error e and its rate of changeActual flight path η and its change RateFor the input variable of neutral net, with the estimate of dirigible kinetic modelSet for the output variable of neutral net Neural network approximator has been counted, function is infinitely approached using neutral net and estimates unknown ambiguous model, to improve control essence Degree, is comprised the following steps that:
1) due to being difficult to carry out dirigible Accurate Model during practical flight, f (x) is unknown function, it is difficult to according to Formula (35) is controlled rule and resolved, therefore, must use f (x) estimateFlight tracking control rule formula (35) is resolved;Adopt Unknown function f (x) is approached with neutral net, then is had:
F (x)=wTh(x)+ε (37)
In formula, w is the weight vectors of neutral net, and ε is approximate error, h (x)=[hi(x)]T, hi(x) it is gaussian basis letter Number, subscript i represents i-th of Gaussian bases;
2) input/output variable is selected
Make flight tracking control error e and its rate of changeActual flight path η and its rate of changeFor the input of neural network approximator Variable, makes estimateFor the output variable of neural network approximator.
3) neural network structure is designed
Neural network structure includes input layer, hidden layer and output layer.
Input layer:Choose neutral net input variable be
Hidden layer:Gaussian function is chosen as the basic function of hidden node
Wherein, c=[ci]T, ciFor the intermediate value of i-th of Gaussian function, σiFor the base width parameter of i-th of node, | | | | Represent euclideam norm.
Output layer:Neutral net is output as
Wherein,For w estimate.
4) stability analysis
DefinitionWith w differences:
Choose Lyapunov functions:
In formula, ξ=[e e ']T,Θ is adjustable positive definite matrix, λ-1Representing matrix λ Inverse matrix.
To formula (41) differential, it can obtain:
Definition
Then formula (42) can be written as:
In formula,
Design following adaptive law:
In formula, γ > 0 are adjustable parameter,
Adaptive law is substituted into formula (44), can be obtained:
According to Schwarz (Schwarz) inequality, have:
In formula, | | | |FRepresent soft Bin Niusi (Frobenius) norm of volt.
Formula (47) is substituted into formula (46), can be obtained:
In formula, εNFor the upper bound of approximate error, kminFor adjustable parameter matrix k minimal eigenvalue, WMFor weight matrix W's Maximum element.
In view of following equation:
If so thatMust then have and be set up with lower inequality:
Or
IfThen have | | ξ | | andUniform ultimate bounded, from | | ξ | | convergence can obtain:Track In Track precision With neutral net approximate error upper bound εN, adjustable parameter matrix k it is relevant.
Thus, uncertain dirigible nonlinear kinetics mould can accurately be estimated by above-mentioned neural network approximator Type.
The advantageous effects of the present invention:
1) this method is directly based upon the non-linear dynamic model design flight tracking control rule of dirigible, it is contemplated that every non-linear Factor and Multivariable Coupling effect, overcome the limitation that inearized model is only suitable to equilibrium state, being capable of high precision tracking times The given parametrization instruction flight path of meaning.
2) complicated non-linear flight path control system is resolved into two subsystems for being no more than systematic education by this method, so Lypaunov functions and intermediate virtual controlled quentity controlled variable are designed for each subsystem afterwards, by determining appropriate virtual feedback so that be The front position of system reaches Asymptotic Stability, and " pusher " is to whole system always, it is ensured that the Asymptotic Stability of whole system.
3) this method does not need accurately known to dirigible kinetic model, and unknown fly is estimated using neural network approximator Ship kinetic model, improves the adaptability and control accuracy of system.
Control engineer to give arbitrary instruction flight path according to actual dirigible in application process, and will be obtained by this method To controlled quentity controlled variable transmit to executing agency and realize flight tracking control function.
Brief description of the drawings
Fig. 1 is dirigible flight path control system structure chart of the present invention
Fig. 2 is dirigible Three-dimensional Track tracking and controlling method flow chart of steps of the present invention
Fig. 3 is that dirigible coordinate system of the present invention and kinematic parameter are defined
Fig. 4 is neural network structure figure of the present invention
Fig. 5 is dirigible Three-dimensional Track tracing control result of the present invention
Fig. 6 is dirigible Three-dimensional Track tracing control error of the present invention
Fig. 7 is neutral net Approaching Results
Symbol description is as follows in figure:
η η=[x, y, z, θ, ψ, φ]TFor dirigible flight path, wherein x, y, z, θ, ψ, φ be respectively actual flight path x coordinate, Y-coordinate, z coordinate, the angle of pitch, yaw angle and roll angle;
ηd ηd=[xd,yd,zdddd]TFor instruction flight path, wherein xd、yd、zd、θd、ψdAnd φdRespectively instruct x Coordinate, instruction y-coordinate, instruction z coordinate, the instruction angle of pitch, instruction yaw angle and instruction roll angle;
oexeyeze oexeyezeRepresent earth axes;
obxbybzb obxbybzbRepresent dirigible body coordinate system;
E e=[xe,ye,zeeee]TFor the flight tracking control margin of error, respectively the x coordinate error of flight tracking control, y Error of coordinate, z coordinate error;
U u are system control amount;
F (x) f (x) are the uncertain kinetic model of dirigible.
Embodiment
The present invention " a kind of contragradience neural network control method of dirigible Three-dimensional Track tracking ", it is comprised the following steps that:
Step one:Given instruction flight path
Giving instruction flight path is:
ηd=[xd,yd,zdddd]T=[(3t) m, (0.93t) m, 10m, 0rad, 0.3rad, 0rad]T, xd、yd、 zd、θd、ψdAnd φdRespectively instruction x coordinate, instruction y-coordinate, instruction z coordinate, the instruction angle of pitch, instruction yaw angle and instruction rolling Corner;
Step 2:The flight tracking control margin of error is calculated
The flight tracking control margin of error between computations flight path and actual flight path:
E=ηd- η=[xd-x,yd-y,zd-z,θd-θ,ψd-ψ,φd-φ]T,
Wherein, η=[x, y, z, θ, ψ, φ]TFor actual flight path, x, y, z, θ, ψ, φ are respectively the x coordinate of actual flight path, y Coordinate, z coordinate, the angle of pitch, yaw angle and roll angle, are consecutive variations value.
Initially flight path is:
η0=[x0,y0,z0000]T=[100m, -200m, 5m, 0.02rad, 0.02rad, 0.1rad]T
Initial velocity:
V0=[u0,v0,w0,p0,q0,r0]T=[8m/s, 0m/s, 0m/s, 0rad/s, 0rad/s, 0rad/s]T
Step 3:Design flight tracking control rule:
1) dirigible kinetic model is set up
The mathematical modeling of dirigible spatial movement is represented by:
In formula
Wherein
In formula, m is dirigible quality, m11、m22、m33For additional mass, I11、I22、I33For additional inertial;Λ is dirigible body Product;Q is dynamic pressure, and α is the angle of attack, and β is yaw angle, CX、CY、CZ、Cl、Cm、CnFor Aerodynamic Coefficient;Ix、Iy、IzRespectively around obxb、 obyb、obzbPrincipal moments;Ixy、Ixz、IyzRespectively on plane obxbyb、obxbzb、obybzbProduct of inertia;T is that thrust is big Small, μ is thrust vectoring and obxbzbAngle between face, provides it in obxbzbThe left side in face is just, υ is thrust vectoring in obxbzb The projection in face and obxbAngle between axle, provides that it is projected in obxbIt is just under axle;lx、ly、lzRepresent thrust point away from Origin obDistance.
Formula (52) is the expression formula on generalized velocity V, it is necessary to transform it into the expression formula on generalized coordinates η.
It can be obtained by formula (51):
In formula, J-1(η) is J (η) inverse matrix,
To formula (65) differential, it can obtain
In formula
Formula (68) premultiplicationIt can obtain
Composite type (52), formula (68) and formula (70) can be obtained:
In formula
Mη(η)=RTMR (72)
Γ=RTτ (75)
Make x1=η,Then kinetic model (71) can be written as following form:
In formula,Representing matrix M η inverse matrix;MηIt is MηThe abbreviation of (η);
Using the mathematical modeling described by formula (76) as controlled device, using Backstepping techniques design flight tracking control rule.
Dirigible parameter in the present embodiment is shown in Table 1.
The dirigible parameter of table 1
2) design control law
According to the flight tracking control margin of error e between instruction flight path and actual flight path, virtual amount is defined as follows:
In formula, α1For virtual amount, k1, k2For adjustable control parameter.
The virtual amount α of definition1With x2Between error e ':
E '=x21 (78)
Formula (78) to time diffusion and substitutes into formula (76), can obtain:
Order
Then formula (80) is represented by:
Wherein, k1Value is 12.
Choose Lyapunov functions V1
Formula (82) to time diffusion and substitutes into formula (81), can obtain:
According to formula (83), following control law is designed:
Wherein, k2Value is 10.
Due to being difficult to that Accurate Model is carried out to dirigible during practical flight, f (x) is unknown function, it is difficult to according to formula (35) it is controlled rule to resolve, therefore, f (x) estimate must be usedFlight tracking control rule formula (35) is resolved;
Wherein, the design neural network approximator described in step 4, its design method is:
1) unknown function f (x) is approached using neutral net, then had:
F (x)=wTh(x)+ε (37)
In formula, w is the weight vectors of neutral net, and ε is approximate error, h (x)=[hi(x)]T, hi(x) it is gaussian basis letter Number, subscript i represents i-th of Gaussian bases;
2) input/output variable is selected
Make flight tracking control error e and its rate of changeActual flight path η and its rate of changeFor the input of neural network approximator Variable, makes estimateFor the output variable of neural network approximator.
3) neural network structure is designed
Neural network structure includes input layer, hidden layer and output layer, as shown in Figure 4.
Input layer:Choose neutral net input variable be
Hidden layer:Gaussian function is chosen as the basic function of hidden node
Wherein,
Output layer:Neutral net is output as
Wherein,Value be taken as
Thus, uncertain dirigible nonlinear kinetics mould can accurately be estimated by above-mentioned neural network approximator Type.
Dirigible Three-dimensional Track tracing control result in embodiment is as shown in Figure 5-Figure 7.Fig. 5 gives dirigible Three-dimensional Track Tracing control result, can be obtained by Fig. 5:Dirigible can be accurately tracked by instructing flight path, demonstrate the present invention by initial position The validity of the Track In Track control method proposed;Fig. 6 gives Track In Track control error, can be obtained by Fig. 6, institute of the present invention The flight tracking control method of proposition can accurately track given instruction flight path.Fig. 7 gives neutral net Approaching Results, by Fig. 7 can be obtained, and the neural network approximator designed by the present invention can accurately estimate uncertain dirigible kinetic model.
The explanation of the preferred embodiment of the present invention contained above, this be in order to describe the technical characteristic of the present invention in detail, and It is not intended to the content of the invention being limited in the concrete form described by embodiment, according to other of present invention purport progress Modifications and variations are also protected by this patent.The purport of present invention is to be defined by the claims, rather than by embodiment Specific descriptions are defined.

Claims (2)

1. a kind of contragradience neural network control method of dirigible Three-dimensional Track tracking, it is characterised in that comprise the following steps:
Step one:Given instruction flight path:ηd=[xd,yd,zdddd]T
Wherein:Instruction flight path is generalized coordinates ηd=[xd,yd,zdddd]T, xd、yd、zd、θd、ψdAnd φdRespectively instruct X coordinate, instruction y-coordinate, instruction z coordinate, the instruction angle of pitch, instruction yaw angle and instruction roll angle, subscript T represent vector or square The transposition of battle array;
Step 2:The flight tracking control margin of error is calculated:Flight tracking control margin of error e between computations flight path and actual flight path;
Flight tracking control margin of error e computational methods are:
E=ηd- η=[xd-x,yd-y,zd-z,θd-θ,ψd-ψ,φd-φ]T (1)
η=[x, y, z, θ, ψ, φ]TFor actual flight path, x, y, z, θ, ψ, φ are respectively that the x coordinate, y-coordinate, z of actual flight path are sat Mark, the angle of pitch, yaw angle and roll angle;
Step 3:Flight tracking control rule design:Lypaunov functions and intermediate virtual controlled quentity controlled variable are chosen, flight path is designed using Backstepping Control law, calculates flight tracking control amount u;
1) kinetic model of dirigible is set up
The coordinate system and kinematic parameter of dirigible spatial movement are defined as follows:Using earth axes oexeyezeAnd carrier coordinate system obxbybzbSpatial movement to dirigible is described, and CV is centre of buoyancy, and CG is center of gravity, and the vector of centre of buoyancy to center of gravity is rG=[xG, yG,zG]T;Kinematic parameter is defined:Position P=[x, y, z]T, x, y, z is respectively axial direction, the displacement of lateral and vertical direction;Posture Angle Ω=[θ, ψ, φ]T, θ, ψ, φ are respectively the angle of pitch, yaw angle and roll angle;Speed v=[u, v, w]T, u, v, w are respectively Axial direction, the speed of lateral and vertical direction in carrier coordinate system;Angular velocity omega=[p, q, r]T, p, q, r are respectively rolling, pitching And yaw rate;Remember generalized coordinates η=[x, y, z, θ, ψ, φ]T, generalized velocity is V=[u, v, w, p, q, r]T
The kinetic model of dirigible is described as follows:
<mrow> <mover> <mi>&amp;eta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>=</mo> <mi>J</mi> <mrow> <mo>(</mo> <mi>&amp;eta;</mi> <mo>)</mo> </mrow> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>J</mi> <mn>1</mn> </msub> </mtd> <mtd> <msub> <mn>0</mn> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mn>0</mn> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mi>J</mi> <mn>2</mn> </msub> </mtd> </mtr> </mtable> </mfenced> <mi>V</mi> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>2</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <mi>M</mi> <mover> <mi>V</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>=</mo> <mover> <mi>N</mi> <mo>&amp;OverBar;</mo> </mover> <mo>+</mo> <mover> <mi>G</mi> <mo>&amp;OverBar;</mo> </mover> <mo>+</mo> <mi>&amp;tau;</mi> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>3</mn> <mo>)</mo> </mrow> </mrow>
In formula
<mrow> <msub> <mi>J</mi> <mn>1</mn> </msub> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <mi>cos</mi> <mi>&amp;psi;</mi> <mi>cos</mi> <mi>&amp;theta;</mi> </mrow> </mtd> <mtd> <mrow> <mi>cos</mi> <mi>&amp;psi;</mi> <mi>sin</mi> <mi>&amp;theta;</mi> <mi>sin</mi> <mi>&amp;phi;</mi> <mo>-</mo> <mi>sin</mi> <mi>&amp;psi;</mi> <mi>cos</mi> <mi>&amp;phi;</mi> </mrow> </mtd> <mtd> <mrow> <mi>cos</mi> <mi>&amp;psi;</mi> <mi>sin</mi> <mi>&amp;theta;</mi> <mi>cos</mi> <mi>&amp;phi;</mi> <mo>+</mo> <mi>sin</mi> <mi>&amp;psi;</mi> <mi>sin</mi> <mi>&amp;phi;</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>sin</mi> <mi>&amp;psi;</mi> <mi>cos</mi> <mi>&amp;theta;</mi> </mrow> </mtd> <mtd> <mrow> <mi>sin</mi> <mi>&amp;psi;</mi> <mi>sin</mi> <mi>&amp;theta;</mi> <mi>sin</mi> <mi>&amp;phi;</mi> <mo>+</mo> <mi>cos</mi> <mi>&amp;psi;</mi> <mi>cos</mi> <mi>&amp;phi;</mi> </mrow> </mtd> <mtd> <mrow> <mi>sin</mi> <mi>&amp;psi;</mi> <mi>sin</mi> <mi>&amp;theta;</mi> <mi>cos</mi> <mi>&amp;phi;</mi> <mo>-</mo> <mi>cos</mi> <mi>&amp;psi;</mi> <mi>sin</mi> <mi>&amp;phi;</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <mi>sin</mi> <mi>&amp;theta;</mi> </mrow> </mtd> <mtd> <mrow> <mi>cos</mi> <mi>&amp;theta;</mi> <mi>sin</mi> <mi>&amp;phi;</mi> </mrow> </mtd> <mtd> <mrow> <mi>cos</mi> <mi>&amp;theta;</mi> <mi>cos</mi> <mi>&amp;phi;</mi> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>4</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <msub> <mi>J</mi> <mn>2</mn> </msub> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mi>&amp;phi;</mi> </mrow> </mtd> <mtd> <mrow> <mo>-</mo> <mi>sin</mi> <mi>&amp;phi;</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mi>sec</mi> <mi>&amp;theta;</mi> <mi>sin</mi> <mi>&amp;phi;</mi> </mrow> </mtd> <mtd> <mrow> <mi>sec</mi> <mi>&amp;theta;</mi> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mi>&amp;phi;</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mrow> <mi>t</mi> <mi>a</mi> <mi>n</mi> <mi>&amp;theta;</mi> <mi>sin</mi> <mi>&amp;phi;</mi> </mrow> </mtd> <mtd> <mrow> <mi>t</mi> <mi>a</mi> <mi>n</mi> <mi>&amp;theta;</mi> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mi>&amp;phi;</mi> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>5</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <mi>M</mi> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <mi>m</mi> <mo>+</mo> <msub> <mi>m</mi> <mn>11</mn> </msub> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <msub> <mi>mz</mi> <mi>G</mi> </msub> </mrow> </mtd> <mtd> <mrow> <mo>-</mo> <msub> <mi>my</mi> <mi>G</mi> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mi>m</mi> <mo>+</mo> <msub> <mi>m</mi> <mn>22</mn> </msub> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mo>-</mo> <msub> <mi>mz</mi> <mi>G</mi> </msub> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <msub> <mi>mx</mi> <mi>G</mi> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mi>m</mi> <mo>+</mo> <msub> <mi>m</mi> <mn>33</mn> </msub> </mrow> </mtd> <mtd> <mrow> <msub> <mi>my</mi> <mi>G</mi> </msub> </mrow> </mtd> <mtd> <mrow> <mo>-</mo> <msub> <mi>mx</mi> <mi>G</mi> </msub> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mo>-</mo> <msub> <mi>mz</mi> <mi>G</mi> </msub> </mrow> </mtd> <mtd> <mrow> <msub> <mi>my</mi> <mi>G</mi> </msub> </mrow> </mtd> <mtd> <mrow> <msub> <mi>I</mi> <mi>x</mi> </msub> <mo>+</mo> <msub> <mi>I</mi> <mn>11</mn> </msub> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>mz</mi> <mi>G</mi> </msub> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mo>-</mo> <msub> <mi>mx</mi> <mi>G</mi> </msub> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <msub> <mi>I</mi> <mi>x</mi> </msub> <mo>+</mo> <msub> <mi>I</mi> <mn>22</mn> </msub> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <msub> <mi>mx</mi> <mi>G</mi> </msub> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mo>-</mo> <msub> <mi>I</mi> <mrow> <mi>x</mi> <mi>z</mi> </mrow> </msub> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <msub> <mi>I</mi> <mi>x</mi> </msub> <mo>+</mo> <msub> <mi>I</mi> <mn>33</mn> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>6</mn> <mo>)</mo> </mrow> </mrow> 1
<mrow> <mover> <mi>G</mi> <mo>&amp;OverBar;</mo> </mover> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mo>(</mo> <mi>B</mi> <mo>-</mo> <mi>G</mi> <mo>)</mo> <mi>s</mi> <mi>i</mi> <mi>n</mi> <mi>&amp;theta;</mi> </mtd> </mtr> <mtr> <mtd> <mo>(</mo> <mi>G</mi> <mo>-</mo> <mi>B</mi> <mo>)</mo> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mi>&amp;theta;</mi> <mi>sin</mi> <mi>&amp;phi;</mi> </mtd> </mtr> <mtr> <mtd> <mo>(</mo> <mi>G</mi> <mo>-</mo> <mi>B</mi> <mo>)</mo> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mi>&amp;theta;</mi> <mi>cos</mi> <mi>&amp;phi;</mi> </mtd> </mtr> <mtr> <mtd> <msub> <mi>y</mi> <mi>G</mi> </msub> <mi>G</mi> <mi> </mi> <mi>cos</mi> <mi>&amp;theta;</mi> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mi>&amp;phi;</mi> <mo>-</mo> <msub> <mi>z</mi> <mi>G</mi> </msub> <mi>G</mi> <mi> </mi> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mi>&amp;theta;</mi> <mi>s</mi> <mi>i</mi> <mi>n</mi> <mi>&amp;phi;</mi> </mtd> </mtr> <mtr> <mtd> <mo>-</mo> <msub> <mi>x</mi> <mi>G</mi> </msub> <mi>G</mi> <mi> </mi> <mi>cos</mi> <mi>&amp;theta;</mi> <mi>cos</mi> <mi>&amp;phi;</mi> <mo>-</mo> <msub> <mi>z</mi> <mi>G</mi> </msub> <mi>G</mi> <mi> </mi> <mi>s</mi> <mi>i</mi> <mi>n</mi> <mi>&amp;theta;</mi> </mtd> </mtr> <mtr> <mtd> <msub> <mi>x</mi> <mi>G</mi> </msub> <mi>G</mi> <mi> </mi> <mi>cos</mi> <mi>&amp;theta;</mi> <mi>sin</mi> <mi>&amp;phi;</mi> <mo>+</mo> <msub> <mi>y</mi> <mi>G</mi> </msub> <mi>G</mi> <mi> </mi> <mi>sin</mi> <mi>&amp;theta;</mi> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>7</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <mi>&amp;tau;</mi> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>&amp;tau;</mi> <mi>u</mi> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>&amp;tau;</mi> <mi>v</mi> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>&amp;tau;</mi> <mi>w</mi> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>&amp;tau;</mi> <mi>l</mi> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>&amp;tau;</mi> <mi>m</mi> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>&amp;tau;</mi> <mi>n</mi> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mi>T</mi> <mi> </mi> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mi>&amp;mu;</mi> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mi>&amp;upsi;</mi> </mtd> </mtr> <mtr> <mtd> <mi>T</mi> <mi> </mi> <mi>sin</mi> <mi>&amp;mu;</mi> </mtd> </mtr> <mtr> <mtd> <mi>T</mi> <mi> </mi> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mi>&amp;mu;</mi> <mi>s</mi> <mi>i</mi> <mi>n</mi> <mi>&amp;upsi;</mi> </mtd> </mtr> <mtr> <mtd> <mi>T</mi> <mi> </mi> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mi>&amp;mu;</mi> <mi>sin</mi> <mi>&amp;upsi;</mi> <msub> <mi>l</mi> <mi>y</mi> </msub> <mo>-</mo> <mi>T</mi> <mi> </mi> <mi>s</mi> <mi>i</mi> <mi>n</mi> <mi>&amp;mu;</mi> <msub> <mi>l</mi> <mi>z</mi> </msub> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>T</mi> <mi> </mi> <msub> <mi>cos&amp;mu;cos&amp;upsi;l</mi> <mi>z</mi> </msub> <mo>-</mo> <mi>T</mi> <mi> </mi> <msub> <mi>cos&amp;mu;sin&amp;upsi;l</mi> <mi>x</mi> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>T</mi> <mi> </mi> <msub> <mi>sin&amp;mu;l</mi> <mi>x</mi> </msub> <mo>-</mo> <mi>T</mi> <mi> </mi> <msub> <mi>cos&amp;mu;cos&amp;upsi;l</mi> <mi>y</mi> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>8</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <mover> <mi>N</mi> <mo>&amp;OverBar;</mo> </mover> <mo>=</mo> <msup> <mrow> <mo>&amp;lsqb;</mo> <msub> <mi>N</mi> <mi>u</mi> </msub> <mo>,</mo> <msub> <mi>N</mi> <mi>v</mi> </msub> <mo>,</mo> <msub> <mi>N</mi> <mi>w</mi> </msub> <mo>,</mo> <msub> <mi>N</mi> <mi>p</mi> </msub> <mo>,</mo> <msub> <mi>N</mi> <mi>q</mi> </msub> <mo>,</mo> <msub> <mi>N</mi> <mi>r</mi> </msub> <mo>&amp;rsqb;</mo> </mrow> <mi>T</mi> </msup> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>9</mn> <mo>)</mo> </mrow> </mrow>
Wherein
<mrow> <mfenced open='' close=''> <mtable> <mtr> <mtd> <msub> <mi>N</mi> <mi>u</mi> </msub> <mo>=</mo> <mrow> <mo>(</mo> <mi>m</mi> <mo>+</mo> <msub> <mi>m</mi> <mn>22</mn> </msub> <mo>)</mo> </mrow> <mi>vr</mi> <mo>-</mo> <mrow> <mo>(</mo> <mi>m</mi> <mo>+</mo> <msub> <mi>m</mi> <mn>33</mn> </msub> <mo>)</mo> </mrow> <mi>wq</mi> <mo>+</mo> <mi>m</mi> <mo>[</mo> <msub> <mi>x</mi> <mi>G</mi> </msub> <mrow> <mo>(</mo> <msup> <mi>p</mi> <mn>2</mn> </msup> <mo>+</mo> <msup> <mi>r</mi> <mn>2</mn> </msup> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mi>y</mi> <mi>G</mi> </msub> <mi>pq</mi> <mo>-</mo> <msub> <mi>z</mi> <mi>G</mi> </msub> <mi>pr</mi> <mo>]</mo> </mtd> </mtr> <mtr> <mtd> <mo>+</mo> <msup> <mi>Q&amp;Lambda;</mi> <mrow> <mn>2</mn> <mo>/</mo> <mn>3</mn> </mrow> </msup> <mrow> <mo>(</mo> <mo>-</mo> <msub> <mi>G</mi> <mi>X</mi> </msub> <mi>cos</mi> <mi></mi> <mi>&amp;alpha;</mi> <mi>cos</mi> <mi>&amp;beta;</mi> <mo>+</mo> <msub> <mi>G</mi> <mi>Y</mi> </msub> <mi>cos</mi> <mi></mi> <mi>&amp;alpha;</mi> <mi>sin</mi> <mi>&amp;beta;</mi> <mo>+</mo> <msub> <mi>C</mi> <mi>Z</mi> </msub> <mi>sin</mi> <mi>&amp;alpha;</mi> <mo>)</mo> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>10</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <mfenced open='' close=''> <mtable> <mtr> <mtd> <msub> <mi>N</mi> <mi>v</mi> </msub> <mo>=</mo> <mrow> <mo>(</mo> <mi>m</mi> <mo>+</mo> <msub> <mi>m</mi> <mn>33</mn> </msub> <mo>)</mo> </mrow> <mi>wp</mi> <mo>-</mo> <mrow> <mo>(</mo> <mi>m</mi> <mo>+</mo> <msub> <mi>m</mi> <mn>11</mn> </msub> <mo>)</mo> </mrow> <mi>ur</mi> <mo>+</mo> <mi>m</mi> <mo>[</mo> <msub> <mi>x</mi> <mi>G</mi> </msub> <mi>pq</mi> <mo>-</mo> <msub> <mi>y</mi> <mi>G</mi> </msub> <mrow> <mo>(</mo> <msup> <mi>p</mi> <mn>2</mn> </msup> <mo>+</mo> <msup> <mi>r</mi> <mn>2</mn> </msup> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>z</mi> <mi>G</mi> </msub> <mi>qr</mi> <mo>]</mo> </mtd> </mtr> <mtr> <mtd> <mo>+</mo> <msup> <mi>Q&amp;Lambda;</mi> <mrow> <mn>2</mn> <mo>/</mo> <mn>3</mn> </mrow> </msup> <mrow> <mo>(</mo> <msub> <mi>C</mi> <mi>X</mi> </msub> <mi>sin</mi> <mi>&amp;beta;</mi> <mo>+</mo> <msub> <mi>C</mi> <mi>Y</mi> </msub> <mi>cos</mi> <mi>&amp;beta;</mi> <mo>)</mo> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>11</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <mfenced open='' close=''> <mtable> <mtr> <mtd> <msub> <mi>N</mi> <mi>w</mi> </msub> <mo>=</mo> <mrow> <mo>(</mo> <mi>m</mi> <mo>+</mo> <msub> <mi>m</mi> <mn>22</mn> </msub> <mo>)</mo> </mrow> <mi>vp</mi> <mo>-</mo> <mrow> <mo>(</mo> <mi>m</mi> <mo>+</mo> <msub> <mi>m</mi> <mn>11</mn> </msub> <mo>)</mo> </mrow> <mi>uq</mi> <mo>-</mo> <mi>m</mi> <mo>[</mo> <msub> <mi>x</mi> <mi>G</mi> </msub> <mi>pr</mi> <mo>+</mo> <msub> <mi>y</mi> <mi>G</mi> </msub> <mi>qr</mi> <mo>-</mo> <msub> <mi>z</mi> <mi>G</mi> </msub> <mrow> <mo>(</mo> <msup> <mi>p</mi> <mn>2</mn> </msup> <mo>+</mo> <msup> <mi>q</mi> <mn>2</mn> </msup> <mo>)</mo> </mrow> <mo>]</mo> </mtd> </mtr> <mtr> <mtd> <mo>+</mo> <mi>Q</mi> <msup> <mi>&amp;Lambda;</mi> <mrow> <mn>2</mn> <mo>/</mo> <mn>3</mn> </mrow> </msup> <mrow> <mo>(</mo> <mo>-</mo> <msub> <mi>C</mi> <mi>X</mi> </msub> <mi>sin</mi> <mi></mi> <mi>&amp;alpha;</mi> <mi>sin</mi> <mi>&amp;beta;</mi> <mo>+</mo> <msub> <mi>C</mi> <mi>Y</mi> </msub> <mi>sin</mi> <mi></mi> <mi>&amp;alpha;</mi> <mi>cos</mi> <mi>&amp;beta;</mi> <mo>-</mo> <msub> <mi>C</mi> <mi>Z</mi> </msub> <mi>cos</mi> <mi>&amp;alpha;</mi> <mo>)</mo> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>12</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <mfenced open='' close=''> <mtable> <mtr> <mtd> <msub> <mi>N</mi> <mi>p</mi> </msub> <mo>=</mo> <mo>[</mo> <mrow> <mo>(</mo> <msub> <mi>I</mi> <mi>y</mi> </msub> <mo>+</mo> <msub> <mi>I</mi> <mn>22</mn> </msub> <mo>)</mo> </mrow> <mo>-</mo> <mrow> <mo>(</mo> <msub> <mi>I</mi> <mi>z</mi> </msub> <mo>+</mo> <msub> <mi>I</mi> <mn>33</mn> </msub> <mo>)</mo> </mrow> <mo>]</mo> <mi>qr</mi> <mo>+</mo> <msub> <mi>I</mi> <mi>xz</mi> </msub> <mi>pq</mi> <mo>-</mo> <msub> <mi>I</mi> <mi>xy</mi> </msub> <mi>pr</mi> <mo>-</mo> <msub> <mi>I</mi> <mi>yz</mi> </msub> <mrow> <mo>(</mo> <msup> <mi>r</mi> <mn>2</mn> </msup> <mo>-</mo> <msup> <mi>q</mi> <mn>2</mn> </msup> <mo>)</mo> </mrow> <mo>+</mo> </mtd> </mtr> <mtr> <mtd> <mo>[</mo> <msub> <mi>mz</mi> <mi>G</mi> </msub> <mrow> <mo>(</mo> <mi>ur</mi> <mo>-</mo> <mi>wp</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>y</mi> <mi>G</mi> </msub> <mrow> <mo>(</mo> <mi>uq</mi> <mo>-</mo> <mi>vp</mi> <mo>)</mo> </mrow> <mo>]</mo> <mo>+</mo> <mi>Q&amp;Lambda;</mi> <msub> <mi>C</mi> <mi>l</mi> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>13</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <mfenced open='' close=''> <mtable> <mtr> <mtd> <msub> <mi>N</mi> <mi>q</mi> </msub> <mo>=</mo> <mo>[</mo> <mrow> <mo>(</mo> <msub> <mi>I</mi> <mi>z</mi> </msub> <mo>+</mo> <msub> <mi>I</mi> <mn>33</mn> </msub> <mo>)</mo> </mrow> <mo>-</mo> <mrow> <mo>(</mo> <msub> <mi>I</mi> <mi>x</mi> </msub> <mo>+</mo> <msub> <mi>I</mi> <mn>22</mn> </msub> <mo>)</mo> </mrow> <mo>]</mo> <mi>pr</mi> <mo>+</mo> <msub> <mi>I</mi> <mi>xy</mi> </msub> <mi>qr</mi> <mo>-</mo> <msub> <mi>I</mi> <mi>yz</mi> </msub> <mi>pq</mi> <mo>-</mo> <msub> <mi>I</mi> <mi>xz</mi> </msub> <mrow> <mo>(</mo> <msup> <mi>p</mi> <mn>2</mn> </msup> <mo>-</mo> <msup> <mi>r</mi> <mn>2</mn> </msup> <mo>)</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mo>+</mo> <mi>m</mi> <mo>[</mo> <msub> <mi>x</mi> <mi>G</mi> </msub> <mrow> <mo>(</mo> <mi>vp</mi> <mo>-</mo> <mi>uq</mi> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mi>z</mi> <mi>G</mi> </msub> <mrow> <mo>(</mo> <mi>wp</mi> <mo>-</mo> <mi>vr</mi> <mo>)</mo> </mrow> <mo>]</mo> <mo>+</mo> <mi>Q&amp;Lambda;</mi> <msub> <mi>C</mi> <mi>m</mi> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>14</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <mfenced open='' close=''> <mtable> <mtr> <mtd> <msub> <mi>N</mi> <mi>r</mi> </msub> <mo>=</mo> <mo>[</mo> <mrow> <mo>(</mo> <msub> <mi>I</mi> <mi>y</mi> </msub> <mo>+</mo> <msub> <mi>I</mi> <mn>22</mn> </msub> <mo>)</mo> </mrow> <mo>-</mo> <mrow> <mo>(</mo> <msub> <mi>I</mi> <mi>x</mi> </msub> <mo>+</mo> <msub> <mi>I</mi> <mn>11</mn> </msub> <mo>)</mo> </mrow> <mo>]</mo> <mi>pq</mi> <mo>+</mo> <msub> <mi>I</mi> <mi>xz</mi> </msub> <mi>qr</mi> <mo>-</mo> <msub> <mi>I</mi> <mi>xy</mi> </msub> <mrow> <mo>(</mo> <msup> <mi>q</mi> <mn>2</mn> </msup> <mo>-</mo> <msup> <mi>p</mi> <mn>2</mn> </msup> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>I</mi> <mi>yz</mi> </msub> <mi>pr</mi> </mtd> </mtr> <mtr> <mtd> <mo>+</mo> <mi>m</mi> <mo>[</mo> <msub> <mi>y</mi> <mi>G</mi> </msub> <mrow> <mo>(</mo> <mi>wq</mi> <mo>-</mo> <mi>vr</mi> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mi>x</mi> <mi>G</mi> </msub> <mrow> <mo>(</mo> <mi>ur</mi> <mo>-</mo> <mi>wp</mi> <mo>)</mo> </mrow> <mo>]</mo> <mo>+</mo> <mi>Q&amp;Lambda;</mi> <msub> <mi>C</mi> <mi>n</mi> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>15</mn> <mo>)</mo> </mrow> </mrow>
In formula, m is dirigible quality, m11、m22、m33For additional mass, I11、I22、I33For additional inertial, Λ is dirigible volume;Q is Dynamic pressure, α is the angle of attack, and β is yaw angle, CX、CY、CZ、Cl、Cm、CnFor Aerodynamic Coefficient;Ix、Iy、IzRespectively around obxb、obyb、obzb Principal moments;Ixy、Ixz、IyzRespectively on plane obxbyb、obxbzb、obybzbProduct of inertia;T is thrust size, and μ is thrust Vector and obxbzbAngle between face, provides it in obxbzbThe left side in face is just, υ is thrust vectoring in obxbzbThe projection in face with obxbAngle between axle, provides that it is projected in obxbIt is just under axle;lx、ly、lzRepresent thrust point away from origin obAway from From;
Formula (3) is the expression formula on generalized velocity V, it is necessary to transform it into the expression formula on generalized coordinates η;
It can be obtained by formula (2):
<mrow> <mi>V</mi> <mo>=</mo> <msup> <mi>J</mi> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> <mrow> <mo>(</mo> <mi>&amp;eta;</mi> <mo>)</mo> </mrow> <mover> <mi>&amp;eta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>=</mo> <mi>R</mi> <mrow> <mo>(</mo> <mi>&amp;eta;</mi> <mo>)</mo> </mrow> <mover> <mi>&amp;eta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mi>A</mi> </mtd> <mtd> <msub> <mn>0</mn> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mn>0</mn> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <mi>B</mi> </mtd> </mtr> </mtable> </mfenced> <mover> <mi>&amp;eta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>16</mn> <mo>)</mo> </mrow> </mrow>
In formula, J-1(η) is J (η) inverse matrix;
<mrow> <mi>A</mi> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <mi>cos</mi> <mi>&amp;psi;</mi> <mi>cos</mi> <mi>&amp;theta;</mi> </mrow> </mtd> <mtd> <mrow> <mi>sin</mi> <mi>&amp;psi;</mi> <mi>cos</mi> <mi>&amp;theta;</mi> </mrow> </mtd> <mtd> <mrow> <mo>-</mo> <mi>sin</mi> <mi>&amp;theta;</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>cos</mi> <mi>&amp;psi;</mi> <mi>sin</mi> <mi>&amp;theta;</mi> <mi>sin</mi> <mi>&amp;phi;</mi> <mo>-</mo> <mi>sin</mi> <mi>&amp;psi;</mi> <mi>cos</mi> <mi>&amp;phi;</mi> </mrow> </mtd> <mtd> <mrow> <mi>sin</mi> <mi>&amp;psi;</mi> <mi>sin</mi> <mi>&amp;theta;</mi> <mi>sin</mi> <mi>&amp;phi;</mi> <mo>+</mo> <mi>cos</mi> <mi>&amp;psi;</mi> <mi>cos</mi> <mi>&amp;phi;</mi> </mrow> </mtd> <mtd> <mrow> <mi>cos</mi> <mi>&amp;theta;</mi> <mi>sin</mi> <mi>&amp;phi;</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>cos</mi> <mi>&amp;psi;</mi> <mi>sin</mi> <mi>&amp;theta;</mi> <mi>cos</mi> <mi>&amp;phi;</mi> <mo>+</mo> <mi>sin</mi> <mi>&amp;psi;</mi> <mi>sin</mi> <mi>&amp;phi;</mi> </mrow> </mtd> <mtd> <mrow> <mi>sin</mi> <mi>&amp;psi;</mi> <mi>sin</mi> <mi>&amp;theta;</mi> <mi>cos</mi> <mi>&amp;phi;</mi> <mo>-</mo> <mi>cos</mi> <mi>&amp;psi;</mi> <mi>sin</mi> <mi>&amp;phi;</mi> </mrow> </mtd> <mtd> <mrow> <mi>cos</mi> <mi>&amp;theta;</mi> <mi>cos</mi> <mi>&amp;phi;</mi> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>17</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <mi>B</mi> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mo>-</mo> <mi>s</mi> <mi>i</mi> <mi>n</mi> <mi>&amp;theta;</mi> </mrow> </mtd> <mtd> <mn>1</mn> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mi>&amp;phi;</mi> </mrow> </mtd> <mtd> <mrow> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mi>&amp;theta;</mi> <mi>s</mi> <mi>i</mi> <mi>n</mi> <mi>&amp;phi;</mi> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <mi>s</mi> <mi>i</mi> <mi>n</mi> <mi>&amp;phi;</mi> </mrow> </mtd> <mtd> <mrow> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mi>&amp;theta;</mi> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mi>&amp;phi;</mi> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>18</mn> <mo>)</mo> </mrow> </mrow>
To formula (16) differential, it can obtain
<mrow> <mover> <mi>V</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>=</mo> <mover> <mi>R</mi> <mo>&amp;CenterDot;</mo> </mover> <mover> <mi>&amp;eta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>+</mo> <mi>R</mi> <mover> <mi>&amp;eta;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>19</mn> <mo>)</mo> </mrow> </mrow>
In formula
<mrow> <mover> <mi>R</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mover> <mi>A</mi> <mo>&amp;CenterDot;</mo> </mover> </mtd> <mtd> <msub> <mn>0</mn> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mn>0</mn> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <mover> <mi>B</mi> <mo>&amp;CenterDot;</mo> </mover> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>20</mn> <mo>)</mo> </mrow> </mrow>
Formula (19) premultiplicationIt can obtain
<mrow> <msup> <mi>R</mi> <mi>T</mi> </msup> <mi>M</mi> <mover> <mi>V</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>=</mo> <msup> <mi>R</mi> <mi>T</mi> </msup> <mi>M</mi> <mover> <mi>R</mi> <mo>&amp;CenterDot;</mo> </mover> <mover> <mi>&amp;eta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>+</mo> <msup> <mi>R</mi> <mi>T</mi> </msup> <mi>M</mi> <mi>R</mi> <mover> <mi>&amp;eta;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>21</mn> <mo>)</mo> </mrow> </mrow>
Composite type (3), formula (19) and formula (21) can be obtained:
<mrow> <msub> <mi>M</mi> <mi>&amp;eta;</mi> </msub> <mrow> <mo>(</mo> <mi>&amp;eta;</mi> <mo>)</mo> </mrow> <mover> <mi>&amp;eta;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mo>+</mo> <msub> <mi>N</mi> <mi>&amp;eta;</mi> </msub> <mrow> <mo>(</mo> <mi>&amp;eta;</mi> <mo>)</mo> </mrow> <mover> <mi>&amp;eta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>+</mo> <msub> <mi>G</mi> <mi>&amp;eta;</mi> </msub> <mrow> <mo>(</mo> <mi>&amp;eta;</mi> <mo>)</mo> </mrow> <mo>=</mo> <mi>&amp;Gamma;</mi> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>22</mn> <mo>)</mo> </mrow> </mrow>
In formula
Mη(η)=RTMR (23)
<mrow> <msub> <mi>N</mi> <mi>&amp;eta;</mi> </msub> <mrow> <mo>(</mo> <mi>&amp;eta;</mi> <mo>)</mo> </mrow> <mo>=</mo> <msup> <mi>R</mi> <mi>T</mi> </msup> <mi>M</mi> <mover> <mi>R</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>24</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <msub> <mi>G</mi> <mi>&amp;eta;</mi> </msub> <mrow> <mo>(</mo> <mi>&amp;eta;</mi> <mo>)</mo> </mrow> <mo>=</mo> <mo>-</mo> <msup> <mi>R</mi> <mi>T</mi> </msup> <mrow> <mo>(</mo> <mover> <mi>N</mi> <mo>&amp;OverBar;</mo> </mover> <mo>+</mo> <mover> <mi>G</mi> <mo>&amp;OverBar;</mo> </mover> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>25</mn> <mo>)</mo> </mrow> </mrow>
Γ=RTτ (26)
Make x1=η,Then kinetic model (22) is written as following form:
<mrow> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mover> <mi>x</mi> <mo>&amp;CenterDot;</mo> </mover> <mn>1</mn> </msub> <mo>=</mo> <msub> <mi>x</mi> <mn>2</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mover> <mi>x</mi> <mo>&amp;CenterDot;</mo> </mover> <mn>2</mn> </msub> <mo>=</mo> <msubsup> <mi>M</mi> <mi>&amp;eta;</mi> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msubsup> <mi>&amp;Gamma;</mi> <mo>-</mo> <msubsup> <mi>M</mi> <mi>&amp;eta;</mi> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msubsup> <mrow> <mo>(</mo> <mi>&amp;eta;</mi> <mo>)</mo> </mrow> <mover> <mi>&amp;eta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>-</mo> <msub> <mi>G</mi> <mi>&amp;eta;</mi> </msub> <mrow> <mo>(</mo> <mi>&amp;eta;</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>27</mn> <mo>)</mo> </mrow> </mrow>
In formula,Representing matrix MηInverse matrix;MηIt is MηThe abbreviation of (η);
Using the mathematical modeling described by formula (27) as controlled device, using Backstepping techniques design flight tracking control rule;
2) design flight tracking control rule
According to the flight tracking control margin of error e between instruction flight path and actual flight path, virtual amount is defined as follows:
<mrow> <msub> <mi>&amp;alpha;</mi> <mn>1</mn> </msub> <mo>=</mo> <mo>-</mo> <msub> <mi>k</mi> <mn>1</mn> </msub> <mi>e</mi> <mo>+</mo> <msub> <mover> <mi>&amp;eta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>d</mi> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>28</mn> <mo>)</mo> </mrow> </mrow>
In formula, α1For virtual amount, k1For adjustable control parameter;
The virtual amount α of definition1With x2Between error e ':
E '=x21 (29)
Formula (29) to time diffusion and substitutes into formula (27), can obtain:
<mrow> <msup> <mover> <mi>e</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>&amp;prime;</mo> </msup> <mo>=</mo> <msub> <mover> <mi>x</mi> <mo>&amp;CenterDot;</mo> </mover> <mn>2</mn> </msub> <mo>-</mo> <msub> <mover> <mi>&amp;alpha;</mi> <mo>&amp;CenterDot;</mo> </mover> <mn>1</mn> </msub> <mo>=</mo> <msubsup> <mi>M</mi> <mi>&amp;eta;</mi> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msubsup> <mi>r</mi> <mo>-</mo> <msubsup> <mi>M</mi> <mi>&amp;eta;</mi> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msubsup> <msub> <mi>N</mi> <mi>&amp;eta;</mi> </msub> <mrow> <mo>(</mo> <mi>&amp;eta;</mi> <mo>)</mo> </mrow> <mover> <mi>&amp;eta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>-</mo> <msub> <mi>G</mi> <mi>&amp;eta;</mi> </msub> <mrow> <mo>(</mo> <mi>&amp;eta;</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>k</mi> <mn>1</mn> </msub> <mover> <mi>e</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>-</mo> <msub> <mover> <mi>&amp;eta;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mi>d</mi> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>30</mn> <mo>)</mo> </mrow> </mrow>
Order
<mrow> <mi>f</mi> <mrow> <mo>(</mo> <mi>x</mi> <mo>)</mo> </mrow> <mo>=</mo> <mo>-</mo> <msubsup> <mi>M</mi> <mi>&amp;eta;</mi> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msubsup> <msub> <mi>N</mi> <mi>&amp;eta;</mi> </msub> <mrow> <mo>(</mo> <mi>&amp;eta;</mi> <mo>)</mo> </mrow> <mover> <mi>&amp;eta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>-</mo> <msub> <mi>G</mi> <mi>&amp;eta;</mi> </msub> <mrow> <mo>(</mo> <mi>&amp;eta;</mi> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>31</mn> <mo>)</mo> </mrow> </mrow>
Then formula (31) is represented by:
<mrow> <msup> <mover> <mi>e</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>&amp;prime;</mo> </msup> <mo>=</mo> <mi>f</mi> <mrow> <mo>(</mo> <mi>x</mi> <mo>)</mo> </mrow> <mo>+</mo> <msubsup> <mi>M</mi> <mi>&amp;eta;</mi> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msubsup> <mi>r</mi> <mo>+</mo> <msub> <mi>k</mi> <mn>1</mn> </msub> <mover> <mi>e</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>-</mo> <msub> <mover> <mi>&amp;eta;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mi>d</mi> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>32</mn> <mo>)</mo> </mrow> </mrow>
Choose Lyapunov functions V1
<mrow> <msub> <mi>V</mi> <mn>1</mn> </msub> <mo>=</mo> <mfrac> <mn>1</mn> <mn>2</mn> </mfrac> <msup> <mi>e</mi> <mi>T</mi> </msup> <mi>e</mi> <mo>+</mo> <mfrac> <mn>1</mn> <mn>2</mn> </mfrac> <msup> <mi>e</mi> <mrow> <mo>&amp;prime;</mo> <mi>T</mi> </mrow> </msup> <msup> <mi>e</mi> <mo>&amp;prime;</mo> </msup> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>33</mn> <mo>)</mo> </mrow> </mrow>
Formula (33) is substituted into time diffusion, and by formula (32), can be obtained:
<mrow> <msub> <mover> <mi>V</mi> <mo>&amp;CenterDot;</mo> </mover> <mn>1</mn> </msub> <mo>=</mo> <mo>-</mo> <msub> <mi>k</mi> <mn>1</mn> </msub> <msup> <mi>e</mi> <mi>T</mi> </msup> <mi>e</mi> <mo>+</mo> <msup> <mi>e</mi> <mrow> <mo>&amp;prime;</mo> <mi>T</mi> </mrow> </msup> <mrow> <mo>(</mo> <mi>f</mi> <mo>(</mo> <mi>x</mi> <mo>)</mo> </mrow> <mo>+</mo> <msubsup> <mi>M</mi> <mi>&amp;eta;</mi> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msubsup> <mi>&amp;Gamma;</mi> <mo>+</mo> <msub> <mi>k</mi> <mn>1</mn> </msub> <mover> <mi>e</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>-</mo> <msub> <mover> <mi>&amp;eta;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mi>d</mi> </msub> <mo>)</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>34</mn> <mo>)</mo> </mrow> </mrow>
According to formula (34), following flight tracking control rule is designed:
<mrow> <mi>&amp;Gamma;</mi> <mo>=</mo> <msub> <mi>M</mi> <mi>&amp;eta;</mi> </msub> <mrow> <mo>(</mo> <mo>-</mo> <mi>e</mi> <mo>-</mo> <msub> <mi>k</mi> <mn>1</mn> </msub> <mover> <mi>e</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>-</mo> <msub> <mi>k</mi> <mn>2</mn> </msub> <msup> <mi>e</mi> <mo>&amp;prime;</mo> </msup> <mo>+</mo> <msub> <mover> <mi>&amp;eta;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mi>d</mi> </msub> <mo>-</mo> <mi>f</mi> <mo>(</mo> <mi>x</mi> <mo>)</mo> </mrow> <mo>)</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>35</mn> <mo>)</mo> </mrow> </mrow>
In formula, k2For adjustable control parameter;
3) stability analysis
Flight tracking control rule formula (35) is substituted into formula (34), can be obtained:
<mrow> <mtable> <mtr> <mtd> <mrow> <msub> <mover> <mi>V</mi> <mo>&amp;CenterDot;</mo> </mover> <mn>1</mn> </msub> <mo>=</mo> <mo>-</mo> <msub> <mi>k</mi> <mn>1</mn> </msub> <msup> <mi>e</mi> <mi>T</mi> </msup> <mi>e</mi> <mo>+</mo> <msup> <mi>e</mi> <mi>T</mi> </msup> <msup> <mi>e</mi> <mo>&amp;prime;</mo> </msup> <mo>+</mo> <msup> <mi>e</mi> <mrow> <mo>&amp;prime;</mo> <mi>T</mi> </mrow> </msup> <mo>{</mo> <mi>f</mi> <mrow> <mo>(</mo> <mi>x</mi> <mo>)</mo> </mrow> <mo>+</mo> <msubsup> <mi>M</mi> <mi>&amp;eta;</mi> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msubsup> <mo>&amp;lsqb;</mo> <msub> <mi>M</mi> <mi>&amp;eta;</mi> </msub> <mrow> <mo>(</mo> <mo>-</mo> <mi>e</mi> <mo>-</mo> <msub> <mi>k</mi> <mn>1</mn> </msub> <mover> <mi>e</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>-</mo> <msub> <mi>k</mi> <mn>2</mn> </msub> <msup> <mi>e</mi> <mo>&amp;prime;</mo> </msup> <mo>+</mo> <msub> <mover> <mi>&amp;eta;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mi>d</mi> </msub> <mo>-</mo> <mi>f</mi> <mo>(</mo> <mi>x</mi> <mo>)</mo> </mrow> <mo>)</mo> <mo>&amp;rsqb;</mo> <mo>+</mo> <msub> <mi>k</mi> <mn>1</mn> </msub> <mover> <mi>e</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>-</mo> <mi>k</mi> <msub> <mover> <mi>&amp;eta;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mi>d</mi> </msub> <mo>}</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>=</mo> <mo>-</mo> <msub> <mi>k</mi> <mn>1</mn> </msub> <msup> <mi>e</mi> <mi>T</mi> </msup> <mi>e</mi> <mo>+</mo> <msup> <mi>e</mi> <mrow> <mo>&amp;prime;</mo> <mi>T</mi> </mrow> </msup> <msup> <mi>e</mi> <mo>&amp;prime;</mo> </msup> <mo>+</mo> <msup> <mi>e</mi> <mrow> <mo>&amp;prime;</mo> <mi>T</mi> </mrow> </msup> <mrow> <mo>(</mo> <mn>1</mn> <mo>-</mo> <mi>e</mi> <mo>-</mo> <msub> <mi>k</mi> <mn>2</mn> </msub> <msup> <mi>e</mi> <mo>&amp;prime;</mo> </msup> <mo>)</mo> </mrow> <mo>=</mo> <mo>-</mo> <msub> <mi>k</mi> <mn>1</mn> </msub> <msup> <mi>e</mi> <mi>T</mi> </msup> <mi>e</mi> <mo>-</mo> <msub> <mi>k</mi> <mn>2</mn> </msub> <msup> <mi>e</mi> <mrow> <mo>&amp;prime;</mo> <mi>T</mi> </mrow> </msup> <msup> <mi>e</mi> <mo>&amp;prime;</mo> </msup> </mrow> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>36</mn> <mo>)</mo> </mrow> </mrow>
Formula (36) shows:The stability that (35) ensure that closed-loop system is restrained using flight tracking control;
Step 4:Neural network approximator is designed:With flight tracking control margin of error e and its rate of changeActual flight path η and its change RateFor the input variable of neutral net, with the estimate of dirigible kinetic modelDesigned for the output variable of neutral net Neural network approximator, function is infinitely approached using neutral net and estimates unknown ambiguous model, to improve control accuracy.
2. the contragradience neural network control method of dirigible Three-dimensional Track tracking according to claim 1, it is characterised in that:Institute The neural network approximator described in step 4 is stated, its design method is:
1) due to being difficult to carry out dirigible Accurate Model during practical flight, f (x) is unknown function, it is difficult to according to formula (35) it is controlled rule to resolve, therefore, f (x) estimate must be usedFlight tracking control rule formula (35) is resolved;Using Neutral net approaches unknown function f (x), then has:
F (x)=wTh(x)+ε (37)
In formula, w is the weight vectors of neutral net, and ε is approximate error, h (x)=[hi(x)]T, hi(x) it is Gaussian bases, under Mark i represents i-th of Gaussian bases;
2) input/output variable is selected
Make flight tracking control margin of error e and its rate of changeActual flight path η and its rate of changeBecome for the input of neural network approximator Amount, makes estimateFor the output variable of neural network approximator;
3) neural network structure is designed
Neural network structure includes input layer, hidden layer and output layer;
Input layer:Choose neutral net input variable be
Hidden layer:Gaussian function is chosen as the basic function of hidden node
<mrow> <msub> <mi>h</mi> <mi>i</mi> </msub> <mrow> <mo>(</mo> <mi>x</mi> <mo>)</mo> </mrow> <mo>=</mo> <mi>exp</mi> <mrow> <mo>(</mo> <mfrac> <mrow> <mo>|</mo> <mo>|</mo> <mi>x</mi> <mo>-</mo> <mi>c</mi> <mo>|</mo> <msup> <mo>|</mo> <mn>2</mn> </msup> </mrow> <mrow> <mn>2</mn> <msubsup> <mi>&amp;sigma;</mi> <mi>i</mi> <mn>2</mn> </msubsup> </mrow> </mfrac> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>38</mn> <mo>)</mo> </mrow> </mrow>
Wherein, c=[ci]T, ciFor the intermediate value of i-th of Gaussian function, σiFor the base width parameter of i-th of node, | | | | represent Euclideam norm;
Output layer:Neural network approximator is output as
<mrow> <mover> <mi>f</mi> <mo>^</mo> </mover> <mrow> <mo>(</mo> <mi>x</mi> <mo>)</mo> </mrow> <mo>=</mo> <msup> <mover> <mi>w</mi> <mo>^</mo> </mover> <mi>T</mi> </msup> <mi>h</mi> <mrow> <mo>(</mo> <mi>x</mi> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>39</mn> <mo>)</mo> </mrow> </mrow>
Wherein,For w estimate;
4) stability analysis
DefinitionWith w differences:
<mrow> <mover> <mi>w</mi> <mo>~</mo> </mover> <mo>=</mo> <mi>w</mi> <mo>-</mo> <mover> <mi>w</mi> <mo>^</mo> </mover> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>40</mn> <mo>)</mo> </mrow> </mrow>
Choose Lyapunov functions:
<mrow> <msub> <mi>V</mi> <mn>2</mn> </msub> <mo>=</mo> <mfrac> <mn>1</mn> <mn>2</mn> </mfrac> <msup> <mi>&amp;xi;</mi> <mi>T</mi> </msup> <mi>&amp;xi;</mi> <mo>+</mo> <mfrac> <mn>1</mn> <mn>2</mn> </mfrac> <mi>t</mi> <mi>r</mi> <mrow> <mo>(</mo> <msup> <mover> <mi>W</mi> <mo>~</mo> </mover> <mi>T</mi> </msup> <msup> <mi>&amp;lambda;</mi> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> <mover> <mi>W</mi> <mo>~</mo> </mover> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>41</mn> <mo>)</mo> </mrow> </mrow>
In formula, ξ=[e e ']T,Θ is adjustable positive definite matrix, λ-1Representing matrix λ's is inverse Matrix;
To formula (41) differential, it can obtain:
<mrow> <mtable> <mtr> <mtd> <mrow> <msub> <mover> <mi>V</mi> <mo>&amp;CenterDot;</mo> </mover> <mn>3</mn> </msub> <mo>=</mo> <msup> <mi>&amp;xi;</mi> <mi>T</mi> </msup> <mover> <mi>&amp;xi;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>+</mo> <mi>t</mi> <mi>r</mi> <mrow> <mo>(</mo> <msup> <mover> <mi>W</mi> <mo>~</mo> </mover> <mi>T</mi> </msup> <msup> <mi>&amp;lambda;</mi> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> <mover> <mover> <mi>W</mi> <mo>~</mo> </mover> <mo>&amp;CenterDot;</mo> </mover> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>=</mo> <mo>-</mo> <msub> <mi>k</mi> <mn>1</mn> </msub> <msubsup> <mi>e</mi> <mn>1</mn> <mi>T</mi> </msubsup> <msub> <mi>e</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>k</mi> <mn>2</mn> </msub> <msubsup> <mi>e</mi> <mn>2</mn> <mi>T</mi> </msubsup> <msub> <mi>e</mi> <mn>2</mn> </msub> <mo>+</mo> <msubsup> <mi>e</mi> <mn>2</mn> <mi>T</mi> </msubsup> <mrow> <mo>(</mo> <msup> <mover> <mi>w</mi> <mo>^</mo> </mover> <mi>T</mi> </msup> <mi>h</mi> <mo>(</mo> <mi>x</mi> <mo>)</mo> <mo>+</mo> <mi>&amp;epsiv;</mi> <mo>)</mo> </mrow> <mo>+</mo> <mi>t</mi> <mi>r</mi> <mrow> <mo>(</mo> <msup> <mover> <mi>W</mi> <mo>~</mo> </mover> <mi>T</mi> </msup> <msup> <mi>&amp;lambda;</mi> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> <mover> <mover> <mi>W</mi> <mo>~</mo> </mover> <mo>&amp;CenterDot;</mo> </mover> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>42</mn> <mo>)</mo> </mrow> </mrow>
Definition
<mrow> <mi>k</mi> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>k</mi> <mn>1</mn> </msub> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <msub> <mi>k</mi> <mn>2</mn> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>43</mn> <mo>)</mo> </mrow> </mrow>
Then formula (42) can be written as:
<mrow> <mtable> <mtr> <mtd> <mrow> <msub> <mover> <mi>V</mi> <mo>&amp;CenterDot;</mo> </mover> <mn>3</mn> </msub> <mo>=</mo> <msup> <mi>&amp;xi;</mi> <mi>T</mi> </msup> <mover> <mi>&amp;xi;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>+</mo> <mi>t</mi> <mi>r</mi> <mrow> <mo>(</mo> <msup> <mover> <mi>w</mi> <mo>~</mo> </mover> <mi>T</mi> </msup> <msup> <mi>&amp;lambda;</mi> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> <mover> <mover> <mi>w</mi> <mo>~</mo> </mover> <mo>&amp;CenterDot;</mo> </mover> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>=</mo> <msup> <mi>&amp;xi;</mi> <mi>T</mi> </msup> <mi>k</mi> <mi>&amp;xi;</mi> <mo>+</mo> <msup> <mi>&amp;xi;</mi> <mi>T</mi> </msup> <mi>&amp;epsiv;</mi> <mo>+</mo> <msup> <mi>&amp;xi;</mi> <mi>T</mi> </msup> <mover> <mi>W</mi> <mo>~</mo> </mover> <mi>&amp;Psi;</mi> <mo>+</mo> <mi>t</mi> <mi>r</mi> <mrow> <mo>(</mo> <msup> <mover> <mi>W</mi> <mo>~</mo> </mover> <mi>T</mi> </msup> <msup> <mi>&amp;lambda;</mi> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> <mover> <mover> <mi>W</mi> <mo>~</mo> </mover> <mo>&amp;CenterDot;</mo> </mover> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>=</mo> <mo>-</mo> <msup> <mi>&amp;xi;</mi> <mi>T</mi> </msup> <mi>k</mi> <mi>&amp;xi;</mi> <mo>+</mo> <msup> <mi>&amp;xi;</mi> <mi>T</mi> </msup> <mi>&amp;epsiv;</mi> <mo>+</mo> <mi>t</mi> <mi>r</mi> <mrow> <mo>(</mo> <mover> <mi>W</mi> <mo>~</mo> </mover> <msup> <mi>&amp;Psi;&amp;xi;</mi> <mi>T</mi> </msup> <mo>+</mo> <msup> <mover> <mi>W</mi> <mo>~</mo> </mover> <mi>T</mi> </msup> <msup> <mi>&amp;lambda;</mi> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> <mover> <mover> <mi>W</mi> <mo>~</mo> </mover> <mo>&amp;CenterDot;</mo> </mover> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>44</mn> <mo>)</mo> </mrow> </mrow>
In formula,
Design following adaptive law:
<mrow> <mover> <mover> <mi>W</mi> <mo>^</mo> </mover> <mo>&amp;CenterDot;</mo> </mover> <mo>=</mo> <msup> <mi>&amp;lambda;&amp;Psi;&amp;xi;</mi> <mi>T</mi> </msup> <mo>-</mo> <mi>&amp;gamma;</mi> <mi>&amp;lambda;</mi> <mo>|</mo> <mo>|</mo> <mi>&amp;xi;</mi> <mo>|</mo> <mo>|</mo> <mover> <mi>W</mi> <mo>^</mo> </mover> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>45</mn> <mo>)</mo> </mrow> </mrow>
In formula, γ > 0 are adjustable parameter,
Adaptive law is substituted into formula (44), can be obtained:
<mrow> <mtable> <mtr> <mtd> <mrow> <msub> <mover> <mi>V</mi> <mo>&amp;CenterDot;</mo> </mover> <mn>3</mn> </msub> <mo>=</mo> <msup> <mi>&amp;xi;</mi> <mi>T</mi> </msup> <mover> <mi>&amp;xi;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>+</mo> <mi>t</mi> <mi>r</mi> <mrow> <mo>(</mo> <msup> <mover> <mi>w</mi> <mo>~</mo> </mover> <mi>T</mi> </msup> <msup> <mi>&amp;lambda;</mi> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> <mover> <mover> <mi>w</mi> <mo>~</mo> </mover> <mo>&amp;CenterDot;</mo> </mover> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>=</mo> <mo>-</mo> <msup> <mi>&amp;xi;</mi> <mi>T</mi> </msup> <mi>k</mi> <mi>&amp;xi;</mi> <mo>+</mo> <msup> <mi>&amp;xi;</mi> <mi>T</mi> </msup> <mi>&amp;epsiv;</mi> <mo>+</mo> <mi>t</mi> <mi>r</mi> <mrow> <mo>(</mo> <mover> <mi>W</mi> <mo>~</mo> </mover> <msup> <mi>&amp;Psi;&amp;xi;</mi> <mi>T</mi> </msup> <mo>-</mo> <msup> <mover> <mi>W</mi> <mo>~</mo> </mover> <mi>T</mi> </msup> <msup> <mi>&amp;lambda;</mi> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> <mo>(</mo> <mrow> <msup> <mi>&amp;lambda;&amp;Psi;&amp;xi;</mi> <mi>T</mi> </msup> <mo>-</mo> <mi>&amp;gamma;</mi> <mi>&amp;lambda;</mi> <mo>|</mo> <mo>|</mo> <mi>&amp;xi;</mi> <mo>|</mo> <mo>|</mo> <mover> <mi>W</mi> <mo>~</mo> </mover> </mrow> <mo>)</mo> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>=</mo> <mo>-</mo> <msup> <mi>&amp;xi;</mi> <mi>T</mi> </msup> <mi>k</mi> <mi>&amp;xi;</mi> <mo>+</mo> <msup> <mi>&amp;xi;</mi> <mi>T</mi> </msup> <mi>&amp;epsiv;</mi> <mo>+</mo> <mi>t</mi> <mi>r</mi> <mrow> <mo>(</mo> <mi>&amp;gamma;</mi> <msup> <mover> <mi>W</mi> <mo>~</mo> </mover> <mi>T</mi> </msup> <mo>|</mo> <mo>|</mo> <mi>&amp;xi;</mi> <mo>|</mo> <mo>|</mo> <mover> <mi>W</mi> <mo>~</mo> </mover> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>=</mo> <mo>-</mo> <msup> <mi>&amp;xi;</mi> <mi>T</mi> </msup> <mi>k</mi> <mi>&amp;xi;</mi> <mo>+</mo> <msup> <mi>&amp;xi;</mi> <mi>T</mi> </msup> <mi>&amp;epsiv;</mi> <mo>+</mo> <mi>&amp;gamma;</mi> <mo>|</mo> <mo>|</mo> <mi>&amp;xi;</mi> <mo>|</mo> <mo>|</mo> <mi>t</mi> <mi>r</mi> <mrow> <mo>(</mo> <msup> <mover> <mi>W</mi> <mo>~</mo> </mover> <mi>T</mi> </msup> <mo>(</mo> <mrow> <mi>W</mi> <mo>-</mo> <mover> <mi>W</mi> <mo>~</mo> </mover> </mrow> <mo>)</mo> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>46</mn> <mo>)</mo> </mrow> </mrow>
According to Schwarz inequality, have:
<mrow> <mi>t</mi> <mi>r</mi> <mrow> <mo>(</mo> <msup> <mover> <mi>W</mi> <mo>~</mo> </mover> <mi>T</mi> </msup> <mo>(</mo> <mi>W</mi> <mo>-</mo> <mover> <mi>W</mi> <mo>~</mo> </mover> <mo>)</mo> </mrow> <mo>)</mo> <mo>&amp;le;</mo> <mo>|</mo> <mo>|</mo> <mover> <mi>W</mi> <mo>~</mo> </mover> <mo>|</mo> <msub> <mo>|</mo> <mi>F</mi> </msub> <mo>|</mo> <mo>|</mo> <mi>W</mi> <mo>|</mo> <msub> <mo>|</mo> <mi>F</mi> </msub> <mo>-</mo> <mo>|</mo> <mo>|</mo> <mover> <mi>W</mi> <mo>~</mo> </mover> <mo>|</mo> <msubsup> <mo>|</mo> <mi>F</mi> <mn>2</mn> </msubsup> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>47</mn> <mo>)</mo> </mrow> </mrow>
In formula, | | | |FRepresent Frobenius norms;
Formula (47) is substituted into formula (46), can be obtained:
<mrow> <mtable> <mtr> <mtd> <mrow> <msub> <mover> <mi>V</mi> <mo>&amp;CenterDot;</mo> </mover> <mn>3</mn> </msub> <mo>&amp;le;</mo> <mo>-</mo> <msub> <mi>k</mi> <mi>min</mi> </msub> <mo>|</mo> <mo>|</mo> <mi>&amp;xi;</mi> <mo>|</mo> <mo>|</mo> <mo>+</mo> <msub> <mi>&amp;epsiv;</mi> <mi>N</mi> </msub> <mo>|</mo> <mo>|</mo> <mi>&amp;xi;</mi> <mo>|</mo> <mo>|</mo> <mo>+</mo> <mi>&amp;gamma;</mi> <mo>|</mo> <mo>|</mo> <mi>&amp;xi;</mi> <mo>|</mo> <mo>|</mo> <mo>&amp;lsqb;</mo> <mo>|</mo> <mo>|</mo> <mover> <mi>W</mi> <mo>^</mo> </mover> <mo>|</mo> <msub> <mo>|</mo> <mi>F</mi> </msub> <mrow> <mo>(</mo> <mo>|</mo> <mo>|</mo> <mi>W</mi> <mo>|</mo> <msub> <mo>|</mo> <mi>F</mi> </msub> <mo>-</mo> <mo>|</mo> <mo>|</mo> <mover> <mi>W</mi> <mo>~</mo> </mover> <mo>|</mo> <msub> <mo>|</mo> <mi>F</mi> </msub> <mo>)</mo> </mrow> <mo>&amp;rsqb;</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>&amp;le;</mo> <mo>-</mo> <mo>|</mo> <mo>|</mo> <mi>&amp;xi;</mi> <mo>|</mo> <mo>|</mo> <mo>&amp;lsqb;</mo> <msub> <mi>k</mi> <mi>min</mi> </msub> <mo>|</mo> <mo>|</mo> <mi>&amp;xi;</mi> <mo>|</mo> <mo>|</mo> <mo>-</mo> <msub> <mi>&amp;epsiv;</mi> <mi>N</mi> </msub> <mo>+</mo> <mi>&amp;gamma;</mi> <mo>|</mo> <mo>|</mo> <mover> <mi>W</mi> <mo>^</mo> </mover> <mo>|</mo> <msub> <mo>|</mo> <mi>F</mi> </msub> <mrow> <mo>(</mo> <mo>|</mo> <mo>|</mo> <mover> <mi>W</mi> <mo>^</mo> </mover> <mo>|</mo> <msub> <mo>|</mo> <mi>F</mi> </msub> <mo>-</mo> <msub> <mi>W</mi> <mi>M</mi> </msub> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>48</mn> <mo>)</mo> </mrow> </mrow>
In formula, εNFor the upper bound of approximate error, kminFor adjustable parameter matrix k minimal eigenvalue, WMFor weight matrix W maximum It is worth element;
In view of following equation:
<mrow> <mi>&amp;gamma;</mi> <mo>|</mo> <mo>|</mo> <mover> <mi>W</mi> <mo>~</mo> </mover> <mo>|</mo> <msub> <mo>|</mo> <mi>F</mi> </msub> <mrow> <mo>(</mo> <mo>|</mo> <mo>|</mo> <mover> <mi>W</mi> <mo>~</mo> </mover> <mo>|</mo> <msub> <mo>|</mo> <mi>F</mi> </msub> <mo>-</mo> <msub> <mi>W</mi> <mi>M</mi> </msub> <mo>)</mo> </mrow> <mo>=</mo> <mi>&amp;gamma;</mi> <msup> <mrow> <mo>(</mo> <mo>|</mo> <mo>|</mo> <mover> <mi>W</mi> <mo>~</mo> </mover> <mo>|</mo> <msub> <mo>|</mo> <mi>F</mi> </msub> <mo>-</mo> <mfrac> <mn>1</mn> <mn>2</mn> </mfrac> <msub> <mi>W</mi> <mi>M</mi> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>-</mo> <mfrac> <mi>&amp;gamma;</mi> <mn>4</mn> </mfrac> <msubsup> <mi>W</mi> <mi>M</mi> <mn>2</mn> </msubsup> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>49</mn> <mo>)</mo> </mrow> </mrow>
If so thatMust then have and be set up with lower inequality:
OrIfThen have | | ξ | | andUniform ultimate bounded, from | | ξ | | convergence can obtain:Track In Track precision and neutral net approximate error upper bound εN, can Adjust parameter matrix k relevant;
Thus, uncertain dirigible non-linear dynamic model can accurately be estimated by neural network approximator.
CN201510221276.7A 2015-05-04 2015-05-04 A kind of contragradience neural network control method of dirigible Three-dimensional Track tracking Active CN104793629B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201510221276.7A CN104793629B (en) 2015-05-04 2015-05-04 A kind of contragradience neural network control method of dirigible Three-dimensional Track tracking

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201510221276.7A CN104793629B (en) 2015-05-04 2015-05-04 A kind of contragradience neural network control method of dirigible Three-dimensional Track tracking

Publications (2)

Publication Number Publication Date
CN104793629A CN104793629A (en) 2015-07-22
CN104793629B true CN104793629B (en) 2017-09-26

Family

ID=53558513

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510221276.7A Active CN104793629B (en) 2015-05-04 2015-05-04 A kind of contragradience neural network control method of dirigible Three-dimensional Track tracking

Country Status (1)

Country Link
CN (1) CN104793629B (en)

Families Citing this family (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105353612B (en) * 2015-11-04 2016-08-17 中国人民解放军国防科学技术大学 A kind of dirigible obscures the resident control method of contragradience
CN107065847B (en) * 2016-03-31 2020-03-20 北京航空航天大学 Water surface ship track tracking control method with asymmetric saturation of actuator
CN105890626A (en) * 2016-05-19 2016-08-24 极翼机器人(上海)有限公司 Method for resisting magnetic interference
CN106125757B (en) * 2016-07-12 2019-02-12 中国人民解放军国防科学技术大学 A kind of drive lacking dirigible Track In Track control method
CN106406095B (en) * 2016-10-26 2019-06-07 北京航空航天大学 The asymmetric limited full driving surface vessel Trajectory Tracking Control method of input and output
CN106933237B (en) * 2017-02-28 2020-08-18 北京天恒长鹰科技股份有限公司 Passive fault-tolerant control method of stratospheric airship
CN107491088B (en) * 2017-08-23 2020-04-14 中国人民解放军国防科技大学 Airship track control method with saturated input
CN108388126A (en) * 2018-03-15 2018-08-10 浙江工业大学 Quadrotor based on the compound constraint liapunov function of asymmetric time-varying tangent cosine exports constrained control method
CN108717265B (en) * 2018-05-30 2021-05-18 重庆邮电大学 Unmanned aerial vehicle cruise tracking control system and control method based on control variable parameterization
CN112034865B (en) * 2020-08-12 2021-10-08 浙江大学 Full-drive underwater vehicle track tracking control method based on optimization algorithm
CN113189867B (en) * 2021-03-24 2023-11-14 大连海事大学 Unmanned ship self-learning optimal tracking control method considering pose and speed limitation

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6611823B1 (en) * 2000-04-20 2003-08-26 Board Of Regents, The University Of Texas System Backlash compensation using neural network
JP2011209988A (en) * 2010-03-30 2011-10-20 Nippon Telegr & Teleph Corp <Ntt> Control device, method and program for trajectory tracking
CN102385316A (en) * 2011-09-16 2012-03-21 哈尔滨工程大学 Deepening controlling method of underactuated automatic underwater vehicle based on neural network back stepping method
CN102759928A (en) * 2012-04-28 2012-10-31 中国人民解放军国防科学技术大学 Control method for flight path of airship on stratosphere
CN102866635A (en) * 2012-09-29 2013-01-09 西北工业大学 Adaptive control method for discrete neural network of hypersonic aerocraft on basis of equivalence model
CN103324195A (en) * 2013-06-14 2013-09-25 哈尔滨工程大学 Ship self-adaptive robust course tracking control method based on back stepping method
CN104118555A (en) * 2014-07-14 2014-10-29 北京大学 Unmanned autonomous airship and method for building flight control system of unmanned autonomous airship
CN104281155A (en) * 2014-11-07 2015-01-14 中国人民解放军国防科学技术大学 Three-dimensional flight path tracking method for unmanned airship

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6611823B1 (en) * 2000-04-20 2003-08-26 Board Of Regents, The University Of Texas System Backlash compensation using neural network
JP2011209988A (en) * 2010-03-30 2011-10-20 Nippon Telegr & Teleph Corp <Ntt> Control device, method and program for trajectory tracking
CN102385316A (en) * 2011-09-16 2012-03-21 哈尔滨工程大学 Deepening controlling method of underactuated automatic underwater vehicle based on neural network back stepping method
CN102759928A (en) * 2012-04-28 2012-10-31 中国人民解放军国防科学技术大学 Control method for flight path of airship on stratosphere
CN102866635A (en) * 2012-09-29 2013-01-09 西北工业大学 Adaptive control method for discrete neural network of hypersonic aerocraft on basis of equivalence model
CN103324195A (en) * 2013-06-14 2013-09-25 哈尔滨工程大学 Ship self-adaptive robust course tracking control method based on back stepping method
CN104118555A (en) * 2014-07-14 2014-10-29 北京大学 Unmanned autonomous airship and method for building flight control system of unmanned autonomous airship
CN104281155A (en) * 2014-11-07 2015-01-14 中国人民解放军国防科学技术大学 Three-dimensional flight path tracking method for unmanned airship

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
基于神经动态模型的自治水面艇智能跟踪控制;潘昌忠;《中国博士学位论文全文数据库 信息科技辑》;20150215(第2期);全文 *
自主飞艇姿态跟踪的终端滑模控制;杨跃能 等;《中国空间科学技术》;20120831(第4期);第29-36页 *

Also Published As

Publication number Publication date
CN104793629A (en) 2015-07-22

Similar Documents

Publication Publication Date Title
CN104793629B (en) A kind of contragradience neural network control method of dirigible Three-dimensional Track tracking
CN104281155B (en) Three-dimensional flight path tracking method for unmanned airship
CN102495633B (en) Posture control method for airship staying on stratosphere
CN103425135B (en) A kind of have a saturated Near Space Flying Vehicles robust control method of input
CN105242683B (en) A kind of dirigible neutral net terminal sliding mode flight tracking control method
CN104360686B (en) Nonsingular terminal sliding mode flight path control method for airships
Ambati et al. Robust auto-landing of fixed-wing UAVs using neuro-adaptive design
CN109634307A (en) A kind of compound Track In Track control method of UAV navigation
CN105159305A (en) Four-rotor flight control method based on sliding mode variable structure
CN104950901A (en) Nonlinear robust control method with finite-time convergence capacity for unmanned helicopter attitude error
CN107491088A (en) Airship track control method with saturated input
CN108181806B (en) Space robot position and attitude active disturbance rejection control method based on sampling output
CN108089589A (en) A kind of underwater robot attitude control method
CN104793498B (en) A kind of control is fixed a point resident control method
Herlambang et al. Preliminary numerical study on designing navigation and stability control systems for its auv
CN104536448B (en) Backstepping based control method for unmanned-plane attitude system
CN107817818A (en) Finite time control method for flight path tracking of uncertain model airship
Zanon et al. Control of dual-airfoil airborne wind energy systems based on nonlinear mpc and mhe
Wang et al. Trajectory tracking of vertical take-off and landing unmanned aerial vehicles based on disturbance rejection control
CN108829126A (en) A kind of AUV cluster-coordinator control method considering communication delay
Cao et al. Passive fault tolerant control approach for hypersonic vehicle with actuator loss of effectiveness faults
CN106125757B (en) A kind of drive lacking dirigible Track In Track control method
CN107703967A (en) Control method for controlling track of limited airship
CN107450319A (en) Designated time nonsingular terminal sliding mode control method for airship track tracking
Cunis et al. Piece-wise Identification and Analysis of the Aerodynamic Coefficients, Trim Conditions, and Safe Sets of the Generic Transport Model

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
EXSB Decision made by sipo to initiate substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant