Method for controlling steady flight of unmanned aircraft
11721219 · 2023-08-08
Assignee
Inventors
Cpc classification
B64U2101/00
PERFORMING OPERATIONS; TRANSPORTING
B64U2201/10
PERFORMING OPERATIONS; TRANSPORTING
B64C39/024
PERFORMING OPERATIONS; TRANSPORTING
G05D1/0088
PHYSICS
International classification
G05D1/00
PHYSICS
Abstract
Disclosed is a method for controlling stable flight of an unmanned aircraft, comprising the following steps: acquiring real-time flight operation data of the aircraft itself by means of an attitude sensor, a position sensor and an altitude sensor mounted to the unmanned aircraft, performing corresponding analysis on a kinematic problem of the aircraft by a processor mounted thereto, and establishing a dynamics model of the aircraft (S1); designing a controller of the unmanned aircraft according to a multi-layer zeroing neurodynamic method (S2); solving output control quantities of motors of the aircraft by the designed multi-layer zeroing neural network controller using the acquired real-time operation data of the aircraft and target attitude data (S3); and transferring solution results to a motor governor of the aircraft, and controlling powers of the motors according to a relationship between the control quantities solved by the controller and the powers of the motors of the multi-rotor unmanned aircraft, so as to control the motion of the unmanned aircraft (S4). Based on the multi-layer zeroing neurodynamic method, a correct solution to the problem can be approached rapidly, accurately and in real time, and a time-varying problem can be significantly solved.
Claims
1. A method for controlling stable flight of an unmanned aircraft, characterized by comprising the steps of: 1) acquiring real-time flight operation data of the aircraft itself, analyzing a kinematic problem of the aircraft, and establishing a dynamics model of the aircraft; 2) constructing a deviation function according to the real-time flight operation data acquired in step 1) and target attitude data, and constructing neurodynamic equations based on the deviation function by using a multi-layer zeroing neurodynamic method, wherein the neurodynamic equations based on the deviation function corresponding to all parameters together constitute a controller of the unmanned aircraft, and output quantities solved from differential equations of the controller are output control quantities of motors of the aircraft; and 3) controlling powers of the motors according to a relationship between the output control quantities solved in step 2) and the powers of the motors of the unmanned aircraft to complete motion control over the unmanned aircraft, specifically: according to a power allocation scheme for the unmanned aircraft, the control quantities solved by the controller have the following relationship with the powers of the motors of the unmanned aircraft:
U=WF where U=[u.sub.1 u.sub.2 u.sub.3 u.sub.4].sup.T refers to the output control quantities of the unmanned aircraft, F=[F.sub.1 . . . F.sub.j].sup.T refers to the powers of the motors of the unmanned aircraft, j is the number of the motors of the unmanned aircraft, W is a power allocation matrix of the unmanned aircraft, and the matrix W has different forms depending on different structures and the number of rotors, and needs to be determined according to the structure thereof and the number of the rotors; the corresponding powers F of the motors are obtained by means of matrix inversion or pseudo-inversion:
F=W.sup.−1U if the matrix W is a square matrix and is reversible, W.sup.−1 is obtained by means of an inverse operation, and if W is not a square matrix, W.sup.−1 is solved by means of a corresponding pseudo-inverse operation; and the desired powers F of the motors are finally obtained, input voltages of the motors are controlled according to a relationship between the voltages and powers of the motors to control the rotational speeds of the motors, and the control over the powers of the motors is finally realized to complete stable flight control over the unmanned aircraft.
2. The method for controlling stable flight of an unmanned aircraft according to claim 1, further including providing a processor mounted to the unmanned aircraft and wherein analyzing the kinematic problem, in step 1), compromises: defining a ground coordinate system E and a fuselage coordinate system B, and establishing a relationship E=RB between the ground coordinate system and the fuselage coordinate system by means of a transformation matrix R, where R is expressed as
3. The method for controlling stable flight of an unmanned aircraft according to claim 2, characterized in that the step of establishing a dynamics model of the aircraft specifically comprises: according to the defined ground coordinate system E and fuselage coordinate system B, the relationship E=RB established between the two by means of the transformation matrix R and the stress analysis of the aircraft system in the fuselage coordinate system, obtaining dynamics equations of the aircraft as follows
4. The method for controlling stable flight of an unmanned aircraft according to claim 1, characterized in that a step of designing the controller of the unmanned aircraft according to a multi-layer zeroing neurodynamic method specifically comprises the steps of: (2-1) designing a deviation function regarding the output control quantity u.sub.1 from a vertical altitude z by means of the multi-layer zeroing neurodynamic method, and designing an altitude controller for the unmanned aircraft according to this deviation function; (2-2) designing a deviation function regarding u.sub.x and u.sub.y from the horizontal positions x and y by means of the multi-layer zeroing neurodynamic method, designing a position controller for the unmanned aircraft according to this deviation function, and then inversely solving target attitude angles ϕ.sub.T and θ.sub.T; and (2-3) designing a deviation function regarding the output control quantities u.sub.2˜u.sub.4 from a roll angle ϕ, a pitch angle θ and a yaw angle ψ by means of the multi-layer zeroing neurodynamic method, and designing an attitude controller according to this deviation function.
5. The method for controlling stable flight of an unmanned aircraft according to claim 4, characterized in that the step of designing a deviation function regarding the output control quantity u.sub.1 from the vertical altitude z by means of the multi-layer zeroing neurodynamic method, and designing an altitude controller for the unmanned aircraft according to this deviation function specifically comprises: for the vertical altitude z, according to the target altitude value z.sub.T and the actual altitude value z in the Z axis, defining a deviation function as
E.sub.Z={umlaut over (z)}−{umlaut over (z)}.sub.T+2γ(ż−ż.sub.T)+γ.sup.2(z−z.sub.T) (9) according to the dynamics equations of the aircraft, simplifying (9) into
E.sub.z=a.sub.zu.sub.1+b.sub.z (10) where
Ė.sub.z=a.sub.z{dot over (u)}.sub.1+{dot over (a)}.sub.zu.sub.1+{dot over (b)}.sub.z (11) using the multi-layer zeroing neurodynamic method to design
Ė.sub.z=−γE.sub.z (12) substituting equations (10) and (11) into equation (12) and perform collating to obtain
a.sub.z{dot over (u)}.sub.1=−γ(a.sub.zu.sub.1+b.sub.z)−{dot over (b)}.sub.z−{dot over (a)}.sub.zu.sub.1 (13).
6. The method for controlling stable flight of an unmanned aircraft according to claim 4, characterized in that the step of designing a deviation function regarding u.sub.x and u.sub.y and a position controller for the unmanned aircraft specifically comprises: for the horizontal position x, according to the target value x.sub.T and the actual value x in the X axis, defining a deviation function as
E.sub.x={umlaut over (x)}−{umlaut over (x)}.sub.T+2γ({dot over (x)}−{dot over (x)}.sub.T)+γ.sup.2(x−x.sub.T) (22) according to the dynamics equations of the aircraft, simplifying equation (22) into where
Ė.sub.x=a.sub.x{dot over (u)}.sub.x+{dot over (a)}.sub.xu.sub.x+{dot over (b)}.sub.x (24) using the multi-layer zeroing neurodynamic method to design
Ė.sub.x=−γE.sub.x (25) substituting equations (23) and (24) into equation (25) and perform collating to obtain
a.sub.x{dot over (u)}.sub.x=−γ(a.sub.xu.sub.x+b.sub.x)−{dot over (b)}.sub.x−{dot over (a)}.sub.xu.sub.x (26) for the horizontal position y, according to the target value y.sub.T and the actual value y in the Y axis, defining a deviation function as
E.sub.y=ÿ−ÿ.sub.T+2γ({dot over (y)}−{dot over (y)}.sub.T)+γ.sup.2(y−y.sub.T) (35) according to the dynamics equations of the aircraft, simplifying equation (35) into where
E.sub.y=a.sub.yu.sub.y+b.sub.y (36)
Ė.sub.y=a.sub.y{dot over (u)}.sub.y+{dot over (a)}.sub.yu.sub.y+{dot over (b)}.sub.y (37) using the multi-layer zeroing neurodynamic method to design
Ė.sub.y=−γE.sub.y (38) substituting equations (36) and (37) into equation (38) and perform collating to obtain
a.sub.y{dot over (u)}.sub.y=−γ(a.sub.yu.sub.y+b.sub.y)−{dot over (b)}.sub.y−{dot over (a)}.sub.yu.sub.y (39).
7. The method for controlling stable flight of an unmanned aircraft according to claim 6, characterized in that the calculation formulas of inversely solving the target attitude angles ϕ.sub.T and θ.sub.T are: u.sub.x and u.sub.y solved from position controller equations (26) and (39) are
8. The method for controlling stable flight of an unmanned aircraft according to claim 7, characterized in that the step of designing a deviation function regarding the output control quantities u.sub.2˜u.sub.4 from the roll angle ϕ, the pitch angle θ and the yaw angle ψ by means of the multi-layer zeroing neurodynamic method, and designing an attitude controller according to this deviation function specifically comprises: for the roll angle ϕ, according to a target angle ϕ.sub.T solved in (40) and the actual angle ϕ, defining a deviation function as
E.sub.ϕ={umlaut over (ϕ)}−{umlaut over (ϕ)}.sub.T+2γ({dot over (ϕ)}−{dot over (ϕ)}.sub.T)+γ.sup.2(ϕ−ϕ.sub.T) (49) according to the dynamics equations of the aircraft, simplifying equation (49) into
E.sub.ϕ=a.sub.ϕu.sub.2+b.sub.ϕ (50) where
Ė.sub.ϕ=a.sub.ϕ{dot over (u)}.sub.2+{dot over (a)}.sub.ϕu.sub.2+{dot over (b)}.sub.ϕ (51) according to the multi-layer zeroing neurodynamic method, designing
Ė.sub.ϕ=−γE.sub.ϕ (52) substituting equations (50) and (51) into equation (52) and perform collating to obtain
a.sub.ϕ{dot over (u)}.sub.2=−γ(a.sub.ϕu.sub.2+b.sub.ϕ)−{dot over (b)}.sub.ϕ−{dot over (a)}.sub.ϕu.sub.2 (53) for the pitch angle θ, according to the target angle θ.sub.T solved in (40) and the actual angle θ, defining a deviation function as
E.sub.θ={umlaut over (θ)}−{umlaut over (θ)}.sub.T+2γ({dot over (θ)}−{dot over (θ)}.sub.T)+γ.sup.2(θ−θ.sub.T) (62) according to the dynamics equations of the aircraft, simplifying equation (62) into
E.sub.θ=a.sub.θu.sub.3+b.sub.θ (63) where
Ė.sub.θ=a.sub.θ{dot over (u)}.sub.3+{dot over (a)}.sub.θu.sub.3+{dot over (b)}.sub.θ (64) according to the multi-layer zeroing neurodynamic method, designing
Ė.sub.θ=−γE.sub.θ (65) substituting equations (63) and (64) into equation (65) and perform collating to obtain
a.sub.θ{dot over (u)}.sub.3=−γ(a.sub.θu.sub.3+b.sub.θ)−{dot over (b)}.sub.θ−{dot over (a)}.sub.θu.sub.3 (66) for the yaw angle ψ, according to an artificially set angle ψ.sub.T and the actual angle ψ, defining a deviation function as
E.sub.ψ={umlaut over (ψ)}−{umlaut over (ψ)}.sub.T+2γ({dot over (ψ)}−{dot over (ψ)}.sub.T)+γ.sup.2(ψ−ψ.sub.T) (75) according to the dynamics equations of the aircraft, simplifying equation (75) into
E.sub.ψ=a.sub.ψu.sub.4+b.sub.ψ (76) where
Ė.sub.ψ=a.sub.ψ{dot over (u)}.sub.4+{dot over (a)}.sub.ψu.sub.4+{dot over (b)}.sub.ψ (77) according to the multi-layer zeroing neurodynamic method, designing
Ė.sub.ψ=−γE.sub.ψ (78) substituting equations (76) and (77) into equation (78) and perform collating to obtain
a.sub.ψ{dot over (u)}.sub.4=−γ(a.sub.ψu.sub.4+b.sub.ψ)−{dot over (b)}.sub.ψ−{dot over (a)}.sub.ψu.sub.4 (79).
9. The method for controlling stable flight of an unmanned aircraft according to claim 4, characterized in that the step in which the designed altitude controller, position controller and attitude controller together constitute a stable aircraft of the unmanned aircraft specifically comprises:
a.sub.z{dot over (u)}.sub.1=−γ(a.sub.zu.sub.1+b.sub.z)−{dot over (b)}.sub.z−{dot over (a)}.sub.zu.sub.1 (13)
a.sub.ϕ{dot over (u)}.sub.2=−γ(a.sub.ϕu.sub.2+b.sub.ϕ)−{dot over (b)}.sub.ϕ−{dot over (a)}.sub.ϕu.sub.2 (53)
a.sub.θ{dot over (u)}.sub.3=−γ(a.sub.θu.sub.3+b.sub.θ)−{dot over (b)}.sub.θ−{dot over (a)}.sub.θu.sub.3 (66)
a.sub.ψ{dot over (u)}.sub.4=−γ(a.sub.ψu.sub.4+b.sub.ψ)−{dot over (b)}.sub.ψ−{dot over (a)}.sub.ψu.sub.4 (79) obtaining a controller of the unmanned aircraft according to equations (13), (53), (66) and (79), wherein the controller can be implemented by a network structure; the controller of the unmanned aircraft is capable of controlling the stable flight of the unmanned aircraft; and the controller is written in the following form:
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1)
(2)
(3)
(4)
(5)
DETAILED DESCRIPTION OF EMBODIMENTS
(6) Hereafter the present invention will be further described in detail in conjunction with embodiments and appended drawings, but the embodiments of the present invention are not limited thereto.
Embodiment
(7) As shown in
(8) S1: acquiring real-time flight operation data of the aircraft itself by means of an attitude sensor, a position sensor and an altitude sensor mounted to the unmanned aircraft, performing corresponding analysis on a kinematic problem of the aircraft by a processor mounted thereto, and establishing a dynamics model of the aircraft;
(9) One type of rotor flight structure in the multi-rotor aircraft is shown in
(10) Real-time attitude data θ(t), ϕ(t) and ψ(t) of the aircraft may be acquired by sensors such as gyros and accelerometers mounted to the multi-rotor aircraft by means of quaternion algebra, Kalman filtering and other algorithms, and position data x(t), y(t) and z(t) of the aircraft in the three-dimensional space is acquired by using altitude sensors and position sensors.
(11) The definition of aircraft attitude variables is shown in
(12) The multi-rotor aircraft in
(13) (1) six motors of the six-rotor aircraft are defined No. 1 to No. 6 in the clockwise direction;
(14) (2) X axis extends in the direction of No. 1 rotor arm and points to the forward direction of the aircraft through the center of gravity of the fuselage;
(15) (3) Y axis extends in the direction of the axis of symmetry of No. 2 and No. 3 rotor arms and points to the right motion direction of the aircraft through the center of gravity of the fuselage;
(16) (4) Z axis extends upwardly perpendicular to the plane of six rotors and points to the climbing direction of the aircraft through the center of gravity of the fuselage;
(17) (5) the pitch angle θ is an angle between the X axis of the fuselage and the horizontal plane, and is set to be positive when the fuselage is downward;
(18) (6) the roll angle ϕ is an angle between the Z axis of the fuselage and the vertical plane passing through the X axis of the fuselage, and is set to be positive when the fuselage is rightward; and
(19) (7) the yaw angle ψ is an angle between the projection of the X axis of the fuselage on the horizontal plane and the X axis of a geodetic coordinate system, and is set to be positive when the head of the aircraft is leftward.
(20) According to different rotor-type aircraft models, physical model equations and dynamics equations for the aircraft are established, and dynamics analysis may be completed by means of the following aircraft dynamics modeling steps:
(21) defining a ground coordinate system E and a fuselage coordinate system B, and establishing a relationship E=RB between the ground coordinate system and the fuselage coordinate system by means of a transformation matrix R, where R may be expressed as
(22)
(23) where ϕ is a roll angle, θ is a pitch angle, and ψ is a yaw angle;
(24) ignoring the effect of an air resistance on the aircraft, the stress analysis (in the form of Newton-Euler) of the aircraft system in the fuselage coordinate system is as follows
(25)
(26) where m is the total mass of the aircraft, I.sub.3×3 is a unit matrix, I is an inertia matrix, V is a linear velocity in the fuselage coordinate system, ω is an angular velocity in the fuselage coordinate system, F is a resultant external force, and τ is a resultant torque.
(27) According to the above equation, the dynamics equations of the aircraft can be obtained as follows
(28)
(29) where l is an arm length; g is a gravitational acceleration; x, y, z are respectively position coordinates of the aircraft in the ground coordinate system; I.sub.x, I.sub.y, I.sub.z are respectively rotational inertia of the aircraft in X, Y and Z axes; u.sub.x=cos ϕ sin θ cos ψ+sin ϕ sin ψ; u.sub.y=cos ϕ sin θ sin ψ−sin ϕ cos ψ; and u.sub.1, u.sub.2, u.sub.3, u.sub.4 are output control quantities.
(30) S2: designing a controller of the unmanned aircraft according to a multi-layer zeroing neurodynamic method;
(31) A deviation function regarding the output control quantity u.sub.1 is designed from the vertical altitude z, an altitude controller of the multi-rotor unmanned aircraft is designed according to this deviation function, u.sub.1 is solved; a deviation function regarding u.sub.x and u.sub.y and a corresponding position controller for the multi-rotor unmanned aircraft are designed from the horizontal positions x and y, and target attitude angles ϕ.sub.T and θ.sub.T are inversely solved; and a deviation function regarding the output control quantities u.sub.2˜u.sub.4 is designed from the roll angle ϕ, the pitch angle θ and the yaw angle ψ according to the target attitude angles, and a corresponding multi-layer zeroing neural network controller is designed. The specific steps are as follows:
(32) for the vertical altitude z, according to the target altitude value z.sub.T and the actual altitude value z in the Z axis, a deviation function may be defined as
e.sub.z1=z−z.sub.T (1)
(33) and its derivative may be obtained as follows
ė.sub.z1=ż−ż.sub.T (2)
(34) in order to converge the actual value z to the target value z.sub.T, according to the multi-layer zeroing neurodynamic method, a neurodynamic equation based on the deviation function may be designed as
ė.sub.z1=−γe.sub.z1 (3)
(35) where γ is a constant;
(36) equations (1) and (2) are substituted into equation (3) and collating is performed to obtain
ż−ż.sub.T+γ(z−z.sub.T)=0 (4)
(37) since equation (4) is generally not established in the initial situation and does not contain relevant information of the output control quantities, and the control quantities cannot be solved, a further design is needed, and a definition is then made
e.sub.z2=ż−ż.sub.T+γ(z−z.sub.T) (5)
(38) and its derivative may be obtained as follows
ė.sub.z2={umlaut over (z)}−{umlaut over (z)}.sub.T+γ(ż−ż.sub.T) (6)
(39) according to the multi-layer zeroing neurodynamic method, a neurodynamic equation based on the deviation function may be designed as
ė.sub.z2=−γe.sub.z2 (7)
(40) equations (5) and (6) are substituted into equation (7) and collating is performed to obtain
{umlaut over (z)}−{umlaut over (z)}.sub.T+2γ(ż−ż.sub.T)+γ.sup.2(z−z.sub.T)=0 (8)
(41) in this way, a deviation function may be defined as
E.sub.z={umlaut over (z)}−{umlaut over (z)}.sub.T+2γ(ż−ż.sub.T)+γ.sup.2(z−z.sub.T) (9)
(42) according to the dynamics equations of the aircraft, (9) may be simplified into
E.sub.z=a.sub.zu.sub.1+b.sub.z (10)
(43) where
(44)
and b.sub.z=−g−{umlaut over (z)}.sub.T+2γ(ż−ż.sub.T)+γ.sup.2 (z−z.sub.T); and its derivative may be obtained as follows
Ė.sub.z=a.sub.z{dot over (u)}.sub.1+{dot over (a)}.sub.zu.sub.1+{dot over (b)}.sub.z (11)
(45) it is possible to use the multi-layer zeroing neurodynamic method to design
Ė.sub.z=−γE.sub.z (12)
(46) equations (10) and (11) are substituted into equation (12) and collating is performed to obtain
a.sub.z{dot over (u)}.sub.1=−γ(a.sub.zu.sub.1+b.sub.z)−{dot over (b)}.sub.z−{dot over (a)}.sub.zu.sub.1 (13).
(47) for the horizontal position x, according to the target value x.sub.T and the actual value x in the X axis, a deviation function may be defined as
e.sub.x1=x−x.sub.T (14)
(48) and its derivative may be obtained as follows
ė.sub.x1={dot over (x)}−{dot over (x)}.sub.T (15)
(49) in order to converge the actual value x to the target value x.sub.T, according to the multi-layer zeroing neurodynamic method, a neurodynamic equation based on the deviation function may be designed as
ė.sub.x1=−γe.sub.x1 (16)
(50) equations (14) and (15) are substituted into equation (16) and collating is performed to obtain
{dot over (x)}−{dot over (x)}.sub.T+γ(x−x.sub.T)=0 (17)
(51) since equation (17) is generally not established in the initial situation and does not contain relevant information of the output control quantities, and the control quantities cannot be solved, a further design is needed, and a definition is then made
e.sub.x2={dot over (x)}−{dot over (x)}.sub.T+γ(x−x.sub.T) (18)
(52) and its derivative may be obtained as follows
ė.sub.x2={umlaut over (x)}−{umlaut over (x)}.sub.T+γ({dot over (x)}−{dot over (x)}.sub.T) (19)
(53) according to the multi-layer zeroing neurodynamic method, a neurodynamic equation based on the deviation function may be designed as
ė.sub.x2=−γe.sub.x2 (20)
(54) equations (18) and (19) are substituted into equation (20) and collating is performed to obtain
{umlaut over (x)}−{umlaut over (x)}.sub.T+2γ({dot over (x)}−{dot over (x)}.sub.T)+γ.sup.2(x−x.sub.T)=0 (21)
(55) in this way, a deviation function may be defined as
E.sub.x={umlaut over (x)}−{umlaut over (x)}.sub.T+2γ({dot over (x)}−{dot over (x)}.sub.T)+γ.sup.2(x−x.sub.T) (22)
(56) according to the dynamics equations of the aircraft, equation (22) may be simplified into
E.sub.x=a.sub.xu.sub.x+b.sub.x (23)
(57) where
(58)
and b.sub.x=−{umlaut over (x)}.sub.T+2γ({dot over (x)}−{dot over (x)}.sub.T)+γ.sup.2 (x−x.sub.T); and its derivative may be obtained as follows
Ė.sub.x=a.sub.x{dot over (u)}.sub.x+{dot over (a)}.sub.xu.sub.x+b.sub.x (24)
(59) it is possible to use the multi-layer zeroing neurodynamic method to design
Ė.sub.x=−γE.sub.x (25)
(60) equations (23) and (24) are substituted into equation (25) and collating is performed to obtain
a.sub.x{dot over (u)}.sub.x=−γ(a.sub.xu.sub.x+b.sub.x)−{dot over (b)}.sub.x−{dot over (a)}.sub.xu.sub.x (26)
(61) for the horizontal position y, according to the target value y.sub.T and the actual value y in the Y axis, a deviation function may be defined as
e.sub.y1=y−y.sub.T (27)
(62) and its derivative may be obtained as follows
ė.sub.y1=y−y.sub.T (28)
(63) in order to converge the actual value y to the target value y.sub.T, according to the multi-layer zeroing neurodynamic method, a neurodynamic equation based on the deviation function may be designed as
ė.sub.y1=−γe.sub.y1 (29)
(64) equations (27) and (28) are substituted into equation (29) and collating is performed to obtain
{dot over (y)}−{dot over (y)}.sub.T+γ(y−y.sub.T)=0 (30)
(65) since equation (30) is generally not established in the initial situation and does not contain relevant information of the output control quantities, and the control quantities cannot be solved, a further design is needed, and a definition is then made
e.sub.y2={dot over (y)}−{dot over (y)}.sub.T+γ(y−y.sub.T) (31)
(66) and its derivative may be obtained as follows
ė.sub.y2=ÿ−ÿ.sub.T+γ({dot over (y)}−{dot over (y)}.sub.T) (32)
(67) according to the multi-layer zeroing neurodynamic method, a neurodynamic equation based on the deviation function may be designed as
ė.sub.y2=−γe.sub.y2 (33)
(68) equations (31) and (32) are substituted into equation (33) and collating is performed to obtain
ÿ−ÿ.sub.T+2γ({dot over (y)}−{dot over (y)}.sub.T)+γ.sup.2(y−y.sub.T)=0 (34)
(69) in this way, a deviation function may be defined as
E.sub.y=ÿ−ÿ.sub.T+2γ({dot over (y)}−{dot over (y)}.sub.T)+γ.sup.2(y−y.sub.T) (35)
(70) according to the dynamics equations of the aircraft, equation (35) may be simplified into
E.sub.y=a.sub.yu.sub.y+b.sub.y (36)
(71) where
(72)
b.sub.y=−ÿ.sub.T+2γ({dot over (y)}−{dot over (y)}.sub.T)+γ.sup.2 (y−y.sub.T); and its derivative may be obtained as follows
Ė.sub.y=a.sub.y{dot over (u)}.sub.y+{dot over (a)}.sub.yu.sub.y+{dot over (b)}.sub.y (37)
(73) it is possible to use the multi-layer zeroing neurodynamic method to design
Ė.sub.y=−γE.sub.y (38)
(74) equations (36) and (37) are substituted into equation (38) and collating is performed to obtain
a.sub.y{dot over (u)}.sub.y=γ(a.sub.yu.sub.y+b.sub.y)−{dot over (b)}.sub.y−{dot over (a)}.sub.yu.sub.y (39)
(75) u.sub.x and u.sub.y may be solved from equations (26) and (39),
(76)
(77) so that the inversely solved target angle values ϕ.sub.T and θ.sub.T may be
(78)
(79) for the roll angle ϕ, according to the target angle ϕ.sub.T solved in (40) and the actual angle ϕ, a deviation function may be defined as
e.sub.ϕ1=ϕ−ϕ.sub.T (41)
(80) and its derivative may be obtained as follows
ė.sub.ϕ1={dot over (ϕ)}−{dot over (ϕ)}.sub.T (42)
(81) in order to converge the actual value ϕ to the target value ϕ.sub.T, according to the multi-layer zeroing neurodynamic method, a neurodynamic equation based on the deviation function may be designed as
ė.sub.ϕ1=−γe.sub.ϕ1 (43)
(82) equations (41) and (42) are substituted into equation (43) and collating is performed to obtain
{dot over (ϕ)}−{dot over (ϕ)}.sub.T+γ(ϕ−ϕ.sub.T)=0 (44)
(83) since equation (44) is generally not established in the initial situation and does not contain relevant information of the output control quantities, and the control quantities cannot be solved, a further design is needed, and a definition is then made
e.sub.ϕ2={dot over (ϕ)}−{dot over (ϕ)}.sub.T+γ(ϕ−ϕ.sub.T) (45)
(84) and its derivative may be obtained as follows
ė.sub.ϕ2={umlaut over (ϕ)}−{umlaut over (ϕ)}.sub.T+γ({dot over (ϕ)}−{dot over (ϕ)}.sub.T) (46)
(85) according to the multi-layer zeroing neurodynamic method, a neurodynamic equation based on the deviation function may be designed as
ė.sub.ϕ2=−γe.sub.ϕ2 (47)
(86) equations (45) and (46) are substituted into equation (47) and collating is performed to obtain
{umlaut over (ϕ)}−{umlaut over (ϕ)}.sub.T+2γ({dot over (ϕ)}−{dot over (ϕ)}.sub.T)+γ.sup.2(ϕ−ϕ.sub.T)=0 (48)
(87) in this way, a deviation function may be defined as
E.sub.ϕ={umlaut over (ϕ)}−{umlaut over (ϕ)}.sub.T+2γ({dot over (ϕ)}−{dot over (ϕ)}.sub.T)+γ.sup.2(ϕ−ϕ.sub.T) (49)
(88) according to the dynamics equations of the aircraft, equation (49) may be simplified into
E.sub.ϕ=a.sub.ϕu.sub.2+b.sub.ϕ (50)
(89) where
(90)
and its derivative may be obtained as follows
Ė.sub.ϕ=a.sub.ϕ{dot over (u)}.sub.2+{dot over (a)}.sub.ϕu.sub.2+{dot over (b)}.sub.ϕ (51)
(91) according to the multi-layer zeroing neurodynamic method, it is possible to design
Ė.sub.ϕ=γE.sub.ϕ (52)
equations (50) and (51) are substituted into equation (52) and collating is performed to obtain
a.sub.ϕ{dot over (u)}.sub.2=γ(a.sub.ϕu.sub.2+b.sub.ϕ)−{dot over (b)}.sub.ϕ−{dot over (a)}.sub.ϕu.sub.2 (53)
(92) for the pitch angle θ, according to the target angle θ.sub.T solved in (40) and the actual angle θ, a deviation function may be defined as
e.sub.θ1=θ−θ.sub.T (54)
(93) and its derivative may be obtained as follows
ė.sub.θ1={dot over (θ)}−{dot over (θ)}.sub.r (55)
(94) in order to converge the actual value θ to the target value θ.sub.T, according to the multi-layer zeroing neurodynamic method, a neurodynamic equation based on the deviation function may be designed as
ė.sub.θ1=−γe.sub.θ1 (56)
(95) equations (54) and (55) are substituted into equation (56) and collating is performed to obtain
{dot over (θ)}−{dot over (θ)}.sub.T+γ(θ−θ.sub.T)=0 (57)
(96) since equation (57) is generally not established in the initial situation and does not contain relevant information of the output control quantities, and the control quantities cannot be solved, a further design is needed, and a definition is then made
e.sub.θ2={dot over (θ)}−{dot over (θ)}.sub.T+γ(θ−θ.sub.T) (58)
(97) and its derivative may be obtained as follows
ė.sub.θ2={umlaut over (θ)}−{umlaut over (θ)}.sub.T+γ({dot over (θ)}−{dot over (θ)}.sub.T) (59)
(98) according to the multi-layer zeroing neurodynamic method, a neurodynamic equation based on the deviation function may be designed as
ė.sub.θ2=−γe.sub.θ2 (60)
(99) equations (58) and (59) are substituted into equation (60) and collating is performed to obtain
{umlaut over (θ)}−{umlaut over (θ)}.sub.T+2γ({dot over (θ)}−{dot over (θ)}.sub.T)+γ.sup.2(θ−θ.sub.T)=0 (61)
(100) in this way, a deviation function may be defined as
E.sub.θ={umlaut over (θ)}−{umlaut over (θ)}.sub.T+2γ({dot over (θ)}−{dot over (θ)}.sub.T)+γ.sup.2(θ−θ.sub.T) (62)
(101) according to the dynamics equations of the aircraft, equation (62) may be simplified into
E.sub.θ=a.sub.θu.sub.3+b.sub.θ (63)
(102) where
(103)
and its derivative may be obtained as follows
Ė.sub.θ=a.sub.θ{dot over (u)}.sub.3+{dot over (b)}.sub.θ (64)
(104) according to the multi-layer zeroing neurodynamic method, it is possible to design
Ė.sub.θ=−γE.sub.θ (65)
(105) equations (63) and (64) are substituted into equation (65) and collating is performed to obtain
a.sub.θ{dot over (u)}.sub.3=−γ(a.sub.θu.sub.3+b.sub.θ)−{dot over (b)}.sub.θ−{dot over (a)}.sub.θu.sub.3 (66)
(106) for the yaw angle ψ, according to the target angle ψ.sub.T solved in (40) and the actual angle ψ, a deviation function may be defined as
e.sub.ψ1=ψ−ψ.sub.T (67)
(107) and its derivative may be obtained as follows
ė.sub.ψ1={dot over (ψ)}−{dot over (ψ)}.sub.T (68)
(108) in order to converge the actual value ψ to the target value ψ.sub.T, according to the multi-layer zeroing neurodynamic method, a neurodynamic equation based on the deviation function may be designed as
ė.sub.ψ1=−γe.sub.ψ1 (69)
(109) equations (67) and (68) are substituted into equation (69) and collating is performed to obtain
{dot over (ψ)}−{dot over (ψ)}.sub.T+γ(ψ−ψ.sub.T)=0 (70)
(110) since equation (70) is generally not established in the initial situation and does not contain relevant information of the output control quantities, and the control quantities cannot be solved, a further design is needed, and a definition is then made
e.sub.ψ2={dot over (ψ)}−{dot over (ψ)}.sub.T+γ(ψ−ψ.sub.T) (71)
(111) and its derivative may be obtained as follows
ė.sub.ψ2={umlaut over (ψ)}−{umlaut over (ψ)}.sub.T+γ({dot over (ψ)}−{dot over (ψ)}.sub.T) (72)
(112) according to the multi-layer zeroing neurodynamic method, a neurodynamic equation based on the deviation function may be designed as
ė.sub.ψ2=−γe.sub.ψ2 (73)
(113) equations (71) and (72) are substituted into equation (73) and collating is performed to obtain
{umlaut over (ψ)}−{umlaut over (ψ)}.sub.T+2γ({dot over (ψ)}−{dot over (ψ)}.sub.T)+γ.sup.2(ψ−ψ.sub.T)=0 (74)
(114) in this way, a deviation function may be defined as
E.sub.ψ={umlaut over (ψ)}−{umlaut over (ψ)}.sub.T+2γ({dot over (ψ)}−{dot over (ψ)}.sub.T)+γ.sup.2(ψ−ψ.sub.T) (75)
(115) according to the dynamics equations of the aircraft, equation (75) may be simplified into
E.sub.ψ=a.sub.ψu.sub.4+b.sub.ψ (76)
(116) where
(117)
and its derivative may be obtained as follows
Ė.sub.ψ=a.sub.ψ{dot over (u)}.sub.4+{dot over (a)}.sub.ψu.sub.4+{dot over (b)}.sub.ψ (77)
(118) according to the multi-layer zeroing neurodynamic method, it is possible to design
Ė.sub.ψ=−γE.sub.ψ (78)
(119) equations (76) and (77) are substituted into equation (78) and collating is performed to obtain
a.sub.ψ{dot over (u)}.sub.4=−γ(a.sub.ψu.sub.4+b.sub.ψ)−{dot over (b)}.sub.ψ−{dot over (a)}.sub.ψu.sub.4 (79).
(120) S3: solving output control quantities of motors of the aircraft by the designed multi-layer zeroing neural network controller using the acquired real-time operation data of the aircraft and target attitude data; and
(121) A controller of the unmanned aircraft may be obtained according to multi-layer zeroing neural network equations (13), (53), (66) and (79), wherein the controller can be implemented by a network structure; the controller of the unmanned aircraft is capable of controlling the stable flight of the unmanned aircraft; and the controller may be written in the following form:
(122)
(123) a zeroing neural network is constructed from the differential equations of the controller, and the control quantities of the unmanned aircraft are solved by means of the zeroing neural network.
(124) S4: transferring solution results of step S3 to a motor governor of the aircraft, and controlling powers of the motors according to a relationship between the control quantities solved by the controller and the powers of the motors of the multi-rotor unmanned aircraft, so as to control the motion of the unmanned aircraft;
(125) according to a power allocation scheme for the unmanned aircraft, the control quantities solved by the controller have the following relationship with the powers of the motors of the multi-rotor unmanned aircraft:
U=WF
(126) where U=[u.sub.1 u.sub.2 u.sub.3 u.sub.4]T refers to the control quantities of the unmanned aircraft, F=[F.sub.1 . . . F.sub.j].sup.T refers to the powers of the motors of the unmanned aircraft, j is the number of the motors of the multi-rotor unmanned aircraft, and W is a power allocation matrix of the unmanned aircraft.
(127) In order to obtain the power required by the corresponding motor, the corresponding powers of the motors F may be obtained by means of matrix inversion or pseudo-inversion, i.e.
F=W.sup.−1U
(128) if the matrix W is a square matrix and is reversible, W.sup.−1 is obtained by means of an inverse operation, and if W is not a square matrix, W.sup.−1 is solved by means of a corresponding pseudo-inverse operation; and the desired powers F of the motors are finally obtained, input voltages of the motors are controlled according to a relationship between the voltages and powers of the motors to control the rotational speeds of the motors, and the control over the powers of the motors is finally realized to complete stable flight control over the unmanned aircraft. Since different numbers and structures of the rotors affect the control mode of the multi-rotor unmanned aircraft, the matrix W has different forms depending on the structure and the number of the rotors.
(129) Taking the six-rotor unmanned aircraft as an example, the power allocation thereof has the following relationship:
(130)
(131) The relationship may be further written as
(132)
(133) Since W is not a square matrix in the above relationship, W.sup.−1 may be obtained by means of pseudo-inversion, i.e.
(134)
(135) In this way, the power allocation of the six-rotor unmanned aircraft and the corresponding actual motor control quantity may be obtained to control the operation of the motor.
(136) The foregoing description is merely illustrative of preferred embodiments of the present invention, but the scope of protection of the present invention is not limited thereto. Equivalent replacements or modifications made to the inventive concept or technical solution of the present invention by a person skilled in the art within the scope of the disclosure of the present invention fall into the scope of protection of the present invention.