Tandem Rotor Unmanned Aerial Vehicle and Attitude Adjustment Control Method

Information

  • Patent Application
  • 20230312143
  • Publication Number
    20230312143
  • Date Filed
    March 31, 2023
    a year ago
  • Date Published
    October 05, 2023
    7 months ago
Abstract
The present disclosure provides a tandem rotor unmanned aerial vehicle, which includes a vehicle body, a flight control system, and a propulsion system. The propulsion system includes a front distributed propulsion system and a rear distributed propulsion system. The front distributed propulsion system is arranged at a front end of the vehicle body. The rear distributed propulsion system is arranged a rear end of the vehicle body. The front distributed propulsion system includes rotor blades, a rotor nose, a main shaft, a speed reducer, a synchronizer, a motor, and a periodic variable pitch mechanism. A polar attitude of the tandem rotor unmanned aerial vehicle of the present disclosure can be adjusted conveniently and stably in the air, and the adjustment efficiency is high. The present disclosure further provides an attitude adjustment control method for the tandem rotor unmanned aerial vehicle.
Description
CROSS-REFERENCE TO RELATED APPLICATION

This patent application claims the benefit and priority of Chinese Patent Application No. 202210351390.1, filed with the China National Intellectual Property Administration on Apr. 2, 2022, the disclosure of which is incorporated by reference herein in its entirety as part of the present application.


TECHNICAL FIELD

The present disclosure relates to the technical field of unmanned aerial vehicles, and in particular, to a tandem rotor unmanned aerial vehicle and an attitude adjustment control method.


BACKGROUND

In environments of complex terrain, wide space, rapid emergency rescue, and the like, unmanned aerial vehicles which can respond quickly and are launched by cartridge ejection or box emission are applied more and more widely. In order to facilitate carrying and storage, wings are folded before the unmanned aerial vehicles are launched, and are unfolded after the unmanned aerial vehicles are ejected or rockets are launched to a certain height or distance. The unmanned aerial vehicles launched by ejection or booster rocket emission have become a major development and application direction of rapidly deployed emergency rescue or disaster relief unmanned aerial vehicles.


Compared with a fixed-wing unmanned aerial vehicle, a tandem rotor unmanned aerial vehicle has the characteristics of large load, high hover efficiency, and the like. Therefore, it is applied more in scenarios such as emergency rescue delivery and material delivery. However, most of the existing unmanned aerial vehicles that are launched by cartridge ejection or box emission have fixed wings, which are difficult to give full play to the advantages of rotorcrafts in application scenarios such as maritime or mountain emergency rescue. Therefore, taking off the tandem rotor unmanned aerial vehicle in an ejection mode is a hot spot of current engineering research. The fastness and the reliability of the unfolding of a rotor of the tandem rotor unmanned aerial vehicle after being launched have problems about attitude stability and the like because the unmanned aerial vehicle is affected by various factors during an unfolding stage of the rotor. Complex problems such as the stability and the robustness of attitude control of the tandem rotor unmanned aerial vehicle need to be solved urgently.


SUMMARY

The present disclosure aims to overcome at least one of the technical defects in the related art.


In view of this, a purpose of the present disclosure is to provide a tandem rotor unmanned aerial vehicle to solve the problem mentioned in the BACKGROUND and overcome the deficiencies in the related art.


In order to achieve the abovementioned purpose, an embodiment in an aspect of the present disclosure is to provide a tandem rotor unmanned aerial vehicle, which includes a vehicle body, a flight control system, and a propulsion system. The propulsion system includes a front distributed propulsion system and a rear distributed propulsion system. The front distributed propulsion system is arranged at a front end of the vehicle body. The rear distributed propulsion system is arranged a rear end of the vehicle body. The front distributed propulsion system includes rotor blades, a rotor nose, a main shaft, a speed reducer, a synchronizer, a motor, and a periodic variable pitch mechanism. The rotor blades are connected to the rotor nose. The rotor nose is connected to the main shaft. An output end of the motor is connected to the speed reducer. The speed reducer is connected to the synchronizer. The main shaft is connected to the speed reducer. The motor drives the main shaft to rotate through the speed reducer. The periodic variable pitch mechanism includes a steering engine set and an automatic tilter. An output end of the steering engine set is connected to the automatic tilter. The automatic tilter is arranged on the main shaft in a sleeving manner. The automatic tilter is connected to the rotor nose. The automatic tilter changes tilt directions of the rotor blades through the rotor nose. The steering engine set includes three steering engines. The flight control system controls the motor and the steering engine set to realize attitude adjustment of the tandem rotor unmanned aerial vehicle.


Preferably, the rear distributed propulsion system has the same structure as the front distributed propulsion system.


In any of the above solutions, preferably, the flight control system controls an attitude adjustment loop of the tandem rotor unmanned aerial vehicle by combining a linear quadratic regulation algorithm and an L1 adaptive control algorithm to realize attitude adjustment of the tandem rotor unmanned aerial vehicle and ensure robust control of the attitude adjustment, which includes:

    • establishing a transverse and longitudinal linearization model of the tandem rotor unmanned aerial vehicle in different flight conditions, and designing a state feedback gain matrix of the transverse and longitudinal linearization model by using the linear quadratic regulation algorithm;
    • designing a full-order state observer according to the transverse and longitudinal linearization model, and combining an observation state quantity value output by the full-order state observer and a measurement value of a sensor to obtain an estimated value of a state variable and an estimated error of the state variable;
    • designing a parameter adaptive law to obtain an estimated value of a disturbance parameter according to the estimated error of the state variable;
    • designing an L1 adaptive controller of a transverse and longitudinal motion system to obtain a control input quantity according to the estimated value of the disturbance parameter, the estimated value of the state variable, the estimated error of the state variable, and a received desired attitude command signal; and
    • controlling the tandem rotor unmanned aerial vehicle to complete attitude adjustment according to the control input quantity.


In any of the above solutions, preferably, the transverse and longitudinal linearization model includes a lateral linearization model and a longitudinal linearization model. The control input quantity includes a lateral motion control input quantity and a longitudinal motion control input quantity. The L1 adaptive controller of the transverse and longitudinal motion system includes an L1 adaptive controller of a lateral motion system and an L1 adaptive controller of a longitudinal motion system. The L1 adaptive controller of the lateral motion system outputs the lateral motion control input quantity. The lateral motion control input quantity includes a transverse periodic variable pitch input quantity and a yaw control quantity. The L1 adaptive controller of the longitudinal motion system outputs the longitudinal motion control input quantity. The longitudinal motion control input quantity includes a collective pitch input quantity and a longitudinal periodic variable pitch input quantity. The state variable includes a transverse motion state variable and a longitudinal motion state variable. The full-order state observer includes a longitudinal full-order state observer and a lateral full-order state observer.


In any of the above solutions, preferably, the longitudinal linearization model of the tandem rotor unmanned aerial vehicle is expressed as:






{dot over (x)}θ
v(t)=Aθvxθv(t)+bθv(ω(t)u(t)+θT(t)xθv(t)+σ(t))






y
θ

v
(t)=cθvTxθv(t)


In the formula, xθv(y) is the longitudinal motion state variable, {dot over (x)}θv(t) is a change rate of the longitudinal motion state variable, yθv(t) is a pitch attitude angle output quantity, Aθv is a longitudinal system state spatial matrix, bθv is a longitudinal system state input matrix, and ω(t) is an input weight and is used for compensating an error of a system input matrix; u(t) is a longitudinal variable pitch input quantity, θ(t) is a longitudinal motion model disturbance parameter, θT(t) is a transpose of θ(t), σ(t) is an external environment disturbance parameter, cθvT is a longitudinal system state output matrix, and t is a time parameter.


For the longitudinal linearization model, an indicator function related to the longitudinal motion state variable and the longitudinal motion control input quantity is fit:






J=∫(xTQx+uTRu)dt


J is the indicator function, x is an error quantity matrix between a desired longitudinal motion state variable and a real longitudinal motion state variable, xT is a transpose of x, u is a collective pitch input quantity and a longitudinal periodic variable pitch input matrix, and uT is a transpose of u; Q is a longitudinal motion state variable weighted parameter matrix, R is a weighted parameter matrix of the longitudinal motion control input quantity, u=−Kmx, Km is a feedback gain matrix, and the solution of the feedback gain matrix Km in the linear quadratic regulation algorithm is:






K
m
=R
−1
b
θ

v

T
P


Where R−1 is an inverse of R, bθvT is a transpose of bθv, P is an intermediate parameter matrix, and P is obtained by solving the following Riccati equation:






A
θ

v

T
P+PA
θ

v

−Pb
θ

v

R
−1
b
θ

v

P+Q=0


Where AθvT is a transpose of Aθv.


A longitudinal linearization model with a longitudinal motion state variable feedback is expressed as:






{dot over (x)}θ
v(t)=Amxθv(t)+bθv(ω(t)u(t)+θT(t)xθv(t)+σ(t))






y
θ

v
(t)=cθvTxθv(t)






A
m
=A
θ

v

−b
θ

v

K
m


Where Am is a longitudinal system state spatial feedback matrix.


In any of the above solutions, preferably, a specific expression formula of the longitudinal full-order state observer is as follows:





{circumflex over ({dot over (x)})}θv(t)=Aθv{circumflex over (x)}θv(t)+bθv({circumflex over (ω)}(t)u(t)+{circumflex over (θ)}T(t)xθv(t)+{circumflex over (σ)}(t))






ŷ
θ

v
(t)=cθvT{circumflex over (x)}θv(t)


Where {circumflex over (x)}θv(t) is an estimated value of the longitudinal motion state variable, {circumflex over ({dot over (x)})}θv(t) is a change rate of the estimated value of the longitudinal motion state variable, {circumflex over (ω)}(t) is an input weighted estimated value, {circumflex over (θ)}T(t) is an estimated value of θT(t), {circumflex over (σ)}(t) is an estimated value of the external environment disturbance parameter; ŷθv(t) is an estimated value of a pitch attitude angle, and the estimated value {circumflex over (x)}θv(t) of the longitudinal motion state variable is calculated.


An estimated error of the longitudinal motion state variable is as follows:





{tilde over ({dot over (x)})}θv(t)=Aθv{tilde over (x)}θv(t)+bθv({tilde over (ω)}(t)u(t)+{tilde over (θ)}T(t)xθv(t)+{tilde over (σ)}(t))






{tilde over (x)}
θ

v
(0)=0





{tilde over (θ)}(t)={circumflex over (θ)}(t)−θ(t)






{tilde over (x)}
θ

v
(t)={circumflex over (x)}θv(t)−xθv(t)





{tilde over (ω)}(t)={circumflex over (ω)}(t)−ω(t)





{tilde over (σ)}(t)={circumflex over (σ)}(t)−σ(t)

    • wherein {tilde over ({dot over (x)})}θv(t) is a change rate of the estimated error of the longitudinal motion state variable, {tilde over (x)}θv (t) is the estimated error of the longitudinal motion state variable, {tilde over (ω)}(t) is an input weighted estimated error, {circumflex over (θ)}(t) is an estimated value of the longitudinal motion model disturbance parameter, {tilde over (θ)}(t) is an estimated error of the longitudinal motion model disturbance parameter, and {tilde over (σ)}(t) is an estimated error of the external environment disturbance parameter;


In any of the above solutions, preferably, the parameter adaptive law is designed to obtain {circumflex over (θ)}(t), {circumflex over (σ)}(t), and {circumflex over (ω)}(t) according to the estimated error of the longitudinal motion state variable; and an adaptive law calculation formula is as follows:





{circumflex over ({dot over (θ)})}(t)=ΓProj({circumflex over (θ)}(t),−custom-character(t)Pbθvxθv(t)),{circumflex over (θ)}(0)={circumflex over (θ)}0





{circumflex over ({dot over (σ)})}(t)=ΓProj({circumflex over (σ)}(t),−{tilde over (x)}θvT(t)Pbθv),{circumflex over (σ)}(0)={circumflex over (σ)}0





{circumflex over ({dot over (ω)})}(t)=ΓProj({circumflex over (ω)}(t),−{tilde over (x)}θvT(t)Pbθvuad(t)),{circumflex over (ω)}(0)={circumflex over (ω)}0


Where {circumflex over ({dot over (θ)})}(t) is a change rate of the estimated value of the longitudinal motion model disturbance parameter, {circumflex over ({dot over (σ)})}(t) is a change rate of the estimated value of the external environment disturbance parameter, and {circumflex over ({dot over (ω)})}(t) is a change rate of the input weighted estimated value.


The L1 adaptive controller of the longitudinal motion system is designed and the longitudinal motion control input quantity is output according to the estimated value {circumflex over (θ)}(t) of the longitudinal motion model disturbance parameter, the estimated value {circumflex over (σ)}(t) of the external environment disturbance parameter, the input weighted estimated value {circumflex over (ω)}(t), the estimated value {circumflex over (x)}θv(t) of the longitudinal motion state variable, the estimated error {tilde over (x)}θv(t) of the longitudinal motion state variable, and the received desired attitude command signal.


In any of the above solutions, preferably, a specific form of the designed L1 adaptive controller uad(t) is as follows:






u
ad(s)=−kD(s)({circumflex over (η)}(s)−kgr(s))


Where uad(t) is a combination of the longitudinal periodic variable pitch input quantity and the collective pitch input quantity, uad(s) is the Laplace transform of uad(t), r(s) is the Laplace transform of a command input r(t), {circumflex over (η)}(s) is the Laplace transform of {circumflex over (η)}(t), and {circumflex over (η)}(t)={circumflex over (ω)}(t)uad(t)+{circumflex over (θ)}Txθv(t)+{circumflex over (σ)}(t) kg is a gain of the command input, and kg=−1/(cθvT Am−1bθv); and D(s) is a strictly positive real transfer function,








D

(
s
)

=

1
s


,




s expresses a s domain, and k is an adaptive feedback gain.


The present disclosure further discloses an attitude adjustment control method for a tandem rotor unmanned aerial vehicle. The method controls an attitude adjustment loop of the tandem rotor unmanned aerial vehicle by combining a linear quadratic regulation algorithm and an L1 adaptive control algorithm to realize attitude adjustment of the tandem rotor unmanned aerial vehicle and ensure robust control of the attitude adjustment, which specifically includes:


S1: establishing a transverse and longitudinal linearization model of the tandem rotor unmanned aerial vehicle in different flight conditions, and designing a state feedback gain matrix for the transverse and longitudinal linearization model through a Linear Quadratic Regulator (LQR).


S2: designing a longitudinal full-order state observer according to the transverse and longitudinal linearization model established in S1, and combining with a measurement value of a sensor to obtain an estimated value of a state variable and an estimated error of the state variable;


S3: designing a parameter adaptive law to obtain an estimated value of a disturbance parameter according to the estimated error of the state variable obtained in S2;


S4: designing an L1 adaptive controller of a transverse and longitudinal motion system to obtain a control input quantity according to the estimated value of the disturbance parameter obtained in S3, the estimated value of the state variable obtained in S2, the estimated error of the state variable, and a received desired attitude command signal; and


S5: controlling the tandem rotor unmanned aerial vehicle to complete attitude adjustment according to the control input quantity.


Preferably, the transverse and longitudinal linearization model includes a lateral linearization model and a longitudinal linearization model. The control input quantity includes a lateral motion control input quantity and a longitudinal motion control input quantity. The L1 adaptive controller of the transverse and longitudinal motion system includes an L1 adaptive controller of a lateral motion system and an L1 adaptive controller of a longitudinal motion system. The L1 adaptive controller of the lateral motion system outputs the lateral motion control input quantity. The lateral motion control input quantity includes a transverse periodic variable pitch input quantity and a yaw control quantity. The L1 adaptive controller of the longitudinal motion system outputs the longitudinal motion control input quantity. The longitudinal motion control input quantity includes a collective pitch input quantity and a longitudinal periodic variable pitch input quantity. The state variable includes a transverse motion state variable and a longitudinal motion state variable. The full-order state observer includes a longitudinal full-order state observer and a lateral full-order state observer.


In any of the above solutions, preferably, after S1, the method further includes:


S11: expressing the longitudinal linearization model of the tandem rotor unmanned aerial vehicle as:






{dot over (x)}θ
v(t)=Aθvxθv(t)+bθv(ω(t)u(t)+θT(t)xθv(t)+σ(t))






y
θ

v
(t)=cθvTxθv(t)


