# US 2022/0036739 A1 · Method for Controlling Steady Flight of Unmanned Aircraft

> Agents: this data is available as JSON from the patentgrep API and MCP server — see https://patentgrep.com/llms.txt

- Number: US 2022/0036739 A1
- Document ID: US20220036739A1
- Status: Published application
- Kind: A1
- Application number: 16/652,457
- Filed: 2018-10-26
- Published: 2022-02-03
- Earliest claimed: 2017-11-01
- Assignees: South China University of Technology
- Applicants: South China University of Technology
- Inventors: Zhijun Zhang; Lu'nan Zheng; Dongyu Ji
- Web page: https://patentgrep.com/patent/US20220036739A1

## CPC

- G05D 1/0858: {specially adapted for vertical take-off of aircraft}
- G05D 1/495: to ensure stability
- B64U 10/16: with five or more distinct rotor axes, e.g. octocopters
- G05D 1/0088: {characterized by the autonomous decision making process, e.g. artificial intelligence, predefined behaviours (using knowledge based models G06N5/00)}
- G05D 1/0816: {to ensure stability}
- B64U 2201/10: autonomous, i.e. by navigating independently from ground or air stations, e.g. by using inertial navigation systems [INS]
- G05D: SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- B64U: UNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR

## 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

### Claim 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 multi-rotor 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 multi-rotor unmanned aircraft:
U=WF
where U=[u1 u2 u3 u4]T refers to the output control quantities of the unmanned aircraft, F=[F1 . . . Fj]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, 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, i.e.:
F=W−1U
if the matrix W is a square matrix and is reversible, W−1 is obtained by means of an inverse operation, and if W is not a square matrix, W−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.

### Claim 2 (depends on 1)

The method for controlling stable flight of an unmanned aircraft according to claim 1, characterized in that the step of analyzing a kinematic problem of the aircraft by a processor mounted thereto specifically comprises:
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
R
=
[
cos
⁢
⁢
θ
⁢
⁢
cos
⁢
⁢
ψ
cos
⁢
⁢
θ
⁢
⁢
sin
⁢
⁢
ψ
-
sin
⁢
⁢
θ
sin
⁢
⁢
ϕ
⁢
⁢
sin
⁢
⁢
θ
⁢
⁢
cos
⁢
⁢
ψ
-
cos
⁢
⁢
ϕ
⁢
⁢
sin
⁢
⁢
ψ
sin
⁢
⁢
ϕ
⁢
⁢
sin
⁢
⁢
θ
⁢
⁢
sin
⁢
⁢
ψ
+
cos
⁢
⁢
ϕ
⁢
⁢
cos
⁢
⁢
ψ
sin
⁢
⁢
ϕ
⁢
⁢
cos
⁢
⁢
θ
cos
⁢
⁢
ϕ
⁢
⁢
sin
⁢
⁢
θ
⁢
⁢
cos
⁢
⁢
ψ
+
sin
⁢
⁢
ϕ
⁢
⁢
sin
⁢
⁢
ψ
cos
⁢
⁢
ϕ
⁢
⁢
sin
⁢
⁢
θ
⁢
⁢
sin
⁢
⁢
ψ
-
sin
⁢
⁢
ϕ
⁢
⁢
cos
⁢
⁢
ψ
cos
⁢
⁢
ϕ
⁢
⁢
cos
⁢
⁢
θ
]
where ϕ is a roll angle, θ is a pitch angle, and ψ is a yaw angle;
ignoring the effect of an air resistance on the aircraft, the stress analysis of the aircraft system in the fuselage coordinate system is as follows
[
mI
3
×
3
0
0
I
]
⁡
[
V
.
ω
.
]
+
[
ω
×
m
⁢
⁢
V
ω
×
I
⁢
⁢
ω
]
=
[
F
τ
]
where m is the total mass of the aircraft, I3×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.

### Claim 3 (depends on 2)

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 multi-rotor aircraft as follows
{
x
¨
=
u
x
⁢
u
1
m
y
¨
=
u
y
⁢
u
1
m
z
¨
=
-
g
+
(
cos
⁢
⁢
ϕ
⁢
⁢
cos
⁢
⁢
θ
)
⁢
u
1
m
ϕ
¨
=
(
I
y
-
I
z
)
⁢
θ
.
⁢
ψ
.
+
l
⁢
u
2
I
x
θ
¨
=
(
I
z
-
I
x
)
⁢
ψ
¨
⁢
ϕ
¨
+
l
⁢
u
3
I
y
ψ
¨
=
(
I
x
-
I
y
)
⁢
ϕ
¨
⁢
θ
¨
+
u
4
I
z
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; {umlaut over (x)}, ÿ, {umlaut over (z)} respectively represent second derivatives of x(t), γ(t) and z(t); ϕ, θ and ψ respectively represent a roll angle, a pitch angle and a yaw angle; {umlaut over (ϕ)}, {umlaut over (θ)} and {umlaut over (ψ)} respectively represent second derivatives of the corresponding parameters; {dot over (ϕ)}, {dot over (θ)}, {dot over (ψ)} respectively represent first derivatives of the corresponding parameters; Ix, Iy, Iz are respectively rotational inertia of the aircraft in X, Y and Z axes; ux=cos ϕ sin θ cos ψ+sin ϕ sin ψ; uy=cos ϕ sin θ sin ψ−sin ϕ cos ψ; and u1, u2, u3, u4 are output control quantities.

### Claim 4 (depends on 1)

The method for controlling stable flight of an unmanned aircraft according to claim 1, characterized in that the step of designing a 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 u1 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;
(2-2) designing a deviation function regarding ux and uy 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 ϕT and θT; and
(2-3) designing a deviation function regarding the output control quantities u2˜u4 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.

### Claim 5 (depends on 4)

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 u1 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 zT and the actual altitude value z in the Z axis, defining a deviation function as
Ez={umlaut over (z)}−{umlaut over (z)}T+2γ(ż−żT)+γ2(z−zT) (9)
according to the dynamics equations of the aircraft, simplifying (9) into
Ez=azu1+bz (10)
where
a
z
=
cos
⁢
⁢
ϕ
⁢
⁢
cos
⁢
⁢
θ
m
,
b
z
=
-
g
-
z
¨
T
+
2
⁢
γ
⁡
(
z
.
-
z
.
T
)
+
γ
2
⁡
(
z
-
z
T
)
,
and γ is a constant; and obtaining its derivative as follows
Ėz=az{dot over (u)}1+{dot over (a)}zu1+{dot over (b)}z (11)
using the multi-layer zeroing neurodynamic method to design
Ėz=−γEz (12)
substituting equations (10) and (11) into equation (12) and perform collating to obtain
az{dot over (u)}1=γ(azu1+bz)−{dot over (b)}z−{dot over (a)}zu1 (13).

### Claim 6 (depends on 4)

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 ux and uy and a position controller for the unmanned aircraft specifically comprises:
for the horizontal position x, according to the target value xT and the actual value x in the X axis, defining a deviation function as
Ex={umlaut over (x)}−{umlaut over (x)}T+2γ({dot over (x)}−{dot over (x)}T)+γ2(x−xT) (22)
according to the dynamics equations of the aircraft, simplifying equation (22) into
Ex=axux+bx (23)
where
a
x
=
u
1
m
,
and bx=−{umlaut over (x)}T+2γ({dot over (x)}−{dot over (x)}T)+γ2(x−xT); and obtaining its derivative as follows
Ėx=ax{dot over (u)}x+{dot over (a)}xux+{dot over (b)}x (24)
using the multi-layer zeroing neurodynamic method to design
Ėx=−γEx (25)
substituting equations (23) and (24) into equation (25) and perform collating to obtain
ax{dot over (u)}x=−γ(axux+bx)−{dot over (b)}x−{dot over (a)}xux (26)
for the horizontal position y, according to the target value yT and the actual value y in the Y axis, defining a deviation function as
Ey=ÿ−ÿT+2γ({dot over (y)}−{dot over (y)}T)+γ2(y−yT) (35)
according to the dynamics equations of the aircraft, simplifying equation (35) into
Ey=ayuy+by (36)
where
a
y
=
u
1
m
,
and by=−ÿT+2γ({dot over (y)}−{dot over (y)}T)+γ2 (y−yT); and obtaining its derivative as follows
Ėy=ay{dot over (u)}y+{dot over (a)}yuy+{dot over (b)}y (37)
using the multi-layer zeroing neurodynamic method to design
Ėy=−γEy (38)
substituting equations (36) and (37) into equation (38) and perform collating to obtain
ay{dot over (u)}y=−γ(ayuy+by)−{dot over (b)}y−{dot over (a)}yuy (39).

### Claim 7 (depends on 6)

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 ϕT and θT are:
ux and uy solved from position controller equations (26) and (39) are
{
u
x
=
cos
⁢
⁢
ϕ
⁢
⁢
sin
⁢
⁢
θ
⁢
⁢
cos
⁢
⁢
ψ
+
sin
⁢
⁢
ϕ
⁢
⁢
sin
⁢
⁢
ψ
u
y
=
cos
⁢
⁢
ϕ
⁢
⁢
sin
⁢
⁢
θ
⁢
⁢
sin
⁢
⁢
ψ
-
sin
⁢
⁢
ϕ
⁢
⁢
cos
⁢
⁢
ψ
so that the inversely solved target angle values ϕT and θT are
{
ϕ
T
=
sin
-
1
⁡
(
u
x
⁢
⁢
sin
⁢
⁢
ψ
-
u
y
⁢
⁢
cos
⁢
⁢
ψ
)
θ
T
=
sin
-
1
⁡
(
u
x
-
sin
⁢
⁢
ϕ
T
⁢
⁢
sin
⁢
⁢
ψ
cos
⁢
⁢
ϕ
T
⁢
⁢
cos
⁢
⁢
ψ
)
.
(
40
)

### Claim 8 (depends on 4)

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 quantities u2˜u4 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 the target angle ϕT solved in (40) and the actual angle ϕ, defining a deviation function as
Eϕ={umlaut over (ϕ)}−{umlaut over (ϕ)}T+2γ({dot over (ϕ)}−{dot over (ϕ)}T)+γ2(ϕ−ϕT) (49)
according to the dynamics equations of the aircraft, simplifying equation (49) into
Eϕ=aϕu2+bϕ (50)
where
a
ϕ
=
l
I
x
,
and
⁢
⁢
b
ϕ
=
(
I
y
-
I
z
)
⁢
θ
.
⁢
ψ
.
I
x
-
ϕ
¨
T
+
2
⁢
γ
⁡
(
ϕ
.
-
ϕ
.
T
)
+
γ
2
⁡
(
ϕ
-
ϕ
T
)
;
and obtaining its derivative as follows
Ėϕ=aϕ{dot over (u)}2+{dot over (a)}ϕu2+{dot over (b)}ϕ (51)
according to the multi-layer zeroing neurodynamic method, designing
Ėϕ=−γEϕ (52)
substituting equations (50) and (51) into equation (52) and perform collating to obtain
aϕ{dot over (u)}2=−γ(aϕu2+bϕ)−{dot over (b)}ϕ−{dot over (a)}ϕu2 (53)
for the pitch angle θ, according to the target angle θT solved in (40) and the actual angle θ, defining a deviation function as
Eθ={umlaut over (θ)}−{umlaut over (θ)}T+2γ({dot over (θ)}−{dot over (θ)}T)+γ2(θ−θT) (62)
according to the dynamics equations of the aircraft, simplifying equation (62) into
Eθ=aθu3+bθ (63)
where
a
θ
=
l
I
y
,
and
⁢
⁢
b
θ
=
(
I
z
-
I
x
)
⁢
ϕ
.
⁢
ψ
.
I
y
-
θ
¨
T
+
2
⁢
γ
⁡
(
θ
.
-
θ
.
T
)
+
γ
2
⁡
(
θ
-
θ
T
)
;
and obtaining its derivative as follows
Ėθ=aθ{dot over (u)}3+{dot over (a)}θu3+{dot over (b)}θ (64)
according to the multi-layer zeroing neurodynamic method, designing
Ėθ=−γEθ (65)
substituting equations (63) and (64) into equation (65) and perform collating to obtain
aθ{dot over (u)}3=−γ(aθu3+bθ)−{dot over (b)}θ−{dot over (a)}θu3 (66)
for the yaw angle ψ, according to an artificially set angle ψT and the actual angle ψ, defining a deviation function as
Eψ={umlaut over (ψ)}−{umlaut over (ψ)}T+2γ({dot over (ψ)}−{dot over (ψ)}T)+γ2(ψ−ψT) (75)
according to the dynamics equations of the aircraft, simplifying equation (75) into
Eψ=aψu4+bψ (76)
where
a
ψ
=
1
I
z
,
and
⁢
⁢
b
ψ
=
(
I
x
-
I
y
)
⁢
ϕ
.
⁢
θ
.
I
z
-
ψ
¨
T
+
2
⁢
γ
⁡
(
ψ
.
-
ψ
.
T
)
+
γ
2
⁡
(
ψ
-
ψ
T
)
;
and obtaining its derivative as follows
Ėψ=aψ{dot over (u)}4+{dot over (a)}ψu4+{dot over (b)}ψ (77)
according to the multi-layer zeroing neurodynamic method, designing
Ėψ=−γEψ (78)
substituting equations (76) and (77) into equation (78) and perform collating to obtain
aψ{dot over (u)}4=γ(aψu4+bψ)−{dot over (b)}ψ−{dot over (a)}ψu4 (79).

### Claim 9 (depends on 4)

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 multi-rotor unmanned aircraft specifically comprises:
az{dot over (u)}1=−γ(azu1+bz)−{dot over (b)}z−{dot over (a)}zu1 (13)
aϕ{dot over (u)}2=−γ(aϕu2+bϕ)−{dot over (b)}ϕ−{dot over (a)}ϕu2 (53)
aθ{dot over (u)}3=−γ(aθu3+bθ)−{dot over (b)}θ−{dot over (a)}θu3 (66)
aψ{dot over (u)}4=−γ(aψu4+bγ)−{dot over (b)}ψ{dot over (a)}ψu4 (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:
{
u
.
1
=
-
γ
⁡
(
a
z
⁢
u
1
+
b
z
)
-
b
.
z
-
a
.
z
⁢
u
1
a
z
u
.
2
=
-
γ
⁡
(
a
ϕ
⁢
u
2
+
b
ϕ
)
-
b
.
ϕ
-
a
.
ϕ
⁢
u
2
a
ϕ
u
.
3
=
-
γ
⁡
(
a
θ
⁢
u
3
+
b
θ
)
-
b
.
θ
-
a
.
θ
⁢
u
3
a
θ
u
.
4
=
-
γ
⁡
(
a
ψ
⁢
u
4
+
b
ψ
)
-
b
.
ψ
-
a
.
ψ
⁢
u
4
a
ψ
a multi-layer 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 multi-layer zeroing neural network.
