CN110632940B - Active anti-interference time-varying track tracking control method for multiple unmanned aerial vehicles with hybrid quantizers - Google Patents

Active anti-interference time-varying track tracking control method for multiple unmanned aerial vehicles with hybrid quantizers Download PDF

Info

Publication number
CN110632940B
CN110632940B CN201910677634.3A CN201910677634A CN110632940B CN 110632940 B CN110632940 B CN 110632940B CN 201910677634 A CN201910677634 A CN 201910677634A CN 110632940 B CN110632940 B CN 110632940B
Authority
CN
China
Prior art keywords
unmanned aerial
aerial vehicle
hybrid
quantizer
quantization
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.)
Active
Application number
CN201910677634.3A
Other languages
Chinese (zh)
Other versions
CN110632940A (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.)
North University of China
Original Assignee
North University of China
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 North University of China filed Critical North University of China
Priority to CN201910677634.3A priority Critical patent/CN110632940B/en
Publication of CN110632940A publication Critical patent/CN110632940A/en
Application granted granted Critical
Publication of CN110632940B publication Critical patent/CN110632940B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/10Simultaneous control of position or course in three dimensions
    • G05D1/101Simultaneous control of position or course in three dimensions specially adapted for aircraft

Abstract

The invention discloses a multi-unmanned aerial vehicle active anti-interference time-varying track tracking control method with a hybrid quantizer, which comprises the steps of firstly, establishing an unmanned aerial vehicle kinematic model with non-integrity constraint, designing a hybrid quantizer integrating average quantization and hysteresis quantization characteristics, and establishing an automatic pilot dynamic state containing environmental interference and quantized input; secondly, designing a virtual control quantity of an unmanned aerial vehicle displacement loop by combining a given time-varying formation style instruction, and generating an expected linear speed and course angle instruction; then, constructing a model auxiliary extended state observer to estimate lumped interference in the autopilot and counteract the influence of the interference on the control performance; and finally, designing a robust dynamic feedback linearization control law capable of inhibiting the quantization error effect so as to update the dynamic output of the automatic pilot. The invention can effectively overcome the adverse effect of unknown environmental interference on the formation system and ensure the realization of strong robust formation tracking performance.

Description

Active anti-interference time-varying track tracking control method for multiple unmanned aerial vehicles with hybrid quantizers
Technical Field
The invention relates to the technical field of automatic control of multiple unmanned aerial vehicles, in particular to an active anti-interference time-varying track tracking control method for multiple unmanned aerial vehicles with hybrid quantizers, which is mainly applied to time-varying track tracking control of multiple unmanned aerial vehicles in environments with strong interference and limited communication bandwidth.
Background
Unmanned aerial vehicle is as the result under the modern science and technology, and many characteristics such as low cost, no casualties, equipment are simple, convenient operation, action are nimble reliable can effectual realization closely to ground target selective and pertinence observation to can get into some special areas and monitor and patrol and examine, the information that its acquireed has very high reliability and ageing. The unmanned aerial vehicle for formation is used for military reconnaissance and civil measurement, and the reconnaissance and detection range can be enlarged. At present, although a single unmanned aerial vehicle can adopt an advanced control strategy to realize real-time high-precision attitude control and complete trajectory tracking, the success rate of the formation flight execution task of multiple unmanned aerial vehicles and the capability of resisting emergency events are higher than those of the single unmanned aerial vehicle. For example, in the process of executing military reconnaissance missions, one unmanned aerial vehicle fails and cannot continue to work, so that the unmanned aerial vehicle can return to the air for maintenance, and the rest unmanned aerial vehicles can still keep formation flying according to the original plan, so that the missions can be completed satisfactorily.
However, the existing technology level can not support the autonomous decision-making function of unmanned aerial vehicle formation in the complete sense, and the high-integration intelligent cluster type large-scale formation flying is difficult to realize. Therefore, aiming at a multi-unmanned aerial vehicle cluster system, multiple targets of expanding the flight task range of unmanned aerial vehicle collaborative formation, improving the task execution efficiency and the completion quality, improving the effectiveness of combat in high-risk environments, enhancing the environment self-adaptive capacity of the system and the like are achieved, and researches in various aspects such as an information perception technology, a multiple data fusion technology, a task allocation principle, a flight trajectory planning technology, a formation control strategy, a communication transmission network technology, a virtual/physical comprehensive verification platform technology and the like and researches on effective collaborative work of multiple technologies are necessary.
Compared with a distributed formation control system, the centralized formation control framework utilizes ground station software to calculate the control law of the unmanned aerial vehicles in real time based on the position information telemetered by the unmanned aerial vehicles, and distributes the control law to the corresponding unmanned aerial vehicles to be executed through uplink communication links, so that the global formation control effect under the optimal meaning is achieved. Therefore, the existing centralized multi-unmanned aerial vehicle formation control strategy puts extremely high requirements on the communication bandwidth between the ground station and the unmanned aerial vehicle, and the formation effect of the asymptotic tracking is usually to use a high-bandwidth communication channel and a high-sampling-rate precise execution mechanism as a support. However, in an actual dynamic environment, problems such as signal interruption and signal disturbance caused by multipath effect and obstacle shielding inevitably exist, and packet loss of communication data causes a series of unpredictable consequences such as non-negligible tracking performance deterioration, stability margin reduction and even control instability to a formation control system due to time delay. In addition, the design of the flight formation controller in a practical environment must explicitly take into account the adverse effects of environmental disturbances to achieve robust flight control in a dynamic environment. Therefore, the requirement on the communication bandwidth of the measurement and control link of the ground station is reduced as much as possible on the premise of not sacrificing the formation control performance, and the active anti-interference cooperative tracking control method for the multiple unmanned aerial vehicles, which considers the quantitative input, has important engineering application value.
Disclosure of Invention
The invention provides an active anti-interference time-varying track tracking control method for multiple unmanned aerial vehicles with hybrid quantizers, which aims to solve the control problem of centralized time-varying formation of multiple unmanned aerial vehicles under the conditions of strong interference and limited communication bandwidth.
The invention is realized by the following technical scheme: a multi-unmanned aerial vehicle active anti-interference time-varying track tracking control method with a hybrid quantizer comprises the following steps:
(1) establishing an unmanned aerial vehicle kinematics model with non-integrity constraint, designing a hybrid quantizer integrating average quantization and hysteresis quantization characteristics, and constructing an automatic pilot dynamic state containing environmental interference and quantitative input, wherein the method specifically comprises the following steps:
firstly, the kinematics model of the ith unmanned aerial vehicle is established as follows:
Figure BDA0002143800420000021
wherein (x)i,yi) Represents the position of the ith drone in a Cartesian coordinate system, phiiIs the course angle, v, of the unmanned aerial vehicleiiRespectively representing the linear velocity and the angular velocity of the unmanned aerial vehicle;
secondly, establishing the dynamic state of the automatic pilot which comprises environmental interference and quantitative input:
Figure BDA0002143800420000022
wherein, thetaivAnd thetaIs the time constant of the autopilot,
Figure BDA0002143800420000023
and
Figure BDA0002143800420000024
respectively actual control quantity
Figure BDA0002143800420000025
And
Figure BDA0002143800420000026
discrete control signal after the hybrid quantizer, divAnd dThe interference signal is acted on the autopilot by the external environment; here, the hybrid quantizer design that integrates the average quantization and hysteresis quantization characteristics is as follows:
Figure BDA0002143800420000031
where u represents the input to the hybrid quantizer and q (u) represents the quantized output; hybrid quantizer in the hysteretic quantization state uj=ρ1-juminThe integer j is 1, 2.; u. ofminThe quantization dead zone is represented by more than 0, the hysteresis interval parameter is represented by delta and used for adjusting the hysteresis interval of the hybrid quantizer, delta belongs to (0,1), and the smaller delta is, the more sensitive the hybrid quantizer is to interference signals;
Figure BDA0002143800420000032
representing the quantization density of the hybrid quantizer, the larger the ρ, the finer the hybrid quantizer quantizes the signal;
Figure BDA0002143800420000033
represents the switching threshold of the hybrid quantizer, in the average quantization state, ΔqRepresents the minimum resolution of the hybrid quantizer quantization; n is a radical of an alkyl radicalqRepresenting the quantization magnitude of the hybrid quantizer; sign (u) denotes
Figure BDA0002143800420000034
(2) The method comprises the following steps of designing a virtual control quantity of an unmanned aerial vehicle displacement loop by combining a given time-varying formation style instruction, and generating an expected linear speed and course angle instruction so as to solve the problem of incomplete constraint of an unmanned aerial vehicle model, wherein the method specifically comprises the following steps: .
And designing a virtual control quantity of the displacement loop of the unmanned aerial vehicle by combining a given time-varying formation style instruction:
Figure BDA0002143800420000035
wherein alpha isixAnd alphaiyRespectively representing the virtual speed control quantity of the ith unmanned aerial vehicle in the directions of an x axis and a y axis; k is a radical ofixAnd kiyRespectively representing the control gain of the displacement loop of the ith unmanned aerial vehicle; x is the number ofrAnd yrRespectively representing the reference tracks of the unmanned aerial vehicle in the directions of an x axis and a y axis;
Figure BDA0002143800420000041
and
Figure BDA0002143800420000042
respectively representing the reference speeds of the unmanned aerial vehicle in the directions of an x axis and a y axis; sigmaixAnd σiyRespectively representing the offset of the ith unmanned aerial vehicle in the x-axis direction and the y-axis direction relative to the reference track;
Figure BDA0002143800420000043
and
Figure BDA0002143800420000044
respectively representing the offset speeds of the ith unmanned aerial vehicle in the directions of the x axis and the y axis relative to the reference speed;
generating expected linear velocity command v by utilizing triangular geometric relationAnd a course angle command phi
Figure BDA0002143800420000045
Further, the following virtual angular velocity control amount α is designed
Figure BDA0002143800420000046
Wherein k isAnd the control gain of the ith unmanned aerial vehicle course angle loop is shown.
(3) Aiming at the autopilot quantitative model given in the step (1), a model auxiliary extended state observer is constructed to estimate lumped interference in the autopilot and counteract the influence of the interference on the control performance, and the method specifically comprises the following steps:
the model-assisted extended state observer for dealing with external disturbances is designed as follows:
Figure BDA0002143800420000047
wherein λ isivRepresents the bandwidth, lambda, of the auxiliary extended state observer of the linear velocity model of the ith unmanned aerial vehicleThe bandwidth of the ith unmanned aerial vehicle angular velocity model auxiliary extended state observer is represented;
Figure BDA0002143800420000048
represents the linear velocity viIs determined by the estimated value of (c),
Figure BDA0002143800420000049
representing the angular velocity omegaiAn estimated value of (d);
Figure BDA00021438004200000410
indicating disturbance d in autopilotivIs determined by the estimated value of (c),
Figure BDA00021438004200000411
indicating disturbance d in autopilotAn estimate of (d).
(4) Based on the expected linear velocity and course angle instructions provided in the step (2) and the interference estimation provided in the step (3), a robust dynamic feedback linearization control law capable of suppressing the quantization error effect is designed to update the dynamic output of the automatic pilot, so that the multi-unmanned aerial vehicle time-varying trajectory tracking control under the conditions of a given formation pattern, external interference and quantization input is realized, and the method specifically comprises the following steps:
the control updating rule of the ith unmanned aerial vehicle is designed as follows:
Figure BDA0002143800420000051
wherein ξa(a ═ iv1, i ω 1) is an arbitrarily small positive constant used to limit the quantization effect; robust dynamic feedback linearized control law kivAnd kappaThe following were chosen:
Figure BDA0002143800420000052
wherein k isivAnd kAnd the control gain of the i-th unmanned aerial vehicle autopilot is shown.
The invention designs a multi-unmanned aerial vehicle active anti-interference time-varying track tracking control method with a hybrid quantizer, which comprises the steps of firstly, establishing an unmanned aerial vehicle kinematic model with non-integrity constraint, designing a hybrid quantizer integrating average quantization and hysteresis quantization characteristics, and establishing an automatic pilot dynamic state containing environmental interference and quantized input; secondly, designing a virtual control quantity of an unmanned aerial vehicle displacement loop by combining a given time-varying formation style instruction, and generating an expected linear speed and course angle instruction; secondly, constructing a model auxiliary extended state observer to estimate lumped interference in the autopilot and counteract the influence of the interference on the control performance; and finally, designing a robust dynamic feedback linearization control law capable of inhibiting the quantization error effect so as to update the dynamic output of the automatic pilot.
Compared with the prior art, the invention has the following beneficial effects: the active anti-interference time-varying track tracking control method for the multiple unmanned aerial vehicles with the hybrid quantizers, provided by the invention, definitely considers discontinuous control input so as to reduce the harsh requirement on channel transmission bandwidth in the formation process. The problem that the existing quantizer is easy to cause remarkable quantization error when the variation range of the control quantity is large can be solved by adopting the hybrid quantizer. The model auxiliary extended state observer technology is introduced, the adverse effect of unknown environmental interference on a formation system can be effectively overcome, and the realization of strong robust formation tracking performance is ensured.
Drawings
Fig. 1 is a schematic diagram of a centralized multi-drone formation structure.
Fig. 2 is a diagram of a multi-drone time-varying formation trajectory tracking control structure.
Fig. 3 is a simulation result of time-varying formation of four drones.
FIG. 4 shows the simulation effect of the displacement tracking error and the heading angle control error of four unmanned aerial vehicles.
Fig. 5 is a comparison of four drone control signals before and after quantization using a hybrid quantizer.
FIG. 6 is a disturbance estimation effect on the linear velocity loop in the autopilot using an extended state observer.
Fig. 7 is a disturbance estimation effect on an angular velocity loop in a self-driving machine using an extended state observer.
Detailed Description
The present invention is further illustrated by the following specific examples.
A multi-unmanned aerial vehicle active anti-interference time-varying track tracking control method with a hybrid quantizer comprises the following steps:
(1) establishing an unmanned aerial vehicle kinematics model with non-integrity constraint, designing a hybrid quantizer integrating average quantization and hysteresis quantization characteristics, and constructing an automatic pilot dynamic state containing environmental interference and quantitative input, wherein the method specifically comprises the following steps:
firstly, the kinematics model of the ith unmanned aerial vehicle is established as follows:
Figure BDA0002143800420000061
wherein (x)i,yi) Represent that the ith unmanned plane is in the cartesianPosition in the coordinate system, phiiIs the course angle, v, of the unmanned aerial vehicleiiRespectively representing the linear velocity and the angular velocity of the unmanned aerial vehicle;
secondly, establishing the automatic pilot dynamics containing environmental interference and quantitative input:
Figure BDA0002143800420000062
wherein, thetaivAnd thetaIs the time constant of the autopilot,
Figure BDA0002143800420000063
and
Figure BDA0002143800420000064
respectively actual control quantity
Figure BDA0002143800420000065
And
Figure BDA0002143800420000066
discrete control signal after the hybrid quantizer, divAnd dThe interference signal is acted on the autopilot by the external environment; here, the hybrid quantizer design that integrates the average quantization and hysteresis quantization characteristics is as follows:
Figure BDA0002143800420000071
where u represents the input to the hybrid quantizer and q (u) represents the quantized output; hybrid quantizer in the hysteretic quantization state, uj=ρ1-juminThe integer j is 1, 2.; u. ofminThe quantization dead zone is represented by more than 0, the hysteresis interval parameter is represented by delta and used for adjusting the hysteresis interval of the hybrid quantizer, delta belongs to (0,1), and the smaller delta is, the more sensitive the hybrid quantizer is to interference signals;
Figure BDA0002143800420000072
representing the quantization density of the hybrid quantizer, the larger the ρ, the finer the hybrid quantizer quantizes the signal;
Figure BDA0002143800420000073
represents the switching threshold of the hybrid quantizer, in the average quantization state, ΔqRepresents the minimum resolution of the hybrid quantizer quantization; n isqRepresenting the quantization magnitude of the hybrid quantizer; sign (u) denotes
Figure BDA0002143800420000074
(2) The method comprises the following steps of designing a virtual control quantity of an unmanned aerial vehicle displacement loop by combining a given time-varying formation style instruction, and generating an expected linear speed and course angle instruction so as to solve the problem of incomplete constraint of an unmanned aerial vehicle model, wherein the method specifically comprises the following steps: .
And designing a virtual control quantity of the displacement loop of the unmanned aerial vehicle by combining a given time-varying formation style instruction:
Figure BDA0002143800420000075
wherein alpha isixAnd alphaiyRespectively representing the virtual speed control quantity of the ith unmanned aerial vehicle in the x-axis direction and the y-axis direction; k is a radical of formulaixAnd kiyRespectively representing the control gain of the displacement loop of the ith unmanned aerial vehicle; x is the number ofrAnd yrRespectively representing the reference tracks of the unmanned aerial vehicle in the directions of an x axis and a y axis;
Figure BDA0002143800420000081
and
Figure BDA0002143800420000082
respectively representing the reference speeds of the unmanned aerial vehicle in the directions of an x axis and a y axis; sigmaixAnd σiyRespectively representing the offset of the ith unmanned aerial vehicle relative to the reference track in the directions of an x axis and a y axis;
Figure BDA0002143800420000083
and
Figure BDA0002143800420000084
respectively representing the offset speeds of the ith unmanned aerial vehicle in the directions of the x axis and the y axis relative to the reference speed;
generating expected linear velocity command v by utilizing triangular geometric relationAnd a course angle command phi
Figure BDA0002143800420000085
Further, the following virtual angular velocity control amount α is designed
Figure BDA0002143800420000086
Wherein k isAnd the control gain of the ith unmanned aerial vehicle course angle loop is shown.
(3) Aiming at the autopilot quantitative model given in the step (1), a model auxiliary extended state observer is constructed to estimate lumped interference in the autopilot and counteract the influence of the interference on the control performance, and the method specifically comprises the following steps:
the model-assisted extended state observer coping with external disturbances is designed as follows:
Figure BDA0002143800420000087
wherein λ isivRepresents the bandwidth, lambda, of the auxiliary extended state observer of the linear velocity model of the ith unmanned aerial vehicleThe bandwidth of an ith unmanned aerial vehicle angular velocity model auxiliary extended state observer is represented;
Figure BDA0002143800420000088
represents the linear velocity viIs determined by the estimated value of (c),
Figure BDA0002143800420000089
representing the angular velocity omegaiAn estimated value of (d);
Figure BDA00021438004200000810
indicating disturbance d in autopilotivIs determined by the estimated value of (c),
Figure BDA00021438004200000811
indicating disturbance d in autopilotAn estimate of (d).
(4) Based on the expected linear velocity and course angle instructions provided in the step (2) and the interference estimation provided in the step (3), a robust dynamic feedback linearization control law capable of suppressing the quantization error effect is designed to update the dynamic output of the automatic pilot, so that the multi-unmanned aerial vehicle time-varying trajectory tracking control under the conditions of a given formation pattern, external interference and quantization input is realized, and the method specifically comprises the following steps:
the control updating rule of the ith unmanned aerial vehicle is designed as follows:
Figure BDA0002143800420000091
wherein ξa(a ═ iv1, i ω 1) is an arbitrarily small positive constant used to limit the quantization effect; robust dynamic feedback linearized control law kivAnd kappaThe following were chosen:
Figure BDA0002143800420000092
wherein k isivAnd kAnd the control gain of the i-th unmanned aerial vehicle autopilot is shown.
The model initialization parameters, controller and hybrid quantizer parameters, extended state observer parameters, and simulated disturbance parameters are detailed in tables 1,2, 3, and 4.
TABLE 1 initial position of four unmanned aerial vehicles, formation instruction and autopilot time constant
Figure BDA0002143800420000093
TABLE 2 four unmanned aerial vehicle model auxiliary extended state observer parameters
Figure BDA0002143800420000101
TABLE 3 four unmanned aerial vehicle formation trajectory tracking quantizer and controller parameters
Figure BDA0002143800420000102
TABLE 4 simulation interference parameters for four unmanned aerial vehicles
Figure BDA0002143800420000103
The centralized multi-unmanned aerial vehicle formation structure principle is shown in fig. 1, unmanned aerial vehicle formation instructions and reference tracks are manually input and transmitted to a console, the console receives instruction signals and then communicates with each unmanned aerial vehicle to calculate the actual control quantity of each unmanned aerial vehicle, and then the actual control quantity is quantized by a hybrid quantizer and then transmitted to the unmanned aerial vehicles to reduce communication burden. And finally, the unmanned aerial vehicle completes the formation track tracking task by combining a flight control system and hardware of the unmanned aerial vehicle. The time-varying formation trajectory tracking control structure of the multiple unmanned aerial vehicles is shown in fig. 2, and a controller completes the formation trajectory tracking task of the unmanned aerial vehicles in four steps.
The simulation results of the time-varying formation of the four unmanned aerial vehicles are shown in fig. 3, and the four unmanned aerial vehicles complete the expected time-varying formation and the stable tracking task of the target track in the simulation.
As shown in fig. 4, the displacement tracking error and the heading angle control error of each drone can be converged in a short time and stabilized in a small zero-field range.
As shown in fig. 5, after the control signals of the four drones are quantized by the hybrid quantizer, the requirement on the communication bandwidth of the measurement and control link of the ground station is reduced to a certain extent on the premise of not sacrificing the formation control performance.
As shown in fig. 6 and 7, by estimating the interference by using the active interference rejection strategy, the stability of the task executed by the unmanned aerial vehicle can be improved well. From the result graph, the active anti-interference strategy can estimate large high-frequency and low-frequency sinusoidal interference and free attenuation interference, effectively inhibits interference in an automatic pilot, and enhances robustness and stability of the multi-unmanned-aerial-vehicle time-varying trajectory tracking controller in an uncertain environment.
The scope of the invention is not limited to the above embodiments, and various modifications and changes may be made by those skilled in the art, and any modifications, improvements and equivalents within the spirit and principle of the invention should be included in the scope of the invention.

