METHOD AND SYSTEM FOR CONTROLLING POSITION AND ATTITUDE SEPARATION OF TILTABLE ROTORCRAFT

Abstract

A method and system for controlling position and attitude separation of a tiltable rotorcraft is provided, including a capability prediction module, a position control subsystem, a velocity control subsystem, an attitude angle control subsystem, an angular rate control subsystem, a control allocation module, and a tiltable rotorcraft. After expected position and attitude commands are corrected by the capability prediction module, expected force and torque commands are output by various control subsystems, and after receiving the force and torque commands, the control allocation module is further configured to calculate actual control commands of the aircraft, such as a tilt angle of a rotor assembly and a rotor speed, thus controlling the tiltable rotorcraft to perform the tracking of the expected position and attitude commands.

Claims

1. A method for controlling position and attitude separation control method of a tiltable rotorcraft, comprising: establishing six-degree-of-freedom motion equations of translational motion of center-of-mass and rotation around the center-of-mass of the tilting rotorcraft; establishing a control efficiency model of the tiltable rotorcraft; integrating the six-degree-of-freedom motion equations and the control efficiency model into a control model designed for a control system; establishing a capability prediction model according to the control model, and outputting a position and attitude angle correction command through the capability prediction model; constructing a velocity control subsystem, an attitude angle control subsystem, an angular rate control subsystem and a control allocation module; and outputting an actual control command of an aircraft according to a correction command provided by the capability prediction model.

2. The method for controlling position and attitude separation of the tiltable rotorcraft according to claim 1, wherein a kinematic equation of the translational motion of the center-of-mass is established as follows: $\stackrel{}{P}=v;$ wherein P=[x, y, z].sup.T represents three-axis positions of the aircraft; v=[v.sub.x, v.sub.y, v.sub.z].sup.T represents three-axis velocity of the aircraft; the dynamic equation of the translational motion of the center-of-mass is expressed as: $m\stackrel{}{v}=\mathrm{mg}+f_v+f_v;$ wherein m represents a mass of the aircraft; g=[0,0, g].sup.T represents a gravitational acceleration vector; f.sub.v represents a lumped force disturbance; wherein f.sub.v represents a control force, which is defined as: $\begin{array}{cc}{f}_v=R_b^e& {}_{}^b{f}_v^{}=R_b^e{.Math.}_{i=1}^4\end{array}{R}_{p,i}^b{R}_{p^{},i}^{p,i}{T}_i;$ $\mathrm{wherein}$ ${}_{}^b{f}_v^{}=R_b^e{.Math.}_{i=1}^4{R}_{p,i}^b{R}_{p^{},i}^{p,i}{T}_i$ represents a resultant force in a body coordinate system of the aircraft; T.sub.i=[0,0,T.sub.i].sup.T represents a rotor thrust of an i.sup.th rotor; $T_i=c_T{n}_i^2,c_T$ represents a thrust coefficient; n.sub.i represents a rotor speed of the i.sup.th rotor; and $R_b^e,R_{p,i}^b,R_{p^{},i}^{p,i}$ represent a conversion relationship from the body coordinate system to a geodetic coordinate system, a conversion relationship from a fixed coordinate system of a propeller disc of the i.sup.th rotor to the body coordinate system, and a conversion relationship from a comoving coordinate system of the propeller disc of the i.sup.th rotor to the fixed coordinate system of the propeller disc, respectively.

3. The method for controlling position and attitude separation control of the tiltable rotorcraft according to claim 2, wherein a kinematic equation of the rotation around the center-of-mass is established as follows: $\stackrel{}{}=G_w;$ wherein =[, , ].sup.T represents an attitude angle of the aircraft; , , represent a roll angle, a pitch angle and a yaw angle, respectively; =[p, q, r].sup.T represents an angular rate of the aircraft; p, q, r represents a roll angular rate, a pitch angular rate and a yaw angular rate, respectively; a matrix G.sub.W is defined as: $G_w=\left[\begin{array}{ccc}1& \tan \sin & \tan \cos \\ 0& \cos & -\sin \\ 0& \sin /\cos & \cos /\cos \end{array}\right];$ the dynamic equation of the rotation around the center-of-mass is: $J\stackrel{}{}+J=G_a++;$ wherein J=diag{J.sub.xx,J.sub.yy,J.sub.zz} represents an inertia tensor matrix; G.sub.a represents a gyroscopic torque; represents a triaxial torque generated by a propeller; represents a lumped torque disturbance; a control torque is defined as: $={}_t+{}_d;$ $\mathrm{wherein}$ ${}_t={.Math.}_{i=1}^4\left({}_{}^b{O}_{p,i}^{}{R}_{p,i}^b{R}_{p^{},i}^{p,i}{T}_i\right)$ represents a torque generated by four rotor thrusts; ${}_d={.Math.}_{i=1}^4{R}_{p,i}^b{R}_{p^{},i}^{p,i}\left({\left(-1\right)}^{i-1}{c}_M{n}_i^2\right)$ represents a torque formed by a reaction torque for the rotor; .sup.bO.sub.p,i represents a position of an origin of the fixed coordinate system of the propeller disc in the body coordinate system; ${}_{}^b{O}_{p,i}^{}=R_b^{p,i}l;$ l=[l, 0,0].sup.T represents a length of an arm; and c.sub.M represents a coefficient of the reaction torque.

4. The method for controlling position and attitude separation of the tiltable rotorcraft according to claim 3, wherein obtaining $\left[\begin{array}{c}{}^b{f}_v\\ \end{array}\right]=\left[\begin{array}{c}{.Math.}_{i=1}^4{R}_{p,i}^b{R}_{p^{},i}^{p,i}{T}_i\\ {.Math.}_{i=1}^4\left({}_{}^b{O}_{p,i}^{}{R}_{p,i}^b{R}_{p^{},i}^{p,i}{T}_i\right)+{.Math.}_{i=1}^4{R}_{p,i}^b{R}_{p^{},i}^{p,i}\left({\left(-1\right)}^{i-1}{c}_d{T}_i\right)\end{array}\right]$ according to equations of the control force f.sub.v and the control torque , which is organized into the following matrix form: $\left[\begin{array}{c}{}^b{f}_v\\ \end{array}\right]=A\left(\right)N;$ wherein =[.sub.1, .sub.2, .sub.3, .sub.4].sup.T represents tilt angles of four rotor assemblies; $N={\left[n_1^2,n_2^2,n_3^2,n_4^2\right]}^T$ represents square of rotor speeds of the four rotor assemblies; and A() is a trigonometric function matrix related to a tilt angle .sub.i of the rotor assembly.