In the formula, xθv(t) is the longitudinal motion state variable, {dot over (x)}θv(t) is a change rate of the longitudinal motion state variable, yθv(t) is a pitch attitude angle output quantity, Aθv is a longitudinal system state spatial matrix, bθv is a longitudinal system state matrix; and ω(t) is an input weight and is used for compensating an error of a system input matrix; u(t) is a longitudinal variable pitch input quantity, θ(t) is a longitudinal motion model disturbance parameter, θT(t) is a transposition of θ(t), σ(t) is an external environment disturbance parameter, cθvT is a longitudinal system state output matrix, and t is a time parameter.


For the longitudinal linearization model, an indicator function related to the longitudinal motion state variable and the longitudinal motion control input quantity is fit:






J=∫(xTQx+uTRu)dt


J is the indicator function, x is an error quantity matrix between a desired longitudinal motion state variable and a real longitudinal motion state variable, xT is a transpose of x, u is a collective pitch input quantity and a longitudinal periodic variable pitch input matrix, and uT is a transpose of u; Q is a longitudinal motion state variable weighted parameter matrix, R is a weighted parameter matrix of the longitudinal motion control input quantity, u=−Kmx, Km is a feedback gain matrix, and the solution of the feedback gain matrix Km in the linear quadratic regulation algorithm is:






K
m
=R
−1
b
θ

v

T
P


Where R−1 is an inverse of R, bθvT is a transpose of bθv, P is an intermediate parameter matrix, and P is obtained by solving the following Riccati equation:






A
θ

v

T
P+PA
θ

v

−Pb
θ

v

R
−1
b
θ

v

P+Q=0


Where AθvT is a transpose of Aθv.


The longitudinal linearization model with a longitudinal motion state variable feedback is expressed as:






{dot over (x)}θ
v(t)=Amxθv(t)+bθv(ω(t)u(t)+θT(t)xθv(t)+σ(t))






y
θ

v
(t)=cθvTxθv(t)






A
m
=A
θ

v

−b
θ

v

K
m


Where Am is a longitudinal system state spatial feedback matrix.


In any of the above solutions, preferably, after S2, the method further includes S21: a specific expression formula of the longitudinal full-order state observer is as follows:





{circumflex over ({dot over (x)})}θv(t)=Aθv{circumflex over (x)}θv(t)+bθv({circumflex over (ω)}(t)u(t)+{circumflex over (θ)}T(t)xθv(t)+{circumflex over (σ)}(t))






ŷ
θ

v
(t)=cθvT{circumflex over (x)}θv(t)


Where {circumflex over (x)}θv(t) is an estimated value of the longitudinal motion state variable, {circumflex over ({dot over (x)})}θv(t) is a change rate of the estimated value of the longitudinal motion state variable, {circumflex over (ω)}(t) is an input weighted estimated value, {circumflex over (θ)}T(t) is an estimated value of θT(t), and {circumflex over (σ)}(t) is an estimated value of the external environment disturbance parameter; and ŷθv(t) is an estimated value of a pitch attitude angle, and the estimated value {circumflex over (x)}θv(t) of the longitudinal motion state variable is calculated.


An estimated error of the longitudinal motion state variable is as follows:





{tilde over ({dot over (x)})}θv(t)=Aθv{tilde over (x)}θv(t)+bθv({tilde over (ω)}(t)u(t)+{tilde over (θ)}T(t)xθv(t)+{tilde over (σ)}(t))






{tilde over (x)}
θ

v
(0)=0





{tilde over (θ)}(t)={circumflex over (θ)}(t)−θ(t)






{tilde over (x)}
θ

v
(t)={circumflex over (x)}θv(t)−xθv(t)





{tilde over (ω)}(t)={circumflex over (ω)}(t)−ω(t)





{tilde over (σ)}(t)={circumflex over (σ)}(t)−σ(t)


Where {tilde over ({dot over (x)})}θv(t) is a change rate of the estimated error of the longitudinal motion state variable, {tilde over (x)}θv (t) is the estimated error of the longitudinal motion state variable, {tilde over (ω)}(t) is an input weighted estimated error, {circumflex over (θ)}(t) is an estimated value of the longitudinal motion model disturbance parameter, {tilde over (θ)}(t) is an estimated error of the longitudinal motion model disturbance parameter, and {tilde over (σ)}(t) is an estimated error of the external environment disturbance parameter.


In any of the above solutions, preferably, after S3, the method further includes S31: designing the parameter adaptive law to obtain {circumflex over (θ)}(t), {circumflex over (σ)}(t), and {circumflex over (ω)}(t) according to the estimated error of the longitudinal motion state variable; and an adaptive law calculation formula is as follows:





{circumflex over ({dot over (θ)})}(t)=ΓProj({circumflex over (θ)}(t),−custom-character(t)Pbθvxθv(t)),{circumflex over (θ)}(0)={circumflex over (θ)}0





{circumflex over ({dot over (σ)})}(t)=ΓProj({circumflex over (σ)}(t),−{tilde over (x)}θvT(t)Pbθv),{circumflex over (σ)}(0)={circumflex over (σ)}0





{circumflex over ({dot over (ω)})}(t)=ΓProj({circumflex over (ω)}(t),−{tilde over (x)}θvT(t)Pbθvuad(t)),{circumflex over (ω)}(0)={circumflex over (ω)}0


Where {circumflex over ({dot over (θ)})}(t) is a change rate of the estimated value of the longitudinal motion model disturbance parameter, {circumflex over ({dot over (σ)})}(t) is a change rate of the estimated value of the external environment disturbance parameter, and {circumflex over ({dot over (ω)})}(t) is a change rate of the input weighted estimated value.


The L1 adaptive controller of the longitudinal motion system is designed and the longitudinal motion control input quantity is output according to the estimated value {circumflex over (θ)}(t) of the longitudinal motion model disturbance parameter, the estimated value {circumflex over (σ)}(t) of the external environment disturbance parameter, the input weighted estimated value {circumflex over (ω)}(t), the estimated value {circumflex over (x)}θv(t) of the longitudinal motion state variable, the estimated error {tilde over (x)}θv(t) of the longitudinal motion state variable, and the received desired attitude command signal.


In any of the above solutions, preferably, after S4, the method further includes S41: designing a specific formula of the L1 adaptive controller of the longitudinal motion system as follows:






u
ad(s)=−kD(s)({circumflex over (η)}(s)−kgr(s))


Where uad(t) is a combination of the longitudinal periodic variable pitch input quantity and the collective pitch input quantity, uad(s) is the Laplace transform of uad(t), r(s) is the Laplace transform of a command input r(t), {circumflex over (η)}(s) is the Laplace transform of {circumflex over (η)}(t), {circumflex over (η)}(t)={circumflex over (ω)}(t)uad(t)+{circumflex over (θ)}Txθv(t)+{circumflex over (σ)}(t); kg is a gain of the command input, and kg=−1/(cθvTAm−1bθv); and D(s) is a strictly positive real transfer function,








D

(
s
)

=

1
s


,




s expresses a s domain, and k is an adaptive feedback gain.


Compared with the related art, the present disclosure has the advantages and beneficial effects that:

    • 1. The tandem rotor unmanned aerial vehicle of the present disclosure has a simple structure. The rotor blades are connected to the rotor nose. The rotor blades are subjected to folding and unfolding positioning through a hinge mechanism and a spring buckle locking mechanism. The flight control system controls the motor and the periodic variable pitch mechanism to realize the attitude adjustment of the tandem rotor unmanned aerial vehicle. The structure transmission is stable, so that the tandem rotor unmanned aerial vehicle can perform fast unfolding and adjustment of the rotors in the air, and the adjustment is more stable.
    • 2. The attitude adjustment control method for the tandem rotor unmanned aerial vehicle of the present disclosure controls the rotating speed of the motor of a propulsion system and the periodic variable pitch mechanism through a pre-designed attitude control law, so as to realize fast unfolding and attitude adjustment control of the rotors of the tandem rotor unmanned aerial vehicle. The control is stable, the control efficiency is high, and robust and reliable control is provided for the unfolding and attitude adjustment of the rotors of the tandem rotor unmanned aerial vehicle.


Additional aspects and advantages of the present disclosure will be partially set forth in the following description, and some will become apparent from the following description, or will be understood by the practice of the present disclosure.





BRIEF DESCRIPTION OF THE DRAWINGS

The above and/or additional aspects and advantages of the present disclosure will become apparent and readily understood from the description of the embodiments in combination with the accompanying drawings.



FIG. 1 is a schematic structural diagram of a tandem rotor unmanned aerial vehicle according to an embodiment of the present disclosure.



FIG. 2 is a schematic structural diagram of the front distributed propulsion system in the tandem rotor unmanned aerial vehicle according to an embodiment of the present disclosure.



FIG. 3 is a main view of the front distributed propulsion system of the tandem rotor unmanned aerial vehicle according to an embodiment of the present disclosure.



FIG. 4 is a schematic diagram of an L1 adaptive control structure in an attitude adjustment control method for a tandem rotor unmanned aerial vehicle.



FIG. 5 is a simulation diagram of a pitch angle 10° step response of an attitude loop of a tandem rotor unmanned aerial vehicle according to an embodiment of the present disclosure.



FIG. 6 is simulation diagram of a longitudinal periodic variable pitch input quantity during pitch angle step response control of a tandem rotor unmanned aerial vehicle according to an embodiment of the present disclosure.



FIG. 7 is a simulation diagram of a roll angle stable control response of a 10° disturbance of a tandem rotor unmanned aerial vehicle according to an embodiment of the present disclosure.



FIG. 8 is a simulation diagram of a transverse periodic variable pitch input quantity during roll angle stable control of a 10° disturbance of a tandem rotor unmanned aerial vehicle according to an embodiment of the present disclosure.



FIG. 9 is a simulation diagram of a yaw rate stable control response of a 1°/s disturbance of a tandem rotor unmanned aerial vehicle according to an embodiment of the present disclosure.



FIG. 10 is a simulation diagram of a yaw control input during yaw rate stable control of a 1°/s disturbance of a tandem rotor unmanned aerial vehicle according to an embodiment of the present disclosure.



FIG. 11 is a simulation diagram of a pitch angle output tracking response after a rotor of a tandem rotor unmanned aerial vehicle according to an embodiment of the present disclosure is unfolded.



FIG. 12 is a simulation diagram of a roll angle output tracking response of a tandem rotor unmanned aerial vehicle according to an embodiment of the present disclosure.



FIG. 13 is a simulation diagram of a yaw angle output tracking response of a tandem rotor unmanned aerial vehicle according to an embodiment of the present disclosure.





REFERENCE SIGNS IN THE DRAWINGS


1—vehicle body; 2—rotor blade; 3—rotor nose; 4—main shaft; 5—speed reducer; 6—synchronizer; 7—motor; 8—automatic tilter; and 9—steering engine.


DETAILED DESCRIPTION OF THE EMBODIMENTS

The embodiments of the present disclosure are described in detail below, and the examples of the embodiments are illustrated in the drawings, where the same or similar reference numerals throughout refer to the same or similar elements or elements having the same or similar functions. The embodiments described below with reference to the drawings are intended to be illustrative of the present disclosure and are not to be construed as a limitation to the present disclosure.


As shown in FIG. 1 to FIG. 3, a tandem rotor unmanned aerial vehicle according to an embodiment of the present disclosure includes a vehicle body 1, a flight control system, and a propulsion system. The propulsion system includes a front distributed propulsion system and a rear distributed propulsion system. The front distributed propulsion system is arranged at a front end of the vehicle body. The rear distributed propulsion system is arranged a rear end of the vehicle body. The front distributed propulsion system includes rotor blades 2, a rotor nose 3, a main shaft 4, a speed reducer 5, a synchronizer 6, a motor 7, and a periodic variable pitch mechanism. The rotor blades 2 are connected to the rotor nose 3. The rotor nose 3 is connected to the main shaft 4. An output end of the motor 7 is connected to the speed reducer 5. The speed reducer 5 is connected to the synchronizer 6. The main shaft 4 is connected to the speed reducer 5. The motor 7 drives the main shaft 4 to rotate through the speed reducer 5. The periodic variable pitch mechanism includes a steering engine set and an automatic tilter 8. An output end of the steering engine set is connected to the automatic tilter. The automatic tilter 8 is arranged on the main shaft 4 in a sleeving manner. The automatic tilter 8 is connected to the rotor nose 3. The automatic tilter 8 changes tilt directions of the rotor blades 2 through the rotor nose 3. The steering engine set includes three steering engines 9. An output end of each steering engine 9 is connected to the automatic tilter 8. The flight control system controls the motor and the steering engine set to realize attitude adjustment of the tandem rotor unmanned aerial vehicle.


The tandem rotor unmanned aerial vehicle of the present disclosure is simple in structure. During launching, unfolding actions of the rotors can be performed quickly, and a flight attitude can be adjusted in time through the periodic variable pitch mechanism, so the flight is safer and more stable.


Further, the rear distributed propulsion system has the same structure as the front distributed propulsion system.


After a booster rocket falls off, the flight control system controls the motor to drive the main shaft to rotate. The main shaft drives the rotors to unfold and rotate, and meanwhile, the tandem rotor unmanned aerial vehicle starts to perform attitude adjustment until a desired attitude is reached.


Specifically, the flight control system controls an attitude adjustment loop of the tandem rotor unmanned aerial vehicle by combining a linear quadratic regulation algorithm and an L1 adaptive control algorithm to realize attitude adjustment of the tandem rotor unmanned aerial vehicle and ensure robust control of the attitude adjustment, which includes that:

    • a transverse and longitudinal linearization model of the tandem rotor unmanned aerial vehicle in different flight conditions is established, and a state feedback gain matrix of the transverse and longitudinal linearization model is designed by using the linear quadratic regulation algorithm;
    • a full-order state observer is designed according to the transverse and longitudinal linearization model, and an observation state quantity value output by the full-order state observer and a measurement value of a sensor are combined to obtain an estimated value of a state variable and an estimated error of the state variable; the sensor is an attitude sensor, and is mounted inside the vehicle body to measure a real attitude value of the rotor unmanned aerial vehicle;
    • a parameter adaptive law is designed to obtain an estimated value of a disturbance parameter according to the estimated error of the state variable;
    • an L1 adaptive controller of a transverse and longitudinal motion system is designed to obtain a control input quantity according to the estimated value of the disturbance parameter, the estimated value of the state variable, the estimated error of the state variable, and a received desired attitude command signal; and
    • the tandem rotor unmanned aerial vehicle is controlled to complete attitude adjustment according to the control input quantity.


Specifically, the transverse and longitudinal linearization model includes a lateral linearization model and a longitudinal linearization model. The control input quantity includes a lateral motion control input quantity and a longitudinal motion control input quantity. The L1 adaptive controller of the transverse and longitudinal motion system includes an L1 adaptive controller of a lateral motion system and an L1 adaptive controller of a longitudinal motion system. The L1 adaptive controller of the lateral motion system outputs the lateral motion control input quantity. The lateral motion control input quantity includes a transverse periodic variable pitch input quantity and a yaw control quantity. The L1 adaptive controller of the longitudinal motion system outputs the longitudinal motion control input quantity. The longitudinal motion control input quantity includes a collective pitch input quantity and a longitudinal periodic variable pitch input quantity. The state variable includes a transverse motion state variable and a longitudinal motion state variable. The full-order state observer includes a longitudinal full-order state observer and a lateral full-order state observer.


The motor and the steering engine set are controlled according to the lateral motion control input quantity and the longitudinal motion control input quantity to realize quick attitude adjustment of the tandem rotor unmanned aerial vehicle.


An attitude adjustment control method for a tandem rotor unmanned aerial vehicle of an embodiment of the present disclosure has high control efficiency, greatly improves the stability and the robustness of attitude control, reduces the attitude adjustment failure rate in more launching processes, meanwhile, reduces more fuel cost, and has higher control accuracy.


Further, a longitudinal linearization model of the tandem rotor unmanned aerial vehicle is expressed as:






{dot over (x)}θ
v(t)=Aθvxθv(t)+bθv(ω(t)u(t)+θT(t)xθv(t)+σ(t))






y
θ

v
(t)=cθvTxθv(t)


In the formula, xθv(t) is a longitudinal motion state variable. The longitudinal motion state variable includes: a forward speed quantity, a vertical speed quantity, a pitch rate quantity, and a pitch angle quantity. {dot over (x)}θv(t) is a change rate of the longitudinal motion state variable, yθv(t) is a pitch attitude angle output quantity, Aθv is a longitudinal system state spatial matrix, bθv is a longitudinal system state input matrix, and ω(t) is an input weight and is used for compensating an error of a system input matrix; u(t) is a longitudinal variable pitch input quantity, θ(t) is a longitudinal motion model disturbance parameter, that is, a system error of a longitudinal motion model, θT(t) is a transpose of θ(t), σ(t) is an external environment disturbance parameter, that is, an influence error of the rotor unmanned aerial vehicle caused by external environment factors, cθvT is a longitudinal system state output matrix, and t is a time parameter.


Specifically, xθv(t) is a column vector of 1×4, and θ(t) is a weighted parameter row vector of 1×4.


It is necessary to assume that the parameters in the model satisfy the following conditions:


Assumption 1: parameters θ(t) and σ(t) satisfy: θ(t)∈Θ, |σ(t)|≤Δ0, ∀t≥0, where Θ is a known convex set, and Δ0∈R+.


Assumption 2: parameters θ(t) and σ(t) are continuously differentiable and uniformly bounded:





∥{dot over (θ)}(t)∥≤dθ<∞,|{dot over (σ)}(t)|≤dσ<∞,∀t≥0


Assumption 3: the weighted parameter ω∈R satisfies: ω∈Ω0∈[ω1 ωu].


For the longitudinal linearization model of the present disclosure, all assumptions above can be satisfied to ensure the reliability of the model.


For the longitudinal linearization model, an indicator function related to the longitudinal motion state variable and the longitudinal motion control input quantity is fit:






J=∫(xTQx+uTRu)dt


J is the indicator function, x is an error quantity matrix between a desired longitudinal motion state variable and a real longitudinal motion state variable, xT is a transpose of x, u is a collective pitch input quantity and a longitudinal periodic variable pitch input matrix, and uT is a transpose of u; Q is a longitudinal motion state variable weighted parameter matrix, R is a weighted parameter matrix of the longitudinal motion control input quantity, u=−Kmx, specifically, Q is a 4×4 weighted parameter matrix, R is a 2×2 weighted parameter matrix, Km is a feedback gain matrix, and Q and R in the indicator function respectively realize the weighting of the longitudinal motion state variable and the longitudinal periodic variable pitch input quantity. Both matrix Q and matrix R are diagonal positive semi-definite matrixes, elements on a diagonal line of the matrix Q directly affect the convergence rate of the corresponding longitudinal motion state variable, and elements on a diagonal line of the matrix R directly affect the energy magnitude of the longitudinal periodic variable pitch input quantity. The higher the convergence rate of the longitudinal motion state variable, the greater the energy of the longitudinal periodic variable pitch input quantity, and the higher the requirement on actuators such as a steering engine. The optimal control of a Linear Quadratic Regulator (LQR) is to select Q and R in advance according to a real model case to find out an appropriate feedback gain matrix Km, and a feedback control input u=−Kmx thereof optimizes the indicator function J; and the indicator function J is optimal when reaching a minimum value, and the optimal represents the most energy-saving state of the model.


The solution of the feedback gain matrix Km in the linear quadratic regulation algorithm is:






K
m
=R
−1
b
θ

v

T
P


Where R−1 is an inverse of R, bθvT is a transpose of bθv, P is an intermediate parameter matrix, and P is obtained by solving the following Riccati equation:






A
θ

v

T
P+PA
θ

v

−Pb
θ

v

R
−1
b
θ

v

P+Q=0


Where AθvT is a transpose of Aθv,


The longitudinal linearization model with a longitudinal motion state variable feedback is expressed as:






{dot over (x)}θ
v(t)=Amxθv(t)+bθv(ω(t)u(t)+θT(t)xθv(t)+σ(t))






y
θ

v
(t)=cθvTxθv(t)






A
m
=A
θ

v

−b
θ

v

K
m


Where Am is a longitudinal system state spatial feedback matrix.


Specifically, a specific expression formula of the longitudinal full-order state observer is as follows:





{circumflex over ({dot over (x)})}θv(t)=Aθv{circumflex over (x)}θv(t)+bθv({circumflex over (ω)}(t)u(t)+{circumflex over (θ)}T(t)xθv(t)+{circumflex over (σ)}(t))






ŷ
θ

v
(t)=cθvT{circumflex over (x)}θv(t)


Where {circumflex over (x)}θv(t) is an estimated value of the longitudinal motion state variable, {circumflex over ({dot over (x)})}θv(t) is a change rate of the estimated value of the longitudinal motion state variable, {circumflex over (ω)}(t) is an input weighted estimated value, {circumflex over (θ)}T(t) is an estimated value of θT(t), {circumflex over (σ)}(t) is an estimated value of the external environment disturbance parameter; ŷθv(t) is an estimated value of a pitch attitude angle, and the estimated value {circumflex over (x)}θv(t) of the longitudinal motion state variable is calculated.


Different from the above model expression formula, parameters {circumflex over (ω)}(t), {circumflex over (θ)}(t), and {circumflex over (σ)}(t) in the model are all estimated values calculated by the parameter adaptive law, and the longitudinal full-order state observer calculates and outputs an estimated value {circumflex over (x)}θv(t) of the state variable. The deviation between the estimated value of the state variable and a real state variable is used for the calculation of the parameter adaptive law.


An estimated error of the longitudinal motion state variable is as follows:





{tilde over ({dot over (x)})}θv(t)=Aθv{tilde over (x)}θv(t)+bθv({tilde over (ω)}(t)u(t)+{tilde over (θ)}T(t)xθv(t)+{tilde over (σ)}(t))






{tilde over (x)}
θ

v
(0)=0





{tilde over (θ)}(t)={circumflex over (θ)}(t)−θ(t)






{tilde over (x)}
θ

v
(t)={circumflex over (x)}θv(t)−xθv(t)





{tilde over (ω)}(t)={circumflex over (ω)}(t)−ω(t)





{tilde over (σ)}(t)={circumflex over (σ)}(t)−σ(t)


Where {tilde over ({dot over (x)})}θv(t) is a change rate of the estimated error of the longitudinal motion state variable, {tilde over (x)}θv (t) is the estimated error of the longitudinal motion state variable, {tilde over (ω)}(t) is an input weighted estimated error, {circumflex over (θ)}(t) is an estimated value of the longitudinal motion model disturbance parameter, {tilde over (θ)}(t) is an estimated error of the longitudinal motion model disturbance parameter, and {tilde over (σ)}(t) is an estimated error of the external environment disturbance parameter. According to a relevant theorem of an L1 adaptive control theory, it can be proved that an estimated state error of the system is uniformly bounded.


The parameter adaptive law is designed to obtain {circumflex over (θ)}(t), {circumflex over (σ)}(t) and {circumflex over (ω)}(t) according to the estimated error of the longitudinal motion state variable; and an adaptive law calculation formula is as follows:





{circumflex over ({dot over (θ)})}(t)=ΓProj({circumflex over (θ)}(t),−custom-character(t)Pbθvxθv(t)),{circumflex over (θ)}(0)={circumflex over (θ)}0





{circumflex over ({dot over (σ)})}(t)=ΓProj({circumflex over (σ)}(t),−{tilde over (x)}θvT(t)Pbθv),{circumflex over (σ)}(0)={circumflex over (σ)}0





{circumflex over ({dot over (ω)})}(t)=ΓProj({circumflex over (ω)}(t),−{tilde over (x)}θvT(t)Pbθvuad(t)),{circumflex over (ω)}(0)={circumflex over (ω)}0


Where {circumflex over ({dot over (θ)})}(t) is a change rate of the estimated value of the longitudinal motion model disturbance parameter, {circumflex over ({dot over (σ)})}(t) is a change rate of the estimated value of the external environment disturbance parameter, and {circumflex over ({dot over (ω)})}(t) is a change rate of the input weighted estimated value; Γ∈R+ is an adaptive gain, and Proj(⋅) is a projection operator, which is specifically defined as follows:







Proj

(

θ
,
y

)

=

{




y
,





f

(
θ
)

<
0







y
-






f

(
θ
)








f

(
θ
)














f

(
θ
)








f

(
θ
)





,
y





f

(
θ
)



,






f

(
θ
)


0

,







f

(
θ
)

T



y

>
0







y
,






f

(
θ
)


0

,







f

(
θ
)

T



y


0










Where ƒ:Rn→R is a smooth convex function, which is specifically defined as follows:







f

(
θ
)

=




(


ε
θ

+
1

)



θ
T


θ

-

θ
max
2




ε
θ



θ
max
2







Where θmax is a boundary constraint of a vector θ; εθ is any small positive real number less than 1; and ∇ƒ(θ) is set as a gradient of ƒ(⋅) at θ.


P=PT is substituted in the Lyapunov equation as follows:






A
m
T
P+PA
m
=−Q


For the solution of any Q=QT, AmT is a transpose of a longitudinal system state spatial feedback matrix. For any value of Q, the solution of the P is unique. In combination with a longitudinal motion modeling case, it can be known that the input weighted parameter ω(t) and a longitudinal motion model disturbance parameter θ(t) are related to the weight, the rotational inertia, and the aerodynamic parameter of the tandem rotor unmanned aerial vehicle, and σ(t) is related to the disturbance of external environmental factors, such as wind.


The L1 adaptive controller of the longitudinal motion system is designed and the longitudinal motion control input quantity is output according to the estimated value {circumflex over (θ)}(t) of the longitudinal motion model disturbance parameter, the estimated value {circumflex over (σ)}(t) of the external environment disturbance parameter, the input weighted estimated value {circumflex over (ω)}{circumflex over (()}t), the estimated value {circumflex over (x)}θv(t) of the longitudinal motion state variable, the estimated error {tilde over (x)}θv(t) of the longitudinal motion state variable, and the received desired attitude command signal.


A specific form of the L1 adaptive controller uad(t) of the designed longitudinal motion system is follows:






u
ad(s)=−kD(s)({circumflex over (η)}(s)−kgr(s))


Where uad(t) is a combination of the longitudinal periodic variable pitch input quantity and the collective pitch input quantity, uad(s) is the Laplace transform of uad(t), r(s) is the Laplace transform of a command input r(t), {circumflex over (η)}(s) is the Laplace transform of {circumflex over (η)}(t), and {circumflex over (η)}(t)={circumflex over (ω)}(t)uad(t)+{circumflex over (θ)}Txθv(t)+{circumflex over (σ)}(t); kg is a gain of the command input, kg=−1/(cθvT Am−1bθv), so that the system outputs a tracking command input signal that can be stabilized; D(s) is a strictly positive real transfer function,








D

(
s
)

=

1
s


,




s expresses a s domain, and k is an adaptive feedback gain.


An appropriate adaptive feedback gain value is designed, which can ensure the asymptotic stability of a closed loop system. Therefore, an expression formula of a transfer function output by the longitudinal full-order state observer is solved as:






ŷ=c
θ

v

T(sI−Am)−1bθv({circumflex over (ω)}u+{circumflex over (θ)}x+{circumflex over (σ)})


Where ŷ is the transfer function, I is a unit matrix, s is an s domain, cθvT is a longitudinal system state output matrix, Am is a longitudinal system state spatial feedback matrix, bθv is a longitudinal system state input matrix, {circumflex over (ω)} is an input weighted estimated value, u is a longitudinal variable pitch input quantity, {circumflex over (θ)} is an estimated value of a longitudinal motion model disturbance parameter, x is a longitudinal motion state variable, and {circumflex over (σ)} is an estimated value of the external environment disturbance parameter.


When time tends to infinity, an output value may reach:






ŷ=−c
θ

v

T
A
m
−1
b
θ

v
({circumflex over (ω)}u+{circumflex over (θ)}x+{circumflex over (σ)})


In order to achieve ŷ=r, it may be solved that:






u
=


1

ω
^




(



-

1


-

c

θ
v

T




A
m

-
1




b

θ
v






r

-


θ
^


x

-

σ
^


)






Therefore, the gain kg=−1/(cθvTAm−1bθv) may be solved.


D(s) is a strictly positive real transfer function, and







D

(
s
)

=

1
s





design here.


The form of a low pass filter is set as:







C

(
s
)

=


ω

k


s
+

ω

k







The design of the low pass filter C(s) needs to ensure C(0)=1, and when a s domain and a frequency domain are 0, an input of the low pass filter is equal to an output. The value k of the adaptive feedback gain directly affects the bandwidth of the low pass filter.


In order to ensure the asymptotic stability of the closed loop system, the design of k must satisfy an L1 small gain theorem of the closed loop system. Now, it is defined that:






L=maxθ∈Θ∥θ∥1






H(s)=(sI−Am)−1b






G(s)=H(s)(1−C(s))


L, H(s), and G(s) are respectively intermediate variable transfer functions.


According to the L1 small gain theorem of the closed loop system, the designed adaptive feedback gain k needs to satisfy:





G(s)∥L1L<1


G(s) is a transfer function, which is a description of the low pass filter and a system without a state feedback.


For the longitudinal motion model, the designed longitudinal motion control input quantity includes a collective pitch input quantity and a longitudinal periodic variable pitch input quantity. Therefore, a longitudinal linearization motion equation of the tandem rotor unmanned aerial vehicle is as follows:







[





u
p

·







w
p

·







q
p

·







θ
p

·




]

=



[





X
u

m





X
w

m




(



X
q

m

-

w
N


)





-
g


cos


θ
N








Z
u

m





Z
w

m




(


u
N

+


Z
q

m


)





-
g


sin


θ
N








M
u


I
YY






M
w


I
YY






M
q


I
YY




0




0


0


1


0



]

[




u
P






w
P






q
P






θ
P




]

+


[





X

u
b


m





X

u
c


m







Z

u
b


m





Z

u
c


m







M

u
b



I
YY






M

u
c



I
YY






0


0



]

[




u

b
,
P







u

c
,
P





]






Where


uP is a forward speed, {dot over (u)}p is a forward speed change rate, wP is a vertical speed, {dot over (w)}P is a vertical speed change rate, qP is a pitch rate, {dot over (q)}p is a pitch rate change rate, θP is a pitch angle, {dot over (θ)}P is a pitch angle change rate, m is the mass of the tandem rotor unmanned aerial vehicle, Xu is an aerodynamic derivative in a forward direction, Xw is an aerodynamic derivative in a vertical direction, Xq is an aerodynamic derivative of the pitch angle, wN is a vertical speed reference quantity, g is a gravitational acceleration, θN is an aircraft pitch angle when longitudinal motion is trimmed, Zu is a derivative of a vertical resultant force with respect to the forward speed, Zw is a derivative of the vertical resultant force with respect to the vertical speed, uN is an aircraft forward speed when the longitudinal motion is trimmed, Zq is a derivative of the vertical resultant force with respect to the pitch rate, Mu is an aerodynamic derivative of a pitch moment with respect to the forward speed, Mq is an aerodynamic derivative of the pitch moment with respect to the vertical speed, Mq is an aerodynamic derivative of the pitch moment with respect to the pitch rate, IYY is a Y-axis rotational inertia of a body axis system, Xub is a derivative of a forward resultant force with respect to a longitudinal variable pitch control quantity, Zub is a derivative of the vertical resultant force with respect to the longitudinal variable pitch control quantity, Zuc is a derivative of the vertical resultant force with respect to the collective pitch control quantity, Mub is a derivative of the pitch moment with respect to the longitudinal variable pitch control quantity, Muc is a derivative of the pitch moment with respect to the collective pitch control quantity, ub,P is a longitudinal variable pitch control quantity, and Uc,P is a collective pitch control quantity.


Further, a lateral linearization model of the tandem rotor unmanned aerial vehicle is expressed as:






{dot over (x)}θ
v1(t)=Aθv1xθv1(t)+bθv11(t)u1(t)+θ1T(t)xθv1(t)+σ1(t))






y
θ

v1
(t)=cθv1Txθv1(t)


In the formula, xθv1(t) is a lateral motion state variable. The lateral motion state variable includes: a transverse roll rate, a transverse roll angle, a yaw rate, and a side speed. {dot over (x)}θv1(t) is a change rate of the lateral motion state variable, yθv1(t) is a yaw attitude angle output quantity, Aθv1 is a lateral system state spatial matrix, bθv1 is a lateral system state input matrix, and ω1(t) is a weight of a lateral input and is used for compensating an error of a system input matrix; u1(t) is a lateral variable pitch input quantity, θ1(t) is a lateral motion model disturbance parameter, that is, a system error of a lateral motion model, θ1T(t) is a transpose of θ1(t), σ1(t) is a lateral external environment disturbance parameter, that is, an influence error of the rotor unmanned aerial vehicle caused by external environment factors, Cθv1T is a lateral system state output matrix, and t is a time parameter.