Claims (1)

1. The active anti-interference time-varying track tracking control method for the multiple unmanned aerial vehicles with the hybrid quantizers is characterized by comprising the following steps of: the method comprises the following steps:
(1) establishing an unmanned aerial vehicle kinematic model with non-integrity constraint, designing a hybrid quantizer integrating average quantization and hysteresis quantization characteristics, and constructing an automatic pilot dynamic state containing environmental interference and quantitative input:
firstly, the kinematics model of the ith unmanned aerial vehicle is established as follows:
Figure FDA0003587594140000011
wherein (x)i,yi) Represents the position of the ith drone in a Cartesian coordinate system, phiiIs the course angle, v, of the unmanned aerial vehicleiiRespectively representing the linear velocity and the angular velocity of the unmanned aerial vehicle;
secondly, establishing the automatic pilot dynamics containing environmental interference and quantitative input:
Figure FDA0003587594140000012
wherein, thetaivAnd thetaIs the time constant of the autopilot,
Figure FDA0003587594140000013
and
Figure FDA0003587594140000014
respectively actual control quantity
Figure FDA0003587594140000015
And
Figure FDA0003587594140000016
discrete control signal after the hybrid quantizer, divAnd dThe interference signal is acted on the autopilot by the external environment; here, the hybrid quantizer design that integrates the average quantization and hysteresis quantization characteristics is as follows:
Figure FDA0003587594140000021
where u represents the input to the hybrid quantizer and q (u) represents the quantized output; hybrid quantizer in the hysteretic quantization state, uj=ρ1-juminThe integer j is 1, 2.; u. ofminThe quantization dead zone is represented by more than 0, the hysteresis interval parameter is represented by delta and used for adjusting the hysteresis interval of the hybrid quantizer, delta belongs to (0,1), and the smaller delta is, the more sensitive the hybrid quantizer is to interference signals;
Figure FDA0003587594140000022
representing the quantization density of the hybrid quantizer, the larger the ρ, the finer the hybrid quantizer quantizes the signal;
Figure FDA0003587594140000023
representing the switching threshold of the hybrid quantizer in the average quantization stateqRepresents the minimum resolution of the hybrid quantizer quantization; n is a radical of an alkyl radicalqRepresenting the quantization magnitude of the hybrid quantizer; sign (u) denotes
Figure FDA0003587594140000024
(2) Designing a virtual control quantity of an unmanned aerial vehicle displacement loop by combining a given time-varying formation style instruction, and generating an expected linear speed and course angle instruction:
and designing a virtual control quantity of the displacement loop of the unmanned aerial vehicle by combining a given time-varying formation style instruction:
Figure FDA0003587594140000025
wherein alpha isixAnd alphaiyRespectively representing the virtual speed control quantity of the ith unmanned aerial vehicle in the x-axis direction and the y-axis direction; k is a radical ofixAnd kiyRespectively representing the control gain of the displacement loop of the ith unmanned aerial vehicle; x is the number ofrAnd yrRespectively representing the reference trajectories of the unmanned aerial vehicle in the directions of an x axis and a y axis;
Figure FDA0003587594140000031
and
Figure FDA0003587594140000032
respectively representing the reference speeds of the unmanned aerial vehicle in the directions of an x axis and a y axis; sigmaixAnd σiyRespectively representing the offset of the ith unmanned aerial vehicle in the x-axis direction and the y-axis direction relative to the reference track;
Figure FDA0003587594140000033
and
Figure FDA0003587594140000034
respectively indicate that the i-th unmanned aerial vehicle is atOffset velocities in the x-axis and y-axis directions relative to a reference velocity;
generating expected linear velocity command v by utilizing triangular geometric relationAnd a course angle command phi
Figure FDA0003587594140000035
Further, the following virtual angular velocity control amount α is designed
Figure FDA0003587594140000036
Wherein k isRepresenting the control gain of the i-th unmanned aerial vehicle course angle loop;
(3) aiming at the autopilot quantitative model given in the step (1), a model auxiliary extended state observer is constructed to estimate lumped interference in the autopilot:
the model-assisted extended state observer for dealing with external disturbances is designed as follows:
Figure FDA0003587594140000037
wherein λ isivRepresents the bandwidth, lambda, of the auxiliary extended state observer of the linear velocity model of the ith unmanned aerial vehicleThe bandwidth of the ith unmanned aerial vehicle angular velocity model auxiliary extended state observer is represented;
Figure FDA0003587594140000038
represents the linear velocity viIs determined by the estimated value of (c),
Figure FDA0003587594140000039
representing the angular velocity omegaiAn estimated value of (d);
Figure FDA00035875941400000310
indicating disturbance d in autopilotivIs determined by the estimated value of (c),
Figure FDA00035875941400000311
indicating disturbance d in autopilotAn estimated value of (d);
(4) designing a robust dynamic feedback linearization control law capable of inhibiting quantization error effects based on the expected linear speed and course angle instructions provided in the step (2) and the interference estimation provided in the step (3) to update the dynamic output of the automatic pilot, and realizing multi-unmanned aerial vehicle time-varying trajectory tracking control under the conditions of a given formation pattern, external interference and quantization input:
the control updating rule of the ith unmanned aerial vehicle is designed as follows:
Figure FDA0003587594140000041
wherein ξa(a ═ iv1, i ω 1) is an arbitrarily small positive constant used to limit the quantization effect; robust dynamic feedback linearized control law kivAnd kappaThe following were chosen:
Figure FDA0003587594140000042
wherein k isivAnd kAnd the control gain of the i-th unmanned aerial vehicle autopilot is shown.
CN201910677634.3A 2019-07-25 2019-07-25 Active anti-interference time-varying track tracking control method for multiple unmanned aerial vehicles with hybrid quantizers Active CN110632940B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910677634.3A CN110632940B (en) 2019-07-25 2019-07-25 Active anti-interference time-varying track tracking control method for multiple unmanned aerial vehicles with hybrid quantizers

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910677634.3A CN110632940B (en) 2019-07-25 2019-07-25 Active anti-interference time-varying track tracking control method for multiple unmanned aerial vehicles with hybrid quantizers