5. The method for controlling position and attitude separation of the tiltable rotorcraft according to claim 4, wherein the tilt angle of the rotor assembly and a rotor speed have the following physical constraints: $\{\begin{array}{c}\underset{\_}{}{}_i\stackrel{\_}{}\\ \underset{\_}{n}{n}_i\stackrel{\_}{n}\end{array};$ wherein , , n, n represent feasible physical upper and lower boundaries thereof; virtual control variables N.sub.l,i and N.sub.l,i are defined as follows: $\begin{array}{c}{N}_{l,i}=.Math.N_{l,i}.Math.=T_{i}s\left({}_i\right)=c_T{n}_i^{2}s\left({}_i\right)\\ N_{v,i}=.Math.N_{v,i}.Math.=T_{i}c\left({}_i\right)=c_T{n}_i^{2}c\left({}_i\right)\end{array};$ a relationship among the virtual variables, the control force and the control torque is expressed as follows: $\left[\begin{array}{c}{}^b{f}_v\\ \end{array}\right]=\stackrel{\_}{A}\stackrel{\_}{N};$ wherein N=[N.sub.l,1, N.sub.v,1, N.sub.l,2, N.sub.v,2, N.sub.l,3, N.sub.v,3, N.sub.l,4, N.sub.v,4], is a constant matrix. after obtaining the virtual control variables N.sub.l,i and N.sub.v,i, a motor speed and a tilt angle of a steering engine are calculated.

6. The method for controlling position and attitude separation of the tiltable rotorcraft according to claim 1, wherein integrating the six-degree-of-freedom motion equation and the control efficiency model into the control model designed for the control system comprises: modifying the established six-degree-of-freedom motion equation of the aircraft as the following form: $\{\begin{array}{c}\stackrel{}{P}=v\\ \stackrel{.}{v}=g+G_v{}^b{f}_v+d_v\\ \stackrel{}{}=G_{}\\ \stackrel{}{}=-J^{-1}J+J^{-1}{G}_a+J^{-1}+d_{}\end{array};$ $\mathrm{wherein}{G}_v=\frac{1}{m}{R}_b^e,d_v=\frac{1}{m}{f}_v,\mathrm{and}{d}_{}=J^{-1}.$

7. A system for controlling position and attitude separation of a tiltable rotorcraft, comprising a capability prediction module, a position control subsystem, a velocity control subsystem, an attitude angle control subsystem, an angular rate control subsystem, a control allocation module, and a tiltable rotorcraft; after expected position and attitude commands are corrected by the capability prediction module, expected force and torque commands are output by the position control subsystem, the velocity control subsystem, the attitude angle control subsystem, and the angular rate control subsystem, and after receiving the force and torque commands, the control allocation module is further configured to calculate actual control commands of an aircraft including a tilt angle of a rotor assembly and a rotor speed, thus controlling the tiltable rotorcraft to perform the tracking of the expected position and attitude commands.

8. The system for controlling position and attitude separation of the tiltable rotorcraft according to claim 7, wherein a position tracking error is defined as: $e_p=P-P_c={\left[e_x,e_y,e_z\right]}^T;$ a performance function of the position control subsystem is defined as: ${}_p=\mathrm{diag}\left\{{}_x\left(t\right),{}_y\left(t\right),{}_z\left(t\right)\right\}$ ${}_i\left(t\right)=\{\begin{array}{cc}{\left(\frac{T_i-t}{T_i}\right)}^{\frac{1}{1-{}_i}}\left({}_{i,0}-{}_{i,}\right)+{}_{i,},& 0t{T}_i\\ {}_{i,},& t>T_i\end{array};$ wherein i=x, y, z; T.sub.i represents convergence time of set by a user; .sub.i(0,1), .sub.i,o and .sub.i, represent an initial value and a steady-state value of the performance function, respectively; a relationship between the position tracking error and the performance function is as follows: $-{\underset{\_}{b}}_i{}_i\left(t\right)<e_i\left(t\right)<{\stackrel{}{b}}_i{}_i\left(t\right);$ wherein b.sub.i, b.sub.i(0,1]; a conversion error .sub.p is defined as: ${}_p={\frac{1}{2}\left[\ln \frac{{}_x\left(t\right)+{\underset{\_}{b}}_x}{{\stackrel{}{b}}_x-{}_x\left(t\right)},\ln \frac{{}_y\left(t\right)+{\underset{}{b}}_y}{{\stackrel{}{b}}_y-{}_y\left(t\right)},\ln \frac{{}_z\left(t\right)+{\underset{\_}{b}}_z}{{\stackrel{}{b}}_z-{}_z\left(t\right)}\right]}^T$ ${}_i\left(t\right)=\left({}_i\left(t\right)\right)=\frac{1}{2}\ln \left(\frac{{}_i\left(t\right)+{\underset{}{b}}_i}{{\stackrel{}{b}}_i-{}_i\left(t\right)}\right),{}_i\left(t\right)=\frac{e_i\left(t\right)}{{}_i\left(t\right)};$ wherein .sub.i(t)(b.sub.i, b.sub.i) represents a normalization error; based on the conversion error .sub.p, guaranteed performance control law of the position control subsystem is: $\stackrel{}{v}=-k_p{}_p+{\stackrel{}{P}}_d+{}_p;$ $\mathrm{wherein}$ ${}_p={\left[e_x{\stackrel{}{}}_x/{}_x,e_y{\stackrel{}{}}_y/{}_y,e_z{\stackrel{}{}}_z/{}_z\right]}^T;$ k.sub.p represents a control gain; a conversion error .sub. of the attitude angle control subsystem is defined as: ${}_{}={\frac{1}{2}\left[\ln \frac{{}_{}\left(t\right)+{\underset{\_}{b}}_{}}{{\stackrel{}{b}}_{}-{}_{}\left(t\right)},\ln \frac{{}_{}\left(t\right)+{\underset{\_}{b}}_{}}{{\stackrel{}{b}}_{}-{}_{}\left(t\right)},\ln \frac{{}_{}\left(t\right)+{\underset{\_}{b}}_{}}{{\stackrel{}{b}}_{}-{}_{}\left(t\right)}\right]}^T;$ a control law of the attitude angle control subsystem is: $\stackrel{}{}=-k_{}{}_{}+{\stackrel{}{}}_d+{}_{};$ $\mathrm{wherein}$ ${}_{}={\left[e_{}{\stackrel{}{}}_{}/{}_{},e_{}{\stackrel{}{}}_{}/{}_{},e_{}{\stackrel{}{}}_{}/{}_{}\right]}^T;$ k.sub. represents a control gain.

9. The system for controlling position and attitude separation of the tiltable rotorcraft according to claim 8, wherein a first-order filter is configured to perform expected command smoothing and acquire a corresponding differential signal calculation, and a lumped disturbance force of the velocity control subsystem and a lumped disturbance torque of the angular rate control subsystem are estimated by a disturbance observer; in the velocity control subsystem: the first order filter is configured to acquire a smooth signal v.sub.c and a differential signal {dot over (v)}.sub.c of an expected velocity command v; the lumped disturbance force of the velocity control subsystem is estimated by the disturbance observer: $\{\begin{array}{c}{\stackrel{}{e}}_v=\stackrel{}{v}-v\\ \stackrel{}{v}=g+\frac{1}{m}{f}_v-k_{v1}{\mathrm{sig}}^{\frac{1}{2}}\left({\stackrel{}{e}}_v\right)-{}_{v1}\left(1-\right){\mathrm{sig}}^{\frac{2+{}_v}{2}}\left({\stackrel{}{e}}_v\right)+{\stackrel{}{d}}_v;\\ {\stackrel{}{d}}_v=-k_{v2}\mathrm{sign}\left({\stackrel{}{e}}_v\right)-{}_{v2}\left(1-\right){\mathrm{sig}}^{1+{}_v}\left({\stackrel{}{e}}_v\right)\end{array}$ wherein {tilde over (e)}.sub.v represents an estimated error; {circumflex over (v)} and {circumflex over (d)}.sub.v represent an estimated velocity and the lumped disturbance force, respectively; ${}_v,{}_{v1},{}_{v2}>0,k_{v1}=1.5{{\stackrel{\_}{d}}_v}^{1/2},k_{v2}=1.1{\stackrel{\_}{d}}_v;$ and d.sub.v represents an upper boundary of a change rate of the lumped disturbance force; $=\{\begin{array}{cc}0,& t{T}_{v,o}\\ 1,& \mathrm{otherwise}\end{array};$ wherein T.sub.v,o represent parameters of the disturbance observer; a control law of the velocity control subsystem is: ${}^b{f}_{v,c}=G_v^{-1}\left(-k_v{e}_v-g-{\stackrel{}{d}}_v+{\stackrel{}{v}}_c-{}_p{}_p\right);$ wherein e.sub.v=vv.sub.c=[e.sub.vx, e.sub.vy, e.sub.vz].sup.T represents a velocity tracking error; and k.sub.v represents a control gain; in the angular rate control subsystem: the first-order filter is also configured to acquire a smooth signal .sub.c and a differential signal {dot over ()}.sub.c of an expected angular rate command ; the lumped disturbance torque of the angular rate control subsystem is estimated by the disturbance observer: $\{\begin{array}{c}{\stackrel{}{e}}_{}=\stackrel{}{}-\\ \stackrel{.}{\hat{}}=-J^{-1}J+J^{-1}{G}_a+J^{-1}-\\ k_1{\mathrm{sig}}^{\frac{1}{2}}\left({\stackrel{}{e}}_{}\right)-{}_1\left(1-\right){\mathrm{sig}}^{\frac{2+{}_{}}{2}}\left({\stackrel{}{e}}_{}\right)+{\stackrel{}{d}}_{}\\ {\stackrel{.}{\stackrel{}{d}}}_{}=-k_2\mathrm{sign}\left({\stackrel{}{e}}_{}\right)-{}_2\left(1-\right){\mathrm{sig}}^{1+{}_{}}\left({\stackrel{}{e}}_{}\right)\end{array};$ wherein {tilde over (e)}.sub. represents an estimated error; {circumflex over ()} and {circumflex over (d)}.sub. represent an estimated angular rate and the lumped disturbance torque; ${}_{},{}_1,{}_2>0,k_1=1.5{\stackrel{}{d}}_{}^{1/2},k_2=1.1{\stackrel{}{d}}_{};$ and d.sub. represents an upper boundary of a change rate of the lumped disturbance torque; $=\{\begin{array}{cc}0,& t{T}_{,o}\\ 1,& \mathrm{otherwise}\end{array};$ wherein T.sub.,o represent parameters of the disturbance observer; a control law of the angular rate control subsystem is: ${}_c=G_{}^{-1}\left(-k_{}{e}_{}+J^{-1}J-J^{-1}{G}_a-{\stackrel{}{d}}_{}+{\stackrel{}{}}_c-{}_{}{}_{}\right);$ wherein e.sub.=.sub.c=[e.sub.p,e.sub.q,e.sub.r].sup.T represents an angular rate tracking error; and k.sub. represents a control gain.

10. The system for controlling position and attitude separation of a tiltable rotorcraft according to claim 9, wherein according to an expected force and torque given by the velocity control subsystem and the angular rate control subsystem, a virtual control variable is calculated by means of pseudo-inverse control allocation, $\stackrel{}{N}={\stackrel{}{A}}^{-1}\left[\begin{array}{c}{}^b{f}_v\\ \end{array}\right];$ after obtaining the virtual control variable N, a tilt angle of a rotor assembly and a rotor speed are calculated.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

[0095] FIG. 1 is a schematic diagram of an aircraft;

[0096] FIG. 2 is a schematic diagram of a boundary of control capacity according to the present disclosure;

[0097] FIG. 3 is a schematic diagram of a position and attitude separation control system according to the present disclosure;

[0098] FIG. 4 is a schematic diagram of a position tracking effect curve according to the present disclosure;

[0099] FIG. 5 is a schematic diagram of a position tracking error curve according to the present disclosure;

[0100] FIG. 6 is a schematic diagram of an attitude angle tracking effect curve according to the present disclosure;

[0101] FIG. 7 is a schematic diagram of an attitude angle tracking error curve according to the present disclosure;

[0102] FIGS. 8A-D is a schematic diagram of a curve of a rotor tilt angle according to the present disclosure;

[0103] FIGS. 9A-D is a schematic diagram of a curve of a rotor speed according to the present disclosure.

REFERENCE NUMERALS

[0104] 1 to 4rotor; 102geodetic coordinate system; 103fixed coordinate system of propeller disc; and 104comoving coordinate system of propeller disc.

[0105] The implementation, functional characteristics and advantages of the present disclosure will be further described with reference to the accompanying drawings in conjunction with embodiments.

DETAILED DESCRIPTION OF THE EMBODIMENTS

[0106] It should be understood that specific embodiments described here are only used to illustrate rather than limiting the present disclosure.

[0107] Referring to FIG. 1-FIG. 3, the present disclosure provides a system for controlling position and attitude separation of a tiltable rotorcraft, including: [0108] a capability prediction module, a position control subsystem, a velocity control subsystem, an attitude angle control subsystem, an angular rate control subsystem, a control allocation module, and a tiltable rotorcraft. The capacity prediction module is configured to correct expected position and attitude commands, expected force and torque commands are output by the position control subsystem, the velocity control subsystem, the attitude angle control subsystem and the angular rate control subsystem. After receiving the force and torque commands, the control allocation module is further configured to calculate actual control commands of the aircraft, such as a tilt angle of a rotor assembly and a rotor speed, thus controlling the tiltable rotorcraft to perform the tracking of the expected position and attitude commands.

[0109] The method for controlling position and attitude separation of a tiltable rotorcraft including: [0110] establishing six-degree-of-freedom motion equations of translational motion of the center-of-mass and rotation around the center-of-mass of the tiltable rotorcraft; [0111] establishing a control efficiency model of the tiltable rotorcraft; [0112] integrating the six-degree-of-freedom motion equations and the control efficiency model into a control model designed for a control system; and [0113] establishing a capability prediction model according to the control model, and outputting a position and attitude angle correction command through the capability prediction model.

[0114] A position control subsystem, a velocity control subsystem, an attitude angle control subsystem, an angular rate control subsystem and a control allocation module are constructed according to the control model, and an actual control command (a tilt angle of a rotor assembly and a rotor speed) of an aircraft is output according to a correction command given by the capability prediction model.

[0115] Therefore, a practical method for controlling position and attitude separation is provided in the present disclosure, which can simultaneously ensure that errors of the position and attitude angle commands are limited in a pre-designed performance envelope, and a higher control performance can be obtained. Moreover, the expected command can be corrected by the capacity prediction module, which, by considering the actual control capacity of the aircraft system, can correct the command beyond the control capacity range at an upper level, thus effectively avoiding a catastrophic consequence such as controller instability caused by control saturation and other problems.

[0116] Specifically, the schematic diagram of an aircraft, the definition of a coordinate system and the serial number of a rotor assembly can refer to FIG. 1.

[0117] A kinematic equation of the translational motion of the center-of-mass can be established as:

[00035]$\stackrel{}{P}=v;$ [0118] where: [0119] P=[x, y, z].sup.T represents three-axis positions of the aircraft; [0120] v=[v.sub.x, v.sub.y, v.sub.z].sup.T represents three-axis velocity of the aircraft; [0121] the dynamic equation of the translational motion of the center-of-mass can be expressed as:

[00036]$m\stackrel{}{v}=\mathrm{mg}+f_v+f_v;$ [0122] where: [0123] m represents a mass of the aircraft; [0124] g=[0,0, g].sup.T represents a gravitational acceleration vector; [0125] f.sub.v represents a lumped force disturbance; [0126] where f.sub.v represents a control force, which is defined as:

[00037]$\begin{array}{cc}{f}_v=R_b^e& {}_{}^b{f}_v^{}=R_b^e{.Math.}_{i=1}^4{R}_{p,i}^b{R}_{p^{},i}^{p,i}{T}_i;\end{array}$$\text{where:}$${}_{}^b{f}_v^{}=R_b^e{.Math.}_{i=1}^4{R}_{p,i}^b{R}_{p^{},i}^{p,i}{T}_i$ represents a resultant force in a body coordinate system of the aircraft;

[0127] T.sub.i=[0,0,T.sub.i].sup.T represents a rotor thrust of an i.sup.th rotor;

[00038]$T_i=c_T{n}_i^2,c_T$ represents a thrust coefficient; [0128] n.sub.i represents a rotor speed of the it rotor; and

[00039]$R_b^e,R_{p,i}^b,R_{p^{},i}^{p,i}$ represent a conversion relationship from the body coordinate system to a geodetic coordinate system, a conversion relationship from a fixed coordinate system of a propeller disc of the i.sup.th rotor to the body coordinate system, and a conversion relationship from a comoving coordinate system of the propeller disc of the i.sup.th rotor to the fixed coordinate system of the propeller disc, respectively.

[0129] A kinematic equation of the rotation around of the center-of-mass can be established as:

[00040]$\stackrel{}{}=G_w;$ [0130] where: [0131] =[, , ].sup.T represents an attitude angle of the aircraft; [0132] , , represent a roll angle, a pitch angle and a yaw angle, respectively; [0133] =[p, q, r].sup.T represents an angular rate of the aircraft; and [0134] p, q, r represents a roll angular rate, a pitch angular rate and a yaw angular rate, respectively; [0135] a matrix G.sub.W is defined as:

[00041]$G_w=\left[\begin{array}{ccc}1& \tan \sin & \tan \cos \\ 0& \cos & -\sin \\ 0& \sin /\cos & \cos /\cos \end{array}\right];$ [0136] according to Euler's dynamic equation, the dynamic equation of the rotation around of the center-of-mass is:

[00042]$J\stackrel{}{}+J=G_a++;$ [0137] where: [0138] J=diag{J.sub.xx,J.sub.yy,J.sub.zz} represents an inertia tensor matrix; [0139] G.sub.a represents a gyroscopic torque; [0140] represents a triaxial torque (also called a control torque) generated by a propeller; and [0141] represents a lumped torque disturbance. [0142] a control torque is defined as:

[00043]$={}_r+{}_d.$$\text{Where:}$${}_t={.Math.}_{i=1}^4\left({}_{}^b{O}_{p,i}^{}{R}_{p,i}^b{R}_{p^{},i}^{p,i}{T}_i\right)$ represents a torque generated by four rotor thrusts;

[00044]${}_d={.Math.}_{i=1}^4{R}_{p,i}^b{R}_{p^{},i}^{p,i}\left({\left(-1\right)}^{i-1}{c}_M{n}_i^2\right)$ represents a torque formed by a reaction torque for the rotor; [0143] .sup.bO.sub.p,i represents a position of an origin of the fixed coordinate system of the propeller disc in the body coordinate system;

[00045]${}^b{O}_{p,i}=R_b^{p,i}l;$ [0144] l=[l, 0,0].sup.T represents a length of an arm; and [0145] c.sub.M represents a coefficient of the reaction torque.

[0146] In addition, according to equations of the control force f.sub.v and the control torque , the following can be obtained:

[00046]$\left[\begin{array}{c}{}^b{f}_v\\ \end{array}\right]=\left[\begin{array}{c}{.Math.}_{i=1}^4{R}_{p,i}^b{R}_{p^{},i}^{p,i}{T}_i\\ {.Math.}_{i=1}^4\left({}_{}^b{O}_{p,i}^{}{R}_{p,i}^b{R}_{p^{},i}^{p,i}{T}_i\right)+{.Math.}_{i=1}^4{R}_{p,i}^b{R}_{p^{},i}^{p,i}\left({\left(-1\right)}^{i-1}{c}_d{T}_i\right)\end{array}\right],$ [0147] which can be organized into the following matrix form:

[00047]$\left[\begin{array}{c}{}^b{f}_v\\ \end{array}\right]=A\left(\right)N;$ [0148] where: =[.sub.1, .sub.2, .sub.3, .sub.4].sup.T represents tilt angles of four rotor assemblies;

[00048]$N={\left[n_1^2,n_2^2,n_3^2,n_4^2\right]}^T$ represents the square of rotor speeds of four rotor assemblies; and [0149] A() is a trigonometric function matrix related to a tilt angle di of the rotor assembly.

[0150] Considering the actual condition, the tilt angle of the rotor assembly and the rotor speed have the following physical constraints:

[00049]$\{\begin{array}{c}\underset{\_}{}{}_i\stackrel{\_}{}\\ \underset{\_}{n}{n}_i\stackrel{\_}{n}\end{array};$ [0151] where: [0152] , , n, n represent feasible physical upper and lower boundaries thereof.

[0153] The control force, the control torque and a virtual control variable (the tilt angle of the rotor assembly and the rotor speed) are non-affine, to avoid the non-affine control allocation problem, virtual control variables N.sub.l,i and N.sub.v,i are defined as follows:

[00050]$\begin{array}{c}{N}_{l,i}=.Math.N_{l,i}.Math.=T_{i}s\left({}_i\right)=c_T{n}_i^{2}s\left({}_i\right)\\ N_{v,i}=.Math.N_{v,i}.Math.=T_{i}c\left({}_i\right)=c_T{n}_i^{2}c\left({}_i\right)\end{array};$

[0154] a relationship among the virtual control variables, the control force and the control torque can be expressed as follows:

[00051]$\left[\begin{array}{c}{}^b{f}_v\\ \end{array}\right]=\stackrel{}{A}\stackrel{}{N};$

[0155] where:

[0156] N=[N.sub.l,1, N.sub.v,1, N.sub.l,2, N.sub.v,2, N.sub.l,3, N.sub.v,3, N.sub.l,4, N.sub.v,4], is a constant matrix.

[0157] After obtaining the virtual control variables N.sub.l,i and N.sub.v,i, a tilt angle of a steering engine and a motor speed can be calculated.

[0158] In an embodiment, to facilitate the design of a controller, the six-degree-of-freedom motion equations and the control efficiency model are integrated into a control model designed for a control system, including: [0159] the established six-degree-of-freedom motion equation of the aircraft is modified as the following form:

[00052]$\{\begin{array}{c}\stackrel{}{P}=v\\ \stackrel{.}{v}=g+G_v{}^b{f}_v+d_v\\ \stackrel{}{}=G_{}\\ \stackrel{}{}=-J^{-1}J+J^{-1}{G}_a+J^{-1}+d_{}\end{array};$$\mathrm{where}{G}_v=\frac{1}{m}{R}_b^e,d_v=\frac{1}{m}{f}_v,\mathrm{and}{d}_{}=J^{-1}.$

[0160] Considering that the control capability of the aircraft is limited due to the physical constraints of an actuator (the tilt angle and the rotor speed), not all arbitrary position and attitude commands can be tracked, and thus an aircraft capability prediction module based on deep learning is designed in the present disclosure.

[0161] Taking the calculation of an attitude angle constraint boundary as an example, a control capability constraint value can be calculated by optimizing the following formula:

[00053]$\max x,x=,,$$s.t.\{\begin{array}{c}\stackrel{.}{v}=g-R_b^e{f}_b/m+d_f\\ \stackrel{.}{}=-J^{-1}J+J^{-1}{G}_a+J^{-1}+d_{}\\ v=v^{*}\mathrm{or}={}^{*}\\ \left(\underset{\_}{},\stackrel{\_}{}\right)\\ N\left(\underset{\_}{N},\stackrel{\_}{N}\right)\end{array};$ [0162] however, it is extremely time-consuming to solve the above optimization problems online, and an on-board chip is difficult to be applied to each control cycle due to its limited computing performance. To solve this problem, a strategy of off-line optimization and deep network fitting and online application is adopted in the present disclosure, and thus an aircraft capability prediction module based on deep learning is proposed.

[0163] Specifically, first of all, in the possible working conditions of the aircraft, the above optimization problems are solved by traversal, and calculation conditions v for each optimization problem and upper and lower values of the optimization results , , are saved (FIG. 2 shows a schematic diagram of a controllable boundary of an attitude angle during hovering). Then, the calculation conditions and the optimization results are used as an input and label values of the network respectively for network training. Finally, the online application can be performed after the training is completed.

[0164] The aircraft capability prediction module based on deep learning can correct the position and attitude angle commands according to the prediction results in each control cycle, and provided the control system with the expected command that meet the control capability thereof, thus avoiding a series of problems such as instability caused by limited control capability of the aircraft.

[0165] In the above embodiment, the guaranteed performance position and attitude separation control method is designed by the position control subsystem, the velocity control subsystem, the attitude angle control subsystem, and the angular rate control subsystem.

[0166] The position control subsystem is designed as follows: [0167] a position tracking error is defined as:

[00054]$e_p=P-P_c={\left[e_x,e_y,e_z\right]}^T;$ [0168] a performance function of the position control subsystem is defined as:

[00055]${}_p=\mathrm{diag}\left\{{}_x\left(t\right),{}_y\left(t\right),{}_z\left(t\right)\right\}$${}_i\left(t\right)=\{\begin{array}{cc}{\left(\frac{T_i-t}{T_i}\right)}^{\frac{1}{1-{}_i}}\left({}_{i,0}-{}_{i,}\right)+{}_{i,},& 0t{T}_i\\ {}_{i,},& t>T_i\end{array};$ [0169] where i=x, y, z; [0170] T.sub.i represents convergence time set by a user; [0171] .sub.i(0,1), .sub.i,0 and .sub.i, represent an initial value and a steady-state value of the performance function, respectively.

[0172] A relationship between the position tracking error and the performance function is as follows:

[00056]$-{\underset{\_}{b}}_i{}_i\left(t\right)<e_i\left(t\right)<{\stackrel{}{b}}_i{}_i\left(t\right);$ [0173] wherein b.sub.i, b.sub.i(0,1]; [0174] the attitude angle control subsystem is designed as follows: [0175] the following conversion error .sub.p is defined as:

[00057]$\begin{array}{c}{}_p={\frac{1}{2}\left[\ln \frac{{}_x\left(t\right)+{\underset{\_}{b}}_x}{{\stackrel{}{b}}_x-{}_x\left(t\right)},\ln \frac{{}_y\left(t\right)+{\underset{}{b}}_y}{{\stackrel{}{b}}_y-{}_y\left(t\right)},\ln \frac{{}_z\left(t\right)+{\underset{\_}{b}}_z}{{\stackrel{}{b}}_z-{}_z\left(t\right)}\right]}^T\\ {}_i\left(t\right)=\left({}_i\left(t\right)\right)=\frac{1}{2}\ln \left(\frac{{}_i\left(t\right)+{\underset{}{b}}_i}{{\stackrel{}{b}}_i-{}_i\left(t\right)}\right),{}_i\left(t\right)=\frac{e_i\left(t\right)}{{}_i\left(t\right)},\end{array};$ [0176] where .sub.i(t)(b.sub.i, b.sub.i) represents a normalization error. [0177] based on a conversion error .sub.p, the guaranteed performance control law is:

[00058]$\stackrel{}{v}=-k_p{}_p+{\stackrel{}{P}}_d+{}_p;$ [0178] where: [0179] .sub.p=[e.sub.x{dot over ()}.sub.x/.sub.x, e.sub.y{dot over ()}.sub.y/.sub.y, e.sub.z{dot over ()}.sub.z/.sub.z].sup.T; and [0180] k.sub.p represents a control gain. [0181] a conversion error .sub. of the attitude angle control subsystem is defined as:

[00059]${}_{}={\frac{1}{2}\left[\ln \frac{{}_{}\left(t\right)+{\underset{\_}{b}}_{}}{{\stackrel{}{b}}_{}-{}_{}\left(t\right)},\ln \frac{{}_{}\left(t\right)+{\underset{}{b}}_{}}{{\stackrel{}{b}}_{}-{}_{}\left(t\right)},\ln \frac{{}_{}\left(t\right)+{\underset{\_}{b}}_{}}{{\stackrel{}{b}}_{}-{}_{}\left(t\right)}\right]}^T;$ [0182] the control law of the attitude angle control subsystem is:

[00060]$\stackrel{}{}=-k_{}{}_{}+{\stackrel{}{}}_d+{}_{};$$\text{where:}$${}_{}={\left[e_{}{\stackrel{}{}}_{}/{}_{},e_{}{\stackrel{}{}}_{}/{}_{},e_{}{\stackrel{}{}}_{}/{}_{}\right]}^T;$ and [0183] k.sub. represents a control gain.

[0184] The velocity control subsystem is designed as follows: [0185] to avoid a differential explosion phenomenon, the first-order filter is configured to acquire a smooth signal v.sub.c and a differential signal {dot over (v)}.sub.c of an expected velocity command v; and; [0186] the lumped disturbance force of the velocity control subsystem is estimated by an disturbance observer:

[00061]$\{\begin{array}{c}{\stackrel{}{e}}_v=\stackrel{}{v}-v\\ \stackrel{.}{\stackrel{}{v}}=g+\frac{1}{m}{f}_v-k_{v1}{\mathrm{sig}}^{\frac{1}{2}}\left({\stackrel{}{e}}_v\right)-{}_{v1}\left(1-\right){\mathrm{sig}}^{\frac{2+{}_v}{2}}\left({\stackrel{}{e}}_v\right)+{\stackrel{}{d}}_v\\ {\stackrel{.}{\stackrel{}{d}}}_v=-k_{v2}\mathrm{sign}\left({\stackrel{}{e}}_v\right)-{}_{v2}\left(1-\right){\mathrm{sig}}^{1+{}_v}\left({\stackrel{}{e}}_v\right)\end{array};$ [0187] where: [0188] {tilde over (e)}.sub.v represents an estimated error; [0189] {circumflex over (v)} and {circumflex over (d)}.sub.v represent an estimated velocity and the lumped disturbance force, respectively;

[00062]${}_v,{}_{v1},{}_{v2}>0,k_{v1}=1.5{\stackrel{}{d}}_v^{1/2},k_{v2}=1.1{\stackrel{}{d}}_v;$ [0190] d.sub.v represents an upper boundary of a change rate of the lumped disturbance force;

[00063]$=\{\begin{array}{cc}0,& t{T}_{v,0}\\ 1,& \mathrm{otherwise}\end{array};$ [0191] T.sub.v,o represent parameters of the disturbance observer.

[0192] The control law of the velocity control subsystem is:

[00064]${}^b{f}_{v,c}=G_v^{-1}\left(-k_v{e}_v-g-{\stackrel{}{d}}_v+{\stackrel{}{v}}_c-{}_p{}_p\right);$ [0193] where: [0194] e.sub.v=vv.sub.c=[e.sub.vx,e.sub.vy,e.sub.vz].sup.T represents a velocity tracking error; and [0195] k.sub.v represents a control gain.

[0196] The angular rate control subsystem is designed as follows: [0197] the first-order filter is also configured to acquire a smooth signal .sub.c and a differential signal {dot over ()}.sub.c of an expected angular rate command ; [0198] the lumped disturbance torque of the angular rate control subsystem is estimated by the disturbance observer:

[00065]$\{\begin{array}{c}{\stackrel{}{e}}_{}=\stackrel{}{}-\\ \stackrel{.}{\stackrel{}{}}=-J^{-1}J+J^{-1}{G}_a+J^{-1}-\\ k_1{\mathrm{sig}}^{\frac{1}{2}}\left({\stackrel{}{e}}_{}\right)-{}_1\left(1-\right){\mathrm{sig}}^{\frac{2+{}_{}}{2}}\left({\stackrel{}{e}}_{}\right)+{\stackrel{}{d}}_{}\\ {\stackrel{.}{\stackrel{}{d}}}_{}=-k_2\mathrm{sign}\left({\stackrel{}{e}}_{}\right)-{}_2\left(1-\right){\mathrm{sig}}^{1+{}_{}}\left({\stackrel{}{e}}_{}\right)\end{array};$ [0199] where: [0200] {tilde over (e)}.sub. represents an estimated error; [0201] {circumflex over ()} and {circumflex over (d)}.sub. represent an estimated angular rate and the lumped disturbance torque, respectively;

[00066]${}_{},{}_1,{}_2>0,k_1=1.5{\stackrel{}{d}}_{}^{1/2},k_2=1.1{\stackrel{}{d}}_{};$ [0202] d.sub. represents an upper boundary of a change rate of the lumped disturbance torque;

[00067]$=\{\begin{array}{cc}0,& t{T}_{,0}\\ 1,& \mathrm{otherwise}\end{array};$ [0203] T.sub.,o represent parameters of the disturbance observer.

[0204] The control law of the angular rate control subsystem is:

[00068]${}_c=G_{}^{-1}\left(-k_{}{e}_{}+J^{-1}J-J^{-1}{G}_a-{\stackrel{}{d}}_{}+{\stackrel{}{}}_c-{}_{}{}_{}\right);$ [0205] where: [0206] e.sub.=.sub.c=[e.sub.p,e.sub.q,e.sub.r].sup.T represents an angular rate tracking error; and [0207] k.sub. represents a control gain.

[0208] Further, according to the expected force and torque given by the velocity control subsystem and the angular rate control subsystem, a virtual control variable is calculated by means of pseudo-inverse control allocation:

[00069]$\stackrel{}{N}={\stackrel{}{A}}^{-1}\left[\begin{array}{c}{}^b{f}_v\\ \end{array}\right];$ [0209] after obtaining the virtual control variable N, a tilt angle of a rotor assembly and a rotor speed can be calculated.

[0210] The present disclosure is simulated and tested in the following simulation examples: an initial position of the aircraft is P=[0.5 m, 0.3 m, 1 m].sup.T, an initial velocity is v=[0.2 m/s, 0.3 m/s, 0.1 m/s].sup.T, an initial attitude angle is =[1, 20,1.2].sup.T, and an initial angular rate is =[0.2/s, 0.3/s, 0.1/s].sup.T.

[0211] The position and attitude angle commands are:

[00070]$P_d=\left[\begin{array}{c}\cos \left(0.5t\right)\\ \sin \left(0.5t\right)\\ 0.1t\end{array}\right]m,{}_d=\left[\begin{array}{c}0.3\cos \left(0.5t\right)\\ 0.3\sin \left(0.5t\right)\\ 0\end{array}\right]\mathrm{rad}.$

[0212] The disturbance force and the disturbance torque are set as:

[00071]$\{\begin{array}{c}{d}_{\mathrm{vx}}=\sin \left(0.4t\right)\\ d_{\mathrm{vy}}=1.2\sin \left(0.2t\right)\\ d_{\mathrm{vz}}=0.8\sin \left(0.2t\right)\end{array},\{\begin{array}{c}{d}_p=0.5\sin \left(0.6t\right)\\ d_q=0.6\sin \left(0.7t\right)\\ d_r=0.4\sin \left(0.8t\right)\end{array}.$

[0213] Referring to FIG. 4 to FIG. 9, a position tracking performance curve and a position tracking error curve shown in FIG. 4 and FIG. 5, an attitude angle tracking performance curve and an attitude angle tracking error curve shown in FIG. 6 and FIG. 7 can be found that the tracking error can be limited within the designed performance function boundary under the action of the designed method, and the aircraft can be better controlled. From the curves of the tilt angel of the rotor shown in FIGS. 8A-D and the curves of the rotor speed shown in FIGS. 9A-D, it can be found that the virtual control variable is smooth and within the feasible range.

[0214] Compared with the prior art, the method for controlling position and attitude separation of the tiltable rotorcraft provided by the present disclosure has the following advantages. [0215] 1. For a research object, i.e., a tiltable rotorcraft, a practical method for controlling position and attitude separation is proposed. Moreover, the proposed method can ensure that the errors of position and attitude angle commands are limited in the pre-designed performance envelope at the same time, and higher control performance can be obtained. [0216] 2. The expected command can be corrected by the capacity prediction module, the module, by considering the actual control capacity of the aircraft system, can correct the command beyond the control capacity range at an upper level, thus effectively avoiding a catastrophic consequence such as controller instability caused by control saturation and other problems. [0217] 3. The system has an open architecture and is composed of the capability prediction module, the first-order filter, the disturbance observer and the control law. The capability prediction module, the filter and the disturbance observer are not limited to the methods used here, and can be quickly replaced according to the actual task requirements on the premise of ensuring consistent interfaces.

[0218] In conclusion, the method for controlling position and attitude separation of a tiltable rotorcraft provided by the present disclosure has the advantages of high robustness and strong expansibility, which can be widely used in various practical task scenarios of the tiltable rotorcraft, and is a valuable and innovative research achievement.

[0219] Through the description of the above embodiments, those skilled in the art can clearly understand that above embodiment methods may be implemented by software and a necessary universal hardware platform. Certainly, the embodiment methods may also be implemented by hardware, but in many cases the former is a better implementation. Based on such an understanding, the essence of the technical solution, or the part contributing to the prior art, of the present disclosure may be implemented in the form of a software product. The software product may be stored in a storage medium (such as ROM (Read-only memory)/RAM (Random access memory), a magnetic disk, an optical disk), and include several commands for indicating a terminal device (which may be an aircraft, or a flight simulation computer) to execute all methods described in the embodiments of the present disclosure.

[0220] The above is only the preferred embodiment of the present disclosure and is not intended to limit the patent scope of the present disclosure. Any equivalent structure or equivalent flow transformation made by using the contents of this specification and accompanying drawings of the present disclosure, or directly or indirectly used in other related technical fields, are equally included in the patent protection scope of the present disclosure.