Specifically, xθv1(t) is a column vector of 1×4, and θ1(t) is a weighted parameter row vector of 1×4.


It is necessary to assume that the parameters in the model satisfy the following conditions:


Assumption 1: Parameters θ1(t) and σ1(t) satisfy:





θ1(t)∈Θ,|σ1(t)|≤Δ0,∀t≥0


Where Θ is a known convex set, Δ0∈R+.


Assumption 2: parameters θ1(t) and σ1(t) are continuously differentiable and uniformly bounded: ∥{dot over (θ)}1(t)∥≤dθ<∞,|{dot over (σ)}11(t)|≤dσ<∞, ∀t≥0


Assumption 3: the weighted parameter φ1∈R satisfies:





ω1∈Ω0∈[ω1 ωu].


For the lateral linearization model of the present disclosure, all assumptions above can be satisfied to ensure the reliability of the model.


For the lateral linearization model, an indicator function related to the lateral motion state variable and the lateral motion control input quantity is fit:






J
1=∫(x1TQ1x1+u1TR1u1)dt


J1 is the indicator function, x1 is an error quantity matrix between a desired lateral motion state variable and a real lateral motion state variable, x1T is a transpose of x1, U1 is a yaw control quantity and a transverse periodic variable pitch input matrix, and u1T is a transpose of u1; Q1 is a lateral motion state variable weighted parameter matrix, R1 is a weighted parameter matrix of the lateral motion control input quantity, u1=−Km1x1, specifically, Q1 is a 4×4 weighted parameter matrix, R1 is a 2×2 weighted parameter matrix, Km1 is a feedback gain matrix, and Q1 and R1 in the indicator function respectively realize the weighting of the longitudinal motion state variable and the longitudinal periodic variable pitch input quantity. Both matrix Q1 and matrix R1 are diagonal positive semi-definite matrixes, elements on a diagonal line of the matrix Q1 directly affect the convergence rate of the corresponding lateral motion state variable, and elements on a diagonal line of the matrix R1 directly affect the energy magnitude of the transverse periodic variable pitch input quantity. The higher the convergence rate of lateral motion state variable, the greater the energy of the transverse periodic variable pitch input quantity, and the higher the requirement on actuators such as a steering engine. The optimal control of the LQR is to select Q1 and R1 in advance according to a real model case to find out an appropriate feedback gain matrix Km1, a feedback control input u1=−Km1x1 thereof optimizes the indicator function J1; and the indicator function J1 is optimal when reaching a minimum value, and the optimal represents the most energy-saving state of the model.


The solution of the feedback gain matrix Km1 in the linear quadratic regulation algorithm is:






K
m1
=R
1
−1
b
θ

v1

T
P
1


Where R1−1 is an inverse of R, bθv1T is a transpose of bθv1, P1 is an intermediate parameter matrix, and P1 is obtained by solving the following Riccati equation:






A
θ

v1

T
P
1
+P
1
A
θ

v1

−P
1
b
θ

v1

R
1
−1
b
θ

v1

P
1
+Q
1=0


Where Aθv1T is a transpose of Aθv1.


The lateral linearization model with a lateral motion state variable feedback is expressed as:






{dot over (x)}θ
v1(t)=Am1xθv1(t)+bθv11(t)u1(t)+θ1T(t)xθv1(t)+σ1(t))






y
θ

v1
(t)=cθv1Txθv1(t)






A
m1
=A
θ

v1

−b
θ

v1

K
m1


Where Am1 is a lateral system state spatial feedback matrix.


Specifically, a specific expression formula of a lateral full-order state observer is as follows:





{circumflex over ({dot over (x)})}θv1(t)=Aθv1{circumflex over (x)}θv1(t)+bθv1({circumflex over (ω)}1(t)u1(t)+{circumflex over (θ)}1T(t)xθv1(t)+{circumflex over (σ)}1(t))






ŷ
θ

v1
(t)=cθv1T{circumflex over (x)}θv1(t)


Where {circumflex over (x)}θv1(t) is an estimated value of the longitudinal motion state variable, {circumflex over ({dot over (x)})}θv1(t) is change rate of the estimated value of the lateral motion state variable and is an input weighted estimated value, {circumflex over (θ)}1T(t) is an estimated value of θ1T (t), and {circumflex over (σ)}1(t) is an estimated value of the lateral external environment disturbance parameter; is an estimated value of a yaw attitude angle, and the lateral full-order state observer calculates the estimated value xθv1(t) of the lateral motion state variable.


Different from the above model expression formula, parameters ω1(t), θ1(t), and {circumflex over (σ)}1(t) in the model are all estimated values calculated by the parameter adaptive law, and the observer calculates an estimated value xθv1(t) of the state variable accordingly. The deviation between the estimated state variable and a real state variable is used for the calculation of the parameter adaptive law.


An estimated error of the lateral motion state variable is as follows:





{tilde over ({dot over (x)})}θv1(t)=Aθv{tilde over (x)}θv1(t)+bθv1({tilde over (ω)}1(t)u1(t)+{tilde over (θ)}1T(t)xθv1(t)+{tilde over (σ)}1(t))






{tilde over (x)}
θ

v1
(0)=0





{tilde over (θ)}1(t)={circumflex over (θ)}1(t)−θ1(t)






{tilde over (x)}
θ

v1
(t)={circumflex over (x)}θv1(t)−xθv1(t)





{tilde over (ω)}1(t)={circumflex over (ω)}1(t)−ω1(t)





{tilde over (σ)}1(t)={circumflex over (σ)}1(t)−σ1(t)


Where {tilde over ({dot over (x)})}θv1(t) is a change rate of the estimated error of the longitudinal motion state variable, {tilde over (x)}θv1(t) is the estimated error of the lateral motion state variable, {tilde over (ω)}1(t) is a lateral input weighted estimated error, {circumflex over (θ)}1(t) is an estimated value of the longitudinal motion model disturbance parameter, {tilde over (θ)}1(t) is an estimated error of the lateral motion model disturbance parameter, and {tilde over (σ)}1(t) is an estimated error of the external environment disturbance parameter. According to a relevant theorem of an L1 adaptive control theory, it can be proved that an estimated state error of the system is uniformly bounded.)


The parameter adaptive law is designed to obtain {circumflex over (θ)}1(t), {circumflex over (σ)}1(t) and ω1(t) according to the estimated error of the lateral motion state variable; and an adaptive law calculation formula is as follows:





{circumflex over ({dot over (θ)})}1(t)=ΓProj({circumflex over (θ)}1(t),−custom-character(t)Pbθv1xθv1(t)),{circumflex over (θ)}1(0)={circumflex over (θ)}0





{circumflex over ({dot over (σ)})}1(t)=ΓProj({circumflex over (σ)}1(t),−{tilde over (x)}θv1T(t)Pbθv1),{circumflex over (σ)}1(0)={circumflex over (σ)}0





{circumflex over ({dot over (ω)})}1(t)=ΓProj({circumflex over (ω)}1(t),−{tilde over (x)}θvT(t)Pbθv1uad(t)),{circumflex over (ω)}1(0)={circumflex over (ω)}0


Where {circumflex over (θ)}1(t) is a change rate of the estimated value of the lateral motion model disturbance parameter, {circumflex over ({dot over (σ)})}1(t) is a change rate of the estimated value of the lateral external environment disturbance parameter, {circumflex over ({dot over (φ)})}1(t) is a change rate of a lateral input weighted estimated value, Γ∈R+ is an adaptive gain, and Proj(⋅) is a projection operator, which is specifically defined as follows:







Proj
(

θ
,
y

)

=

