CN112923925B - Dual-mode multi-unmanned aerial vehicle collaborative track planning method for hovering and tracking ground target - Google Patents
Dual-mode multi-unmanned aerial vehicle collaborative track planning method for hovering and tracking ground target Download PDFInfo
- Publication number
- CN112923925B CN112923925B CN202110018314.4A CN202110018314A CN112923925B CN 112923925 B CN112923925 B CN 112923925B CN 202110018314 A CN202110018314 A CN 202110018314A CN 112923925 B CN112923925 B CN 112923925B
- Authority
- CN
- China
- Prior art keywords
- unmanned aerial
- aerial vehicle
- mode
- model
- obstacle avoidance
- 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
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
-
- 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
- Y02T10/00—Road transport of goods or passengers
- Y02T10/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
Abstract
The invention discloses a multi-unmanned aerial vehicle collaborative track planning method for tracking a ground target in a dual-mode hovering mode, which comprises the steps of constructing an unmanned aerial vehicle kinematics model, a ground target motion model and a three-dimensional urban environment model; providing a switching condition of a hovering mode and an obstacle avoidance mode based on the obstacle avoidance requirements of the unmanned aerial vehicle and the high-rise building; constructing a multi-objective optimization model under a dual mode based on a multi-objective optimization algorithm of synchronous distributed model predictive control; establishing a priority model based on a relaxation satisfaction degree sequence method to obtain a generalized fuzzy satisfaction degree target planning model; constructing a multi-unmanned aerial vehicle collaborative track planning model under a dual mode based on a synchronous distributed model predictive control and fuzzy target planning method; the invention comprehensively considers performance indexes such as tracking precision, energy conservation and the like and different priority requirements thereof, and provides a reliable flight path planning scheme for a multi-unmanned aerial vehicle cooperative tracking target on the premise of ensuring controllable safety of multi-unmanned aerial vehicle cooperative flight based on a synchronous distributed model predictive control and fuzzy target planning method.
Description
Technical Field
The invention belongs to the field of flight path planning, and particularly relates to a multi-unmanned aerial vehicle collaborative flight path planning method for tracking a ground target in a dual-mode hovering mode.
Background
The unmanned aerial vehicle has small volume, high flexibility, good stability and strong adaptability, can replace human beings to finish difficult work, undertakes special missions, and is widely applied to military and civil aspects such as agricultural plant protection, forest fire extinguishing, marine rescue, logistics transportation and the like. Because the unmanned aerial vehicle does not need manned flight, the characteristic of potential risk can be avoided, the unmanned aerial vehicle is often used for executing some complex and high-risk tasks, such as real-time monitoring and tracking of ground targets in urban scenes with severe conditions and complex maps. However, building sheltering in urban environments can affect the tracking effect, and therefore in order to achieve higher tracking accuracy, the tracking task is often completed through cooperation of multiple unmanned aerial vehicles.
Taking a complex urban environment as an example, in the method, buildings are distributed in a high-low mixed mode, the speed of a moving target is changed, accurate monitoring and tracking of the unmanned aerial vehicles are achieved through cooperative work of the unmanned aerial vehicles, important research values are achieved, and the aircraft planning algorithm of the unmanned aerial vehicles is concerned. When tracking a target moving at a lower speed, the drone needs to maintain a certain cruising speed, so that the drone continuously spirals around the target to avoid stalling. When high-rise building obstacles exist in the coverage area of the unmanned aerial vehicle sensor, the obstacle avoidance is considered, and simultaneously, the tracking task is completed to the maximum extent. Therefore, the dual-mode flight path planning scheme is necessary and complete for tracking the variable speed target and adapting to the complex flight environment, and different performance index functions and constraint conditions are set according to the tracking characteristics of different modes to adapt to requirements, such as precision requirements, energy-saving requirements and the like. The establishment of the performance index model and the representation of the priority under different modes have a decisive effect on whether the optimal flight path can be obtained. In addition, considering the flight safety of the unmanned aerial vehicles, when a communication delay condition exists, how to avoid collision between the unmanned aerial vehicles is also one of the important points. Therefore, under the condition of considering multiple performance requirements of unmanned aerial vehicle tracking precision, energy conservation, collision avoidance, obstacle avoidance and the like, in order to realize the double-mode multi-unmanned aerial vehicle spiral tracking task of the ground target, the method has important theoretical significance and practical significance for researching the collaborative track planning algorithm.
The unmanned aerial vehicle has the advantages of being wide in aerial environment and few in uncertain factors, and being capable of utilizing the unmanned aerial vehicle to perform tasks which are difficult to complete on the ground. The flight path planning is one of the relevant key technologies of the unmanned aerial vehicle, and the existing special research contents are rich and the algorithms are various. However, a single unmanned aerial vehicle cannot be suitable for some complicated, crowded and sheltered terrain conditions, and therefore multiple unmanned aerial vehicles need to be adopted to cooperate to complete work. The purpose of the collaborative planning of multiple unmanned aerial vehicles is not to require a certain unmanned aerial vehicle to obtain an optimal path, but to require the overall performance of the unmanned aerial vehicle cluster to be optimal. However, the existing unmanned aerial vehicle collaborative track planning algorithm for tracking at low speed of the target is few, and the problems of obstacle avoidance and the like of the urban environment are also rarely considered, so that the method has important research significance.
Disclosure of Invention
The invention relates to cooperative track planning of multiple unmanned aerial vehicles, which is characterized in that multiple unmanned aerial vehicles track moving ground targets in an urban environment as a background, on the basis of ensuring high-precision tracking, the energy-saving problem and the safe flight problem of the unmanned aerial vehicles are considered, and a dual-mode cooperative track planning algorithm for hovering and tracking the ground targets is designed.
The invention is implemented by adopting the following technical scheme:
the multi-unmanned aerial vehicle collaborative track planning method for the dual-mode hovering tracking of the ground target comprises the following steps:
constructing an unmanned aerial vehicle kinematic model, a ground target motion model and a three-dimensional city environment model by taking ground target tracking of multiple unmanned aerial vehicles for tracking low-speed movement in a city as a background;
providing a condition for switching between a spiral mode and an obstacle avoidance mode based on the obstacle avoidance requirements of the unmanned aerial vehicle and the high-rise building;
constructing a multi-objective optimization model under a dual mode based on a multi-objective optimization algorithm of synchronous distributed model predictive control;
establishing a priority model based on a relaxation satisfaction degree sequence method to obtain a generalized fuzzy satisfaction degree target planning model;
and constructing a multi-unmanned aerial vehicle collaborative track planning model under a dual mode based on a synchronous distributed model prediction control and fuzzy target planning method.
Further, the dual-mode multi-unmanned aerial vehicle collaborative track planning method for hovering and tracking the ground target is characterized in that: providing a switching condition of a hovering mode and an obstacle avoidance mode based on the obstacle avoidance requirements of the unmanned aerial vehicle and the high-rise building; wherein:
1) Hover mode conditions: when the high-rise building is out of the visual range of all unmanned aerial vehicle sensors, i.e.
2) Obstacle avoidance mode conditions: when the high-rise building is within a certain unmanned sensor visible range, that is to say
In order to meet the obstacle avoidance requirement, all unmanned aerial vehicles are in an obstacle avoidance mode.
Wherein R is B Is the minimum circumscribed circle radius of the bottom surface of the building, thenRepresents half of the length of a side of the bottom surface of the building; r s Is the unmanned aerial vehicle sensor coverage area radius.
Further, the dual-mode multi-unmanned aerial vehicle collaborative track planning method for hovering and tracking the ground target is characterized in that: constructing a multi-objective optimization model under a dual mode based on a multi-objective optimization algorithm of synchronous distributed model predictive control; wherein:
a: spiral pattern
The two performance indexes of the hover distance keeping and the phase angle difference keeping are set and arranged in parallel at the first priority. In addition, the maintenance characteristics of the speed and the steering rate of the unmanned aerial vehicle model are considered, the speed input cost and the steering rate input cost are set, and two performance indexes in the aspect of energy conservation are arranged at the second priority.
The performance index in hover mode is as follows:
1) Spiral distance maintenance
2) Phase angle difference maintenance
3) Speed input cost
4) Steering rate input cost
According to the state and control limit of the unmanned aerial vehicle, the requirements of collision and obstacle avoidance set state constraint and control constraint, collision avoidance constraint, compatibility constraint and obstacle avoidance constraint. The method is characterized in that collision avoidance constraints which are usually adopted are distinguished, and based on the algorithm characteristics of synchronous distributed predictive control, each unmanned aerial vehicle can only obtain state information of other unmanned aerial vehicles at the previous sampling moment at the current sampling moment, and can only take collision avoidance actions according to the prediction result at the previous moment, and uncertain errors caused by information delay need to be constrained, so that new collision avoidance constraints and compatibility constraint conditions are designed to reduce the uncertain errors and avoid collision among the unmanned aerial vehicles.
The constraints in hover mode are as follows:
1) State constraints and control constraints
2) Restraint of avoiding collision
3) Compatibility constraints
B: obstacle avoidance mode
To ensure high accuracy tracking, a tracking error cost performance indicator is set and arranged at a first priority. In addition, considering the energy-saving requirement, two performance indexes of speed input cost and steering rate input cost are set and arranged at the second priority.
The performance indexes in the obstacle avoidance mode are as follows:
1) Tracking error cost
2) Speed input cost
3) Steering rate input cost
The constraints are as follows:
1) State constraints and control constraints:
2) Restraint of avoiding collision
3) Compatibility constraints
4) Obstacle avoidance restraint
Further, the multi-unmanned aerial vehicle collaborative track planning model in the dual mode respectively comprises a multi-unmanned aerial vehicle collaborative track planning model in a hovering mode and a multi-unmanned aerial vehicle collaborative track planning model in an obstacle avoidance mode; wherein:
the multi-unmanned aerial vehicle collaborative track planning model in the hovering mode is as follows:
n 1 ≤r 0 -0,p 1 ≤R v -r 0 ,p 2 ≤1-cosθ 0
n 1 ·p 1 =0,n 3 ·p 3 =0,n 4 ·p 4 =0;n 1 ,p 1 ,p 2 ,n 3 ,p 3 ,n 4 ,p 4 ≥0;-1≤η≤1
x i (k|k)=x i (k),y i (k|k)=y i (k),ψ i (k|k)=ψ i (k),υ i (k|k)=υ i (k),ω i (k|k)=ω i (k)
P=0,1,..H-1;i,j=1,2,..N,i≠j;l=1,2,..N h ;
the multi-unmanned aerial vehicle collaborative track planning model in the obstacle avoidance mode comprises the following steps:
n 6 ·p 6 =0,n 7 ·p 7 =0;p 5 ,n 6 ,p 6 ,n 7 ,p 7 ≥0;-1≤η≤1
x i (k|k)=x i (k),y i (k|k)=y i (k),ψ i (k|k)=ψ i (k),υ i (k|k)=υ i (k),ω i (k|k)=ω i (k)
P=0,1,..H-1;i,j=1,2,..N,i≠j;l=1,2,..N h 。
further, the switching condition of the hovering mode and the obstacle avoidance mode is a rolling solving process optimized based on a nonlinear programming method, and the method comprises the following steps:
step 1: at a sampling moment k, judging the flight mode of the unmanned aerial vehicle cluster according to the distance between the unmanned aerial vehicle and a high-rise building, if the flight mode is a hover mode, jumping to Step2, and if the flight mode is an obstacle avoidance mode, jumping to Step3;
step 2: establishing a multi-unmanned aerial vehicle collaborative track planning model in a hovering mode, solving an optimization result based on a nonlinear programming algorithm, and jumping to Step4;
step 3: establishing a multi-unmanned aerial vehicle collaborative track planning model in an obstacle avoidance mode, and solving an optimization result based on a nonlinear programming algorithm;
step 4: applying the first item of the solved optimal control sequence to the corresponding unmanned aerial vehicle; the optimal control sequence is as follows:
u υi (k+P|k),u ωi (k+P|k)
step5: and (4) sending the predicted track of the current unmanned aerial vehicle at the moment k to other unmanned aerial vehicles, and turning to Step 1 at the moment k +1 until the tracking task is finished.
Advantageous effects
In the process of planning the ground target track tracked by the multiple unmanned aerial vehicles, the invention has three main targets: enabling the unmanned aerial vehicle to accurately track and monitor the target; the safety problem of the unmanned aerial vehicle in the flight process is guaranteed; the energy lost in flight is saved as much as possible. The first point is the problem of tracking precision, namely, after the unmanned aerial vehicle group obtains the state information of the ground target, the purpose of tracking the same ground target is achieved by solving the collaborative optimal flight path. In order to meet the actual situation, the ground target always travels at a low speed, which is considered in the research, and the difficulty of tracking is undoubtedly increased. The second point is the problem of flight safety, and the key for solving the problem is to set reasonable obstacle avoidance and collision avoidance constraints, especially to consider the problem of collision avoidance among multiple unmanned aerial vehicles under the distributed model predictive control framework. The third point is the energy saving problem, and the target is used as an auxiliary target rather than a primary target of the track planning, so how to balance the proportion relation among the performance indexes also becomes one of the key problems of the track planning.
The invention provides a high-precision tracking scheme for continuously tracking a low-speed moving target in an urban environment, namely a dual-mode multi-unmanned aerial vehicle collaborative track planning algorithm for spirally tracking a ground target. On the basis that an unmanned aerial vehicle kinematics model, a ground target motion model and a three-dimensional urban environment model are known, the accurate tracking of the ground target is realized by adopting a dual-mode switching tracking strategy with a circling mode as a main mode and an obstacle avoidance mode as an auxiliary mode on the assumption that the motion track is also known. The performance indexes such as tracking precision, energy conservation and the like and different priority requirements thereof are comprehensively considered, and an efficient and reliable flight path planning scheme is provided for the multi-unmanned aerial vehicle cooperative tracking target on the premise of ensuring controllable safety of the multi-unmanned aerial vehicle cooperative flight based on the synchronous distributed model predictive control and fuzzy target planning method.
Drawings
FIG. 1 is a flow chart of the hover/obstacle avoidance model building in the present invention;
FIG. 2 is a flow chart of the rolling optimization in the present invention;
fig. 3 is a simulation diagram of the three-dimensional tracking effect in the present invention.
Detailed Description
Aiming at the problem that the conventional multi-unmanned aerial vehicle collaborative track planning is difficult to adapt to urban environment, the invention adopts a dual-mode switching tracking strategy with a hovering mode as a main mode and an obstacle avoidance mode as an auxiliary mode to realize the accurate tracking of a ground target. The dual-mode multi-unmanned aerial vehicle collaborative track planning algorithm for hovering and tracking the ground target can be used for monitoring and tracking a low-speed moving target in an urban environment. The specific process is as follows:
1. the ground target tracking of multiple unmanned aerial vehicles for tracking the middle-low-speed movement of the city is used as a background, and an unmanned aerial vehicle kinematics model, a ground target movement model and a three-dimensional city environment model are constructed.
Firstly, an unmanned aerial vehicle kinematics model is introduced, the fixed-wing unmanned aerial vehicle model adopted in the invention is a double-input unmanned aerial vehicle kinematics model with speed and course keeping functions, and compared with a single-input constant-speed unmanned aerial vehicle model which is usually adopted, the speed and the steering rate of an unmanned aerial vehicle in the model are controllable and variable, and the model is suitable for tracking complex tasks such as variable speed targets. The kinematics model of the unmanned aerial vehicle is as follows:
wherein i =1,2,. N, N is the number of drones used for tracking;is the three-dimensional position coordinate of drone i, z i Indicating the flight altitude; psi i Is the course angle; upsilon is i And ω i Speed and steering rate, respectively; u. of υi And u ωi Is a control input; tau is υ And τ ω The delay of the drone actuator is considered.
Discretizing the model with Δ T as sampling time interval:
where k denotes the time k and k +1 denotes the time k + 1.
Secondly, a ground target motion model is introduced, the invention adopts the ground target motion model with speed change, and the discrete form of the model is as follows:
wherein the content of the first and second substances,representing the state of the ground target, including its position, velocity, and acceleration; g is a transformation matrix; q (k) to N (0,Q (k)) are process noise and Q (k) is its covariance matrix.
The urban environment model is defined as:
wherein omega B Is the area occupied by a single building, N B Is the number of buildings, omega B =F((x B ,y B ),H B ) Representing the area occupied by a building as a function of the coordinates of the center and the height of its floor, Ω is the set of all buildings.
The position information of the intersection is expressed by the intersection point coordinates of the road center lines, namely:
wherein the content of the first and second substances,coordinates representing a certain junction, N c Is the number of intersections, I represents all intersection informationA collection of information.
In order to simulate a real urban environment, a high-rise building model is added into an environment model to serve as a high-altitude barrier in the flight of an unmanned aerial vehicle, and a dark building in the figure 3 is a high-rise building and is represented as follows:
wherein the content of the first and second substances,represents a center position coordinate above the flight height of the drone, l =1,2,. N h In the formula N h Indicating the number of high-rise buildings.
2. Based on the obstacle avoidance requirements of the unmanned aerial vehicle and the high-rise building, the switching condition of the hovering mode and the obstacle avoidance mode is provided.
When the unmanned aerial vehicle is always in a spiral state, due to the existence of high-rise buildings, the flight safety is difficult to guarantee, collision accidents are possible, the tracking precision is guaranteed on the basis that obstacles can be avoided, and therefore the tracking strategy is switched by adopting a double mode with a spiral mode as a main mode and an obstacle avoiding mode as an auxiliary mode.
1) Hover mode conditions: when the high-rise building is out of the visual range of all unmanned aerial vehicle sensors, i.e.
2) Obstacle avoidance mode conditions: when the high-rise building is within a certain unmanned sensor visible range, that is to say
In order to meet the obstacle avoidance requirement, all unmanned aerial vehicles are in an obstacle avoidance mode.
Wherein R is B Is the minimum circumscribed circle radius of the bottom surface of the building, thenRepresents half of the length of a side of the bottom surface of the building; r s Is the unmanned aerial vehicle sensor coverage area radius.
3. Based on a multi-objective optimization algorithm of synchronous distributed model predictive control, considering factors such as unmanned aerial vehicle state constraint and control constraint, obstacle avoidance constraint, collision avoidance constraint among unmanned aerial vehicles and the like, constructing a multi-objective optimization model under a dual mode, wherein performance indexes of a spiral mode comprise spiral distance keeping, phase angle difference keeping, speed input cost and steering rate input cost; the performance indexes of the obstacle avoidance mode comprise tracking error cost, speed input cost and steering rate input cost.
The objective is to obtain the optimal overall flight path in the prediction time domain through the airborne processor of each unmanned aerial vehicle, so that the flight path planning algorithm has foresight property and the control of each unmanned aerial vehicle has independence. The specific content of the algorithm is as follows:
a: spiral pattern
The purpose of hovering is in the control and the surveillance target, also can play the effect of escort and protection, when the visual domain within range of unmanned aerial vehicle does not have high-rise building, opens the mode of hovering. Considering that the unmanned aerial vehicles need to maintain a certain confronting distance with the target in a hovering state, and certain phase angle difference needs to be maintained between the unmanned aerial vehicles so as to keep hovering when tracking a low-speed target, two performance indexes of hovering distance keeping and phase angle difference keeping are set and are arranged in parallel at a first priority. In addition, the maintenance characteristics of the speed and the steering rate of the unmanned aerial vehicle model are considered, the speed input cost and the steering rate input cost are set, and two performance indexes in the aspect of energy conservation are arranged at the second priority.
The performance index in hover mode is as follows:
1) Spiral distance maintenance
Wherein the content of the first and second substances,the plane distance between the k + P +1 time frame unmanned aerial vehicle i and the target obtained by k time prediction is represented, P =1,2 0 Indicating the hover distance of the drone relative to the target.
2) Phase angle difference maintenance
Wherein, theta ij (k + P +1k | represents a phase angle difference between the unmanned plane i and the unmanned plane j, and θ ij =|θ i (k+P+1|k)-θ j (k+P+1|k)|;θ 0 Indicating the desired phase angle difference.
3) Speed input cost
Wherein, the first and the second end of the pipe are connected with each other,showing the cruising speed in the hover mode of the drone.
4) Steering rate input cost
Wherein the content of the first and second substances,representing the cruise steering rate in the hover mode of the drone.
Considering firstly the tracking configuration situation between the drone and the target and drone and secondly the problem of economy reduction of the drone, two priorities are therefore defined as follows:
according to the state and control limit of the unmanned aerial vehicle, the requirements of collision and obstacle avoidance set state constraint and control constraint, collision avoidance constraint, compatibility constraint and obstacle avoidance constraint. The method is characterized in that collision avoidance constraints which are usually adopted are distinguished, and based on the algorithm characteristics of synchronous distributed predictive control, each unmanned aerial vehicle can only obtain state information of other unmanned aerial vehicles at the previous sampling moment at the current sampling moment, and can only take collision avoidance actions according to the prediction result at the previous moment, and uncertain errors caused by information delay need to be constrained, so that new collision avoidance constraints and compatibility constraint conditions are designed to reduce the uncertain errors and avoid collision among the unmanned aerial vehicles.
The constraints in hover mode are as follows:
1) State constraints and control constraints
The constraints on speed, steering rate and control input are:
2) Restraint of avoiding collision
Since the drone receives the location information of other drones at time k-1 at time k, the states of each drone at time k will be calculated simultaneously based on the distributed predictive control at time k. Then predicted drone position at time k-1With k actual unmanned aerial vehicle position constantlyThe uncertainty error between is:
then, the unmanned aerial vehicle i obtains the predicted distance between the unmanned aerial vehicles i and j according to the received position information of the unmanned aerial vehicle j at the moment k-1 as follows:
the boundaries of the uncertainty error are:
wherein the content of the first and second substances,r a is the confrontation distance between the unmanned planes when the unmanned planes are in a spiral state.
The collision avoidance constraint is as follows:
3) Compatibility constraints
Compatibility constraints are set in order to ensure that the uncertainty error is within a certain range and gradually reduced in the rolling optimization. The maximum value of the prediction distance obtained at the moment k-1 between the unmanned aerial vehicles in the prediction time domain is as follows:
another boundary of uncertainty error is:
The compatibility constraints are:
b: obstacle avoidance mode
Keep away the aim at of barrier mode and guarantee to track precision and unmanned aerial vehicle flight safety, when having high-rise building thing when the visual domain within range of unmanned aerial vehicle, open and keep away the barrier mode. To ensure high accuracy tracking, a tracking error cost performance indicator is set and arranged at a first priority. In addition, considering the energy-saving requirement, two performance indexes of speed input cost and steering rate input cost are set and arranged at the second priority.
The performance indexes in the obstacle avoidance mode are as follows:
1) Tracking error cost
2) Speed input cost
Wherein, the first and the second end of the pipe are connected with each other,and the cruising speed of the unmanned aerial vehicle in the obstacle avoidance mode is shown.
3) Steering rate input cost
Wherein the content of the first and second substances,and the cruise steering rate in the unmanned plane obstacle avoidance mode is represented.
Two priorities are defined as follows:
according to the state and control input limit of the unmanned aerial vehicle, the requirements of collision and obstacle avoidance set state constraint and control constraint, collision avoidance constraint, compatibility constraint and obstacle avoidance constraint. The constraints are as follows:
1) State constraints and control constraints
The constraints on speed, steering rate and control input are:
2) Restraint of collision avoidance
The bounds of uncertainty error are:
wherein the content of the first and second substances,r b = L is the stand-off distance between drones when tracking.
The collision avoidance constraint is as follows:
3) Compatibility constraints
4) Obstacle avoidance restraint
L/2 is the safe radius of the unmanned aerial vehicle, and when the unmanned aerial vehicle keeps a safe distance from a high-rise building, the unmanned aerial vehicle can bypass the obstacle.
4. A fuzzy satisfaction target optimization method is adopted, the performance index is converted into a fuzzy membership function form, a priority model is established based on a relaxation satisfaction sequence method, and a generalized fuzzy satisfaction target planning model is obtained.
Based on a traditional target planning model, requirements for performance indexes are abstracted into a form of a membership function through a fuzzification means, and when deviation between a target function and an expected value is minimum, an optimal solution is obtained. However, the strict priority model established in the foregoing may cause difficulty in finding the optimal solution, so that the priority relationship is relaxed based on the relaxed satisfaction degree method, and the performance requirements and the priority requirements are balanced as much as possible. The method comprises the following specific contents:
the traditional target planning model is:
n e ,p e ≥0,n e ·p e =0
w∈G e
wherein p is e ,n e Respectively, positive and negative offset variables, m is the number of performance indicators, G e Is a domain of definition.
Then the three fuzzy relations are:
Assume that the priority relationship is f d (w)≥f s (w)≥f t (w) establishing a priority model based on a relaxation satisfaction degree sequence method:
the generalized fuzzy satisfaction target planning model is as follows:
p d ,n s ,n t ,p t ≥0,n t ·p t =0
-1≤γ≤1,w∈G e
wherein gamma is an unknown variable, -1 is more than or equal to gamma and less than or equal to 0, which indicates that the priority relationship is satisfied, otherwise, the priority relationship is not satisfied; λ is an adjustable parameter, with increasing values representing more emphasis on priority differences.
5. And constructing a multi-unmanned aerial vehicle collaborative track planning model under the dual modes based on a synchronous distributed model predictive control and fuzzy target planning method by combining an unmanned aerial vehicle model, a performance index function, constraint conditions and priority requirements.
The fuzzy performance index function and priority under the dual mode are as follows:
a: spiral pattern
The performance index in hover mode is as follows:
1) Spiral distance maintenance
Wherein R is v Is the radius of the field of view of the sensor.
2) Phase angle difference maintenance
3) Speed input cost
4) Steering rate input cost
Based on the relaxed satisfaction order, the priority model is:
the multi-unmanned aerial vehicle collaborative track planning model in the hovering mode is as follows:
n 1 ≤r 0 -0,p 1 ≤R v -r 0 ,p 2 ≤1-cosθ 0
n 1 ·p 1 =0,n 3 ·p 3 =0,n 4 ·p 4 =0;n 1 ,p 1 ,p 2 ,n 3 ,p 3 ,n 4 ,p 4 ≥0;-1≤η≤1
x i (k|k)=x i (k),y i (k|k)=y i (k),ψ i (k|k)=ψ i (k),υ i (k|k)=υ i (k),ω i (k|k)=ω i (k)
P=0,1,..H-1;i,j=1,2,..N,i≠j;l=1,2,..N h
b: obstacle avoidance mode
The performance indexes in the obstacle avoidance mode are as follows:
1) Tracking error cost
2) Speed input cost
3) Steering rate input cost
Based on the relaxation satisfaction order, the priority model is:
the multi-unmanned aerial vehicle collaborative track planning model in the obstacle avoidance mode is as follows:
n 6 ·p 6 =0,n 7 ·p 7 =0;p 5 ,n 6 ,p 6 ,n 7 ,p 7 ≥0;-1≤η≤1
x i (k|k)=x i (k),y i (k|k)=y i (k),ψ i (k|k)=ψ i (k),υ i (k|k)=υ i (k),ω i (k|k)=ω i (k)
P=0,1,..H-1;i,j=1,2,..N,i≠j;l=1,2,..N h
6. and designing a rolling solving step of the optimization algorithm based on a nonlinear programming method.
The concrete rolling solving steps are as follows:
step 1: at a sampling moment k, judging the flight mode of the unmanned aerial vehicle cluster according to the distance between the unmanned aerial vehicle and a high-rise building, if the flight mode is a hover mode, jumping to Step2, and if the flight mode is an obstacle avoidance mode, jumping to Step3;
step 2: establishing a multi-unmanned aerial vehicle collaborative track planning model in a hovering mode, solving an optimization result based on a nonlinear programming algorithm, and jumping to Step4;
step 3: establishing a multi-unmanned aerial vehicle collaborative track planning model in an obstacle avoidance mode, and solving an optimization result based on a nonlinear programming algorithm;
step 4: applying the first item of the optimal control sequence to the corresponding unmanned aerial vehicle; the optimal control sequence is as follows:
u υi (k+P|k),u ωi (k+P|k)
step5: and (4) sending the predicted track of the current unmanned aerial vehicle at the moment k to other unmanned aerial vehicles, and turning to Step 1 at the moment k +1 until the tracking task is finished.
According to the embodiment of the invention, the processes of model establishment, algorithm verification and the like are completed through program writing, and the effectiveness of the dual-mode unmanned aerial vehicle collaborative track planning algorithm for spirally tracking the ground target is tested through a large amount of data and image processing. In the invention, the test is carried out by using two unmanned aerial vehicles as backgrounds for tracking the same ground target. After the data processing is completed, the results are shown in fig. 3.
Simulation results show that the algorithm has small error, high reliability and good safety when multiple unmanned aerial vehicles cooperatively track the ground low-speed target, and can complete a high-quality tracking task. Therefore, the dual-mode multi-unmanned aerial vehicle collaborative track planning algorithm for hovering and tracking the ground target has feasibility. The method ensures tracking accuracy in a dual-mode, considers the problems that unmanned aerial vehicles avoid each other and high-level obstacles, the unmanned aerial vehicles save energy and the like, and can be used for tracking ground low-speed moving targets in complex environments and the like.
The present invention is not limited to the above-described embodiments. The foregoing description of the specific embodiments is intended to describe and illustrate the technical solutions of the present invention, and the above specific embodiments are merely illustrative and not restrictive. Those skilled in the art can make various changes in form and details without departing from the spirit and scope of the invention as defined by the appended claims.
Claims (4)
1. The method for planning the cooperative flight path of the multiple unmanned aerial vehicles for hovering and tracking the ground target in the dual mode comprises the following steps:
constructing an unmanned aerial vehicle kinematic model, a ground target motion model and a three-dimensional city environment model by taking ground target tracking of multiple unmanned aerial vehicles for tracking low-speed movement in a city as a background;
providing a switching condition of a hovering mode and an obstacle avoidance mode based on the obstacle avoidance requirements of the unmanned aerial vehicle and the high-rise building;
constructing a multi-objective optimization model under a dual mode based on a multi-objective optimization algorithm of synchronous distributed model predictive control;
establishing a priority model based on a relaxation satisfaction degree sequence method to obtain a generalized fuzzy satisfaction degree target planning model;
constructing a multi-unmanned aerial vehicle collaborative track planning model under a dual mode based on a synchronous distributed model predictive control and fuzzy target planning method; wherein: the multi-unmanned aerial vehicle collaborative track planning model in the dual mode respectively comprises a multi-unmanned aerial vehicle collaborative track planning model in a hovering mode and a multi-unmanned aerial vehicle collaborative track planning model in an obstacle avoidance mode;
the multi-unmanned aerial vehicle collaborative track planning model in the hovering mode is as follows:
n 1 ≤r 0 -0,p 1 ≤R v -r 0 ,p 2 ≤1-cosθ 0
n 1 ·p 1 =0,n 3 ·p 3 =0,n 4 ·p 4 =0;n 1 ,p 1 ,p 2 ,n 3 ,p 3 ,n 4 ,p 4 ≥0;-1≤η≤1
x i (k|k)=x i (k),y i (k|k)=y i (k),ψ i (k|k)=ψ i (k),υ i (k|k)=υ i (k),ω i (k|k)=ω i (k)
P=0,1,..H-1;i,j=1,2,..N,i≠j;l=1,2,..N h
wherein:is the three-dimensional position coordinate of drone i, z i Indicating the flight altitude; psi i Is the course angle; upsilon is i And ω i Speed and steering rate, respectively; u. of υi And u ωi Is a control input; gamma is an unknown variable, -1 is more than or equal to gamma and less than or equal to 0, the priority relation is satisfied, otherwise, the priority relation is not satisfied; λ is an adjustable parameter, with increasing values representing more emphasis on priority differences; Δ T is the sampling time interval;
obtaining the predicted distance between the unmanned aerial vehicles i and j for the unmanned aerial vehicle i according to the received position information of the unmanned aerial vehicle j at the moment k-1;
predicting drone position for k-1 timeWith k actual unmanned aerial vehicle position constantlyUncertainty error between;
is the boundary of the uncertainty error; wherein:
r a is the confrontation distance between the unmanned planes when the unmanned planes are in a spiral state,is the desired convergence rate;
the performance index in hover mode is as follows:
1) Spiral distance maintenance
Wherein R is v Is the radius of the sensor field of view;the plane distance between the unmanned aerial vehicle i and the target at the k + P +1 moment predicted at the k moment is represented, P =1,2 0 Indicating the hovering distance of the drone relative to the target;
2) Phase angle difference maintenance
Wherein, theta ij (k + P + 1|k) represents the phase angle difference between drone i and drone j, θ ij =|θ i (k+P+1|k)-θ j (k+P+1|k)|;θ 0 Representing a desired phase angle difference;
3) Speed input cost
Wherein the content of the first and second substances,representing the cruising speed of the unmanned aerial vehicle in the hovering mode;
4) Steering rate input cost
Wherein the content of the first and second substances,representing the cruise steering rate in the hovering mode of the unmanned aerial vehicle;
based on the relaxation satisfaction order, the priority model is:
the constraints in hover mode are as follows:
1) State constraints and control constraints
The constraints on speed, steering rate and control input are:
2) Restraint of avoiding collision
3) Compatibility constraints
Setting compatibility constraint to ensure that the uncertain error is within a certain range and gradually reduced in the rolling optimization;
the multi-unmanned aerial vehicle collaborative track planning model in the obstacle avoidance mode comprises the following steps:
n 6 ·p 6 =0,n 7 ·p 7 =0;p 5 ,n 6 ,p 6 ,n 7 ,p 7 ≥0;-1≤η≤1
x i (k|k)=x i (k),y i (k|k)=y i (k),ψ i (k|k)=ψ i (k),υ i (k|k)=υ i (k),ω i (k|k)=ω i (k)
P=0,1,..H-1;i,j=1,2,..N,i≠j;l=1,2,..N h
wherein r is b = L is the confrontation distance between unmanned aerial vehicles during tracking; l/2 is the safe radius of the unmanned plane; r is B Is the minimum circumscribed circle radius of the building floor;
the performance indexes in the obstacle avoidance mode are as follows:
1) Tracking error cost
2) Speed input cost
Wherein the content of the first and second substances,representing the cruising speed of the unmanned aerial vehicle in an obstacle avoidance mode;
3) Steering rate input cost
Wherein the content of the first and second substances,the cruise steering rate of the unmanned aerial vehicle in the obstacle avoidance mode is represented;
based on the relaxation satisfaction order, the priority model is:
the constraints are as follows:
1) State constraints and control constraints
The constraints on speed, steering rate and control input are:
2) Restraint of avoiding collision
3) Compatibility constraints
4) Obstacle avoidance restraint
2. The dual-mode multi-drone collaborative flight path planning method for hovering tracking of a ground target according to claim 1, characterized in that: providing a switching condition of a hovering mode and an obstacle avoidance mode based on the obstacle avoidance requirements of the unmanned aerial vehicle and the high-rise building; wherein:
1) Hover mode conditions: when the high-rise building is out of the visual range of all unmanned aerial vehicle sensors, i.e.When the unmanned aerial vehicle is in the hovering mode, all the unmanned aerial vehicles are in the hovering mode;
2) Obstacle avoidance mode conditions: when the high-rise building is within a certain unmanned sensor visible range, that is to sayIn order to meet the obstacle avoidance requirement, all unmanned aerial vehicles are in an obstacle avoidance mode;
3. The dual-mode multi-drone collaborative flight path planning method for hovering tracking of a ground target according to claim 1, characterized in that: constructing a multi-objective optimization model under a dual mode based on a multi-objective optimization algorithm of synchronous distributed model predictive control; wherein:
a: spiral pattern
Setting two performance indexes of spiral distance keeping and phase angle difference keeping, and arranging the two performance indexes in parallel at a first priority; in addition, considering the maintenance characteristics of the speed and the steering rate of the unmanned aerial vehicle model, setting speed input cost and steering rate input cost, and arranging two performance indexes in the aspect of energy saving at a second priority;
according to unmanned aerial vehicle's state and control restriction, the demand of keeping away to bump and keeping away the barrier sets up state restraint and control restraint, keeps away to bump restraint, compatibility restraint and keeps away the barrier restraint, wherein: the method is characterized in that collision avoidance constraints which are usually adopted are distinguished, on the basis of the algorithm characteristics of synchronous distributed prediction control, each unmanned aerial vehicle can only acquire state information of other unmanned aerial vehicles at the previous sampling moment at the current sampling moment, and can only take collision avoidance actions according to the prediction result at the previous moment, so that uncertain errors caused by information delay are restrained, and the uncertain errors are reduced through the collision avoidance constraints and compatibility constraint conditions;
b: obstacle avoidance mode
In order to ensure high-precision tracking, a tracking error cost performance index is set and arranged at a first priority; in addition, considering the energy-saving requirement, two performance indexes of speed input cost and steering rate input cost are set and arranged at the second priority.
4. The dual-mode multi-drone collaborative flight path planning method for hovering tracking of a ground target according to claim 1, characterized in that: the condition for switching between the hover mode and the obstacle avoidance mode is a rolling solving process optimized based on a nonlinear programming method, and the method comprises the following steps of:
step 1: at a sampling moment k, judging the flight mode of the unmanned aerial vehicle cluster according to the distance between the unmanned aerial vehicle and a high-rise building, if the flight mode is a hover mode, jumping to Step2, and if the flight mode is an obstacle avoidance mode, jumping to Step3;
step 2: establishing a multi-unmanned aerial vehicle collaborative track planning model in a hovering mode, solving an optimization result based on a nonlinear programming algorithm, and jumping to Step4;
step 3: establishing a multi-unmanned aerial vehicle collaborative track planning model in an obstacle avoidance mode, and solving an optimization result based on a nonlinear programming algorithm;
step 4: applying the first item of the solved optimal control sequence to the corresponding unmanned aerial vehicle; the optimal control sequence is as follows:
u υi (k+P|k),u ωi (k+P|k)
step5: and (4) sending the predicted track of the current unmanned aerial vehicle at the moment k to other unmanned aerial vehicles, and turning back to Step 1 at the moment k +1 until the tracking task is finished.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110018314.4A CN112923925B (en) | 2021-01-07 | 2021-01-07 | Dual-mode multi-unmanned aerial vehicle collaborative track planning method for hovering and tracking ground target |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110018314.4A CN112923925B (en) | 2021-01-07 | 2021-01-07 | Dual-mode multi-unmanned aerial vehicle collaborative track planning method for hovering and tracking ground target |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112923925A CN112923925A (en) | 2021-06-08 |
CN112923925B true CN112923925B (en) | 2023-02-21 |
Family
ID=76163122
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110018314.4A Active CN112923925B (en) | 2021-01-07 | 2021-01-07 | Dual-mode multi-unmanned aerial vehicle collaborative track planning method for hovering and tracking ground target |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112923925B (en) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113759977B (en) * | 2021-09-18 | 2023-07-28 | 西北工业大学 | Obstacle avoidance track planning method based on optimized coordinated transportation of multiple tethered unmanned aerial vehicles |
CN113900449B (en) * | 2021-10-26 | 2023-12-22 | 鹏城实验室 | Multi-unmanned aerial vehicle track planning method and device, unmanned aerial vehicle and storage medium |
CN113867417B (en) * | 2021-12-06 | 2022-03-29 | 北京航空航天大学 | Unmanned aerial vehicle moving target long-term-flight tracking method |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108536171A (en) * | 2018-03-21 | 2018-09-14 | 电子科技大学 | The paths planning method of multiple no-manned plane collaboration tracking under a kind of multiple constraint |
CN109976386A (en) * | 2019-04-04 | 2019-07-05 | 中国电子科技集团公司信息科学研究院 | A kind of method and system of multiple no-manned plane collaboration tracking target |
CN110262563A (en) * | 2018-05-23 | 2019-09-20 | 中国海洋大学 | Multiple no-manned plane collaboratively searching mesh calibration method waterborne |
CN110412559A (en) * | 2019-07-26 | 2019-11-05 | 西安电子科技大学 | The non-coherent of distributed unmanned plane MIMO radar merges object detection method |
CN110908395A (en) * | 2019-11-26 | 2020-03-24 | 西北工业大学 | Improved unmanned aerial vehicle flight path real-time planning method |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9557738B2 (en) * | 2015-04-21 | 2017-01-31 | Gopro, Inc. | Return path configuration for remote controlled aerial vehicle |
CN108762286A (en) * | 2018-05-31 | 2018-11-06 | 智飞智能装备科技东台有限公司 | A kind of ground control system for the control that can fly to multiple UAVs |
-
2021
- 2021-01-07 CN CN202110018314.4A patent/CN112923925B/en active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108536171A (en) * | 2018-03-21 | 2018-09-14 | 电子科技大学 | The paths planning method of multiple no-manned plane collaboration tracking under a kind of multiple constraint |
CN110262563A (en) * | 2018-05-23 | 2019-09-20 | 中国海洋大学 | Multiple no-manned plane collaboratively searching mesh calibration method waterborne |
CN109976386A (en) * | 2019-04-04 | 2019-07-05 | 中国电子科技集团公司信息科学研究院 | A kind of method and system of multiple no-manned plane collaboration tracking target |
CN110412559A (en) * | 2019-07-26 | 2019-11-05 | 西安电子科技大学 | The non-coherent of distributed unmanned plane MIMO radar merges object detection method |
CN110908395A (en) * | 2019-11-26 | 2020-03-24 | 西北工业大学 | Improved unmanned aerial vehicle flight path real-time planning method |
Non-Patent Citations (2)
Title |
---|
Distributed synchronous cooperative tracking algorithm for ground moving target in urban by UAVs;Chaofang Hu , et al;《International Journal of Systems Science》;20201108;第1-16页 * |
多无人机模糊多目标分布式地面目标协同追踪;胡超芳等;《控 制 理 论 与 应 用》;20180831;第1101-1110页 * |
Also Published As
Publication number | Publication date |
---|---|
CN112923925A (en) | 2021-06-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112923925B (en) | Dual-mode multi-unmanned aerial vehicle collaborative track planning method for hovering and tracking ground target | |
CN102591358B (en) | Multi-UAV (unmanned aerial vehicle) dynamic formation control method | |
CN108897312B (en) | Method for planning continuous monitoring path of multiple unmanned aerial vehicles to large-scale environment | |
Tang et al. | Dynamic reallocation model of multiple unmanned aerial vehicle tasks in emergent adjustment scenarios | |
CN111897316B (en) | Multi-aircraft autonomous decision-making method under scene fast-changing condition | |
CN111831008B (en) | Unmanned aerial vehicle formation cooperative control system and method based on distributed architecture | |
CN104714555B (en) | Three-dimensional independent exploration method based on edge | |
CN105759829A (en) | Laser radar-based mini-sized unmanned plane control method and system | |
CN107015238A (en) | Unmanned vehicle autonomic positioning method based on three-dimensional laser radar | |
CN108694864B (en) | Complex low-altitude flight multi-machine conflict detection and release method and system | |
Malaek et al. | Dynamic based cost functions for TF/TA flights | |
Gunetti et al. | Simulation of a soar-based autonomous mission management system for unmanned aircraft | |
CN112947594A (en) | Unmanned aerial vehicle-oriented flight path planning method | |
CN114138022A (en) | Distributed formation control method for unmanned aerial vehicle cluster based on elite pigeon swarm intelligence | |
Luo et al. | UAV penetration mission path planning based on improved holonic particle swarm optimization | |
Xiang et al. | Autonomous eVTOL: A summary of researches and challenges | |
CN112258896A (en) | Unmanned aerial vehicle fusion airspace operation method based on flight path | |
Lu et al. | Dual Redundant UAV Path Planning and Mission Analysis Based on Dubins Curves | |
Wei et al. | UCAV formation online collaborative trajectory planning using hp adaptive pseudospectral method | |
Godbole | Control and coordination in uninhabited combat air vehicles | |
Duoxiu et al. | Proximal policy optimization for multi-rotor UAV autonomous guidance, tracking and obstacle avoidance | |
Khachumov | Controlling the motion of a group of unmanned flight vehicles in a perturbed environment based on the rules | |
Guan et al. | A new integrated navigation system for the indoor unmanned aerial vehicles (UAVs) based on the neural network predictive compensation | |
Gao | Autonomous soaring and surveillance in wind fields with an unmanned aerial vehicle | |
Dong et al. | Control method of Manned/Unmanned Aerial Vehicle cooperative formation based on mission effectiveness |
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 |