Publications (2)

Publication Number Publication Date
CN110632940A CN110632940A (en) 2019-12-31
CN110632940B true CN110632940B (en) 2022-05-24

Family

ID=68969303

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910677634.3A Active CN110632940B (en) 2019-07-25 2019-07-25 Active anti-interference time-varying track tracking control method for multiple unmanned aerial vehicles with hybrid quantizers

Country Status (1)

Country Link
CN (1) CN110632940B (en)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111308897B (en) * 2020-04-22 2022-07-19 中北大学 Four-rotor wing performance-guaranteeing quantitative control method considering airborne resource limitation
CN113359822B (en) * 2021-05-28 2022-11-11 济南大学 Active disturbance rejection control method and system with pilot unmanned aerial vehicle formation
CN116560227B (en) * 2023-03-31 2023-12-12 上海理工大学 Lu Bangxian stable vehicle team longitudinal control method based on generalized extended state observer

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108107717A (en) * 2017-09-27 2018-06-01 西北工业大学深圳研究院 A kind of distributed control method for being suitable for quantifying multi agent systems
CN110007682A (en) * 2019-02-02 2019-07-12 曲阜师范大学 Attitude of flight vehicle output feedback ontrol method and system, controller and control method based on input and output quantization

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108107717A (en) * 2017-09-27 2018-06-01 西北工业大学深圳研究院 A kind of distributed control method for being suitable for quantifying multi agent systems
CN110007682A (en) * 2019-02-02 2019-07-12 曲阜师范大学 Attitude of flight vehicle output feedback ontrol method and system, controller and control method based on input and output quantization

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
Adaptive Tracking Control of Uncertain Nonlinear Systems With Saturated Input Quantization;Guanyu Lai等;《2019 12th Asian Control Conference (ASCC)》;20190612;全文 *
Distributed Adaptive Finite-Time Approach for Formation–Containment Control of Networked Nonlinear Systems Under Directed Topology;Yujuan Wang等;《TRANSACTIONS ON NEURAL NETWORKS AND LEARNING SYSTEMS》;20180731;全文 *
量化和事件触发控制若干问题研究;邢兰涛;《中国优秀博硕士学位论文全文数据库(博士)信息科技辑》;20180815;全文 *

Also Published As

Publication number Publication date
CN110632940A (en) 2019-12-31

Similar Documents

Publication Publication Date Title
CN110632940B (en) Active anti-interference time-varying track tracking control method for multiple unmanned aerial vehicles with hybrid quantizers
CN110703795B (en) Unmanned aerial vehicle group cooperative security control method based on switching topology
Low A dynamic virtual structure formation control for fixed-wing UAVs
Mueller et al. Iterative learning of feed-forward corrections for high-performance tracking
CN111258214B (en) Fixed-time consistency tracking method of high-order multi-agent system based on directed topology
CN111522361A (en) Multi-unmanned aerial vehicle formation consistency control method in master-slave mode
CN109032137B (en) Distributed tracking control method for multi-Euler-Lagrange system
CN103558857A (en) Distributed composite anti-interference attitude control method of BTT flying machine
CN111638726A (en) Event trigger communication-based multi-unmanned aerial vehicle formation consistency control method
Shou et al. Finite‐time formation control and obstacle avoidance of multi‐agent system with application
CN110673623B (en) Quad-rotor unmanned aerial vehicle landing method based on dual-ring PD control algorithm control
CN113050427B (en) Rapid terminal sliding mode fault-tolerant control method for nonlinear system under actuator fault
CN113268064A (en) Multi-mobile-robot cooperative formation control method considering communication time delay
CN111439392B (en) Spacecraft formation position cooperative control method
CN111898201A (en) High-precision autonomous attack guiding method for fighter in air combat simulation environment
Wang et al. Global event-triggered inner–outer loop stabilization of under-actuated surface vessels
CN106647264A (en) Unmanned aerial vehicle control method based on control constraint extended robust H<infinite>
CN112180961B (en) Track tracking control method and system for all-state limited stratospheric airship
Chemori et al. A prediction‐based nonlinear controller for stabilization of a non‐minimum phase PVTOL aircraft
CN114326781A (en) Fully-distributed missile formation cooperative self-adaptive fault-tolerant compensation controller
CN117177208B (en) Cluster unmanned aerial vehicle cooperative fault-tolerant control method considering random communication delay
CN111596688A (en) Multi-unmanned aerial vehicle formation consistency control method based on continuous communication
CN116360258A (en) Hypersonic deformed aircraft anti-interference control method based on fixed time convergence
Wang et al. Distributed formation flight control with translational and rotational maneuvering
CN109062232B (en) Seabed seismic wave detection flight node distributed finite time anti-shake configuration inclusion control method

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