{




y
,





f

(
θ
)

<
0






y
-





f

(
θ
)







f

(
θ
)













f

(
θ
)







f

(
θ
)





,
y










f

(
θ
)


0

,






f

(
θ
)

T



y

>
0







y
,






f


(
θ
)



0

,






f

(
θ
)

T



y


0










Where ƒ:Rn→R is a smooth convex function, which is specifically defined as follows:







f

(
θ
)

=




(


ε
θ

+
1

)



θ
T


θ

-

θ
max
2




ε
θ



θ
max
2







Where θmax is a boundary constraint of a vector θ; εθ is any small positive real number less than 1; and ∇ƒ(θ) is set as a gradient of ƒ(⋅) at θ.


P1=P1T is substituted in the Lyapunov equation as follows:






A
m1
T
P
1
+P
1
A
m1
=−Q
1


For the solution of any Q1=QT1, Am1T is a transpose of the lateral system state spatial feedback matrix. For any value of Q1, the solution of the P1 is unique. In combination with a lateral motion modeling case, it can be known that the input weighted parameter ω1(t) and the lateral motion model disturbance parameter θ1(t) are related to the weight, the rotational inertia, and the aerodynamic parameter of the tandem rotor unmanned aerial vehicle, and σ1(t) is related to the disturbance of external environmental factors, such as wind.


The L1 adaptive controller of the lateral motion system is designed and the lateral motion control input quantity is output according to the estimated value {circumflex over (θ)}1(t) of the lateral motion model disturbance parameter, the estimated value {circumflex over (σ)}1(t) of the external environment disturbance parameter, the input weighted estimated value {circumflex over (φ)}1(t), the estimated value {circumflex over (x)}θv1(t) of the lateral motion state variable, the estimated error {tilde over (x)}θv1(t) of the lateral motion state variable, and the received desired attitude command signal.


A specific form of the L1 adaptive controller uad1(t) of the designed lateral motion system is follows:






u
ad1(s)=−k1D1(s)({circumflex over (η)}1(s)−kg1r1(s))


Where uad1(t) is a combination of the transverse periodic variable pitch input quantity and the yaw control quantity, uad1(s) is the Laplace transform of uad1(t), r1(s) is the Laplace transform of a command input r1(t), {circumflex over (η)}1(s) is the Laplace transform of {circumflex over (η)}1(t), {circumflex over (η)}1(t)={circumflex over (ω)}1(t)uad1(t)+{circumflex over (θ)}1Txθv1(t)+{circumflex over (σ)}1(t); and kg1 is a gain of the command input,






k
g

1
=−1/(cθv1TAm1−1bθv1)

    • so that the system outputs a tracking command input signal that can be stabilized; D1(s) is a strictly positive real transfer function,









D
1

(
s
)

=

1
s


,




s expresses a s domain, and k1 is an adaptive feedback gain.


An appropriate adaptive feedback gain value is designed, which can ensure the asymptotic stability of a closed loop system. Therefore, an expression formula of a transfer function output by the lateral full-order state observer is solved as:






ŷ
1
=c
θ

v1

T(sI−Am1)−1bθv1({circumflex over (ω)}1u1+{circumflex over (θ)}1x1+{circumflex over (θ)}1x1+{circumflex over (σ)}1)


Where ŷ1 is the transfer function, I is a unit matrix, s is an s domain, cθv1T is a lateral system state output matrix, Am1 is a lateral system state spatial feedback matrix, bθv1 is a lateral system state input matrix, {circumflex over (ω)}1 is an input weighted estimated value, u1 is a lateral variable pitch input quantity, {circumflex over (θ)}1 is an estimated value of the lateral motion model disturbance parameter, x1 is a lateral motion state variable, and {circumflex over (σ)}1 is an estimated value of the lateral external environment disturbance parameter.


When time tends to infinity, an output value may reach:






ŷ
1
=−c
θ

v1

T
A
m1
−1
b
θ

v1
({circumflex over (ω)}1u1+{circumflex over (θ)}1x1+{circumflex over (σ)}1)


In order to achieve ŷ1=r1, it may be solved that:







u
1

=


1


ω
^

1




(



-

1


-

c

θ

v

1


T




A

m

1


-
1




b

θ

v

1








r
1


-



θ
ˆ

1



x
1


-


σ
ˆ

1


)






Therefore, the gain kg1=−1/(cθv1TAm1−1bθv1) may be solved.


D1(s) is a strictly positive real transfer function, and








D
1

(
s
)

=

1
s





is selected to facilitate design here.


The form of a low pass filter is set as:








C
1

(
s
)

=



ω
1



k
1



s
+


ω
1



k
1








The design of the low pass filter C1(s) needs to ensure C1(0)=1, and when a s domain and a frequency domain are 0, an input of the low pass filter is equal to an output. The value k1 of the adaptive feedback gain directly affects the bandwidth of the low pass filter.


In order to ensure the asymptotic stability of the closed loop system, the design of k1 must satisfy an L1 small gain theorem of the closed loop system. Now, it is defined that:






L
1=maxθ∈Θ∥θ11






H
1(s)=(sI−Am1)−1b1






G
1(s)=H1(s)(1−C1(s))


L1, H1(s), and G1(s) are respectively intermediate variable transfer functions.


According to the L1 small gain theorem of the closed loop system, the designed adaptive feedback gain k needs to satisfy:





G1(s)∥L1<1


G1(s) is a transfer function, which is a description of the low pass filter and a system without a state feedback.


For the lateral motion model, the designed lateral motion control input quantity includes a yaw control quantity and a transverse periodic variable pitch input quantity. Therefore, the lateral linearization motion equation of the tandem rotor unmanned aerial vehicle is as follows:








[











p
.

p







ϕ
.

P










r
.

P










v
.

P




]

=

[




(




I
1



L
p



I
xx


+



I
3



N
p



I
zz



)



0



(




I
1



L
r



I
xx


+



I
3



N
r



I
zz



)




(




I
1



L
v



I
xx


+



I
3



N
v



I
zz



)





1


0



tan


θ
N






-
g


sin


θ
N










I
2



L
p



I
xx


+



I
1



N
p



I
zz





0



(




I
2



L
r



I
xx


+



I
1



N
r



I
zz



)




(




I
2



L
v



I
xx


+



I
1



N
v



I
zz



)






(


w
N

+


Y
p

m


)




g

cos


θ
N





(



Y
r

m

-

u
N


)





Y
v

m




]






[




p
P






ϕ
P






r
P






v
P




]

+


[




(




I
1



L

u
a




I
xx


+



I
3



N

u
a




I
zz



)




(




I
1



L

u
r




I
xx


+



I
3



N

u
r




I
zz



)





0


0





(




I
2



L

u
a




I
xx


+



I
1



N

u
a




I
zz



)




(




I
2



L

u
r




I
xx


+



I
1



N

u
r




I
zz



)






Y

u
a





Y

u
r





]

[




u

a
,
P







u

r
,
P





]






Where pP is a transverse roll rate, {dot over (p)}P is a change rate of the transverse roll rate, ϕP is a transverse roll angle, {dot over (ϕ)}P is a change rate of the transverse angle, rP is a yaw rate, {dot over (r)}P is a change rate of the yaw rate, vP is a side speed, {dot over (v)}P is a change rate of the side speed, LP is an aerodynamic derivative related to the roll rate and the roll angle, NP is an aerodynamic derivative related to the roll rate and a yaw angle, Ixx is an x-axis rotational inertia of a body axis system, Izz is a z-axis rotational inertia of the body axis system, wN is a vertical speed reference quantity, Yp is an aerodynamic derivative related to the roll rate and a side aerodynamic force, m is the mass of the tandem rotor unmanned aerial vehicle, g is a gravitational acceleration, θN is an aircraft pitch angle when longitudinal motion is trimmed, Lr is an aerodynamic derivative related to the yaw rate and the roll angle, Nr is an aerodynamic derivative related to the yaw rate and the yaw angle, Lv is an aerodynamic derivative related to the side speed and the roll angle, Nv is an aerodynamic derivative related to the side speed and the yaw angle, Yr is an aerodynamic derivative related to the yaw rate and the side aerodynamic force, uN is a forward speed reference quantity, Yv is an aerodynamic derivative related to the side speed and the side aerodynamic force, Lua is a derivative of roll moment with respect to the transverse variable pitch control quantity, Nua is a derivative of yaw moment with respect to the transverse variable pitch control quantity, Lur is a derivative of a roll moment with respect to a yaw control quantity, Nur is a derivative of the yaw moment with respect to the yaw control quantity, ua,P a transverse variable pitch control quantity, ur,P is the yaw control quantity, Yua is a derivative of the side aerodynamic force with respect to the transverse variable pitch control quantity, and Yur is a derivative of the side aerodynamic force with respect to the yaw control quantity.


The body axis system is that origin O is taken from the rotor unmanned aerial vehicle, and an ox axis of the body axis system is parallel to the axis of the rotor unmanned aerial vehicle. In the above formula,









I
1

=



I
XX



I
ZZ





I
XX



I
ZZ


-

I

X

Z

2




;


I
2

=



I
XX



I

X

Z






I
XX



I

Z

Z



-

I

X

Z

2




;


I
3

=



I

Z

Z




I

X

Z






I
XX



I

Z

Z



-

I

X

Z

2





,




X, Y, and Z are resultant forces in the x, y, and z directions in the body axis system. The aerodynamic derivative and an operation derivative are recorded as:








B

a

=



B



a



,
;




a is a state quantity or a control input quantity, and B is a force or moment. ub,P is a collective pitch input quantity, uc,P is a longitudinal variable pitch control input quantity, ua,P is a transverse variable pitch control input quantity, and Ur,P is a yaw control input quantity.


For the longitudinal motion model, the designed adaptive control input quantity is the collective pitch input quantity and the longitudinal periodic variable pitch input quantity; the collective pitch input quantity is an up-down lifting quantity; and the longitudinal periodic variable pitch input quantity is a front-rear tilt quantity. For the lateral motion model, the control input quantity is the yaw control quantity and the transverse periodic variable pitch input quantity. The transverse periodic variable pitch input quantity is a left-right tilt quantity, and the yaw control quantity is a left-right swinging quantity.


The present disclosure further discloses an attitude adjustment control method for a tandem rotor unmanned aerial vehicle. The method controls an attitude adjustment loop of the tandem rotor unmanned aerial vehicle by combining a linear quadratic adjustment algorithm and an L1 adaptive control algorithm to realize attitude adjustment of the tandem rotor unmanned aerial perform vehicle and ensure robust control of the attitude adjustment, which specifically includes the following steps.


In S1, a transverse and longitudinal linearization model of the tandem rotor unmanned aerial vehicle in different flight conditions is established, and a state feedback gain matrix is designed for the transverse and longitudinal linearization model through an LQR.


In S2, a full-order state observer is designed according to the transverse and longitudinal linearization model established in S1, and a measurement value of a sensor is combined to obtain an estimated value of a state variable and an estimated error of the state variable.


In S3, a parameter adaptive law is designed to obtain an estimated value of a disturbance parameter according to the estimated error of the state variable obtained in S2.


In S4, an L1 adaptive controller of a transverse and longitudinal motion system is designed to obtain a control input quantity according to the estimated value of the disturbance parameter obtained in S3, the estimated value of the state variable obtained in S2, the estimated error of the state variable, and a received desired attitude command signal.


In S5: the tandem rotor unmanned aerial vehicle is controlled to complete attitude adjustment according to the control input quantity.


Specifically, the transverse and longitudinal linearization model includes a lateral linearization model and a longitudinal linearization model. The control input quantity includes a lateral motion control input quantity and a longitudinal motion control input quantity. The L1 adaptive controller of the transverse and longitudinal motion system includes an L1 adaptive controller of a lateral motion system and an L1 adaptive controller of a longitudinal motion system. The L1 adaptive controller of the lateral motion system outputs the lateral motion control input quantity. The lateral motion control input quantity includes a transverse periodic variable pitch input quantity and a yaw control quantity. The L1 adaptive controller of the longitudinal motion system outputs the longitudinal motion control input quantity. The longitudinal motion control input quantity includes a collective pitch input quantity and a longitudinal periodic variable pitch input quantity. The state variable includes a transverse motion state variable and a longitudinal motion state variable. The full-order state observer includes a longitudinal full-order state observer and a lateral full-order state observer.


Specifically, after S1, the method further includes S11: a longitudinal linearization model of the tandem rotor unmanned aerial vehicle is expressed as:






{dot over (x)}θ
v(t)=Aθvxθv(t)+bθv(ω(t)u(t)+θT(t)xθv(t)+σ(t))






y
θ

v
(t)=cθvTxθv(t)


In the formula, xθv(t) is a longitudinal motion state variable. The longitudinal motion state variable includes: a forward speed quantity, a vertical speed quantity, a pitch rate quantity, and a pitch angle quantity. {dot over (x)}θv(t) is a change rate of the longitudinal motion state variable, yθv(t) is a pitch attitude angle output quantity, Aθv is a longitudinal system state spatial matrix, bθv is a longitudinal system state input matrix, and ω(t) is an input weight and is used for compensating an error of a system input matrix; u(t) is a longitudinal variable pitch input quantity, θ(t) is a longitudinal motion model disturbance parameter, that is, a system error of a longitudinal motion model, θT(t) is a transpose of θ(t), σ(t) is an external environment disturbance parameter, that is, an influence error of the rotor unmanned aerial vehicle caused by external environment factors, cθvT is a longitudinal system state output matrix, and t is a time parameter.


Specifically, xθv(t) is a column vector of 1×4, and θ(t) is a weighted parameter row vector of 1×4.


It is necessary to assume that the parameters in the model satisfy the following conditions:


Assumption 1: parameters θ(t) and σ(t) satisfy: θ(t)∈Θ, |σ(t)|≤Δ0,∀t≥0, and Θ is a known convex set, Δ0∈R+.


Assumption 2: parameters θ(t) and σ(t) are continuously differentiable and uniformly bounded: ∥{dot over (θ)}(t)∥≤dθ<∞,|{dot over (σ)}(t)|≤dσ<∞, ∀t≥0.


Assumption 3: the weighted parameter ω∈R satisfies: ω∈Ω0∈[ω1 ωu].


For the longitudinal linearization model of the present disclosure, all assumptions above can be satisfied to ensure the reliability of the model.


For the longitudinal linearization model, an indicator function related to the longitudinal motion state variable and the longitudinal motion control input quantity is fit:






J=∫(xTQx+uTRu)dt


J is the indicator function, x is an error quantity matrix between a desired longitudinal motion state variable and a real longitudinal motion state variable, xT is a transpose of x, u is a collective pitch input quantity and a longitudinal periodic variable pitch input matrix, and uT is a transpose of u; Q is a longitudinal motion state variable weighted parameter matrix, R is a weighted parameter matrix of the longitudinal motion control input quantity, u=−Kmx, specifically, Q is a 4 λ4 weighted parameter matrix, R is a 2×2 weighted parameter matrix, Km is a feedback gain matrix, and Q and R in the indicator function respectively realize the weighting of the longitudinal motion state variable and the longitudinal periodic variable pitch input quantity. Both matrix Q and matrix R are diagonal positive semi-definite matrixes, elements on a diagonal line of the matrix Q directly affect the convergence rate of the corresponding longitudinal motion state variable, and elements on a diagonal line of the matrix R directly affect the energy magnitude of the longitudinal periodic variable pitch input quantity. The higher the convergence rate of the longitudinal motion state variable, the greater the energy of the longitudinal periodic variable pitch input quantity, and the higher the requirement on actuators such as a steering engine. The optimal control of an LQR is to select Q and R in advance according to a real model case to find out an appropriate feedback gain matrix Km, and a feedback control input u=−Kmx thereof optimizes the indicator function J; and the indicator function J is optimal when reaching a minimum value, and the optimal represents the most energy-saving state of the model.


The solution of the feedback gain matrix Km in the linear quadratic regulation algorithm is:






K
m
=R
−1
b
θ

v

T
P


Where R−1 is an inverse of R, bθv is a transpose of vθv, P is an intermediate parameter matrix, and P is obtained by solving the following Riccati equation:






A
θ

v

T
P+PA
θ

v

−Pb
θ

v

R
−1
b
θ

v

P+Q=0


Where AθvT is a transpose of Aθv.


The longitudinal linearization model with a longitudinal motion state variable feedback is expressed as:






{dot over (x)}θ
v(t)=Amxθv(t)+bθv(ω(t)u(t)+θT(t)xθv(t)+σ(t))






y
θ

v
(t)=cθvTxθv(t)






A
m
=A
θ

v

−b
θ

v

K
m


Where Am is a longitudinal system state spatial feedback matrix.


After S2, the method further includes S21: a specific expression formula of the longitudinal full-order state observer is as follows:





{circumflex over ({dot over (x)})}θv(t)=Aθv{circumflex over (x)}θv(t)+bθv({circumflex over (ω)}(t)u(t)+{circumflex over (θ)}T(t)xθv(t)+{circumflex over (σ)}(t))






ŷ
θ

v
(t)=cθvT{circumflex over (x)}θv(t)


Where {circumflex over (x)}θv(t) is an estimated value of the longitudinal motion state variable, {circumflex over ({dot over (x)})}θv(t) is a change rate of the estimated value of the longitudinal motion state variable, {circumflex over (ω)}(t) is an input weighted estimated value, {circumflex over (θ)}T(t) is an estimated value of θT(t), and {circumflex over (σ)}(t) is an estimated value of the external environment disturbance parameter; ŷθv(t) is an estimated value of a pitch attitude angle, and the estimated value {circumflex over (x)}θv(t) of the longitudinal motion state variable is calculated.


Different from the above model expression formula, parameters {circumflex over (ω)}(t), {circumflex over (θ)}(t), and {circumflex over (σ)}(t) in the model are all estimated values calculated by the parameter adaptive law, and the longitudinal full-order state observer calculates and outputs an estimated value of the state variable. The deviation between the estimated value of the state variable and a real state variable is used for the calculation of the parameter adaptive law.


An estimated error of the longitudinal motion state variable is as follows:





{tilde over ({dot over (x)})}θv(t)=Aθv{tilde over (x)}θv(t)+bθv({tilde over (ω)}(t)u(t)+{tilde over (θ)}T(t)xθv(t)+{tilde over (σ)}(t))






{tilde over (x)}
θ

v
(0)=0





{tilde over (θ)}(t)={circumflex over (θ)}(t)−θ(t)






{tilde over (x)}
θ

v
(t)={circumflex over (x)}θv(t)−xθv(t)





{tilde over (ω)}(t)={circumflex over (ω)}(t)−ω(t)





{tilde over (σ)}(t)={circumflex over (σ)}(t)−σ(t)


Where {tilde over ({dot over (x)})}θv(t) is a change rate of the estimated error of the longitudinal motion state variable, {tilde over (x)}θv (t) is the estimated error of the longitudinal motion state variable, {tilde over (ω)}(t) is an input weighted estimated error, {circumflex over (θ)}(t) is an estimated value of the longitudinal motion model disturbance parameter, {tilde over (θ)}(t) is an estimated error of the longitudinal motion model disturbance parameter, and {tilde over (σ)}(t) is an estimated error of the external environment disturbance parameter. According to a relevant theorem of an L1 adaptive control theory, it can be proved that an estimated state error of the system is uniformly bounded.


Further, after S3, the method further includes S31:


The parameter adaptive law is designed to obtain {circumflex over (θ)}(t), {circumflex over (σ)}(t), and {circumflex over (ω)}(t) according to the estimated error of the longitudinal motion state variable; and an adaptive law calculation formula is as follows:





{circumflex over ({dot over (θ)})}(t)=ΓProj({circumflex over (θ)}(t),−custom-character(t)Pbθvxθv(t)),{circumflex over (θ)}(0)={circumflex over (θ)}0





{circumflex over ({dot over (σ)})}(t)=ΓProj({circumflex over (σ)}(t),−{tilde over (x)}θvT(t)Pbθv),{circumflex over (σ)}(0)={circumflex over (σ)}0





{circumflex over ({dot over (ω)})}(t)=ΓProj({circumflex over (ω)}(t),−{tilde over (x)}θvT(t)Pbθvuad(t)),{circumflex over (ω)}(0)={circumflex over (ω)}0


Where {circumflex over ({dot over (θ)})}(t) is a change rate of the estimated value of the longitudinal motion model disturbance parameter, {circumflex over ({dot over (σ)})}(t) is a change rate of the estimated value of the external environment disturbance parameter, {circumflex over ({dot over (ω)})}(t) is a change rate of the input weighted estimated value, Γ∈R+ is an adaptive gain, and Proj(⋅) is a projection operator, which is specifically defined as follows:







Proj

(

θ
,
y

)

=

{




y
,





f

(
θ
)

<
0







y
-





f

(
θ
)







f

(
θ
)













f

(
θ
)







f

(
θ
)





,
y





f

(
θ
)



,






f

(
θ
)


0

,






f

(
θ
)

T



y

>
0







y
,






f

(
θ
)


0

,






f

(
θ
)

T



y


0










Where ƒ:Rn→R is a smooth convex function, which is specifically defined as follows:







f

(
θ
)

=




(


ε
θ

+
1

)



θ
T


θ

-


θ
max

2




ε
θ




θ
max

2







Where θmax is a boundary constraint of a vector θ; εθ is any small positive real number less than 1; and ∇ƒ(θ) is set as a gradient of ƒ(⋅) at θ.


P=PT is substituted in the Lyapunov equation as follows:






A
m
T
P+PA
m
=−Q


For the solution of any Q=QT, AmT is a transpose of a longitudinal system state spatial feedback matrix. For any value of Q, the solution of the P is unique. In combination with a longitudinal motion modeling case, it may be known that the input weighted parameter ω(t) and a longitudinal motion model disturbance parameter θ(t) are related to the weight, the rotational inertia, and the aerodynamic parameter of the tandem rotor unmanned aerial vehicle, and σ(t) is related to the disturbance of external environmental factors, such as wind.


The L1 adaptive controller of the longitudinal motion system is designed and the longitudinal motion control input quantity is output according to the estimated value {circumflex over (θ)}(t) of the longitudinal motion model disturbance parameter, the estimated value {circumflex over (σ)}(t) of the external environment disturbance parameter, the input weighted estimated value {circumflex over (ω)}(t), the estimated value {circumflex over (x)}θv(t) of the longitudinal motion state variable, the estimated error {tilde over (x)}θv(t) of the longitudinal motion state variable, and the received desired attitude command signal.


Further, after S4, the method further includes S41:

    • a specific form of the L1 adaptive controller uad(t) ad of the designed longitudinal motion system is follows:






u
ad(s)=−kD(s)({circumflex over (η)}(s)−kgr(s))


Where uad(t) is a combination of the longitudinal periodic variable pitch input quantity and the collective pitch input quantity, uad(s) is the Laplace transform of uad(t) r(S) is the Laplace transform of a command input r(t), {circumflex over (η)}(S) is the Laplace transform of {circumflex over (η)}(t), and {circumflex over (η)}(t)={circumflex over (ω)}(t)+{circumflex over (θ)}Txθv(t)+{circumflex over (σ)}(t); kg is a gain of the command input, and kg=−1/(cθvTAm−1bθv), so that the system outputs a tracking command input signal that can be stabilized; and D(s) is a strictly positive real transfer function,








D

(
s
)

=

1
s


,




s expresses a s domain, and k is an adaptive feedback gain.


An appropriate adaptive feedback gain value is designed, which can ensure the asymptotic stability of a closed loop system. Therefore, an expression formula of a transfer function output by the longitudinal full-order state observer is solved as:






ŷ=c
θ

v

T(sI−Am)−1bθv({circumflex over (ω)}u+{circumflex over (θ)}x+{circumflex over (σ)})


Where y is the transfer function, I is a unit matrix, s is an s domain, cθvT is a longitudinal system state output matrix, Am is a longitudinal system state spatial feedback matrix, bθv is a longitudinal system state input matrix, {circumflex over (ω)} is an input weighted estimated value, u is a longitudinal variable pitch input quantity, {circumflex over (θ)} is an estimated value of a longitudinal motion model disturbance parameter, x is a longitudinal motion state variable, and {circumflex over (σ)} is an estimated value of the external environment disturbance parameter.


When time tends to infinity, an output value may reach:






ŷ=−c
θ

v

T
A
m
−1
b
θ

v
({circumflex over (ω)}u+{circumflex over (θ)}x+{circumflex over (σ)})


In order to achieve ŷ=r, it may be solved that:






u
=


1

ω
^




(



-

1


-

c

θ
v

T





A
m


-
1




b

θ
v






r

-


θ
^


x

-

σ
^


)






Therefore, the gain kg=−1/(cθvTAm−1bθv) may be solved.


D(s) is a strictly positive real transfer function, and







D

(
s
)

=

1
s





is selected to facilitate design here.


The form of a low pass filter is set as:







C

(
s
)

=


ω

k


s
+

ω

k







The design of the low pass filter C(s) needs to ensure C(0)=1, and when a s domain and a frequency domain are 0, an input of the low pass filter is equal to an output. The value k of the adaptive feedback gain directly affects the bandwidth of the low pass filter.


In order to ensure the asymptotic stability of the closed loop system, the design of k must satisfy an L1 small gain theorem of the closed loop system. Now, it is defined that:






L=maxθ∈Θ∥θ∥1






H(s)=(sI−Am)−1b






G(s)=H(s)(1−C(s))


L, H(s), and G(s) are respectively intermediate variable transfer functions.


According to the L1 small gain theorem of the closed loop system, the designed adaptive feedback gain k needs to satisfy:





G(s)∥L1<1


G(s) is a transfer function, which is a description of the low pass filter and a system without a state feedback.


For the longitudinal motion model, the designed longitudinal motion control input quantity includes a collective pitch input quantity and a longitudinal periodic variable pitch input quantity. Therefore, a longitudinal linearization motion equation of the tandem rotor unmanned aerial vehicle is as follows:







[





u


p







w


p







q


p







θ


p




]

=



[





X
u

m





X
w

m




(



X
q

m

-

w
N


)





-
g


cos


θ
N








Z
u

m





Z
w

m




(


u
N

+


Z
q

m


)





-
g


sin


θ
N








M
u


I
YY






M
w


I
YY






M
q


I
YY




0




0


0


1


0



]

[




u
P






w
P






q
P






θ
P




]

+


[





X

u
b


m





X

u
c


m







Z

u
b


m





Z

u
c


m







M

u
b



I
YY






M

u
c



I
YY






0


0



]

[




u

b
,
P







u

c
,
P





]






Where uP is a forward speed, {dot over (u)}p is a forward speed change rate, wP is a vertical speed, {dot over (w)}P is a vertical speed change rate, qP is a pitch rate, {dot over (q)}P is a pitch rate change rate, θP is a pitch angle, {dot over (θ)}P is a pitch angle change rate, m is the mass of the tandem rotor unmanned aerial vehicle, Xu is an aerodynamic derivative in a forward direction, Xw is an aerodynamic derivative in a vertical direction, Xq is an aerodynamic derivative of the pitch angle, wN is a vertical speed reference quantity, g is a gravitational acceleration, θN is an aircraft pitch angle when longitudinal motion is trimmed, Zu is a derivative of a vertical resultant force with respect to the forward speed, Zw is a derivative of the vertical resultant force with respect to the vertical speed, uN is an aircraft forward speed when the longitudinal motion is trimmed, Zq is a derivative of the vertical resultant force with respect to the pitch rate, Mu is an aerodynamic derivative of a pitch moment with respect to the forward speed, Mw is an aerodynamic derivative of the pitch moment with respect to the vertical speed, Mq is an aerodynamic derivative of the pitch moment with respect to the pitch rate, IYY is a Y-axis rotational inertia of a body axis system, Xub is a derivative of a forward resultant force with respect to a longitudinal variable pitch control quantity, Zub is a derivative of the vertical resultant force with respect to the longitudinal variable pitch control quantity, Zuc is a derivative of the vertical resultant force with respect to the collective pitch control quantity, Mub is a derivative of the pitch moment with respect to the longitudinal variable pitch control quantity, Muc is a derivative of the pitch moment with respect to the collective pitch control quantity, ub,P is a longitudinal variable pitch control quantity, and uc,P is a collective pitch control quantity.


Further, after S11, the method further includes S12:


the lateral linearization model of the tandem rotor unmanned aerial vehicle is expressed as:






{dot over (x)}θ
v1(t)=Aθv1xθv1(t)+bθv11(t)u1(t)+θ1T(t)xθv1(t)+σ1(t))






y
θ

v1
(t)=cθv1Txθv1(t)


In the formula, xθv1 (t) is a lateral motion state variable. The lateral motion state variable includes: a transverse roll rate, a transverse roll angle, a yaw rate, and a side speed. xθv1 (t) is a change rate of the lateral motion state variable, {dot over (y)}θv1 (t) is a yaw attitude angle output quantity, Aθv1 (t) is a lateral system state spatial matrix, bθv1 (t) is a lateral system state input matrix, and ω1(t) is a weight of a lateral input and is used for compensating an error of a system input matrix; u1(t) is a lateral variable pitch input quantity, θ1(t) is a lateral motion model disturbance parameter, that is, a system error of a lateral motion model, θ1T(t) is a transpose of θ1(t), σ1 (t) is a lateral external environment disturbance parameter, that is, an influence error of the rotor unmanned aerial vehicle caused by external environment factors cθv1T is a lateral, system state output matrix, and t is a time parameter.


Specifically, Xθv1 (t) is a column vector of 1×4, and θ1(t) is a weighted parameter row vector of 1×4.


It is necessary to assume that the parameters in the model satisfy the following conditions:


Assumption 1: Parameters θ1(t) and σ1(t) satisfy:





θ1(t)∈Θ,∥σ1(t)|≤Δ0,∀t≥0


Where Θ is a known convex set, Δ0∈R+.


Assumption 2: parameters θ1(t) and σ1(t) are continuously differentiable and uniformly bounded: ∥{dot over (θ)}1(t)∥≤dθ<∞,|{dot over (σ)}11(t)|≤dσ<∞, ∀t≥0


Assumption 3: the weighted parameter ω1∈R satisfies:





ω1∈Ω0∈[ω1 ωu].


For the lateral linearization model of the present disclosure, all assumptions above can be satisfied to ensure the reliability of the model.


For the lateral linearization model, an indicator function related to the lateral motion state variable and the lateral motion control input quantity is fit:

    • J1=∫(x1TQ1x1+u1TR1u1)dt


J1 is the indicator function, x1 is an error quantity matrix between a desired lateral motion state variable and a real lateral motion state variable, x1T is a transpose of x1, u1 is a yaw control quantity and a transverse periodic variable pitch input matrix, and u1T is a transpose of u1; Q1 is a lateral motion state variable weighted parameter matrix, R1 is a weighted parameter matrix of the lateral motion control input quantity, u1=−Km1x1, specifically, Q1 is a 4×4 weighted parameter matrix, R1 is a 2×2 weighted parameter matrix, Km1 is a feedback gain matrix, and Q1 and R1 in the indicator function respectively realize the weighting of the lateral motion state variable and the transverse periodic variable pitch input quantity. Both matrix Q1 and matrix R1 are diagonal positive semi-definite matrixes, elements on a diagonal line of the matrix Q1 directly affect the convergence rate of the corresponding lateral motion state variable, and elements on a diagonal line of the matrix R1 directly affect the energy magnitude of the transverse periodic variable pitch input quantity. The higher the convergence rate of lateral motion state variable, the greater the energy of the transverse periodic variable pitch input quantity, and the higher the requirement on actuators such as a steering engine. The optimal control of an LQR is to select Q1 and R1 in advance according to a real model to find out an appropriate feedback gain matrix Km1, and a feedback control input u1=−Km1x1 thereof optimizes the indicator function J1; and the indicator function J1 is optimal when reaching a minimum value, and the optimal represents the most energy-saving state of the model.


The solution of the feedback gain matrix Km1 in the linear quadratic regulation algorithm is:






K
m1
=R
1
−1
b
θ

v1

T
P
1


Where R1−1 is an inverse of R, bθv1T is a transpose of vθv1, P1 is an intermediate parameter matrix, and P1 is obtained by solving the following Riccati equation:






A
θ

v1

T
P
1
+P
1
A
θ

v1

−P
1
b
θ

v1

R
1
−1
b
θ

v1

P
1
+Q
1=0


Where Aθv1T is a transpose of Aθv1.


The lateral linearization model with a lateral motion state variable feedback is expressed as:






{dot over (x)}θ
v1(t)=Am1xθv1(t)+bθv11(t)u1(t)+θ1T(t)xθv1(t)+σ1(t))






