CN114564047A - Unmanned aerial vehicle constant-speed flight control method considering meteorological conditions - Google Patents

Unmanned aerial vehicle constant-speed flight control method considering meteorological conditions Download PDF

Info

Publication number
CN114564047A
CN114564047A CN202210455586.5A CN202210455586A CN114564047A CN 114564047 A CN114564047 A CN 114564047A CN 202210455586 A CN202210455586 A CN 202210455586A CN 114564047 A CN114564047 A CN 114564047A
Authority
CN
China
Prior art keywords
unmanned aerial
aerial vehicle
sliding mode
speed
outer ring
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202210455586.5A
Other languages
Chinese (zh)
Other versions
CN114564047B (en
Inventor
阚梓
李道春
郑勇峰
姚卓尔
邵浩原
向锦武
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Avic Chengdu Uav System Co ltd
Beihang University
Original Assignee
Avic Chengdu Uav System Co ltd
Beihang University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Avic Chengdu Uav System Co ltd, Beihang University filed Critical Avic Chengdu Uav System Co ltd
Priority to CN202210455586.5A priority Critical patent/CN114564047B/en
Publication of CN114564047A publication Critical patent/CN114564047A/en
Application granted granted Critical
Publication of CN114564047B publication Critical patent/CN114564047B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/10—Simultaneous control of position or course in three dimensions
    • G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

The invention discloses an unmanned aerial vehicle constant-speed flight control method considering meteorological conditions, which comprises the following steps of establishing a flight dynamics equation of an unmanned aerial vehicle; converting a flight dynamics equation into an unmanned aerial vehicle state space equation, and adding a meteorological condition disturbance item; designing a sliding mode surface by using an unmanned aerial vehicle state space equation, carrying out Yapnov stability judgment on the sliding mode surface to obtain an inner-outer ring controller, designing a self-adaptation law corresponding to the meteorological condition disturbance term, and substituting the self-adaptation law into the inner-outer ring controller to obtain an inner-outer ring sliding mode controller capable of realizing parameter self-adaptation; and setting a flying speed, and when the unmanned aerial vehicle is disturbed by meteorological conditions, realizing constant-speed flying of the unmanned aerial vehicle through the parameter self-adaptive inner and outer ring sliding mode controller. The method adopts parameter self-adaptation, has obvious inhibiting effect on disturbance brought to the unmanned aerial vehicle by different complex meteorology, has relatively high control convergence speed, and does not bring large extra weight to the unmanned aerial vehicle.

Description

Unmanned aerial vehicle constant-speed flight control method considering meteorological conditions
Technical Field
The invention belongs to the field of unmanned aerial vehicle flight control, and particularly relates to an unmanned aerial vehicle constant-speed flight control method considering meteorological conditions.
Background
In recent years, unmanned aerial vehicles have become increasingly a research hotspot in the field of aviation. Unmanned aerial vehicles, as a product of modern science and technology, have an irreplaceable status in the civil field and also play a great role in the military field, so that the research and development investment on unmanned aerial vehicles is increased in each country. Along with the further expansion of unmanned aerial vehicle application range, it inevitably can meet complex meteorological conditions such as rainfall, icing, gust in flight process, these complex meteorology can bring certain influence to unmanned aerial vehicle's flight, raindrop striking unmanned aerial vehicle can bring additional power and additional moment under the rainfall environment for example, icing can worsen unmanned aerial vehicle flight performance, the gust also can give unmanned aerial vehicle increase additional aerodynamic force and moment, under the influence of these complex meteorological factors, unmanned aerial vehicle just hardly continues to keep predetermined speed flight. Therefore, the research on the constant-speed flight control method of the unmanned aerial vehicle under the complex meteorological condition has important significance for the development of the unmanned aerial vehicle.
Disclosure of Invention
The invention aims to solve the problem that the unmanned aerial vehicle cannot keep the flying speed due to interference under the complex meteorological conditions, provides a constant-speed flight control method of the unmanned aerial vehicle considering the meteorological conditions, and provides technical reference for the unmanned aerial vehicle to fly under the complex meteorological conditions. By designing a sliding mode surface and adopting a Lyapunov direct method to design a self-adaptive law and a controller according to a stability criterion, the unmanned aerial vehicle can keep the flying speed under the influence of meteorological factors.
In order to achieve the purpose, the invention adopts the following technical scheme:
an unmanned aerial vehicle constant-speed flight control method considering meteorological conditions comprises the following steps:
s1, establishing a flight dynamics equation of the unmanned aerial vehicle under the axis system of the unmanned aerial vehicle based on the plane earth hypothesis;
s2, converting the flight dynamics equation into an unmanned aerial vehicle state space equation, and adding a meteorological condition disturbance term;
s3, designing a sliding mode surface by using an unmanned aerial vehicle state space equation, carrying out japunoff stability judgment on the sliding mode surface to obtain an inner-outer ring controller, designing a self-adaptation law corresponding to the meteorological condition disturbance term, and substituting the self-adaptation law into the inner-outer ring controller to obtain an inner-outer ring sliding mode controller capable of realizing parameter self-adaptation;
and S4, setting a flying speed, and when the unmanned aerial vehicle is disturbed by meteorological conditions, realizing constant-speed flying of the unmanned aerial vehicle through the parameter self-adaptive inner and outer ring sliding mode controller.
Further, in step S2, the unmanned aerial vehicle state space equation after the meteorological condition disturbance term is added specifically is:
Figure 521085DEST_PATH_IMAGE001
wherein
Figure 592946DEST_PATH_IMAGE002
In the form of a matrix of state quantities,
Figure 501996DEST_PATH_IMAGE003
in order to control the matrix of quantities,
Figure 633900DEST_PATH_IMAGE004
in order to be a matrix of the system,
Figure 362822DEST_PATH_IMAGE005
in order to input the matrix, the input matrix is,
Figure 238374DEST_PATH_IMAGE006
representing disturbances caused by meteorological conditions.
Further, in step S3, the control amount of the outer loop controller is set to
Figure 500466DEST_PATH_IMAGE007
The control quantity of the inner ring controller is
Figure 537692DEST_PATH_IMAGE008
The inner and outer ring state space equations are specifically
Figure 19489DEST_PATH_IMAGE009
Wherein
Figure 433153DEST_PATH_IMAGE010
,
Figure 51216DEST_PATH_IMAGE011
，
Figure 524922DEST_PATH_IMAGE012
，
Figure 228436DEST_PATH_IMAGE013
；
Figure 445791DEST_PATH_IMAGE014
Figure 183940DEST_PATH_IMAGE015
Figure 562969DEST_PATH_IMAGE016
Figure 520823DEST_PATH_IMAGE017
Wherein the content of the first and second substances,
Figure 276289DEST_PATH_IMAGE018
Figure 868944DEST_PATH_IMAGE019
,
Figure 418874DEST_PATH_IMAGE020
,
Figure 362560DEST_PATH_IMAGE021
；
Figure 656138DEST_PATH_IMAGE022
respectively representing the speed of the machine body in the X, Y and Z directions;
Figure 368879DEST_PATH_IMAGE023
respectively representing a rolling angular velocity, a pitch angular velocity and a yaw angular velocity;
Figure 355289DEST_PATH_IMAGE024
respectively representing a pitch angle and a roll angle;
Figure 255112DEST_PATH_IMAGE025
respectively representing roll moment, pitch moment and yaw moment;
Figure 352381DEST_PATH_IMAGE026
respectively represents the rotational inertia of the unmanned aerial vehicle to the X axis, the Y axis and the Z axis,
Figure 689603DEST_PATH_IMAGE027
representing the products of inertia of the drone on the X and Z axes;
Figure 581335DEST_PATH_IMAGE028
respectively representing that the unmanned aerial vehicle is subjected to pneumatic resultant force along an X axis, a Y axis and a Z axis;
Figure 234033DEST_PATH_IMAGE029
respectively representing components of the engine thrust on an X axis, a Y axis and a Z axis;
Figure 134993DEST_PATH_IMAGE030
which represents the acceleration of the force of gravity,
Figure 556747DEST_PATH_IMAGE031
representing the drone quality;
Figure 619381DEST_PATH_IMAGE032
represents a dynamic pressure;
Figure 759376DEST_PATH_IMAGE033
showing the length of the spread;
Figure 198447DEST_PATH_IMAGE034
representing the wing area;
Figure 740287DEST_PATH_IMAGE035
representing the flight speed of the unmanned aerial vehicle;
Figure 973822DEST_PATH_IMAGE036
respectively representing an aileron deflection angle, a rudder deflection angle and an elevator deflection angle;
Figure 102578DEST_PATH_IMAGE037
respectively representing the moment coefficients along the X, Y and Z axes of the machine body;
Figure 79761DEST_PATH_IMAGE038
respectively representing the rate of change of a roll torque coefficient relative to the deflection angle of the aileron, the rate of change of the roll torque coefficient relative to the rudder deflection angle, the rate of change of the roll torque coefficient relative to the roll angular speed and the rate of change of the roll torque coefficient relative to the yaw angular speed;
Figure 476107DEST_PATH_IMAGE039
respectively representing the rate of change of a pitch moment coefficient relative to the deflection angle of the elevator and the rate of change of the pitch moment coefficient relative to the pitch angle speed;
Figure 146123DEST_PATH_IMAGE040
respectively representing the change of yaw moment about the angle of deflection of the aileronRate, rate of change of yaw moment with respect to rudder yaw angle, rate of change of yaw moment with respect to roll angular velocity, rate of change of yaw moment with respect to yaw angular velocity.
Further, in step S3, for the outer ring controller, the sliding surface is
Figure 995130DEST_PATH_IMAGE041
；
For an inner ring controller, the sliding mode surface is
Figure 41584DEST_PATH_IMAGE042
；
Wherein
Figure 26857DEST_PATH_IMAGE043
Represents the function of the sliding mode surface,
Figure 867774DEST_PATH_IMAGE044
which represents an error in the form of,K i represents a constant coefficient of the output signal of the amplifier,twhich represents the time of day,
Figure 204078DEST_PATH_IMAGE045
representing the expected value.
Further, in step S3, the determination of the stability of the sliding mode surface luggage japonov to obtain the inner and outer ring controller is specifically
Consider the following Lyapunov candidate function:
Figure 788643DEST_PATH_IMAGE046
wherein the content of the first and second substances,W 1is a first candidate function;
derivation of this can yield:
Figure 658116DEST_PATH_IMAGE047
to make it possible to
Figure 669935DEST_PATH_IMAGE048
For negative, the inner and outer ring controllers are designed as follows:
Figure 493534DEST_PATH_IMAGE049
wherein
Figure 616211DEST_PATH_IMAGE050
In order to determine the constant coefficient to be determined,
Figure 576077DEST_PATH_IMAGE051
for disturbing complex weather
Figure 24376DEST_PATH_IMAGE052
For time invariant disturbances, sgn is a sign function;
setting up
Figure 335271DEST_PATH_IMAGE053
，
Figure 261639DEST_PATH_IMAGE054
Which is indicative of the error in the estimation of the disturbance,i=1,2。
further, in the step S3, the adaptive law corresponding to the meteorological condition disturbance term is designed as
Consider the following Lyapunov candidate function:
Figure 341590DEST_PATH_IMAGE055
wherein the content of the first and second substances,W 2in order to be a second candidate function,
Figure 196676DEST_PATH_IMAGE056
is a constant coefficient to be determined;
derivation of this can yield:
Figure 729289DEST_PATH_IMAGE057
to make it possible to
Figure 459347DEST_PATH_IMAGE058
Negative, the resulting adaptation law is:
Figure 393805DEST_PATH_IMAGE059
。
further, in step S3, the inner and outer ring sliding mode controller is specifically an
Outer loop sliding mode controller:
Figure 918327DEST_PATH_IMAGE060
wherein the content of the first and second substances,
Figure 203815DEST_PATH_IMAGE061
；
inner ring sliding mode controller:
Figure 206406DEST_PATH_IMAGE062
wherein the content of the first and second substances,
Figure 260950DEST_PATH_IMAGE063
。
compared with the prior art, the invention has the following beneficial effects:
the invention provides an unmanned aerial vehicle constant-speed flight control method considering meteorological conditions, which is characterized in that a sliding mode surface is designed, and a Lyapunov direct method is adopted to stabilize criteria to design a self-adaptive law and a controller, so that the unmanned aerial vehicle can keep constant-speed flight under the influence of meteorological factors. The method provided by the invention adopts a parameter self-adaptive method, so that the disturbance of the unmanned aerial vehicle caused by different complex meteorology is obviously inhibited, the control convergence speed is relatively high, and meanwhile, the control method provided by the invention cannot bring large extra weight to the unmanned aerial vehicle.
Drawings
FIG. 1 is a flow chart of a method for controlling constant-velocity flight of an unmanned aerial vehicle in consideration of meteorological conditions according to the present invention;
fig. 2 is a logic diagram of the inner and outer ring sliding mode controller of the present invention.
Detailed Description
For the purpose of making the objects, technical solutions and advantages of the present invention more apparent, the present invention is described in further detail below with reference to the accompanying drawings.
An unmanned aerial vehicle constant-speed flight control method considering meteorological conditions is shown in figure 1 and comprises the following steps:
firstly, establishing a flight dynamics equation of the unmanned aerial vehicle as follows:
Figure 956374DEST_PATH_IMAGE064
Figure 729158DEST_PATH_IMAGE065
wherein
Figure 51553DEST_PATH_IMAGE066
As follows:
Figure 960603DEST_PATH_IMAGE018
Figure 826928DEST_PATH_IMAGE019
,
Figure 87008DEST_PATH_IMAGE020
,
Figure 431401DEST_PATH_IMAGE021
；
wherein the content of the first and second substances,
Figure 460537DEST_PATH_IMAGE067
respectively representing the speed of the machine body in the X, Y and Z directions;
Figure 497764DEST_PATH_IMAGE023
respectively representing a rolling angular velocity, a pitch angular velocity and a yaw angular velocity;
Figure 979560DEST_PATH_IMAGE024
respectively representing a pitch angle and a roll angle;
Figure 393224DEST_PATH_IMAGE068
respectively representing roll moment, pitch moment and yaw moment;
Figure 11287DEST_PATH_IMAGE069
respectively represents the rotational inertia of the unmanned aerial vehicle to the X axis, the Y axis and the Z axis,
Figure 986459DEST_PATH_IMAGE027
representing the inertia product of the unmanned aerial vehicle on the X axis and the Z axis;
Figure 689973DEST_PATH_IMAGE028
respectively representing that the unmanned aerial vehicle is subjected to pneumatic resultant force along an X axis, a Y axis and a Z axis;
Figure 641748DEST_PATH_IMAGE070
respectively representing components of the engine thrust on an X axis, a Y axis and a Z axis;
Figure 379897DEST_PATH_IMAGE030
which represents the acceleration of the force of gravity,
Figure 290084DEST_PATH_IMAGE031
indicating the drone quality.
The specific expressions of force and moment are as follows:
Figure 480894DEST_PATH_IMAGE071
Figure 236361DEST_PATH_IMAGE072
the symbols represent the following meanings:
Figure 829016DEST_PATH_IMAGE073
respectively representing an attack angle and a sideslip angle;
Figure 378946DEST_PATH_IMAGE032
represents a dynamic pressure;
Figure 322631DEST_PATH_IMAGE033
showing the stretching length;
Figure 114744DEST_PATH_IMAGE074
representing a chord length;
Figure 827486DEST_PATH_IMAGE034
representing the wing area;
Figure 548317DEST_PATH_IMAGE035
representing the flight speed of the unmanned aerial vehicle;
Figure 713719DEST_PATH_IMAGE036
respectively representing an aileron deflection angle, a rudder deflection angle and an elevator deflection angle;
Figure 810988DEST_PATH_IMAGE075
respectively representing force coefficients along X, Y and Z axes of the machine body;
Figure 378236DEST_PATH_IMAGE076
respectively representing the change rate of the force coefficient along the X axis of the body relative to the deflection angle of the elevator and the change rate of the force coefficient along the Z axis of the body relative to the deflection angle of the elevator;
Figure 269968DEST_PATH_IMAGE077
representing the rate of change of the force coefficient along the Y axis of the body with respect to the aileron deflection angle;
Figure 188246DEST_PATH_IMAGE078
representing the rate of change of the force coefficient along the Y axis of the body with respect to the rudder deflection angle;
Figure 823626DEST_PATH_IMAGE079
respectively representing the change rate of a force coefficient along an X axis relative to the pitch angle speed, the change rate of the force coefficient along a Y axis relative to the roll angle speed, the change rate of the force coefficient along the Y axis relative to the yaw angle speed and the change rate of the force coefficient along a Z axis relative to the pitch angle speed;
Figure 245380DEST_PATH_IMAGE080
respectively representing the moment coefficients along the X, Y and Z axes of the machine body;
Figure 75058DEST_PATH_IMAGE081
respectively representing the rate of change of a roll torque coefficient relative to the deflection angle of the aileron, the rate of change of the roll torque coefficient relative to the rudder deflection angle, the rate of change of the roll torque coefficient relative to the roll angular speed and the rate of change of the roll torque coefficient relative to the yaw angular speed;
Figure 949473DEST_PATH_IMAGE039
respectively representing the rate of change of a pitch moment coefficient relative to the deflection angle of the elevator and the rate of change of the pitch moment coefficient relative to the pitch angle speed;
Figure 654124DEST_PATH_IMAGE082
the yaw moment rate of change with respect to the aileron yaw angle, the yaw moment rate of change with respect to the rudder yaw angle, the yaw moment rate of change with respect to the roll angle speed, and the yaw moment rate of change with respect to the yaw angle speed are respectively indicated.
Secondly, converting the flight dynamics equation of the unmanned aerial vehicle into an unmanned aerial vehicle state space equation, and adding a meteorological condition disturbance term as follows:
Figure 195964DEST_PATH_IMAGE001
wherein
Figure 429499DEST_PATH_IMAGE002
In the form of a matrix of state quantities,
Figure 56790DEST_PATH_IMAGE003
in order to control the matrix of quantities,
Figure 299552DEST_PATH_IMAGE083
in order to be a matrix of the system,
Figure 430319DEST_PATH_IMAGE005
in order to input the matrix, the input matrix is,
Figure 834756DEST_PATH_IMAGE006
representing the disturbance caused by complex weather, assuming that the disturbance is of a time-invariant nature.
Thirdly, as shown in fig. 2, the unmanned aerial vehicle is divided into an inner ring control and an outer ring control, wherein the outer ring control quantity is
Figure 949342DEST_PATH_IMAGE084
The inner ring control quantity is
Figure 234611DEST_PATH_IMAGE008
. When the unmanned aerial vehicle is disturbed by complex weather, the control quantity of the inner ring of the control surface is firstly passed
Figure 751043DEST_PATH_IMAGE085
Changing angular velocity of unmanned aerial vehicle
Figure 591960DEST_PATH_IMAGE007
And then the outer loop control is entered. Now in the outer loop control, the angular velocity of the drone
Figure 928263DEST_PATH_IMAGE084
For control input, the input will be speed after the drone is disturbed
Figure 247249DEST_PATH_IMAGE086
Remain in the ideal state. Two sets of state space equations are obtained according to the flight dynamics equation of the unmanned aerial vehicle as follows:
Figure 618188DEST_PATH_IMAGE087
wherein the content of the first and second substances,
Figure 630006DEST_PATH_IMAGE010
,
Figure 453606DEST_PATH_IMAGE011
，
Figure 576283DEST_PATH_IMAGE012
，
Figure 303192DEST_PATH_IMAGE013
；
the flight dynamics equation of the unmanned aerial vehicle is combined to obtainf i (x), g i (x) The specific expression of (A) is as follows:
Figure 220333DEST_PATH_IMAGE014
Figure 796808DEST_PATH_IMAGE088
Figure 723175DEST_PATH_IMAGE016
Figure 803127DEST_PATH_IMAGE017
the fourth step, define the sliding mode surface as
Figure 156748DEST_PATH_IMAGE089
Wherein
Figure 954939DEST_PATH_IMAGE090
，
Figure 419419DEST_PATH_IMAGE091
. For outer ring control, the slip form face is
Figure 353877DEST_PATH_IMAGE092
，
Figure 143978DEST_PATH_IMAGE093
，
Figure 928001DEST_PATH_IMAGE094
(ii) a For inner ring control, the slip form surface is
Figure 930592DEST_PATH_IMAGE095
，
Figure 985136DEST_PATH_IMAGE096
，
Figure 946139DEST_PATH_IMAGE097
. Wherein
Figure 187764DEST_PATH_IMAGE098
Represents the function of the sliding mode surface,
Figure 259625DEST_PATH_IMAGE099
which represents an error in the form of,K i representing a constant number of coefficients of the output signal,twhich represents the time of day,
Figure 168676DEST_PATH_IMAGE100
representing the desired value.
Fifthly, designing the controller under the condition of considering unknown complex meteorological disturbance through a Lyapunov stability criterion to obtain the controller with the unknown disturbance, designing an adaptive law for the complex meteorological disturbance by adopting the Lyapunov stability criterion again, and substituting the adaptive law to obtain the final controller.
Consider the following Lyapunov candidate function:
Figure 35000DEST_PATH_IMAGE046
wherein, the first and the second end of the pipe are connected with each other,W 1is a first candidate function;
derivation of this can yield:
Figure 295080DEST_PATH_IMAGE047
to make a
Figure 639474DEST_PATH_IMAGE101
For negative, the inner and outer ring controllers are designed as follows:
Figure 170075DEST_PATH_IMAGE102
wherein
Figure 207301DEST_PATH_IMAGE103
In order to determine the constant coefficient to be determined,
Figure 689098DEST_PATH_IMAGE104
for disturbing complex weather
Figure 102762DEST_PATH_IMAGE105
For time invariant perturbations, sgn is a sign function.
Setting up
Figure 986404DEST_PATH_IMAGE106
，
Figure 194532DEST_PATH_IMAGE107
Which is indicative of the error in the estimation of the disturbance,i=1,2；
consider again the following Lyapunov candidate function:
Figure 163625DEST_PATH_IMAGE108
wherein the content of the first and second substances,W 2in order to be a second one of the candidate functions,
Figure 115400DEST_PATH_IMAGE109
is a constant coefficient to be determined;
derivation of this can yield:
Figure 853549DEST_PATH_IMAGE057
thereby to make
Figure 725253DEST_PATH_IMAGE058
Negative, the adaptation law can be found to be:
Figure 181643DEST_PATH_IMAGE110
substituting the adaptive law into the controller
Figure 937109DEST_PATH_IMAGE111
In this way, the final sliding mode controller expression can be obtained as follows:
Figure 529764DEST_PATH_IMAGE112
wherein the content of the first and second substances,
Figure 79694DEST_PATH_IMAGE113
。
the resulting sliding mode controller can thus be obtained as follows:
outer loop sliding mode controller:
Figure 23380DEST_PATH_IMAGE114
wherein the content of the first and second substances,
Figure 316958DEST_PATH_IMAGE115
；
an inner ring sliding mode controller:
Figure 29699DEST_PATH_IMAGE116
wherein, the first and the second end of the pipe are connected with each other,
Figure 750530DEST_PATH_IMAGE117
。
sixthly, setting an ideal speed
Figure 181511DEST_PATH_IMAGE118
When the unmanned aerial vehicle is disturbed by complex weather, the unmanned aerial vehicle passes through the self-adaptation law
Figure 514666DEST_PATH_IMAGE119
Real-time updating sliding mode controller
Figure 81914DEST_PATH_IMAGE120
The unmanned aerial vehicle can fly at a constant speed under the disturbance of complex weather.
The above description is only exemplary of the present invention and should not be taken as limiting the scope of the present invention, and any modifications, equivalents, improvements and the like that are within the spirit and principle of the present invention should be included in the scope of the present invention.

Claims (7)

1. An unmanned aerial vehicle constant-speed flight control method considering meteorological conditions is characterized by comprising the following steps:
s1, establishing a flight dynamics equation of the unmanned aerial vehicle under the axis system of the unmanned aerial vehicle based on the plane earth hypothesis;
s2, converting the flight dynamics equation into an unmanned aerial vehicle state space equation, and adding a meteorological condition disturbance term;
s3, designing a sliding mode surface by using an unmanned aerial vehicle state space equation, carrying out japunoff stability judgment on the sliding mode surface to obtain an inner-outer ring controller, designing a self-adaptation law corresponding to the meteorological condition disturbance term, and substituting the self-adaptation law into the inner-outer ring controller to obtain an inner-outer ring sliding mode controller capable of realizing parameter self-adaptation;
and S4, setting a flying speed, and when the unmanned aerial vehicle is disturbed by meteorological conditions, realizing constant-speed flying of the unmanned aerial vehicle through the parameter self-adaptive inner and outer ring sliding mode controller.
2. The method for controlling the constant-speed flight of the unmanned aerial vehicle considering the meteorological conditions as claimed in claim 1, wherein in the step S2, the unmanned aerial vehicle state space equation after the meteorological condition disturbance term is added is specifically as follows:
Figure 902162DEST_PATH_IMAGE001
wherein
Figure 575326DEST_PATH_IMAGE002
In the form of a matrix of state quantities,
Figure 441651DEST_PATH_IMAGE003
in order to control the matrix of quantities,
Figure 436152DEST_PATH_IMAGE004
in order to be a matrix of the system,
Figure 311704DEST_PATH_IMAGE005
in order to input the matrix, the input matrix is,
Figure 75261DEST_PATH_IMAGE006
representing disturbances caused by meteorological conditions.
3. The method of controlling the constant speed flight of an unmanned aerial vehicle according to claim 2, wherein the step S3 is performed by setting the control amount of the outer loop controller to be
Figure 112487DEST_PATH_IMAGE007
The control quantity of the inner ring controller is
Figure 859863DEST_PATH_IMAGE008
The inner and outer ring state space equations are specifically
Figure 7947DEST_PATH_IMAGE009
Wherein
Figure 891590DEST_PATH_IMAGE010
,
Figure 601182DEST_PATH_IMAGE011
，
Figure 304696DEST_PATH_IMAGE012
，
Figure 522051DEST_PATH_IMAGE013
；
Figure 260199DEST_PATH_IMAGE014
Figure 639228DEST_PATH_IMAGE015
Figure 95617DEST_PATH_IMAGE016
Figure 585505DEST_PATH_IMAGE017
Wherein, the first and the second end of the pipe are connected with each other,
Figure 443739DEST_PATH_IMAGE018
Figure 993669DEST_PATH_IMAGE019
,
Figure 671775DEST_PATH_IMAGE020
,
Figure 723608DEST_PATH_IMAGE021
；
Figure 170770DEST_PATH_IMAGE022
respectively representing the speeds of the machine body in the X, Y and Z directions;
Figure 157181DEST_PATH_IMAGE023
respectively representing a rolling angular velocity, a pitch angular velocity and a yaw angular velocity;
Figure 322583DEST_PATH_IMAGE024
respectively representing a pitch angle and a roll angle;
Figure 419852DEST_PATH_IMAGE025
respectively representing roll moment, pitch moment and yaw moment;
Figure 987099DEST_PATH_IMAGE026
respectively represents the rotational inertia of the unmanned aerial vehicle to the X axis, the Y axis and the Z axis,
Figure 878832DEST_PATH_IMAGE027
representing the products of inertia of the drone on the X and Z axes;
Figure 531530DEST_PATH_IMAGE028
respectively representing that the unmanned aerial vehicle is subjected to pneumatic resultant force along an X axis, a Y axis and a Z axis;
Figure 166911DEST_PATH_IMAGE029
respectively representing components of the engine thrust on an X axis, a Y axis and a Z axis;
Figure 854244DEST_PATH_IMAGE030
which represents the acceleration of the force of gravity,
Figure 683922DEST_PATH_IMAGE031
representing the unmanned aerial vehicle mass;
Figure 558337DEST_PATH_IMAGE032
represents a dynamic pressure;
Figure 997409DEST_PATH_IMAGE033
showing the stretching length;
Figure 539249DEST_PATH_IMAGE034
representing the wing area;
Figure 772784DEST_PATH_IMAGE035
representing the flight speed of the unmanned aerial vehicle;
Figure 400074DEST_PATH_IMAGE036
respectively representing an aileron deflection angle, a rudder deflection angle and an elevator deflection angle;
Figure 642837DEST_PATH_IMAGE037
respectively representing the moment coefficients along the X, Y and Z axes of the machine body;
Figure 39183DEST_PATH_IMAGE038
respectively representing the rate of change of a roll torque coefficient relative to the deflection angle of the aileron, the rate of change of the roll torque coefficient relative to the rudder deflection angle, the rate of change of the roll torque coefficient relative to the roll angular speed and the rate of change of the roll torque coefficient relative to the yaw angular speed;
Figure 709199DEST_PATH_IMAGE039
respectively representing the coefficient of pitching moment in relation to elevatorsThe yaw rate, the pitch moment coefficient with respect to the pitch angle rate;
Figure 56741DEST_PATH_IMAGE040
the yaw moment rate of change with respect to the aileron yaw angle, the yaw moment rate of change with respect to the rudder yaw angle, the yaw moment rate of change with respect to the roll angle speed, and the yaw moment rate of change with respect to the yaw angle speed are respectively indicated.
4. The method for controlling the constant-speed flight of the unmanned aerial vehicle based on the meteorological conditions, according to the step S3, wherein for the outer-loop controller, the sliding mode surface is
Figure 837615DEST_PATH_IMAGE041
；
For an inner ring controller, the sliding mode surface is
Figure 354047DEST_PATH_IMAGE042
；
Wherein
Figure 194965DEST_PATH_IMAGE043
Represents the function of the sliding mode surface,
Figure 265689DEST_PATH_IMAGE044
which represents an error in the form of,K i represents a constant coefficient of the output signal of the amplifier,twhich represents the time of day,
Figure 850254DEST_PATH_IMAGE045
representing the expected value.
5. The method for controlling the constant-speed flight of the unmanned aerial vehicle considering meteorological conditions as claimed in claim 4, wherein in the step S3, the sliding mode surface is subjected to the determination of the stability of the luggage so as to obtain the inner and outer ring controllers, specifically, the inner and outer ring controllers are determined by the determination of the japonov stability
Consider the following Lyapunov candidate function:
Figure 221192DEST_PATH_IMAGE046
wherein the content of the first and second substances,W 1is a first candidate function;
derivation of this can yield:
Figure 967431DEST_PATH_IMAGE047
to make it possible to
Figure 56610DEST_PATH_IMAGE048
For negative, the inner and outer ring controllers are designed as follows:
Figure 913708DEST_PATH_IMAGE049
wherein
Figure 906197DEST_PATH_IMAGE050
In order to determine the constant coefficient to be determined,
Figure 823337DEST_PATH_IMAGE051
for disturbing complex weather
Figure 134233DEST_PATH_IMAGE052
For time invariant disturbances, sgn is a sign function;
setting up
Figure 60601DEST_PATH_IMAGE053
，
Figure 140552DEST_PATH_IMAGE054
Which is indicative of the error in the estimation of the disturbance,i=1,2。
6. the method for controlling constant-velocity flight of unmanned aerial vehicle based on weather conditions as claimed in claim 5, wherein the step S3 is implemented by designing an adaptive law corresponding to the weather condition disturbance term
Consider the following Lyapunov candidate function:
Figure 494173DEST_PATH_IMAGE055
wherein the content of the first and second substances,W 2in order to be a second candidate function,
Figure 292365DEST_PATH_IMAGE056
is a constant coefficient to be determined;
derivation of this can yield:
Figure 22423DEST_PATH_IMAGE057
to make it possible to
Figure 956881DEST_PATH_IMAGE058
Negative, the resulting adaptation law is:
Figure 481403DEST_PATH_IMAGE059
。
7. the method for controlling the constant-speed flight of the unmanned aerial vehicle considering meteorological conditions according to claim 6, wherein in the step S3, the inner and outer ring sliding mode controllers are specifically inner and outer ring sliding mode controllers
Outer loop sliding mode controller:
Figure 271286DEST_PATH_IMAGE060
wherein the content of the first and second substances,
Figure 539456DEST_PATH_IMAGE061
；
inner ring sliding mode controller:
Figure 594000DEST_PATH_IMAGE062
wherein the content of the first and second substances,
Figure 23844DEST_PATH_IMAGE063
。
CN202210455586.5A 2022-04-28 2022-04-28 Unmanned aerial vehicle constant-speed flight control method considering meteorological conditions Active CN114564047B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210455586.5A CN114564047B (en) 2022-04-28 2022-04-28 Unmanned aerial vehicle constant-speed flight control method considering meteorological conditions

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210455586.5A CN114564047B (en) 2022-04-28 2022-04-28 Unmanned aerial vehicle constant-speed flight control method considering meteorological conditions

Publications (2)

Publication Number Publication Date
CN114564047A true CN114564047A (en) 2022-05-31
CN114564047B CN114564047B (en) 2022-08-16

Family

ID=81721439

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210455586.5A Active CN114564047B (en) 2022-04-28 2022-04-28 Unmanned aerial vehicle constant-speed flight control method considering meteorological conditions

Country Status (1)

Country Link
CN (1) CN114564047B (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115826624A (en) * 2023-02-20 2023-03-21 北京航空航天大学 Unmanned aerial vehicle anti-interference method and anti-interference system for sea surface low-altitude side wind shear

Citations (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106502260A (en) * 2016-12-01 2017-03-15 西北工业大学 Robot of space rope system arrests the attitude adapter control method after flexibility target satellite
US20180290733A1 (en) * 2017-04-05 2018-10-11 Bell Helicopter Textron Inc. Rotorcraft Fly-by-Wire Stabilization
CN109828602A (en) * 2018-01-19 2019-05-31 北京航空航天大学 A kind of track circuit nonlinear model transform method based on observation compensation technique
CN110347036A (en) * 2018-09-30 2019-10-18 哈尔滨工业大学 The autonomous wind resistance intelligent control method of unmanned plane based on fuzzy sliding mode tracking control
CN111026160A (en) * 2019-12-26 2020-04-17 华中科技大学 Trajectory tracking control method for quad-rotor unmanned aerial vehicle
CN111435253A (en) * 2019-01-11 2020-07-21 天津工业大学 Bounded output control for four-rotor aircraft
CN111694278A (en) * 2020-06-28 2020-09-22 南京工业大学 Robust tracking control method and system for quad-rotor unmanned aerial vehicle
CN113128085A (en) * 2021-03-19 2021-07-16 北京航空航天大学 Gust alleviation analysis method based on state space form vortex lattice method
CN113761811A (en) * 2021-09-09 2021-12-07 北京航空航天大学 Unmanned aerial vehicle flexible flight dynamics analysis method considering complex wind field
CN113805602A (en) * 2021-10-23 2021-12-17 北京航空航天大学 Unmanned aerial vehicle flight height control method considering gust influence
CN113848990A (en) * 2021-11-18 2021-12-28 北京航空航天大学 Unmanned aerial vehicle stable flight control method considering structural nonlinearity
CN113987894A (en) * 2021-12-30 2022-01-28 北京航空航天大学 Unmanned aerial vehicle dynamics modeling method based on rainfall weather conditions
CN114020044A (en) * 2021-12-24 2022-02-08 北京航空航天大学 Flexible unmanned aerial vehicle crosswind-resistant flight control method

Patent Citations (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106502260A (en) * 2016-12-01 2017-03-15 西北工业大学 Robot of space rope system arrests the attitude adapter control method after flexibility target satellite
US20180290733A1 (en) * 2017-04-05 2018-10-11 Bell Helicopter Textron Inc. Rotorcraft Fly-by-Wire Stabilization
CN109828602A (en) * 2018-01-19 2019-05-31 北京航空航天大学 A kind of track circuit nonlinear model transform method based on observation compensation technique
CN110347036A (en) * 2018-09-30 2019-10-18 哈尔滨工业大学 The autonomous wind resistance intelligent control method of unmanned plane based on fuzzy sliding mode tracking control
CN111435253A (en) * 2019-01-11 2020-07-21 天津工业大学 Bounded output control for four-rotor aircraft
CN111026160A (en) * 2019-12-26 2020-04-17 华中科技大学 Trajectory tracking control method for quad-rotor unmanned aerial vehicle
CN111694278A (en) * 2020-06-28 2020-09-22 南京工业大学 Robust tracking control method and system for quad-rotor unmanned aerial vehicle
CN113128085A (en) * 2021-03-19 2021-07-16 北京航空航天大学 Gust alleviation analysis method based on state space form vortex lattice method
CN113761811A (en) * 2021-09-09 2021-12-07 北京航空航天大学 Unmanned aerial vehicle flexible flight dynamics analysis method considering complex wind field
CN113805602A (en) * 2021-10-23 2021-12-17 北京航空航天大学 Unmanned aerial vehicle flight height control method considering gust influence
CN113848990A (en) * 2021-11-18 2021-12-28 北京航空航天大学 Unmanned aerial vehicle stable flight control method considering structural nonlinearity
CN114020044A (en) * 2021-12-24 2022-02-08 北京航空航天大学 Flexible unmanned aerial vehicle crosswind-resistant flight control method
CN113987894A (en) * 2021-12-30 2022-01-28 北京航空航天大学 Unmanned aerial vehicle dynamics modeling method based on rainfall weather conditions

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
LI YI 等: "Optimization of range and endurance of a propeller UAV based on SQP algorithm", 《2017 IEEE INTERNATIONAL CONFERENCE ON UNMANNED SYSTEMS (ICUS)》 *
郭猛 等: "四旋翼高阶滑模控制器设计与仿真", 《火力与指挥控制》 *

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115826624A (en) * 2023-02-20 2023-03-21 北京航空航天大学 Unmanned aerial vehicle anti-interference method and anti-interference system for sea surface low-altitude side wind shear

Also Published As

Publication number Publication date
CN114564047B (en) 2022-08-16

Similar Documents

Publication Publication Date Title
CN110377045B (en) Aircraft full-profile control method based on anti-interference technology
CN111766899B (en) Interference observer-based quad-rotor unmanned aerial vehicle cluster anti-interference formation control method
CN111665857B (en) Variant aircraft control method based on composite intelligent learning
CN111679583B (en) Adaptive control method of variant aircraft based on aerodynamic parameter estimation
CN111984020B (en) SDRE-based self-adaptive optimal sliding mode control method for transition flight mode of tilt-four-rotor unmanned aerial vehicle
CN111506099B (en) Intelligent control system and method for height of unmanned aerial vehicle
CN111367182A (en) Hypersonic aircraft anti-interference backstepping control method considering input limitation
CN111290278B (en) Hypersonic aircraft robust attitude control method based on prediction sliding mode
CN109460055B (en) Aircraft control capability determining method and device and electronic equipment
CN114564047B (en) Unmanned aerial vehicle constant-speed flight control method considering meteorological conditions
CN110209192A (en) Fighter plane course augmentation control design method
CN113778129A (en) Hypersonic speed variable sweepback wing aircraft tracking control method with interference compensation
CN115185185A (en) Method for establishing self-adaptive sliding mode control system of four-rotor aircraft
CN112327926A (en) Self-adaptive sliding mode control method for unmanned aerial vehicle formation
CN115933733A (en) Fixed wing unmanned aerial vehicle longitudinal altitude speed decoupling nonlinear control method
CN108762098A (en) Non-minimum phase aircraft neural network control method based on Hybrid Learning
CN108958278B (en) Aerospace vehicle cruise section rapid anti-interference guidance method
CN108459611B (en) Attitude tracking control method of near space vehicle
CN115685764B (en) Task self-adaptive anti-interference tracking control method and system for variable-span aircraft
CN114003052B (en) Fixed wing unmanned aerial vehicle longitudinal movement robust self-adaptive control method based on dynamic compensation system
CN110347036B (en) Unmanned aerial vehicle autonomous wind-resistant intelligent control method based on fuzzy sliding mode control
CN115729264A (en) Flexible self-adaptive winglet-based stability-variable stealth aircraft control method
CN115826624B (en) Unmanned aerial vehicle anti-interference method and anti-interference system for sea surface low-altitude crosswind shear
CN110673616A (en) Limited time fault-tolerant control method for fixed-wing unmanned aerial vehicle based on self-adaptive sliding mode
CN112015194B (en) Method for restraining wake disturbance of carrier-based aircraft based on direct lift control

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant