MULTIPLE ROTORS AIRCRAFT AND CONTROL METHOD

Abstract

A multiple rotors aircraft and a control method thereof are provided. The control method comprises the following steps. First, current motion information of the multiple rotors aircraft is obtained. Then, at least one control gain is adjusted through a gain adjustment function according to the current motion information. The gain adjustment function conforms to a non-Lipschitzian characteristic, and at least one rotor of the multiple rotors aircraft is controlled according to the control gain. Therefore, the multiple rotors aircraft would be ensured that its flight attitude is toward a target position, and the expected result would be conformed rapidly.

Claims

1. A control method, adapted to a multiple rotors aircraft, comprising: obtaining current motion information of the multiple rotors aircraft; and adjusting at least one control gain through a gain adjustment function according to the current motion information, so as to control at least one rotor of the multiple rotors aircraft according to the at least one control gain, wherein the gain adjustment function conforms to a non-Lipschitzian characteristic.

2. The control method as claimed in claim 1, wherein the non-Lipschitzian characteristic represents that a convergence value of a function is only zero, and the convergence value is not varied after being converged to zero.

3. The control method as claimed in claim 1, wherein the current motion information comprises a current pitch angle, a current yaw angle and a current roll angle, and the gain adjustment function is {dot over (h)}.sub.x=h.sub.x.sup.(1/2n+1)[.sub.1(.sub.d+cos sin cos +sin sin )S.sub.x] {dot over (h)}.sub.y=h.sub.y.sup.(1/2n+1)[.sub.1(.sub.d+sin sin cos cos sin )S.sub.y], where h.sub.x, h.sub.y are the at least one ${\dot{h}}_{i} = {\begin{matrix} - h_{i}^{(1 / 2 .Math. n + 1)} .Math._{i}, h_{i} 0, i = x, y \\ , h_{i} = 0 \end{matrix}$ control gain ${\tilde{U}}_{1} = \frac{1}{\cos .Math. .Math. .Math. .Math. \cos .Math. .Math.} .Math. (g + {\overset{.Math.}{z}}_{d} - k_{z} .Math. {\dot{e}}_{z} - K_{z} .Math. S_{z}) .Math. .Math. .Math. < / 2, .Math. .Math. < / 2,,$ .sub.d is a target pitch angle in at least one target attitude parameter, .sub.d is a target yaw angle in the at least one target attitude parameter, is the current roll angle, is the current pitch angel, is the current yaw angle, S.sub.x=.sub.x+k.sub.xe.sub.x , e.sub.x=x.sub.d, S.sub.y=.sub.y+k.sub.ye.sub.y, e.sub.y=xx.sub.d, S.sub.z=.sub.z+k.sub.ze.sub.z, e.sub.z=zz.sub.d,(x,y,z) is a current position, (x.sub.d,y,z.sub.d) is a target position, k.sub.x, k.sub.y, and k.sub.z are control coefficients, K.sub.z is an aerodynamic damping coefficient, n is hierarchy, g is the acceleration of gravity, .sub.i=.sub.1{tilde over (H)}.sub.iS.sub.i, {tilde over (H)}.sub.x=.sub.d+cos sin cos +sin sin , {dot over (H)}.sub.y=.sub.d+sin sin cos cos sin , and is a constant.

4. The control method as claimed in claim 3, wherein after the step of adjusting the at least one control gain through the gain adjustment function according to the current motion information, the method further comprises: adjusting the at least one target attitude parameter through an attitude estimation function according to the current motion information and the at least one control gain, wherein the attitude estimation function is $_{d} = \frac{1}{{\tilde{U}}_{1}} .Math. (- K_{x} .Math. S_{x} + {\overset{.Math.}{x}}_{d} - k_{x} .Math. {\dot{e}}_{x} - .Math. h_{x} .Math. .Math. S_{x}), .Math._{d} = \frac{1}{{\tilde{U}}_{1 .Math.}} .Math. (- K_{y} .Math. S_{y} + {\overset{.Math.}{y}}_{d} - k_{y} .Math. {\dot{e}}_{y} - .Math. h_{y} .Math. .Math. S_{y}) .$

5. The control method as claimed in claim 3, wherein before the step of adjusting the at least one control gain through the gain adjustment function according to the current motion information, the method further comprises: defining an error function, wherein the error function is ${\dot{S}}_{} = {\tilde{U}}_{1} .Math. {bm}^{- 1} [\begin{matrix} _{d} + {\tilde{H}}_{x} \\ _{d} + {\tilde{H}}_{y} \\ \cos .Math. .Math. .Math. .Math. \cos .Math. .Math. \end{matrix}] + [\begin{matrix} - {\overset{.Math.}{x}}_{d} + k_{x} .Math. {\dot{e}}_{x} \\ - {\overset{.Math.}{y}}_{d} + k_{y .Math.} .Math. {\dot{e}}_{y} \\ - {\overset{.Math.}{z}}_{d} + k_{z} .Math. {\dot{e}}_{z} \end{matrix}] + [\begin{matrix} 0 \\ 0 \\ - g \end{matrix}],$ b is a length constant, and the error function conforms to the non-Lipschitzian characteristic.

6. The control method as claimed in claim 3, wherein the current motion information further comprises the current position, the step of obtaining the current motion information of the multiple rotors aircraft comprises: obtaining the current position, the current pitch angle, the current yaw angle and the current roll angle through at least one inertial navigation element.

7. A multiple rotors aircraft, comprising: at least one rotor, respectively controlled by at least one control gain; at least one inertial navigation element, obtaining current motion information of the multiple rotors aircraft; and a processing unit, coupled to the at least one rotor and the at least one inertial navigation element, obtaining the current motion information of the multiple rotors aircraft through the at least one inertial navigation element, and adjusting the at least one control gain through a gain adjustment function according to the current motion information, wherein the gain adjustment function conforms to a non-Lipschitzian characteristic.

8. The multiple rotors aircraft as claimed in claim 7, wherein the non-Lipschitzian characteristic represents that a convergence value of a function is only zero, and the convergence value is not varied after being converged to zero.

9. The multiple rotors aircraft as claimed in claim 7, wherein the current motion information comprises a current pitch angle, a current yaw angle and a current roll angle, and the gain adjustment function is {dot over (h)}.sub.x=h.sub.x.sup.(1/2n+1)[.sub.1(.sub.d+cos sin cos +sin sin )S.sub.x] {dot over (h)}.sub.y=h.sub.y.sup.(1/2n+1)[.sub.1(.sub.d+sin sin cos cos sin )S], where h.sub.x, h.sub.y are the at least one ${\dot{h}}_{i} = {\begin{matrix} - h_{i}^{(1 / 2 .Math. n + 1)} .Math._{i}, h_{i} 0, i = x, y \\ , h_{i} = 0 \end{matrix}$ control gain, ${\tilde{U}}_{1} = \frac{1}{\cos .Math. .Math. .Math. .Math. \cos .Math. .Math.} .Math. (g + {\overset{.Math.}{z}}_{d} - k_{z} .Math. {\dot{e}}_{z} - K_{z} .Math. S_{z}) .Math. .Math. .Math. < / 2, .Math. .Math. < / 2,,$ .sub.d is a target pitch angle in at least one target attitude parameter, .sub.d is a target yaw angle in the at least one target attitude parameter, is the current roll angle, is the current pitch angel, is the current yaw angle, S.sub.x=.sub.x+k.sub.xe.sub.x , e.sub.x=xx.sub.d, S.sub.y=.sub.y+k.sub.ye.sub.y, e.sub.y=xx.sub.d, S.sub.z=.sub.z+k.sub.ze.sub.z, e.sub.z=zz.sub.d,(x,y,z) is a current position, (x.sub.d,y.sub.d,z.sub.d) is a target position, k.sub.x, k.sub.y, and k.sub.z are control coefficients, K.sub.z is an aerodynamic damping coefficient, n is hierarchy, g is the acceleration of gravity, .sub.i=.sub.1{tilde over (H)}.sub.iS.sub.i, {tilde over (H)}.sub.x=.sub.d+cos sin cos +sin sin , {tilde over (H)}.sub.y=.sub.dsin sin cos cos sin , and is a micro constant.

10. The multiple rotors aircraft as claimed in claim 9, wherein the processing unit adjusts the at least one target attitude parameter through an attitude estimation function according to the current motion information and the at least one control gain, wherein the attitude estimation function is $_{d} = \frac{1}{{\tilde{U}}_{1}} .Math. (- K_{x} .Math. S_{x} + {\overset{.Math.}{x}}_{d} - k_{x} .Math. {\dot{e}}_{x} - .Math. h_{x} .Math. .Math. S_{x}), .Math._{d} = \frac{1}{{\tilde{U}}_{1 .Math.}} .Math. (- K_{y} .Math. S_{y} + {\overset{.Math.}{y}}_{d} - k_{y} .Math. {\dot{e}}_{y} - .Math. h_{y} .Math. .Math. S_{y}) .$

11. The multiple rotors aircraft as claimed in claim 9, wherein the processing unit defines an error function, wherein the error function is ${\dot{S}}_{} = {\tilde{U}}_{1} .Math. {bm}^{- 1} [\begin{matrix} _{d} + {\tilde{H}}_{x} \\ _{d} + {\tilde{H}}_{y} \\ \cos .Math. .Math. .Math. .Math. \cos .Math. .Math. \end{matrix}] + [\begin{matrix} - {\overset{.Math.}{x}}_{d} + k_{x} .Math. {\dot{e}}_{x} \\ - {\overset{.Math.}{y}}_{d} + k_{y .Math.} .Math. {\dot{e}}_{y} \\ - {\overset{.Math.}{z}}_{d} + k_{z} .Math. {\dot{e}}_{z} \end{matrix}] + [\begin{matrix} 0 \\ 0 \\ - g \end{matrix}],$ b is a length constant, and the error function conforms to the non-Lipschitzian characteristic.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

[0018] The accompanying drawings are included to provide a further understanding of the invention, and are incorporated in and constitute a part of this specification. The drawings illustrate embodiments of the invention and, together with the description, serve to explain the principles of the invention.

[0019] FIG. 1 is a component block diagram of a multiple rotors aircraft according to an embodiment of the invention.

[0020] FIG. 2 is a flowchart illustrating a control method according to an embodiment of the invention.

[0021] FIG. 3A is a schematic diagram of a four-rotor aircraft according to an embodiment of the invention.

[0022] FIG. 3B is a coordinate schematic diagram.

[0023] FIG. 4A-FIG. 4C are respectively schematic diagrams of a current pitch angle, a current yaw angle and a current roll angle.

[0024] FIG. 5 is an example of a control flow according to an embodiment of the invention.

DESCRIPTION OF EMBODIMENTS

[0025] In conditions of stability analysis of conventional differential equations, it is known that exponential solutions are convergent. A multiple rotors aircraft and a control method thereof provided by the embodiments of the invention are adapted to quickly estimate an actual state (for example, a flight attitude) through specific differential equations, so as to achieve a quick convergence effect. Moreover, through stability analysis, stability of the system is proved. A plurality of embodiment complying with the spirit of the invention is provided below, and users may suitably adjust the embodiments according to an actual requirement without being limited to the following described content.

[0026] FIG. 1 is a component block diagram of a multiple rotors aircraft according to an embodiment of the invention. Referring to FIG. 1, the multiple rotors aircraft 100 includes at least one set of rotors 110.sub.1-110.sub.N, at least one inertial navigation element 130 and a processing unit 150, where N is a positive integer (for example, 4, 6, 8, etc.). The multiple rotors aircraft 100 can be multirotor aircraft of any driving types, which is not limited by the invention.

[0027] Each of the rotors 110.sub.1-110.sub.N may at least include (but not limited to) components of blades, a blade hub, propellers, a torque arm, a rotor shaft, etc. The rotors 110.sub.1-110.sub.N are respectively driven by a control gain, and the multiple rotors aircraft 100 may accordingly implement operations of hovering, maintaining attitude, levelling off, etc. Based on a different number of the rotors 110.sub.1-110.sub.N, the multiple rotors aircraft 100 may have a different term (for example, a quacioter, a hexacopter, an oetocopter, etc.), and the number of the rotors 110.sub.1-110.sub.N is not limited by the invention.

[0028] The inertial navigation element 130 (or an inertial measurement unit (IMU)) includes an accelerometer, a gyro sensor, an E-compass, a G-sensor, a geomagnetic sensor, etc., and is configured to obtain current motion information (for example, a current position, a current pitch angle, a current yaw angle, a current roll angle, etc.) of the multiple rotors aircraft 100. It should be noted that according to a different design requirement, the multiple rotors aircraft 100 may also include a satellite navigation system such as a global positioning system (GPS), an assisted global positioning system (AGPS), a Galileo positioning system or a global navigation satellite system (GLONASS), etc., to assist obtaining position of geodesic coordinates (or geographical position).

[0029] The processing unit 150 is coupled to the rotors 110.sub.1-110.sub.N and the inertial navigation element 130, and is a central processing unit (CPU), or other programmable general purpose or special purpose microprocessor, a digital signal processor (DSP), a programmable controller, an application specific integrated circuit (ASIC) or other similar devices or a combination of the above devices. In the present embodiment, the processing unit 150 is configured to execute all of operations of the multiple rotors aircraft 100. For example, the processing unit 150 has a proportional-integral-differential (PID) controller, which controls rotation speeds of the rotors 110.sub.1-110.sub.N based on the control gain, and adjusts the control gains and a flight attitude, etc., according to a control method of the invention, which is described in detail later.

[0030] It should be noted that according to a different design requirement, the multiple rotors aircraft 100 may further include a motor (for example, a brushless direct current (BLDC) motor, an electric motor, a frame, a bracket, a power module, etc., and appearances, configuration positions and sizes of the above components are not limited by the invention.

[0031] In order to facilitate understanding of an operation flow of the invention, a plurality of embodiments is provided below to describe a control method of the multiple rotors aircraft 100 of the invention in detail. FIG. 2 is a flowchart illustrating a control method according to an embodiment of the invention. Referring to FIG. 2, the control method of the present embodiment is adapted to the multiple rotors aircraft 100 of FIG. 1. In the following description, the control method of the present embodiment is described with reference of various components and modules of the multiple rotors aircraft 100. The flow of the control method can be adjusted according to an actual requirement, and is not limited to the following implementation.

[0032] In step S210, the processing unit 150 obtains current motion information of the multiple rotors aircraft 100 through the inertial navigation element 130. In the present embodiment, the current motion information of the multiple rotors aircraft 100 includes a current pitch angle , a current yaw angle , a current roll angle (or referred to as an Euler angle coefficient in a rotation sequence E.sub.y-E.sub.z-E.sub.x) and a current position. To be specific, in order to further understand the flight attitude of the multiple rotors aircraft 100, a dynamic model of a four-rotor aircraft is taken as an example for preliminary derivation. FIG. 3A is a schematic diagram of a four-rotor aircraft according to an embodiment of the invention. The four-rotor aircraft 300 has components that are the same or similar to that of the multiple rotors aircraft 100 of FIG. 1, and detailed descriptions of the components are not repeated. Referring to a coordinate schematic diagram of FIG. 3B, the coordinate definition of the four-rotor aircraft 300 can be represented as follows: q=(x, y, z, , , ) R.sup.6, where (x,y,z) represents the current position of a center of the four-rotor aircraft 300 relative to the geodesic coordinates (or geographical coordinates), and (, , ) are three rotation angles (i.e. the current pitch angle , the current yaw angle and the current roll angle ) used for describing the flight attitude of the four-rotor aircraft 300.

[0033] FIG. 4A-FIG. 4C are respectively schematic diagrams of the current pitch angle , the current yaw angle and the current roll angle . Referring to FIG. 3B and FIG. 4A, taking the geodesic coordinates (E.sub.x-E.sub.y-E.sub.z) as a basis, an included angle between an E.sub.x axis and a connection line of the rotors 310.sub.1 and 310.sub.3 towards an E.sub.z axis direction is defined as the current pitch angle . Referring to FIG. 3B and FIG. 4B, taking the geodesic coordinates (E.sub.x-E.sub.y-E.sub.z) as the basis, an included angle between an E.sub.y axis and a connection line of the rotors 310.sub.2 and 310.sub.4 towards the E.sub.z axis direction is defined as the current yaw angle . Referring to FIG. 3B and FIG. 4C, an included angle between the rotors 310.sub.1 and 310.sub.4 is defined as the current roll angle .

[0034] The processing unit 150, for example, obtains sensing information (for example, an azimuth angle, an acceleration, a speed, a displacement, etc.) through the inertial navigation element 130 such as a gyro sensor, an accelerometer, an E-compass, etc., and calculates the current position and the current pitch angle , the current yaw angle and the current roll angle according to the sensing information.

[0035] Moreover, a basic principle of navigation is to ensure correct transformation of two coordinate systems (i.e. on-vehicle coordinates and the geodesic coordinates). Then, referring to FIG. 3B, B={B.sub.1, B.sub.2, B.sub.3} is defined as the on-vehicle coordinates, and the on-vehicle coordinates can be transformed into the geodesic coordinates through a following transformation matrix R.sub.E:

[00007] $R_{E} = [\begin{matrix} \cos .Math. .Math. \cos & \sin .Math. .Math. \sin .Math. .Math. & - \sin .Math. .Math. \\ \cos .Math. .Math. \sin .Math. .Math. \sin .Math. .Math. & \sin .Math. .Math. \sin .Math. .Math. .Math. .Math. \sin .Math. .Math. + \cos .Math. .Math. \cos .Math. .Math. & \cos .Math. .Math. \cos .Math. .Math. \\ \cos .Math. .Math. \sin .Math. .Math. .Math. .Math. \cos .Math. .Math. + \sin .Math. .Math. \sin .Math. .Math. & \sin .Math. .Math. \sin .Math. .Math. .Math. .Math. \cos .Math. .Math. - \cos .Math. .Math. \sin .Math. .Math. & \cos .Math. .Math. \cos .Math. .Math. \end{matrix}],$

and a dynamic model can be defined as

[00008] $\overset{.Math.}{x} = \frac{1}{m} .Math. (\cos .Math. .Math. \sin .Math. .Math. \cos .Math. .Math. + \sin .Math. .Math. \sin .Math. .Math.) .Math. U_{1} + \frac{A_{x}}{m}, .Math. \overset{.Math.}{y} = \frac{1}{m} .Math. (\sin .Math. .Math. \sin .Math. .Math. \cos .Math. .Math. + \cos .Math. .Math. \sin .Math. .Math.) .Math. U_{1} + \frac{A_{y}}{m}, .Math. \overset{.Math.}{z} = - g + \frac{1}{m} .Math. (\cos .Math. .Math. \cos) + \frac{A_{y}}{m},$

where m is a mass of the four-rotor aircraft 300, g is an acceleration of gravity (9.8 km/s), and [A.sub.x A.sub.y A.sub.z] is an aerodynamic forces vector.

[0036] It should be noted that in an actual practice, the processing unit 150 may directly obtain a geodesic position (or a geographical position) through the satellite positioning system. In order to ensure the correct transformation of the two coordinate systems, the processing unit 150 requires to perform calibration at all the time. For example, the processing unit 150 corrects the current roll angle based on the E-compass and the geomagnetic sensor, corrects the current pitch angle and the current yaw angle based on the accelerometer and the G-sensor. After the correct transformation of the two coordinate systems is ensured, the processing unit 150, for example, performs an integral operation based on the gyro sensor to obtain attitude information based on the on-vehicle coordinate system (i.e. the current pitch angle , the current yaw angle and the current roll angle ).

[0037] In step S220, the processing unit 150 adjusts a control gain through a gain adjustment function according to the current motion information, so as to control the rotors 110.sub.1-110.sub.N of the multiple rotors aircraft 100 through the control gain. The gain adjustment function conforms to a non-Lipschitzian characteristic. The non-Lipschitzian characteristic represents that a convergence value of the function is only zero, and the convergence value is varied after being converged to zero. To be specific, derivation of the gain adjustment function is described below. First, a translational kinetic energy T.sub.trans and a rotation kinetic energy T.sub.rot can be respectively represented by following equations (1) and (2):

[00009] $\begin{matrix} T_{trans} = \frac{m}{2} .Math. {\dot{}}^{T} .Math. \dot{} & (1) \\ T_{rot} = \frac{m}{2} .Math. {\dot{}}^{T} .Math. J .Math. \dot{} & (2) \end{matrix}$

[0038] Where, =(x, y, z) R.sup.3 , =(, , ) S.sup.3 , J is a rotation inertia matrix. A potential energy U of the four-rotor aircraft 300 in FIG. 3A can be represented by a following equation (3):

U=mgz (3)

[0039] A Lagrangian function can be represented in a following equation (4):

[00010] $\begin{matrix} \frac{}{t} .Math. \frac{L}{\dot{q}} - \frac{L}{q} = F & (4) \end{matrix}$

[0040] Where, q=[ ]. By applying the above equations (1)-(3) to L(q,{dot over (q)}), a following equation (5) is obtained:

[00011] $\begin{matrix} L (q, \dot{q}) = T_{trans} + T_{rot} - U = \frac{m}{2} .Math. {\dot{}}^{T} .Math. \dot{} + \frac{m}{2} .Math. {\dot{}}^{T} .Math. J .Math. \dot{} - mgz, & (5) \\ and \\ F = [\begin{matrix} F_{} \end{matrix}] & (6) \end{matrix}$

[0041] Where,

[00012] $\begin{matrix} F_{} = [\begin{matrix} \cos .Math. .Math. \cos & \sin .Math. .Math. \sin .Math. .Math. & - \sin .Math. .Math. \\ \cos .Math. .Math. \sin .Math. .Math. \sin .Math. .Math. & \begin{matrix} \sin .Math. .Math. \sin .Math. .Math. .Math. .Math. \sin .Math. .Math. + \\ \cos .Math. .Math. \cos .Math. .Math. \end{matrix} & \cos .Math. .Math. \cos .Math. .Math. \\ \begin{matrix} \cos .Math. .Math. \sin .Math. .Math. .Math. .Math. \cos .Math. .Math. + \\ \sin .Math. .Math. \sin .Math. .Math. \end{matrix} & \begin{matrix} \sin .Math. .Math. \sin .Math. .Math. .Math. .Math. \cos .Math. .Math. - \\ \cos .Math. .Math. \sin .Math. .Math. \end{matrix} & \cos .Math. .Math. \cos .Math. .Math. \end{matrix}] [\begin{matrix} 0 \\ 0 \\ f_{1} + f_{2} + f_{3} + f_{4} \end{matrix}], & (7) \\ .Math. and \\ .Math. = [\begin{matrix} _{} \\ _{} \\ _{} \end{matrix}] = [\begin{matrix} (f_{1} - f_{3}) .Math. l \\ (f_{4} - f_{2}) .Math. l \\ (- f_{1} - f_{3} + f_{2} + f_{4}) \end{matrix}] & (8) \end{matrix}$

[0042] Where, f.sub.1, f.sub.2, f.sub.3, f.sub.4 are respectively thrust forces (corresponding to a B.sub.3 axis direction of the on-vehicle coordinate system, or a direction perpendicular to the blades of the rotors 310.sub.1, 310.sub.2, 310.sub.3, 310.sub.4) of the rotors 310.sub.1, 310.sub.2, 310.sub.3, 310.sub.4, l is a length from a motor shaft to a mass center.

[0043] By organizing the above equations, following equations (9) and (10) are obtained:

[00013] $\begin{matrix} m .Math. .Math. \overset{.Math.}{} = (f_{1} + f_{2} + f_{3} + f_{4}) [\begin{matrix} - \sin .Math. .Math. \\ \cos .Math. .Math. \sin .Math. .Math. \\ \cos .Math. .Math. \cos .Math. .Math. \end{matrix}] + [\begin{matrix} 0 \\ 0 \\ mg \end{matrix}] & (9) \\ J .Math. .Math. \overset{.Math.}{} = - C (, \dot{}) .Math. \dot{} + & (10) \end{matrix}$

[0044] Where, C(,{dot over ()})) is a Coriolis term.

[0045] In order to overcome a rotation moment produced when the four sets of rotors 310.sub.1, 310.sub.2, 310.sub.3, 310.sub.4 simultaneously rotate, the four-rotor aircraft 300 may adopt a symmetric rotation direction design (for example, rotation directions M.sub.1, M.sub.2, M.sub.3, M.sub.4 of the rotors 310.sub.1, 310.sub.2, 310.sub.3, 310.sub.4 in FIG. 3A). Based on a special design, an influence of the rotation moment on the four-rotor aircraft 300 produced when the rotors 310.sub.1, 310.sub.2, 310.sub.3, 310.sub.4 simultaneously rotate can be decreased. If the four-rotor aircraft 300 is required to have a variation in the current pitch angle , the thrust forces are designed to satisfy f.sub.1>f.sub.3 or f.sub.1<f.sub.3, and meanwhile a position of the four-rotor aircraft 300 on the E.sub.x axis of the geodesic coordinates is also changed (as shown in FIG. 4A). If the four-rotor aircraft 300 is required to have a variation in the current yaw angle , the thrust forces are designed to satisfy f.sub.4>f.sub.2 or f.sub.4<f.sub.2, and meanwhile a position of the four-rotor aircraft 300 on the E.sub.y axis of the geodesic coordinates is also changed (as shown in FIG. 4B). FIG. 4C presents a symmetric thrust force to produce a variation in the current roll angle , and meanwhile a height of the aircraft is changed. Therefore, by changing an attitude of the aircraft, a flight direction of the aircraft is changed, and meanwhile the change of the attitude of the aircraft causes a change in a direction and a magnitude of the thrust force.

[0046] Therefore, deduced according to a robust adaptive control in collaboration with the non-Lipschitzian characteristic (i.e. the finite time is converged to zero), it is known that in the technique of the multiple rotors aircraft, a position control is a rather important link. A main purpose of the position control is to control the current position of the multiple rotors aircraft 100 to move to a target position (x.sub.d, y.sub.d, z.sub.d) within a certain time. Since the processing unit 150 is required to calculate target attitude parameters (a target pitch angle .sub.d, a target yaw angle .sub.d, a target roll angle .sub.d) required by the multiple rotors aircraft 100 according to the required target position during the calculation process, so as to drive the multiple rotors aircraft 100 to move to the target position, (to facilitate description, the four-rotor aircraft 300 of FIG. 3A is taken as an example for description) each axis acceleration can be defined as a following equation (11):

[00014] $\begin{matrix} [\begin{matrix} \overset{.Math.}{x} \\ \overset{.Math.}{y} \\ \overset{.Math.}{z} \end{matrix}] = m^{- 1} .Math. b [\begin{matrix} (_{1}^{2} +_{2}^{2} +_{3}^{2} +_{4}^{2}) .Math._{d} \\ (_{1}^{2} +_{2}^{2} +_{3}^{2} +_{4}^{2}) .Math._{d} \\ (_{1}^{2} +_{2}^{2} +_{3}^{2} +_{4}^{2}) .Math. \cos .Math. .Math. \cos .Math. .Math. \end{matrix}] + [\begin{matrix} m^{- 1} .Math. b (_{1}^{2} +_{2}^{2} +_{3}^{2} +_{4}^{2}) .Math. {\tilde{H}}_{x} \\ m^{- 1} .Math. b (_{1}^{2} +_{2}^{2} +_{3}^{2} +_{4}^{2}) .Math. {\tilde{H}}_{y} \\ - g \end{matrix}] & (11) \end{matrix}$

[0047] Where, .sub.1, .sub.2, .sub.3, .sub.4 are respectively rotation speeds of the four sets of rotors in the four-rotor aircraft 300, b is a frame related length coefficient, and {tilde over (H)}.sub.x, {tilde over (H)}.sub.y are respectively defined as following equations (12), (13):

{tilde over (H)}.sub.x=.sub.d+cos sin cos +sin sin (12)

{tilde over (H)}.sub.y=.sub.d+sin sin coscos sin (13)

[0048] In order to ensure the multiple rotors aircraft 100 to fly to the target position, a position tracking trajectory error function is defined as a following equation (14):

S.sub.=.sub.+k.sub.e.sub.(14)

[0049] Where, S.sub.70=S.sub.x S.sub.y S.sub.z=.sub.x+k.sub.xe.sub.x .sub.y+k.sub.ye.sub.y .sub.z+k.sub.ze.sub.z and e.sub.=[e.sub.x e.sub.y e.sub.z].sup.T=[xx.sub.d yy.sub.d zz.sub.d].sup.T, and

[00015] $k_{} = [\begin{matrix} k_{x} & 0 & 0 \\ 0 & k_{y} & 0 \\ 0 & 0 & k_{z} \end{matrix}],$

k.sub.x, k.sub.y, and k.sub.z are control coefficients (real numbers).

[0050] According to the position tracking trajectory error function (14), it is known that when S.sub.=0, it represents that the error dynamically reaches a sliding surface, and such result is similar to a variable structure system well known by those skilled in the art, and each time when the error reaches the sliding surface to make S.sub.=0, the tracking trajectory error is ensured to be zero, so as to achieve an effect of position control.

[0051] Then, the target position .sub.d(t) is set as a bounded function, and a differential of the target potion (i.e. the target speed) .sub.d.sup.(i)(t) R, i=1,2,3 is bounded and conforms to .sub.d.sup.(i)(t) L.sub..

[0052] It should be noted that a main design purpose of the position control is to make the current position of the aircraft to reach the target position, i.e.

[00016] $\lim_{t ->} .Math. .Math. e_{} .Math. = 0.$

Therefore, a primary condition is to ensure the processing unit 150 to obtain the current position of the multiple rotors aircraft 100 (i.e. the step S210). Then, the processing unit 150 defines an error function (15) as follows:

[00017] $\begin{matrix} {\dot{S}}_{} = {\tilde{U}}_{1} .Math. {bm}^{- 1} [\begin{matrix} _{d} + {\tilde{H}}_{x} \\ _{d} + {\tilde{H}}_{y} \\ \cos .Math. .Math. .Math. .Math. \cos .Math. .Math. \end{matrix}] + [\begin{matrix} - {\overset{.Math.}{x}}_{d} + k_{x} .Math. {\dot{e}}_{x} \\ - {\overset{.Math.}{y}}_{d} + k_{y} .Math. {\dot{e}}_{y} \\ - {\overset{.Math.}{z}}_{d} + k_{z} .Math. {\dot{e}}_{z} \end{matrix}] + [\begin{matrix} 0 \\ 0 \\ - g \end{matrix}], & (15) \end{matrix}$

[0053] and defines .sub.1 as the main thrust force of the multiple rotors aircraft 100. For example, the main thrust force of the four-rotor aircraft 300 of FIG. 3A is .sub.1=.sub.1.sup.2+.sub.2.sup.2+.sub.3.sup.2+.sub.4.sup.2. The error function (15) conforms to the non-Lipschitzian characteristic.

[0054] It should be noted that rules of a non-Lipschitzian autonomous system include following theorems. Considering that the autonomous system {dot over (x)}=f(x), where f:D.fwdarw.R.sup.n is non-Lipschitzian continuous on an origin open neighborhood D R.sup.n of an origin of R.sup.n. The origin of {dot over (x)}=f(x) is a finite time convergence if there exists an origin N D of the origin and a function T.sub.x:N\{0}.fwdarw.(0, ) calls a setting time function such that every solution a trajectory x(t, x.sub.0) of {dot over (x)}=f(x) starting from an initial point x.sub.0 8 0, T.sub.x(x.sub.0)), and

[00018] $\lim_{t -> T_{x} (x_{0})} .Math. x (t, x_{0}) = 0, .$

In other words, a condition of a differential equation being differentiable is that it is continuous and smooth. If the unique solution to the differential equation is 0 and continuous but not smooth, it is undifferentiable. However, if the solution to the differential equation does not vary after reaching 0, it indicates that the differential equation converges to 0.

[0055] Then, based on height control, the main thrust force can be modified to a following equation (16):

[00019] $\begin{matrix} {\tilde{U}}_{1} = \frac{1}{\cos .Math. .Math. .Math. .Math. \cos .Math. .Math.} .Math. (g + {\overset{.Math.}{z}}_{d} - k_{z} .Math. {\dot{e}}_{z} - K_{z} .Math. S_{z}) .Math. .Math. .Math. < / 2, .Math. .Math. < / 2, & (16) \end{matrix}$

[0056] Where, K.sub.z is an aerodynamic damping coefficient (a real number).

[0057] Regarding the control gains for the E.sub.x axis and the E.sub.y axis, the gain adjustment functions (17), (18), (19) can be deduced based on the non-Lipschitzian characteristic, a Kalman filter and a sliding mode observer:

[00020] $\begin{matrix} {\dot{h}}_{x} = - h_{x}^{(1 / 2 .Math. n + 1)} [{\tilde{U}}_{1} (-_{d} + \cos .Math. .Math. \sin .Math. .Math. \cos .Math. .Math. + \sin .Math. .Math. .Math. .Math. \sin .Math. .Math.) .Math. S_{x}] & (17) \\ {\dot{h}}_{y} = - h_{y}^{(1 / 2 .Math. n + 1)} [{\tilde{U}}_{1} (-_{d} + \sin .Math. .Math. \sin .Math. .Math. .Math. .Math. \cos .Math. .Math. - \cos .Math. .Math. .Math. .Math. \sin .Math. .Math.) .Math. S_{y}] & (18) \\ {\dot{h}}_{i} = {\begin{matrix} - h_{i}^{(1 / 2 .Math. n + 1)} .Math._{i}, h_{i} 0, i = x, y \\ , h_{i} = 0 \end{matrix} & (19) \end{matrix}$

[0058] Where h.sub.x, h.sub.y are the control gains, n is hierarchy, g is the acceleration of gravity, .sub.i=.sub.1{tilde over (H)}.sub.iS.sub.i, i is x or y, and is a small constant.

[0059] It should be noted that the processing unit 150 changes the control gains by adjusting the hierarchy n, so as to adjust the convergence time of the gain adjustment functions (17) and (18).

[0060] Then, the processing unit 150 adjusts the target attitude parameters through attitude estimation functions according to the current motion information and the control gains (i.e. h.sub.x, h.sub.y), where the attitude estimation functions (20), (21) are defined as follows:

[00021] $\begin{matrix} _{d} = \frac{1}{{\tilde{U}}_{1 .Math.}} .Math. (- K_{x} .Math. S_{x} + {\overset{.Math.}{x}}_{d} - k_{x} .Math. {\dot{e}}_{x} - .Math. h_{x} .Math. .Math. S_{x}) & (20) \\ _{d} = \frac{1}{{\tilde{U}}_{1}} .Math. (- K_{y} .Math. S_{y} + {\overset{.Math.}{y}}_{d} - k_{y} .Math. {\dot{e}}_{y} - .Math. h_{y} .Math. .Math. S_{y}) & (21) \end{matrix}$

[0061] In other words, the processing unit 150 adjusts the control gains according to the gain adjustment functions (17), (18), (19), so as to control each set of the rotors 110.sub.1-110.sub.t, such that a flight attitude of the multiple rotors aircraft 100 is adjusted to the target pitch angle .sub.d and the target yaw angle .sub.d , and the multiple rotors aircraft 100 may accurately fly to the target position.

[0062] {t.sub.v}.sub.v=1.sup. is conformed to a measure zero condition, such that h.sub.i(t.sub.v)=0, v=1,2,3, . . . . Moreover, through theoretical analysis of stability conditions of Lyapunov and Kurzweil theory, it is learned that based on the equations (15)-(20), an error of position control of the multiple rotors aircraft 100 may reach an asymptotically stable condition. On the other hand, in the aforementioned descriptions, the derivation of the four-rotor aircraft is taken as an example for descriptions, and the multiple rotors aircraft with other number of the rotors can also be derived to calculate the corresponding error function (15), the gain adjustment functions (17), (18), (19) and the attitude estimation functions (20), (21).

[0063] FIG. 5 is an example of a control flow according to an embodiment of the invention. Referring to FIG. 5, the control method of the present embodiment is adapted to the multiple rotors aircraft 100 of FIG. 1, in the following description, the control method of the present embodiment is described with reference of various components and modules of the multiple rotors aircraft 100. The flow of the control method can be adjusted according to an actual requirement, which is not limited to the flow shown in FIG. 5.

[0064] The processing unit 150 obtains the current motion information (for example, an acceleration and an angular acceleration of each axis) through the accelerometer and the gyro sensor in the inertial navigation element 130 (step S510), and performs a transformation procedure on the current motion information (step S530). The processing unit 150 processes the value of the current motion information through a low-pass filter to obtain a required value, and further calculates through an integrator to obtain current speeds along three axial directions ({dot over (x)} custom-character {dot over (y)}), the current pitch angle , the current yaw angle and the current roll angle (step S531). The processing unit 150 performs correction, transformation and estimation on the current speed ({dot over (x)}-{dot over (7)}-) through matrix adjustment (step S532), moving average calculation (step S535), a Kalman Filter (step S537) and a sliding mode observer (step S539) to calculate the current position (x,y,z). On the other hand, the processing unit 150 performs matrix adjustment on the current pitch angle , the current yaw angle and the current roll angle (step S532) to transform each of the Euler angle coefficients into the geodesic coordinate system. Then, the processing unit 150 applies the above results to the equations (15)-(20) to respectively generate (for example, the error function (15), the gain adjustment functions (17), (18), (19) and the attitude estimation functions (20), (21)) (step S540), such that the current position (x,y,z) is conformed to the target position (x.sub.d,y.sub.d,z.sub.d) and the current attitude parameters (i.e. the current pitch angle , the current yaw angle and the current roll angle ) are conformed to the target attitude parameters (i.e. the target pitch angle .sub.d, the target yaw angle .sub.d and the target roll angle .sub.d) (steps S550, S555). The processing unit 150 transforms a system input into a trust input matrix form (step S570) to drive a brushless DC motor driver (step S580). Then, the processing unit 150 transforms a trust input into the trust input matrix form (step S591) to control the multiple rotors aircraft 100 (step S593). The aforementioned operation flow is repeatedly performed to converge the error value between the current position and the target position to zero.

[0065] It should be noted that according to a different design requirement, the transformation procedure of the step S530 can be varied along with different algorithms, and the embodiment of the invention is not limited to the flow of FIG. 5.

[0066] In summary, in the multiple rotors aircraft and the control method thereof provided by the invention, the inertial navigation element is applied to measure the flight attitude of the multiple rotors aircraft (for example, the current pitch angle , the current yaw angle and the current roll angle ), and the error function based on the on-Lipschitzian characteristic is adopted to derive the attitude estimation functions and the gain adjustment functions, so as to adjust the control gains and the flight attitude. In this way, the error value between the current position and the target position may reach a fast convergence effect according to embodiment of the invention, so as to provide a robust adaptive control system.

[0067] It will be apparent to those skilled in the art that various modifications and variations can be made to the structure of the invention without departing from the scope or spirit of the invention. In view of the foregoing, it is intended that the invention cover modifications and variations of this invention provided they fall within the scope of the following claims and their equivalents.

MULTIPLE ROTORS AIRCRAFT AND CONTROL METHOD

Inventors

Cpc classification

Classification Explorer

B64U2201/00

PERFORMING OPERATIONS; TRANSPORTING

Classification Explorer

B64U30/20

PERFORMING OPERATIONS; TRANSPORTING

Classification Explorer

G05D1/0858

PHYSICS

Classification Explorer

G05D1/0825

PHYSICS

Classification Explorer

B64U10/14

PERFORMING OPERATIONS; TRANSPORTING

International classification

Classification Explorer

G05D1/08

PHYSICS

Classification Explorer

B64C27/08

PERFORMING OPERATIONS; TRANSPORTING

Abstract

Claims

Description