y
θ

v1
(t)=cθv1Txθv1(t)






A
m1
=A
θ

v1

−b
θ

v1

K
m1


Where Am1 is a lateral system state spatial feedback matrix.


Further, after S21, the method further includes S22:


a specific expression formula of a lateral full-order state observer is as follows:





{circumflex over ({dot over (x)})}θv1(t)=Aθv1{circumflex over (x)}θv1(t)+bθv1({circumflex over (ω)}1(t)u1(t)+{circumflex over (θ)}1T(t)xθv1(t)+{circumflex over (σ)}1(t))






ŷ
θ

v1
(t)=cθv1T{circumflex over (x)}θv1(t)


Where {circumflex over (x)}θv1(t) is an estimated value of the lateral motion state variable, {circumflex over ({dot over (x)})}θv1(t) is a change rate of the estimated value of the lateral motion state variable and is an input weighted estimated value, {circumflex over (θ)}1(t) is an estimated value of θ1T(t), and {circumflex over (σ)}1(t) is an estimated value of the lateral external environment disturbance parameter; ŷθv1(t) is an estimated value of a yaw attitude angle, and the lateral full-order state observer calculates the estimated value xθv1(t) of the lateral motion state variable.


Different from the above model expression formula, parameters ω1(t), θ1(t), and {circumflex over (σ)}1(t) in the model are all estimated values calculated by the parameter adaptive law, and the observer calculates an estimated value {circumflex over (x)}θv1(t) of the state variable accordingly. The deviation between the estimated state variable and a real state variable is used for the calculation of the parameter adaptive law.


An estimated error of the lateral motion state variable is as follows:





{tilde over ({dot over (x)})}θv1(t)=Aθv{tilde over (x)}θv1(t)+bθv1({tilde over (ω)}1(t)u1(t)+{tilde over (θ)}1T(t)xθv1(t)+{tilde over (σ)}1(t))






{tilde over (x)}
θ

v1
(0)=0





{tilde over (θ)}1(t)={circumflex over (θ)}1(t)−θ1(t)






{tilde over (x)}
θ

v1
(t)={circumflex over (x)}θv1(t)−xθv1(t)





{tilde over (ω)}1(t)={circumflex over (ω)}1(t)−ω1(t)





{tilde over (σ)}1(t)={circumflex over (σ)}1(t)−σ1(t)


Where {tilde over ({dot over (x)})}θv1(t) is a change rate of the estimated error of the lateral motion state variable, {tilde over (x)}θv1 (t) is the estimated error of the lateral motion state variable, ω1(t) is a lateral input weighted estimated error, {circumflex over (θ)}1(t) is an estimated value of a lateral motion model disturbance parameter, {tilde over (θ)}1(t) is an estimated error of the lateral motion model disturbance parameter, and {tilde over (σ)}1(t) is an estimated error of the lateral external environment disturbance parameter. According to a relevant theorem of an L1 adaptive control theory, it can be proved that an estimated state error of the system is uniformly bounded.


Further, after S31, the method further includes S32:

    • the parameter adaptive law is designed to obtain {circumflex over (θ)}1(t), {circumflex over (σ)}1(t) and ω1(t) according to the estimated error of the lateral motion state variable; and an adaptive law calculation formula is as follows:





{circumflex over ({dot over (θ)})}1(t)=ΓProj({circumflex over (θ)}1(t),−custom-character(t)Pbθv1xθv1(t)),{circumflex over (θ)}1(0)={circumflex over (θ)}0





{circumflex over ({dot over (σ)})}1(t)=ΓProj({circumflex over (σ)}1(t),−{tilde over (x)}θv1T(t)Pbθv1),{circumflex over (σ)}1(0)={circumflex over (σ)}0





{circumflex over ({dot over (ω)})}1(t)=ΓProj({circumflex over (ω)}1(t),−{tilde over (x)}θvT(t)Pbθv1uad(t)),{circumflex over (ω)}1(0)={circumflex over (ω)}0

    • wherein {circumflex over ({dot over (θ)})}1(t) is a change rate of the estimated value of the lateral motion model disturbance parameter, {circumflex over ({dot over (σ)})}1(t) is a change rate of the estimated value of the lateral external environment disturbance parameter, {circumflex over ({dot over (ω)})}1(t) is a change rate of the lateral input weighted; estimated value, Γ∈R+ is an adaptive gain, and Proj(⋅) is a projection operator, which is specifically defined as follows:







Proj

(

θ
,
y

)

=

{




y
,





f

(
θ
)

<
0







y
-





f

(
θ
)







f

(
θ
)













f

(
θ
)







f

(
θ
)





,
y





f

(
θ
)



,






f

(
θ
)


0

,






f

(
θ
)

T



y

>
0







y
,






f

(
θ
)


0

,






f

(
θ
)

T



y


0










Where ƒ:Rn→R is a smooth convex function, which is specifically defined as follows:







f

(
θ
)

=




(


ε
θ

+
1

)



θ
T


θ

-

θ
max
2




ε
θ



θ
max
2







Where θmax is a boundary constraint of a vector θ; εθ is any small positive real number less than 1; and ∇ƒ(θ) is set as a gradient of ƒ(⋅) at θ.


P1=P1T is substituted in the Lyapunov equation as follows:






A
m1
T
P
1
+P
1
A
m1
=−Q
1


For the solution of any Q1=QT1, Am1T is a transpose of the lateral system state spatial feedback matrix. For any value of Q1, the solution of the P1 is unique. In combination with a lateral motion modeling case, it can be known that the input weighted parameter ω1(t) and the lateral motion model disturbance parameter θ1(t) are related to the weight, the rotational inertia, and the aerodynamic parameter of the tandem rotor unmanned aerial vehicle, and σ1(t) is related to the disturbance of external environmental factors, such as wind.


The L1 adaptive controller of the lateral motion system is designed and the lateral motion control input quantity is output according to the estimated value {circumflex over (θ)}1(t) the lateral motion model disturbance parameter, the estimated value {circumflex over (σ)}1(t) of the external environment disturbance parameter, the input weighted estimated value {circumflex over (φ)}1(t), the estimated value {circumflex over (x)}θv1(t) of the lateral motion state variable, the estimated error {tilde over (x)}θv1(t) of the lateral motion state variable, and the received desired attitude command signal.


Further, after S41, the method further includes S42: a specific formula of the L1 adaptive controller of the lateral motion system is designed as follows:






u
ad1(s)=−k1D1(s)({circumflex over (η)}1(s)−kg1r1(s))


Where uad1(t) is a combination of the transverse periodic variable pitch input quantity and the yaw control quantity, uad1(s) is the Laplace transform of uad1(t), r1(s) is the Laplace transform of a command input r1(t), and {circumflex over (η)}1(s) is the Laplace transform of {circumflex over (η)}1(t), {circumflex over (η)}1(t)={circumflex over (ω)}1(t)uad1(t)+{circumflex over (θ)}1Txθv1(t)+{circumflex over (σ)}1(t); kg1 is a gain of the command input,






k
g1=−1/(cθv1TAm1−1bθv1)


so that the system outputs a tracking command input signal that can be stabilized; D1(S) is a strictly positive real transfer function,









D
1

(
s
)

=

1
s


,




S expresses a s domain, and k1 is an adaptive feedback gain.


An appropriate adaptive feedback gain value is designed, which can ensure the asymptotic stability of a closed loop system. Therefore, an expression formula of a transfer function output by the lateral full-order state observer is solved as:






ŷ
1
=c
θ

v1

T(sI−Am1)−1bθv1({circumflex over (ω)}1u1+{circumflex over (θ)}1x1+{circumflex over (σ)}1)


Where ŷ1 is the transfer function, I is a unit matrix, s is an s domain, cθv1T is a lateral system state output matrix, Am1 is a lateral system state spatial feedback matrix, bθv1 is a lateral system state input matrix, {circumflex over (ω)}1 is an input weighted estimated value, u1 is a lateral variable pitch input quantity, {circumflex over (θ)}1 is an estimated value of the lateral motion model disturbance parameter, x1 is a lateral motion state variable, and {circumflex over (σ)}1 is an estimated value of the lateral external environment disturbance parameter.


When time tends to infinity, an output value may reach:






ŷ
1
=−c
θ

v1

T
A
m1
−1
b
θ

v1
({circumflex over (ω)}1u1+{circumflex over (θ)}1x1+{circumflex over (σ)}1)


In order to achieve ŷ1=r1, it may be solved that:







u
1

=


1


ω
^

1




(



-

1


-

c

θ

v

1


T




A

m

1


-
1




b

θ

v

1








r
1


-



θ
ˆ

1



x
1


-


σ
ˆ

1


)






Therefore, the gain kg1=−1/(cθv1TAm1−1b74 v1) may be solved.


D1(s) is a strictly positive real transfer function, and








D
1

(
s
)

=

1
s





is selected to facilitate design here.


The form of a low pass filter is set as:








C
1

(
s
)

=



ω
1



k
1



s
+


ω
1



k
1








The design of the low pass filter C1(s) needs to ensure C1(0)=1, and when a s domain and a frequency domain are 0, an input of the low pass filter is equal to an output. The value k1 of the adaptive feedback gain directly affects the bandwidth of the low pass filter.


In order to ensure the asymptotic stability of the closed loop system, the design of k1 must satisfy an L1 small gain theorem of the closed loop system. Now, it is defined that:






L
1=maxθ∈Θ∥θ11






H
1(s)=(sI−Am1)−1b1






G
1(s)=H1(s)(1−C1(s))


L1, H1(s), and G1(s) are respectively intermediate variable transfer functions.


According to the L1 small gain theorem of the closed loop system, the designed adaptive feedback gain k needs to satisfy:





G1(s)∥L1L1<1


G1(s) is a transfer function, which is a description of the low pass filter and a system without a state feedback.


For the lateral motion model, the designed lateral motion control input quantity includes a yaw control quantity and a transverse periodic variable pitch input quantity. Therefore, the lateral linearization motion equation of the tandem rotor unmanned aerial vehicle is as follows:








[





p
.

p







ϕ
.

P







r
.

P







v
.

P




]

=

[




(




I
1



L
p



I
xx


+



I
3



N
p



I
zz



)



0



(




I
1



L
r



I
xx


+



I
3



N
r



I
zz



)




(




I
1



L
v



I
xx


+



I
3



N
v



I
zz



)





1


0



tan


θ
N






-
g


sin


θ
N










I
2



L
p



I
xx


+



I
1



N
p



I
zz





0



(




I
2



L
r



I
xx


+



I
1



N
r



I
zz



)




(




I
2



L
v



I
xx


+



I
1



N
v



I
zz



)






(


w
N

+


Y
p

m


)




g

cos


θ
N





(



Y
r

m

-

u
N


)





Y
v

m




]






[




p
P






ϕ
P






r
P






v
P




]

+


[




(




I
1



L

u
a




I
xx


+



I
3



N

u
a




I
zz



)




(




I
1



L

u
r




I
xx


+



I
3



N

u
r




I
zz



)





0


0





(




I
2



L

u
a




I
xx


+



I
1



N

u
a




I
zz



)




(




l
2



L

u
γ




l
m


+



l
1



N

u
γ




l

Z

Z




)






Y

u
a





Y

u
r





]

[




u

a
,
P







u

r
,
P





]






Where pP is a transverse roll rate, {dot over (p)}P is a change rate of the transverse roll rate, ϕP is a transverse roll angle, {dot over (ϕ)}P is a change rate of the transverse roll angle, rP is a yaw rate, {dot over (r)}P is a change rate of the yaw rate, vP is a side speed, {dot over (v)}P is a change rate of a side speed, Lp is an aerodynamic derivative related to the roll rate and the roll angle, Np is an aerodynamic derivative related to the roll rate and a yaw angle, Ixx is an x-axis rotational inertia of a body axis system, Izz is a z-axis rotational inertia of the body axis system, wN is a vertical speed reference quantity, Yp is an aerodynamic derivative related to the roll rate and a side aerodynamic force, m is the mass of the tandem rotor unmanned aerial vehicle, g is a gravitational acceleration, θN is an aircraft pitch angle when longitudinal motion is trimmed, Lr is an aerodynamic derivative related to the yaw rate and the roll angle, Nr is an aerodynamic derivative related to the yaw rate and the yaw angle, Lv is an aerodynamic derivative related to the side speed and the roll angle, Nv is an aerodynamic derivative related to the side speed and the yaw angle, Yr is an aerodynamic derivative related to the yaw rate and the side aerodynamic force, uN is a forward speed reference value, Yv is an aerodynamic derivative related to the side speed and the side aerodynamic force, Lua is a derivative of roll moment with respect to the transverse variable pitch control quantity, Nua is a derivative of yaw moment with respect to the transverse variable pitch control quantity, Lur is a derivative of the roll moment with respect to a yaw control quantity, Nur is a derivative of the yaw moment with respect to the yaw control quantity, Ua,P is a transverse variable pitch control quantity, Nr,P is the yaw control quantity, Yua is a derivative of the side aerodynamic force with respect to the transverse variable pitch control quantity, and Yur is a derivative of the side aerodynamic force with respect to the yaw control quantity.


The body axis system is that origin O is taken from the rotor unmanned aerial vehicle, and an ox axis of the body axis system is parallel to the axis of the rotor unmanned aerial vehicle. In the above formula,









I
1

=



I
XX



I

Z

Z






I
XX



I

Z

Z



-

I

X

Z

2




;


I
2

=



I
XX



I

X

Z






I
XX



I

Z

Z



-

I

X

Z

2




;


I
3

=



I

Z

Z




I

X

Z






I
XX



I

Z

Z



-

I

X

Z

2





,




X, Y, and Z are resultant forces in the x, y, and z directions in the body axis system. The aerodynamic derivative and an operation derivative are recorded as:








B

a

=



B



a



;




a is a state quantity or a control input quantity, and B is a force or moment. ub,P is a collective pitch input quantity, uc,P is a longitudinal variable pitch control input quantity, ua,P is a transverse variable pitch control input quantity, and ur,P is a yaw control input quantity.


For the longitudinal motion model, the designed adaptive control input quantity is the collective pitch input quantity and the longitudinal periodic variable pitch input quantity; the collective pitch input quantity is an up-down lifting quantity; the longitudinal periodic variable pitch input quantity is a front-rear tilt quantity. For the lateral motion model, the control input quantity is the yaw control quantity and the transverse periodic variable pitch input quantity. The transverse periodic variable pitch input quantity is a left-right tilt quantity, and the yaw control quantity is a left-right swinging quantity.


The LQR is the linear quadratic regulation algorithm, called LQR for short. The LQR may obtain an optimal control law of a state linear feedback, which is easy to form closed-loop optimal control. The L1 adaptive control is a control consisting of a controlled object, a state predictor, an adaptive control law, a control law, and the like. The L1 adaptive controller, that is, the L1 adaptive control algorithm, is a fast and robust adaptive control. The algorithm is actually that a model is improved with reference to adaptive control. A low pass filter is added in a control law design link, which ensures the separation of the control law and an adaptive law design.


The controlled object: the controlled object is expressed in the form of state space, where ω, θ, and the like are parameter uncertainties.


The state predictor: a mathematical model is shown in the figure above, where x, ω, and the like are corresponding to estimated values in the controlled object. When time tends to infinity, the controlled object and the state predictor have consistent dynamic characteristics. The estimated deviation is stable in the sense of Lyapunov.


The adaptive law: an error between the state predictor and the controlled object is taken as a main input, which ensures that the error is stable in the sense of Lyapunov, and estimations of uncertainty parameters are obtained.


The control law: the control law includes two parts: 1, reconstruction for a reference input matched with the state predictor; and 2, a low pass filtering link.


The control law of an attitude adjustment section of the attitude adjustment control method for the tandem rotor unmanned aerial vehicle of an embodiment of the present disclosure is specifically designed by using an L1 adaptive control structure method, and an overall closed loop control system is designed. FIG. 4 is a schematic diagram of an L1 adaptive control structure. An input design of the L1 adaptive controller includes a state feedback design and an adaptive control input design. The state feedback design is that a state feedback gain matrix reasonably allocates a system pole, so that an output of the system is stable, and meanwhile, input energy and an output change may reach the optimal. An adaptive control input is a core of the L1 adaptive controller. The output of the overall closed loop control system can meet desired dynamic characteristics by compensating the uncertainties of system parameters and external disturbances. The adaptive controller receives parameters instructing to input commands and estimations, and transmits a command control signal to a low pass filter for filtering. The filtered signal is sent to controlled objects, that is, a tandem rotor unmanned aerial vehicle and a state observer. The controlled object feeds back a state variable and a full-order state observer obtains an estimated state error of the system. The parameter adaptive law then calculates estimated values of related unknown parameters by means of a projection operation according to the estimated state error. The unknown parameters include transverse and longitudinal linearization model errors and an external environment disturbance parameter. The adaptive controller reconstructs an input through the estimated related parameters to compensate for the influence caused by model disturbance and uncertain change factors.


When the L1 adaptive control acts, the estimated state error of the control system is obtained by using the full-order state observer first, and then the parameter adaptive law calculates the estimated values of the related unknown parameters through the projection operator according to the estimated state error. The unknown parameters include transverse and longitudinal linearization model errors and an external environment disturbance parameter. The adaptive controller reconstructs the input through the estimated related parameters to compensate for the influence caused by system disturbance and uncertain change factors. The function of the low pass filter is to filter away a high-frequency signal from a control input signal. The design of a bandwidth of the low pass filter directly affects an amplitude value margin and a phase angle margin of system control, thereby affecting the robustness of controlling a model and a system.



FIG. 5 is a simulation result diagram of a given 10° pitch angle step command signal. It can be seen from the figure that a dynamic transition time of the L1 adaptive controller is about 1.2 s, and an output does not have an overshoot. FIG. 6 is a control input change curve when a pitch angle tracking 10° step signal is controlled. It can be seen from FIG. 6 that the longitudinal periodic variable pitch input energy required for the design of the pitch attitude adjustment controller is relatively low, and the oscillation amplitude is about 10°.



FIG. 7 is a simulation process that an attitude controller adjusts the roll angle to 0° when the tandem rotor unmanned aerial vehicle is set to be subjected to a 10° roll angle disturbance in an initial state. It can be seen from FIG. 7 that the attenuation adjustment speed of the roll angle is high, a steady-state establishment time is about 5 s, and a maximum value in a dynamic oscillation process does not exceeds 3°. FIG. 8 is a transverse variable pitch control input change curve in a process of adjusting a roll angle to 0°. It can be seen from FIG. 8 that the maximum amplitude value of an input of a roll controller does not exceed 35°, and the required control energy is within an acceptable range.



FIG. 9 is a simulation process that the attitude controller adjusts a yaw rate to 0° when the tandem rotor unmanned aerial vehicle is set to be subjected to a 1°/s yaw rate disturbance in an initial state. It can be seen from FIG. 9 that the steady-state establishment time of the yaw rate is about 6 s. There is no overshoot during the overall stable adjustment control process. FIG. 10 is a yaw control input change curve in a process of adjusting a yaw rate to 0. It can be seen from FIG. 10 that the maximum fluctuation amplitude value of an input of a yaw controller is 5°, and the required control energy is relatively low.



FIG. 11 is a pitch angle output tracking response after a rotor of the tandem rotor unmanned aerial vehicle is unfolded. It can be known from FIG. 11 that the pitch attitude response of the unmanned aerial vehicle is fast in a process of adjusting a pitch attitude of the unmanned aerial vehicle from 10° to −10°, oscillation and overshoot do not occur, and a dynamic process is good. FIG. 12 is a roll angle output tracking response of the tandem rotor unmanned aerial vehicle. It can be known from FIG. 12 that the roll attitude response of the unmanned aerial vehicle is fast in a process of controlling a roll attitude of the unmanned aerial vehicle from 0° to 10° and then from 10° to 0°, oscillation and overshoot do not occur, and a dynamic process is good. FIG. 13 is a yaw angle output tracking response of the tandem rotor unmanned aerial vehicle. It can be known from FIG. 13 that the yaw attitude response of the unmanned aerial vehicle is fast in a process of adjusting a yaw attitude of the unmanned aerial vehicle from 0° to 10° and then from 10° to 0°, oscillation and overshoot do not occur, and a dynamic process is good. It can be seen that, under the design of the LQR, an L1 adaptivity-based attitude adjustment controller can satisfy a condition of an input energy optimal design, and meanwhile, the fast and robust adjustment of the attitude of the unmanned aerial vehicle can be realized.


A working process of the present disclosure is that: when the tandem rotor unmanned aerial vehicle is launched, a motor provides power, a rotor is unfolded, and an attitude adjustment control command is input to start to adjust the attitude of the tandem rotor unmanned aerial vehicle. By the attitude adjustment control method for the tandem rotor unmanned aerial vehicle, a lateral motion control input quantity and a longitudinal motion control input quantity are generated, the lateral motion control input quantity and the longitudinal motion control input quantity are input into a flight control system, the flight control system receives the lateral motion control input quantity and the longitudinal motion control input quantity, and then the tandem rotor unmanned aerial vehicle is adjusted to a desired state by controlling the motor, the steering engine, and the automatic tilter.


The attitude adjustment control method for the tandem rotor unmanned aerial vehicle of the embodiment of the present disclosure has high control efficiency, and can adjust the tandem rotor unmanned aerial vehicle to an appropriate state within a shortest time. The fuel consumed in an adjustment process is the least, more fuel is saved, and an adjustment process is more stable and reliable.


In the descriptions of the specification, the descriptions made with reference to terms “an embodiment”, “some embodiments”, “example”, “specific example”, “some examples” or the like refer to that specific features, structures, materials or characteristics described in combination with the embodiment or the example are included in at least one embodiment or example of the present disclosure. In the present specification, the schematic representation of the above terms does not necessarily mean the same embodiment or example. Furthermore, the specific features, structures, materials, or characteristics described may be combined in a suitable manner in any one or more embodiments or examples.


It is not difficult for those skilled in the art to understand that the present disclosure includes any combination of the summary and detailed description of the embodiments of then description and various parts shown in the drawings. Due to limited space, various solutions formed by these combinations are not described one by one in order to make the description concise. Any modifications, equivalent replacements, improvements and the like made within the spirit and principle of the present disclosure shall fall within the scope of protection of the present disclosure.

Claims
  • 1. A tandem rotor unmanned aerial vehicle, comprising a vehicle body, a flight control system, and a propulsion system, wherein the propulsion system comprises a front distributed propulsion system and a rear distributed propulsion system; the front distributed propulsion system is arranged at a front end of the vehicle body; the rear distributed propulsion system is arranged a rear end of the vehicle body; the front distributed propulsion system comprises rotor blades, a rotor nose, a main shaft, a speed reducer, a synchronizer, a motor, and a periodic variable pitch mechanism; the rotor blades are connected to the rotor nose; the rotor nose is connected to the main shaft; an output end of the motor is connected to the speed reducer; the speed reducer is connected to the synchronizer; the main shaft is connected to the speed reducer; the motor drives the main shaft to rotate through the speed reducer; the periodic variable pitch mechanism comprises a steering engine set and an automatic tilter; an output end of the steering engine set is connected to the automatic tilter; the automatic tilter is arranged on the main shaft in a sleeving manner; the automatic tilter is connected to the rotor nose; the automatic tilter changes tilt directions of the rotor blades through the rotor nose; the steering engine set comprises three steering engines; the flight control system controls the motor and the steering engine set to realize attitude adjustment of the tandem rotor unmanned aerial vehicle.
  • 2. The tandem rotor unmanned aerial vehicle according to claim 1, wherein the rear distributed propulsion system has the same structure as the front distributed propulsion system.
  • 3. The tandem rotor unmanned aerial vehicle according to claim 1, wherein the flight control system controls an attitude adjustment loop of the tandem rotor unmanned aerial vehicle by combining a linear quadratic regulation algorithm and an L1 adaptive control algorithm to realize the attitude adjustment of the tandem rotor unmanned aerial vehicle and ensure robust control of the attitude adjustment, which comprises: establishing a transverse and longitudinal linearization model of the tandem rotor unmanned aerial vehicle in different flight conditions, and designing a state feedback gain matrix of the transverse and longitudinal linearization model by using the linear quadratic regulation algorithm;designing a full-order state observer according to the transverse and longitudinal linearization model, and combining an observation state quantity value output by the full-order state observer and a measurement value of a sensor to obtain an estimated value of a state variable and an estimated error of the state variable;designing a parameter adaptive law to obtain an estimated value of a disturbance parameter according to the estimated error of the state variable;designing an L1 adaptive controller of a transverse and longitudinal motion system to obtain a control input quantity according to the estimated value of the disturbance parameter, the estimated value of the state variable, the estimated error of the state variable, and a received desired attitude command signal; andcontrolling the tandem rotor unmanned aerial vehicle to complete the attitude adjustment according to the control input quantity.
  • 4. The tandem rotor unmanned aerial vehicle according to claim 3, wherein the transverse and longitudinal linearization model comprises a lateral linearization model and a longitudinal linearization model; the control input quantity comprises a lateral motion control input quantity and a longitudinal motion control input quantity; the L1 adaptive controller of the transverse and longitudinal motion system comprises an L1 adaptive controller of a lateral motion system and an L1 adaptive controller of a longitudinal motion system; the L1 adaptive controller of the lateral motion system outputs the lateral motion control input quantity; the lateral motion control input quantity comprises a transverse periodic variable pitch input quantity and a yaw control quantity; the L1 adaptive controller of the longitudinal motion system outputs the longitudinal motion control input quantity; the longitudinal motion control input quantity comprises a collective pitch input quantity and a longitudinal periodic variable pitch input quantity; the state variable comprises a transverse motion state variable and a longitudinal motion state variable; and the full-order state observer comprises a longitudinal full-order state observer and a lateral full-order state observer.
  • 5. The tandem rotor unmanned aerial vehicle according to claim 4, wherein the longitudinal linearization model of the tandem rotor unmanned aerial vehicle is expressed as: {dot over (x)}θv(t)=Aθvxθv(t)+bθv(ω(t)u(t)+θT(t)xθv(t)+σ(t))yθv(t)=cθvTxθv(t)in the formula, xθv(t) is the longitudinal motion state variable, {dot over (x)}θv(t) is a change rate of the longitudinal motion state variable, yθv(t) is a pitch attitude angle output quantity, Aθv is a longitudinal system state spatial matrix, bθv is a longitudinal system state input matrix, ω(t) is an input weight and is used for compensating an error of a system input matrix; u(t) is a longitudinal variable pitch input quantity, θ(t) is a longitudinal motion model disturbance parameter, θT(t) is a transpose of θ(t) σ(t) is an external environment disturbance parameter, cθvT is a longitudinal system state output matrix, and t is a time parameter;for the longitudinal linearization model, an indicator function related to the longitudinal motion state variable and the longitudinal motion control input quantity is fit: J=∫(xTQx+uTRu)dt J is the indicator function, x is an error quantity matrix between a desired longitudinal motion state variable and a real longitudinal motion state variable, xT is a transpose of x, u is a collective pitch input quantity and a longitudinal periodic variable pitch input matrix, uT is a transpose of u; Q is a longitudinal motion state variable weighted parameter matrix, R is a weighted parameter matrix of the longitudinal motion control input quantity, u=Kmx, Km is a feedback gain matrix, and the solution of the feedback gain matrix Km in the linear quadratic regulation algorithm is: Km=R−1bθvTP wherein R−1 is an inverse of R, bθvT is a transpose of bθv, P is an intermediate parameter matrix, and P is obtained by solving the following Riccati equation: AθvTP+PAθv−PbθvR−1bθvP+Q=0wherein AθvT is a transpose of Aθv;the longitudinal linearization model with a longitudinal motion state variable feedback is expressed as: {dot over (x)}θv(t)=Amxθv(t)+bθv(ω(t)u(t)+θT(t)xθv(t)+σ(t))yθv(t)=cθvTxθv(t)Am=Aθv−bθvKm wherein Am is a longitudinal system state spatial feedback matrix.
  • 6. The tandem rotor unmanned aerial vehicle according to claim 5, wherein a specific expression formula of the longitudinal full-order state observer is as follows: {circumflex over ({dot over (x)})}θv(t)=Aθv{circumflex over (x)}θv(t)+bθv({circumflex over (ω)}(t)u(t)+{circumflex over (θ)}T(t)xθv(t)+{circumflex over (σ)}(t))ŷθv(t)=cθvT{circumflex over (x)}θv(t)wherein {circumflex over (x)}θv(t) is an estimated value of the longitudinal motion state variable, {circumflex over ({dot over (x)})}θv(t) is a change rate of the estimated value of the longitudinal motion state variable, {circumflex over (ω)}(t) is an input weighted estimated value, {circumflex over (θ)}T(t) is an estimated value of θT(t), {circumflex over (σ)}(t) is an estimated value of the external environment disturbance parameter; ŷθv(t) is an estimated value of a pitch attitude angle, and the estimated value {circumflex over (x)}θv(t) of the longitudinal motion state variable is calculated;an estimated error of the longitudinal motion state variable is as follows: {tilde over ({dot over (x)})}θv(t)=Aθv{tilde over (x)}θv(t)+bθv({tilde over (ω)}(t)u(t)+{tilde over (θ)}T(t)xθv(t)+{tilde over (σ)}(t)){tilde over (x)}θv(0)=0{tilde over (θ)}(t)={circumflex over (θ)}(t)−θ(t){tilde over (x)}θv(t)={circumflex over (x)}θv(t)−xθv(t){tilde over (ω)}(t)={circumflex over (ω)}(t)−ω(t){tilde over (σ)}(t)={circumflex over (σ)}(t)−σ(t)wherein {tilde over ({dot over (x)})}θv(t) is a change rate of the estimated error of the longitudinal motion state variable, {tilde over (x)}θv (t) is the estimated error of the longitudinal motion state variable, {tilde over (ω)}(t) is an input weighted estimated error, {circumflex over (θ)}(t) is an estimated value of the longitudinal motion model disturbance parameter, {tilde over (θ)}(t) is an estimated error of the longitudinal motion model disturbance parameter, and {tilde over (σ)}(t) is an estimated error of the external environment disturbance parameter;a parameter adaptive law is designed to obtain {circumflex over (θ)}(t), {circumflex over (σ)}(t), and {circumflex over (ω)}(t) according to the estimated error of the longitudinal motion state variable; and an adaptive law calculation formula is as follows: {circumflex over ({dot over (θ)})}(t)=ΓProj({circumflex over (θ)}(t),−{tilde over (x)}θvT(t)Pbθvxθv(t)){circumflex over ({dot over (σ)})}(t)=ΓProj({circumflex over (σ)}(t),−{tilde over (x)}θvT(t)Pbθv),{circumflex over (σ)}(0)={circumflex over (σ)}0 {circumflex over ({dot over (ω)})}(t)=ΓProj({circumflex over (ω)}(t),−{tilde over (x)}θvT(t)Pbθvuad(t)),{circumflex over (ω)}(0)={circumflex over (ω)}0 wherein {circumflex over ({dot over (θ)})}(t) is a change rate of the estimated value of the longitudinal motion model disturbance parameter, {circumflex over ({dot over (σ)})}(t) is a change rate of the estimated value of the external environment disturbance parameter, and {circumflex over ({dot over (ω)})}(t) is a change rate of the input weighted estimated value;the L1 adaptive controller of the longitudinal motion system is designed and the longitudinal motion control input quantity is output according to the estimated value {circumflex over (θ)}(t) of the longitudinal motion model disturbance parameter, the estimated value {circumflex over (σ)}(t) of the external environment disturbance parameter, the input weighted estimated value {circumflex over (ω)}(t), the estimated value {circumflex over (x)}θv (t) of the longitudinal motion state variable, the estimated error {tilde over (x)}θv(t) of the longitudinal motion state variable, and the received desired attitude command signal;a specific form of the designed L1 adaptive controller uad(t) is as follows: uad(s)=−kD(s)({circumflex over (η)}(s)−kgr(s))wherein uad(t) is a combination of the longitudinal periodic variable pitch input quantity and the collective pitch input quantity, uad(s) is the Laplace transform of uad(t), r(s) is the Laplace transform of a command input r(t), {circumflex over (η)}(s) is the Laplace transform of {circumflex over (η)}(t), {circumflex over (η)}(t)={circumflex over (ω)}(t)uad(t)+{circumflex over (θ)}Txθv(t)+{circumflex over (σ)}(t); kg is a gain of the command input, kg=−1/(cθvTAm−1bθv); and D(s) is a strictly positive real transfer function,
  • 7. An attitude adjustment control method for a tandem rotor unmanned aerial vehicle, wherein an attitude adjustment loop of the tandem rotor unmanned aerial vehicle according to claim 1 is controlled by combining a linear quadratic regulation algorithm and an L1 adaptive control algorithm to realize attitude adjustment of the tandem rotor unmanned aerial vehicle and ensure robust control of the attitude adjustment, which specifically comprises: S1: establishing a transverse and longitudinal linearization model of the tandem rotor unmanned aerial vehicle according to claim 1 in different flight conditions, and designing a state feedback gain matrix for the transverse and longitudinal linearization model through a Linear Quadratic Regulator (LQR);S2: designing a longitudinal full-order state observer according the transverse and longitudinal linearization model established in S1, and combining with a measurement value of a sensor to obtain an estimated value of a state variable and an estimated error of the state variable;S3: designing a parameter adaptive law to obtain an estimated value of a disturbance parameter according to the estimated error of the state variable obtained in S2;S4: designing an L1 adaptive controller of a transverse and longitudinal motion system to obtain a control input quantity according to the estimated value of the disturbance parameter obtained in S3, the estimated value of the state variable obtained in S2, the estimated error of the state variable, and a received desired attitude command signal; andS5: controlling the tandem rotor unmanned aerial vehicle to complete attitude adjustment according to the control input quantity.
  • 8. The attitude adjustment control method for a tandem rotor unmanned aerial vehicle according to claim 7, wherein the transverse and longitudinal linearization model comprises a lateral linearization model and a longitudinal linearization model; the control input quantity comprises a lateral motion control input quantity and a longitudinal motion control input quantity; the L1 adaptive controller of the transverse and longitudinal motion system comprises an L1 adaptive controller of a lateral motion system and an L1 adaptive controller of a longitudinal motion system; the L1 adaptive controller of the lateral motion system outputs the lateral motion control input quantity; the lateral motion control input quantity comprises a transverse periodic variable pitch input quantity and a yaw control quantity; the L1 adaptive controller of the longitudinal motion system outputs the longitudinal motion control input quantity; the longitudinal motion control input quantity comprises a collective pitch input quantity and a longitudinal periodic variable pitch input quantity; the state variable comprises a transverse motion state variable and a longitudinal motion state variable; and the full-order state observer comprises a longitudinal full-order state observer and a lateral full-order state observer.
  • 9. The attitude adjustment control method for a tandem rotor unmanned aerial vehicle according to claim 8, after S1, further comprising: S11: expressing the longitudinal linearization model of the tandem rotor unmanned aerial vehicle as: {dot over (x)}θv(t)=Aθvxθv(t)+bθv(ω(t)u(t)+θT(t)xθv(t)+σ(t))yθv(t)=cθvTxθv(t)wherein in the formula, xθv(t) is the longitudinal motion state variable, {dot over (x)}θv(t) is a change rate of the longitudinal motion state variable, yθv(t) is a pitch attitude angle output quantity, Aθv is a longitudinal system state spatial matrix, bθv is a longitudinal system state input matrix, ω(t) is an input weight and is used for compensating an error of a system input matrix; u(t) is a longitudinal variable pitch input quantity, θ(t) is a longitudinal motion model disturbance parameter, θT(t) is a transpose of θ(t), σ(t) is an external environment disturbance parameter, cθvT is a longitudinal system state output matrix, and t is a time parameter;for the longitudinal linearization model, an indicator function related to the longitudinal motion state variable and the longitudinal motion control input quantity is fit: J=∫(xTQx+uTRu)dt wherein J is the indicator function, x is an error quantity matrix between a desired longitudinal motion state variable and a real longitudinal motion state variable, xT is a transpose of x, u is a collective pitch input quantity and a longitudinal periodic variable pitch input matrix, and uT is a transpose of u; Q is a longitudinal motion state variable weighted parameter matrix, R is a weighted parameter matrix of the longitudinal motion control input quantity, u=−Kmx, Km is a feedback gain matrix, and the solution of the feedback gain matrix Km in the linear quadratic regulation algorithm is: Km=R−1bθvTP wherein R−1 an inverse of R, bθvT is a transpose of bθv, P is an intermediate parameter matrix, and P is obtained by solving the following Riccati equation: AθvTP+PAθv−PbθvR−1bθvP+Q=0wherein AθvT is a transpose of Aθv;the longitudinal linearization model with a longitudinal motion state variable feedback is expressed as: {dot over (x)}θv(t)=Amxθv(t)+bθv(ω(t)u(t)+θT(t)xθv(t)+σ(t))yθv(t)=cθvTxθv(t)Am=Aθv−bθvKm wherein Am is a longitudinal system state spatial feedback matrix.
  • 10. The attitude adjustment control method for a tandem rotor unmanned aerial vehicle according to claim 9, after S2, further comprising S21: designing a specific expression formula of the longitudinal full-order state observer as follows: {circumflex over ({dot over (x)})}θv(t)=Aθv{circumflex over (x)}θv(t)+bθv({circumflex over (ω)}(t)u(t)+{circumflex over (θ)}T(t)xθv(t)+{circumflex over (σ)}(t))ŷθv(t)=cθvT{circumflex over (x)}θv(t)wherein {circumflex over (x)}θv (t) is an estimated value of the longitudinal motion state variable, {circumflex over ({dot over (x)})}θv(t) is a change rate of the estimated value of the longitudinal motion state variable, {circumflex over (ω)}(t) is an input weighted estimated value, {circumflex over (θ)}T(t) is an estimated value of θT(t), {circumflex over (σ)}(t) is an estimated value of the external environment disturbance parameter; ŷθv(t) is an estimated value of a pitch attitude angle, and the estimated value {circumflex over (x)}θv(t) v of the longitudinal motion state variable is calculated;an estimated error of the longitudinal motion state variable is as follows: {tilde over ({dot over (x)})}θv(t)=Aθv{tilde over (x)}θv(t)+bθv({tilde over (ω)}(t)u(t)+{tilde over (θ)}T(t)xθv(t)+{tilde over (σ)}(t)){tilde over (x)}θv(0)=0{tilde over (θ)}(t)={circumflex over (θ)}(t)−θ(t){tilde over (x)}θv(t)={circumflex over (x)}θv(t)−xθv(t){tilde over (ω)}(t)={circumflex over (ω)}(t)−ω(t){tilde over (σ)}(t)={circumflex over (σ)}(t)−σ(t)wherein {tilde over ({dot over (x)})}θv(t) is a change rate of the estimated error of the longitudinal motion state variable, {tilde over (x)}θv(t) is the estimated error of the longitudinal motion state variable, {tilde over (ω)}(t) is an input weighted estimated error, {circumflex over (θ)}(t) is an estimated value of the longitudinal motion model disturbance parameter, {tilde over (θ)}(t) is an estimated error of the longitudinal motion model disturbance parameter, and {tilde over (σ)}(t) is an estimated error of the external environment disturbance parameter;after S3, further comprising S31: designing the parameter adaptive law to obtain {circumflex over (θ)}(t) {circumflex over (σ)}(t) and {circumflex over (ω)}(t) according to the estimated error of the longitudinal motion state variable, wherein an adaptive law calculation formula is as follows: {circumflex over ({dot over (θ)})}(t)=ΓProj({circumflex over (θ)}(t),−(t)Pbθvxθv(t)),{circumflex over (θ)}(0)={circumflex over (θ)}0 {circumflex over ({dot over (σ)})}(t)=ΓProj({circumflex over (σ)}(t),−{tilde over (x)}θvT(t)Pbθv),{circumflex over (σ)}(0)={circumflex over (σ)}0 {circumflex over ({dot over (ω)})}(t)=ΓProj({circumflex over (ω)}(t),−{tilde over (x)}θvT(t)Pbθvuad(t)),{circumflex over (ω)}(0)={circumflex over (ω)}0 wherein {circumflex over ({dot over (θ)})}(t) is a change rate of the estimated value of the longitudinal motion model disturbance parameter, {circumflex over ({dot over (σ)})}(t) is a change rate of the estimated value of the external environment disturbance parameter, and {circumflex over ({dot over (ω)})}(t) is a change rate of the input weighted estimated value;the L1 adaptive controller of the longitudinal motion system is designed and the longitudinal motion control input quantity is output according to the estimated value {circumflex over (θ)}(t) of the longitudinal motion model disturbance parameter, the estimated value {circumflex over (σ)}(t) of the external environment disturbance parameter, the input weighted estimated value {circumflex over (ω)}(t), the estimated value {circumflex over (x)}θv(t) of the longitudinal motion state variable, the estimated error {tilde over (x)}θv(t) of the longitudinal motion state variable, and the received desired attitude command signal;after S4, further comprising S41: designing a specific form of the L1 adaptive controller of the longitudinal motion system as follows: uad(s)=−kD(s)({circumflex over (η)}(s)−kgr(s))wherein uad(t) is a combination of the longitudinal periodic variable pitch input quantity and the collective pitch input quantity, uad(s) is the Laplace transform of uad(t), r(s) is the Laplace transform of a command input r(t), {circumflex over (η)}(s) is the Laplace transform of {circumflex over (η)}(t), {circumflex over (η)}(t)=ω(t)uad(t)+{circumflex over (θ)}Txθv(t)+{circumflex over (σ)}(t); kg is a gain of the command input, kg=−1/(cθvTAm−1bθv); D(s) is a strictly positive real transfer function,
Priority Claims (1)
Number Date Country Kind
202210351390.1 Apr 2022 CN national