CN110069075A - A kind of cluster super maneuver barrier-avoiding method of imitative dove group emergency avoidance mechanism - Google Patents
A kind of cluster super maneuver barrier-avoiding method of imitative dove group emergency avoidance mechanism Download PDFInfo
- Publication number
- CN110069075A CN110069075A CN201910315523.8A CN201910315523A CN110069075A CN 110069075 A CN110069075 A CN 110069075A CN 201910315523 A CN201910315523 A CN 201910315523A CN 110069075 A CN110069075 A CN 110069075A
- Authority
- CN
- China
- Prior art keywords
- unmanned plane
- cluster
- unmanned
- obstacle
- dove group
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 56
- 230000007246 mechanism Effects 0.000 title claims abstract description 23
- 230000008447 perception Effects 0.000 claims abstract description 7
- 230000004044 response Effects 0.000 claims abstract description 5
- 230000004438 eyesight Effects 0.000 claims description 22
- 230000006870 function Effects 0.000 claims description 16
- 238000011156 evaluation Methods 0.000 claims description 15
- 230000004888 barrier function Effects 0.000 claims description 13
- 241000272201 Columbiformes Species 0.000 claims description 3
- 230000010354 integration Effects 0.000 claims description 3
- 230000016776 visual perception Effects 0.000 claims description 3
- 238000012544 monitoring process Methods 0.000 abstract description 4
- 238000004422 calculation algorithm Methods 0.000 description 10
- 238000013178 mathematical model Methods 0.000 description 6
- 238000005070 sampling Methods 0.000 description 5
- 238000005516 engineering process Methods 0.000 description 4
- 230000015572 biosynthetic process Effects 0.000 description 3
- 238000011161 development Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 230000035484 reaction time Effects 0.000 description 3
- 241000271566 Aves Species 0.000 description 2
- 238000004891 communication Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000007613 environmental effect Effects 0.000 description 2
- 238000005457 optimization Methods 0.000 description 2
- 239000007787 solid Substances 0.000 description 2
- 230000000712 assembly Effects 0.000 description 1
- 238000000429 assembly Methods 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 230000007123 defense Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 231100000518 lethal Toxicity 0.000 description 1
- 230000001665 lethal effect Effects 0.000 description 1
- 239000011664 nicotinic acid Substances 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
The present invention discloses a kind of cluster super maneuver barrier-avoiding method of imitative dove group emergency avoidance mechanism, and steps are as follows: one, parameter initialization;Two, current time unmanned plane cluster leader's strategy is determined;Three, the dove group for calculating unmanned plane cluster, which forms into columns, keeps information;Four, unmanned plane collection realm dove group obstacle perception;Five, the obstacle perceptual strategy to other unmanned planes is analyzed;Six, imitative dove group's emergency Robot dodge strategy of unmanned plane cluster is determined;Seven, imitative dove group's emergency avoidance response of unmanned plane cluster is calculated;Eight, subsequent time unmanned plane cluster course angle is calculated;Nine, unmanned plane cluster subsequent time two-dimensional spatial location is updated;Ten, it stores and exports unmanned plane cluster position information.Invention enhances monitoring range, angle, working efficiency, the anti-interferences of raising needed for single rack UAV system;Single machine computational load is effectively reduced, in addition to this, the present invention improves unmanned plane for the adaptability of the urgent avoidance of short distance under complicated dynamic task environment.
Description
Technical field
The present invention is a kind of cluster super maneuver barrier-avoiding method of imitative dove group emergency avoidance mechanism, belongs to unmanned aerial vehicle (UAV) control technology
Field.
Background technique
With the rapid development of computer communication and network technology, unmanned air vehicle technique etc., unmanned plane is led in military civilian wait
Domain using more and more extensive, unmanned plane cluster is with efficient capability of information sharing, low cost, distributed type assemblies wisdom and height
The advantages such as the reliability of degree become the inexorable trend of Development of UAV.From 2005, U.S. Department of Defense issues " UAV system road
Line chart 2005-2030 ", unmanned plane autonomous control grade is divided into 1~10 grade, including single machine is autonomous, multimachine is autonomous, cluster from
Main (distributed AC servo system, group's strategic objective, Quan Zizhu cluster) 3 levels, and point out that " Quan Zizhu cluster " is that unmanned plane is autonomous
The highest level of control, it is contemplated that unmanned plane will be provided with complete autonomous clustering capability after 2025.Task phase is carried out with single rack unmanned plane
It is the collective motion of a large amount of self actuating systems than, unmanned plane cluster, intelligence is realized by information exchange between the unmanned plane in cluster
Energyization, and have a degree of common recognition independence.Under environment complicated and changeable, unmanned plane cluster can solve in commission after
Communication, intelligence reconnaissance, battlefield monitoring, electronic countermeasure, target strike etc. be in military missions, the monitoring model that single rack unmanned plane is faced
Various problems such as narrow, angle is small, lethal radius is small, working efficiency is low, self-healing ability is weak, anti-interference is poor are enclosed, to entirety
UAV system fighting efficiency is greatly improved.
In existing unmanned air vehicle technique, under specific completion reality scene when complicated appointed task, unmanned plane cluster is removed
Except the formation for controlling itself, the complicated unsafe conditions factor is usually further encountered, therefore flew in unmanned plane cluster
Cheng Zhong, avoidance problem are one of the critical issues of modern unmanned air vehicle technique.The avoidance of unmanned plane cluster be divided into a unmanned plane group of planes it
Between avoidance, cluster to the avoidance of large-scale static-obstacle thing and cluster to the emergency avoidance of the small obstacle of burst.Unmanned plane
The reaction obstacle avoidance ability that cluster carries out emergent barrier on the advertised route planned is exactly unmanned plane collection
The emergency obstacle avoidance ability of group.Cluster super maneuver barrier-avoiding method proposed by the invention is a kind of real-time emergency avoidance side of cluster formation
Method.
In general, the burst barrier including no forethought to perceived in unmanned plane cluster flight path
It after barrier, carries out Robot dodge strategy and is detached from original track, determine that avoiding obstacles restore itself formation again later, continue along original
Airline operation.Traditional emergency barrier-avoiding method can mainly be classified as based on nodal method, be based on sampling method, based on mathematical model method
And evolution algorithm etc..Based in nodal method, includes mainly A* algorithm, Dijsktra algorithm etc., be all based on grating map
Carry out heuristic search, however for the accuracy for the track that navigates, need by grid division should as far as possible small and corresponding neighborhood
As far as possible greatly, will cause the increase of single machine computational load, the problems such as operation reaction time is elongated thereupon;It is being based on sampling method
In, include mainly Quick Extended random tree method, Voronoi diagram method, probabilistic road maps method, Artificial Potential Field Method etc., is required to shift to an earlier date
Know existing, the complete complaint message in mission area, adaptability is low in dynamic task environment complicated and changeable;It is based on
Unmanned plane emergency avoidance problem is converted to the number of a specification by piece-wise linearization and integer programming method by mathematical model method
Model is learned, evolution algorithm is then that unmanned plane emergency avoidance problem is converted to the combination that optimal solution is found under constraint condition
Optimization problem, however the corresponding computation complexity of the two is excessive, unmanned plane meets an urgent need do not answer actually in avoidance in real time on line
With value.The above method is each advantageous on complex environment, operation reaction time and algorithm complexity respectively, however works as and combine
Come, lack a good integrated application value, the present invention imitates the cluster super maneuver avoidance side of dove group's emergency avoidance Mechanism Design
Method environmental suitability, convergence time and in terms of the problem of on be correspondingly improved and improved.
With the development of unmanned plane Clustering, the requirement to cluster short distance avoidance is higher and higher, bionic computer control
Technology processed provides for new thinking herein.In the nature spatial domain for the large scales such as migrating, there can be a large amount of research
The various flight navigation strategies of birds are shown, however, scholars have found many birds to closely in rambling environment
Obstructed paths planning is seldom, therefore the unique emergency avoidance mechanism of dove group has creativeness in terms of cluster super maneuver avoidance
Value.Dove group can still complete this very challenging task of rapid avoiding obstacles in high-speed flight.Dove group
Emergency avoidance mechanism be a kind of passive type reaction mechanism, only when apart from barrier about 0.5m just carry out avoidance reaction, this
It is a kind of avoidance mechanism that angle resolves, and not carries out position resolving as principle to minimize distance.Dove group passes through narrow sky
Between when, perceive barrier in vision attention area first, carry out steering decision after aiming at the notch between barrier, i.e., as far as possible
The most spacious gap across obstacle, if it is possible to simulate dove group emergency avoidance mechanism and be applied and be worked as in unmanned plane cluster
In, the self-healing ability and data bandwidth of unmanned plane cluster can will be largely improved, the unmanned plane under complex environment is appointed
There is great application potential in business.The present invention is using dove group emergency avoidance Mechanism Model and to unmanned plane cluster internal unmanned plane
Information exchange is planned, unmanned plane cluster is jointly controlled in such a way that priority is chosen and realizes form into columns holding and emergency avoidance.
Summary of the invention
The invention proposes a kind of cluster super maneuver barrier-avoiding methods of imitative dove group emergency avoidance mechanism, and the purpose is to multi rack
Unmanned plane information exchange carry out planning and designing and simulation dove group emergency avoidance mechanism, while realize unmanned plane cluster form into columns keep with
Super maneuver emergency avoidance, improves anti-interference, the real-time of UAV system entirety, is unmanned plane cluster in ring complicated and changeable
The urgent avoidance of short distance under border provides a solution.
The present invention is developed for the urgent avoidance technology of unmanned plane cluster short distance based on dove group's emergency avoidance Mechanism Model
A kind of cluster super maneuver barrier-avoiding method of imitative dove group emergency avoidance mechanism, specific step is as follows for this method:
Step 1: parameter initialization
Determine unmanned plane cluster main frame number N, target position (Xg,Yg), ignore height coordinate, in certain two-dimensional space with
Machine generates the two-dimensional spatial location (X of every frame unmanned plane i (i=1,2,3...N) initial timei,Yi)(Xi<<Xg,Yi<<Yg), fly
Scanning frequency degree Vi, course angleThe maximum perceived distance R of unmanned planemax, maximum perception angle [alpha]max, unmanned plane course
Controller parameter τ, ΚP、KI、ΚD、KS, map and compass factor P1, unmanned plane velocity factor P2, evaluation function weight coefficient
w1、w2;Ignore height coordinate, generates n round obstacle, each obstacle j (j=1,2,3...n) at random in certain two-dimensional space
Central coordinate of circle (xj,yj)(xj≤Xg,yj≤Yg), radius r (r < Rmax), computer running time T.
Step 2: current time unmanned plane cluster leader's strategy is determined
In order to choose the evaluation of estimate that barrier is less in close from target position in current time unmanned aerial vehicle group and sensing range
Best unmanned plane is arranged evaluation function h, calculates the evaluation function of current time every frame unmanned plane as head machine (dove group's head dove)
Value, according to sequence using the smallest unmanned plane of evaluation function value as the head machine at current time, remaining unmanned plane (is followed as wing plane
Dove).
Wherein,The distance of target position is arrived for unmanned plane i (i=1,2,3...N),
MiThe barrier quantity detected in sensing range for unmanned plane i (i=1,2,3...N).
Step 3: the dove group for calculating unmanned plane cluster, which forms into columns, keeps information
Every frame unmanned plane keeps mechanism according to dove group, updates corresponding speed, position according to command speed, position function and deposits
Storage, head machine navigate to target position, and wing plane follows a machine to carry out navigation information updating.
Wherein, P1For the mapped directions factor, P2For unmanned plane velocity factor, need to set numerical value, rand all in accordance with specific
() is the random number between 0 to 1,
Step 4: unmanned plane collection realm dove group's obstacle perception
Every frame unmanned plane is the same with single pigeon vision attention region, and vision attention region is in place with unmanned plane i institute
Set (Xi, Yi) it is vertex, RmaxFor radius, 2 αmaxIt navigates with unmanned plane in direction for the sector of central angle, and vertex to camber line midpoint
To angle betaiUnanimously.
Judge whether there is fixed obstacle in the vision attention region of every frame unmanned plane i (i=1,2,3...N), i.e., when solid
The angle determined between the line and unmanned plane course of barrier j to unmanned plane i is less than αmaxAnd between unmanned plane i and fixed obstacle j
Distance be less than or equal to RmaxWhen, unmanned plane perceives fixed obstacle j, and carries out Obstacle Position label;
Judge whether there are other unmanned planes in the vision attention region of every frame unmanned plane i (i=1,2,3...N), that is, works as nothing
Angle between man-machine i and the line and unmanned plane course of other unmanned planes is less than αmaxAnd between unmanned plane i and other unmanned planes
Distance is less than or equal to RmaxWhen, unmanned plane perceives other unmanned planes in vision attention region, and is marked.If unmanned plane i
(i=1,2,3...N) is not detected by fixed obstacle, and is not detected by other unmanned planes, then gos to step two.
Step 5: the obstacle perceptual strategy to other unmanned planes is analyzed
The velocity magnitude and nothing for other unmanned planes that unmanned plane i (i=1,2,3...N) vision attention region internal standard is recorded a demerit
The ratio of the velocity magnitude of man-machine i (i=1,2,3...N) is referred to as velocity rate, setting speed rate threshold t (t > 1), if speed ratio
Rate be greater than velocity rate threshold value, then the vision attention region secondary mark unmanned plane i (i=1,2,3...N) internal standard record a demerit its
His unmanned plane coordinate.
Step 6: imitative dove group's emergency Robot dodge strategy of unmanned plane cluster is determined
Determine the corresponding dove group emergency Robot dodge strategy of unmanned plane i (i=1,2,3...N), i.e., according to the obstacle (one detected
The unmanned plane that secondary labeled fixed obstacle and secondary mark are crossed) gap and solve to primary labeled fixed obstacle
Avoidance angle γij(j=1,2,3...n) and to secondary mark the avoidance angle γ for the unmanned plane crossedik。
Wherein,αjFor obstacle angular coordinate, βkCourse angle for k-th of the unmanned plane crossed by secondary mark
Coordinate, QikFor the distance of k-th of unmanned plane being crossed by secondary mark to unmanned plane i (i=1,2,3...N).
Step 7: imitative dove group's emergency avoidance response of unmanned plane cluster is calculated
The dove group's emergency avoidance for calculating unmanned plane i (i=1,2,3...N) responds αI, exp(i=1,2,3...N), i.e., by nothing
At maximum gap between man-machine i (i=1,2,3...N) alignment obstacle.
αI, exp=∑ (αj+γij+βk+γik) (8)
Step 8: subsequent time unmanned plane cluster course angle is calculated
Use unmanned plane direction controllerIt executes the emergency avoidance of unmanned plane i (i=1,2,3...N), that is, calculates
The course angle β that subsequent time should execute outi(i=1,2,3...N).
Wherein, error alphai,error=βi-αi,exp, τ is visual perception sensor time delay, KpFor the control of unmanned plane course ratio
Gain, KiFor integration control gain, KDGain, K are controlled for differentialSGain is controlled for stable inertia.
Step 9: unmanned plane cluster subsequent time two-dimensional spatial location is updated
The course angle β being calculated by step 8i(i=1,2,3...N) Lai Gengxin unmanned plane i (i=1,2,3...N)
Real-time Two-dimensional spatial position (Xi,Yi)。
Step 10: storing and exports unmanned plane cluster position information
The location information at two-dimensional space storage unmanned plane cluster each moment set by step 1, judges whether simultaneously
It is otherwise gone to for the location information of last moment if the last moment then terminates to calculate and export unmanned plane cluster flight path
Step 2.
The invention proposes a kind of cluster super maneuver barrier-avoiding methods of imitative dove group emergency avoidance mechanism, exist for unmanned plane cluster
The urgent avoidance of short distance under environment complicated and changeable provides a solution.This method setting evaluation function determines unmanned plane
Cluster leader's strategy, form into columns by the way of priority selection keeps jointly controlling with avoidance of meeting an urgent need, and passes through speed ratio
Rate threshold value point determines that unmanned plane cluster avoidance Selection Strategy, encoding model simulate dove group's emergency avoidance mechanism, calculate unmanned plane collection
Imitative dove group's emergency avoidance response of group, unmanned plane cluster avoidance position is updated using PD direction controller.This method is to multi rack
Unmanned plane carries out information exchange planning and designing, enhances the monitoring range improved needed for single rack UAV system, angle, work effect
Rate, anti-interference;By the simplicity and rapidity in simulated implementation dove group's avoidance reaction mechanism, with common based on node
Method, the unmanned plane barrier-avoiding method based on mathematical model method and evolution algorithm are compared, and single machine computational load is effectively reduced, and remove this
Except, compared to the common unmanned plane barrier-avoiding method based on sampling method, this method improves unmanned plane and complicated dynamic is appointed
The adaptability for the urgent avoidance of short distance being engaged under environment.
Detailed description of the invention
A kind of flow chart of the cluster super maneuver barrier-avoiding method of imitative dove group emergency avoidance mechanism of Fig. 1 present invention
Fig. 2 unmanned plane cluster flight path
Figure label and symbol description are as follows:
Y --- meet condition (YES)
N --- it is unsatisfactory for condition (no)
Specific embodiment
Having for method proposed by the invention is verified below by a specific unmanned plane cluster super maneuver avoidance example
Effect property.Experimental calculation machine is configured to i5-5200U processor, and 2.20GHz dominant frequency, 4G memory, software environment is R2014b version
Matlab。
The specific implementation steps are as follows for this example:
Step 1: parameter initialization
Determine unmanned plane cluster main frame number 5, target location coordinate (Xg,Yg)=(50dm, 50dm), ignore height coordinate,
X-direction 0dm~5dm, generated within the scope of the two-dimensional space of Y direction 0dm~5dm at random every frame unmanned plane i (i=1,2,
3...5) two-dimensional spatial location (the X of initial timei,Yi)(Xi<5dm,Yi< 5dm), flying speed Vi=1dm/s, course angleThe maximum perceived distance R of unmanned planemax=0.5m, maximum perception angleUnmanned plane Heading control
Device parameter τ=1, ΚP=0.3, KI=0.01, ΚD=0.15, KS=0.08, map and compass factor P1=2, unmanned plane speed
Spend factor P2=0.25, evaluation function weight coefficient w1=0.6, w2=0.4;Ignore height coordinate, X-direction 0dm~
55dm, generates n=20 round obstacle within the scope of the two-dimensional space of Y direction 0dm~55dm at random, each obstacle j (j=1,
2,3...20) central coordinate of circle (xj,yj)(xj≤Xg,yj≤Yg), radius r=0.1m (r < Rmax), computer running time T=
50。
Step 2: current time unmanned plane cluster leader's strategy is determined
In order to choose the evaluation of estimate that barrier is less in close from target position in current time unmanned aerial vehicle group and sensing range
Best unmanned plane is arranged evaluation function h, calculates the evaluation function of current time every frame unmanned plane as head machine (dove group's head dove)
Value, according to sequence using the smallest unmanned plane of evaluation function value as the head machine at current time, remaining unmanned plane (is followed as wing plane
Dove).
H=0.6Di+0.4Mi (1)
Wherein,The distance of target position is arrived for unmanned plane i (i=1,2,3...5),
MiThe barrier quantity detected in sensing range for unmanned plane i (i=1,2,3...5).
Step 3: the dove group for calculating unmanned plane cluster, which forms into columns, keeps information
Every frame unmanned plane keeps mechanism according to dove group, updates corresponding speed, position according to command speed, position function and deposits
Storage, head machine navigate to target position, and wing plane follows a machine to carry out navigation information updating.
Wherein, P1For the mapped directions factor, P2For unmanned plane velocity factor, need to set numerical value, rand all in accordance with specific
() is the random number between 0 to 1,
Step 4: unmanned plane collection realm dove group's obstacle perception
Every frame unmanned plane is the same with single pigeon vision attention region, and vision attention region is in place with unmanned plane i institute
Set (Xi, Yi) it is vertex, radius 0.5m, central angleSector, and vertex to camber line midpoint direction and unmanned plane course angle βi
Unanimously.
Judge whether there is fixed obstacle in the vision attention region of every frame unmanned plane i (i=1,2,3...N), i.e., when solid
The angle determined between the line and unmanned plane course of barrier j to unmanned plane i is less thanAnd between unmanned plane i and fixed obstacle j
Distance be less than or equal to 0.5m when, unmanned plane perceives fixed obstacle j, and carries out Obstacle Position label;
Judge whether there are other unmanned planes in the vision attention region of every frame unmanned plane i (i=1,2,3...N), that is, works as nothing
Angle between man-machine i and the line and unmanned plane course of other unmanned planes is less thanAnd between unmanned plane i and other unmanned planes
When distance is less than or equal to 0.5m, unmanned plane perceives other unmanned planes in vision attention region, and is marked.If unmanned plane
I (i=1,2,3...N) is not detected by fixed obstacle, and is not detected by other unmanned planes, then gos to step two.
Step 5: the obstacle perceptual strategy to other unmanned planes is analyzed
The velocity magnitude and nothing for other unmanned planes that unmanned plane i (i=1,2,3...5) vision attention region internal standard is recorded a demerit
The ratio of the velocity magnitude of man-machine i (i=1,2,3...5) is referred to as velocity rate, setting speed rate threshold 1.5, if velocity rate
Greater than velocity rate threshold value, then the vision attention region secondary mark unmanned plane i (i=1,2,3...5) internal standard record a demerit other
Unmanned plane coordinate.
Step 6: imitative dove group's emergency Robot dodge strategy of unmanned plane cluster is determined
Determine the corresponding dove group emergency Robot dodge strategy of unmanned plane i (i=1,2,3...5), i.e., according to the obstacle (one detected
The unmanned plane that secondary labeled fixed obstacle and secondary mark are crossed) gap and solve to primary labeled fixed obstacle
Avoidance angle γij(j=1,2,3...20) and to secondary mark the avoidance angle γ for the unmanned plane crossedik。
Wherein,αjFor obstacle angular coordinate, βkCourse angle for k-th of the unmanned plane crossed by secondary mark
Coordinate, QikFor the distance of k-th of unmanned plane being crossed by secondary mark to unmanned plane i (i=1,2,3...N).
Step 7: imitative dove group's emergency avoidance response of unmanned plane cluster is calculated
The dove group's emergency avoidance for calculating unmanned plane i (i=1,2,3...5) responds αI, exp(i=1,2,3...5), i.e., by nothing
At maximum gap between man-machine i (i=1,2,3...5) alignment obstacle.
αI, exp=∑ (αj+γij+βk+γik) (8)
Step 8: subsequent time unmanned plane cluster course angle is calculated
Use unmanned plane direction controllerIt executes the emergency avoidance of unmanned plane i (i=1,2,3...5), that is, calculates
The course angle β that subsequent time should execute outi(i=1,2,3...5).
Wherein, error alphai,error=βi-αi,exp, τ is visual perception sensor time delay, KpFor the control of unmanned plane course ratio
Gain, KiFor integration control gain, KDGain, K are controlled for differentialSGain is controlled for stable inertia.
Step 9: unmanned plane cluster subsequent time two-dimensional spatial location is updated
The course angle β being calculated by step 8i(i=1,2,3...5) Lai Gengxin unmanned plane i (i=1,2,3...5)
Real-time Two-dimensional spatial position (Xi,Yi)。
Step 10: storage unmanned plane cluster position information
In the location information at set two-dimensional space storage unmanned plane cluster each moment, while judging whether it is last
Otherwise the location information at moment goes to step 2 if the last moment then terminates to calculate and draw unmanned plane cluster flight path.
With the Contrast on effect of the prior art: traditional emergency barrier-avoiding method mainly can be classified as based on nodal method, be based on
Sampling method, based on mathematical model method and evolution algorithm etc..Based in nodal method, mainly calculated including A* algorithm, Dijsktra
Method etc.;Based in sampling method, main includes Quick Extended random tree method, Voronoi diagram method, probabilistic road maps method, artificial gesture
Field method etc.;Unmanned plane emergency avoidance problem is converted to one by piece-wise linearization and integer programming method based on mathematical model method
The mathematical model of a specification, evolution algorithm are then that unmanned plane emergency avoidance problem is converted to one to find most under constraint condition
The combinatorial optimization problem of excellent solution, the above method is each advantageous on complex environment, operation reaction time and algorithm complexity respectively,
However when combining, lack a good integrated application value.Compared to the above method, the present invention imitates dove group's emergency avoidance machine
Set up the cluster super maneuver barrier-avoiding method of meter respectively environmental suitability, convergence time and in terms of the problem of
On be correspondingly improved and improved, be detailed in the following table 1.
Table 1.
Claims (1)
1. a kind of cluster super maneuver barrier-avoiding method of imitative dove group emergency avoidance mechanism, it is characterised in that: the specific steps of this method
It is as follows:
Step 1: parameter initialization
Determine unmanned plane cluster main frame number N, target position (Xg,Yg), ignore height coordinate, is given birth at random in certain two-dimensional space
At the two-dimensional spatial location (X of every frame unmanned plane i (i=1,2,3...N) initial timei,Yi)(Xi<<Xg,Yi<<Yg), flight speed
Spend Vi, course angleThe maximum perceived distance R of unmanned planemax, maximum perception angle [alpha]max, unmanned plane Heading control
Device parameter τ, KP、KI、KD、KS, map and compass factor P1, unmanned plane velocity factor P2, evaluation function weight coefficient w1、w2;Suddenly
Slightly height coordinate generates n round obstacle, the center of circle of each obstacle j (j=1,2,3...n) at random in certain two-dimensional space
Coordinate (xj,yj)(xj≤Xg,yj≤Yg), radius r (r < Rmax), computer running time T;
Step 2: current time unmanned plane cluster leader's strategy is determined
Evaluation function h is set, the evaluation function value of current time every frame unmanned plane is calculated, it is according to sequence that evaluation function value is minimum
Head machine of the unmanned plane as current time, remaining unmanned plane follows dove as wing plane;
Wherein,The distance of target position, M are arrived for unmanned plane i (i=1,2,3...N)iFor
The barrier quantity that unmanned plane i (i=1,2,3...N) is detected in sensing range;
Step 3: the dove group for calculating unmanned plane cluster, which forms into columns, keeps information
Every frame unmanned plane keeps mechanism according to dove group, updates corresponding speed, position according to command speed, position function and stores,
Head machine navigates to target position, and wing plane follows a machine to carry out navigation information updating;
Wherein, P1For the mapped directions factor, P2For unmanned plane velocity factor, all in accordance with specifically needing to set numerical value, rand () is 0
Random number between to 1,
Step 4: unmanned plane collection realm dove group's obstacle perception
Every frame unmanned plane is the same with single pigeon vision attention region, and vision attention region is with unmanned plane i position (Xi,
Yi) it is vertex, RmaxFor radius, 2 αmaxFor the sector of central angle, and direction and unmanned plane course angle β of the vertex to camber line midpointi
Unanimously;
Judge whether there is fixed obstacle in the vision attention region of every frame unmanned plane i (i=1,2,3...N), i.e., hinders when fixed
The angle between the line and unmanned plane course of object j to unmanned plane i is hindered to be less than αmaxAnd between unmanned plane i and fixed obstacle j away from
From less than or equal to RmaxWhen, unmanned plane perceives fixed obstacle j, and carries out Obstacle Position label;
Judge whether there are other unmanned planes in the vision attention region of every frame unmanned plane i (i=1,2,3...N), i.e., as unmanned plane i
Angle between the line and unmanned plane course of other unmanned planes is less than αmaxAnd the distance between unmanned plane i and other unmanned planes
Less than or equal to RmaxWhen, unmanned plane perceives other unmanned planes in vision attention region, and is marked;If unmanned plane i (i=
1,2,3...N) it is not detected by fixed obstacle, and is not detected by other unmanned planes, then gos to step two;
Step 5: the obstacle perceptual strategy to other unmanned planes is analyzed
The velocity magnitude and unmanned plane for other unmanned planes that unmanned plane i (i=1,2,3...N) vision attention region internal standard is recorded a demerit
The ratio of the velocity magnitude of i (i=1,2,3...N) is referred to as velocity rate, setting speed rate threshold t (t > 1), if velocity rate is big
In velocity rate threshold value, then other nothings that the vision attention region secondary mark unmanned plane i (i=1,2,3...N) internal standard is recorded a demerit
Man-machine coordinate;
Step 6: imitative dove group's emergency Robot dodge strategy of unmanned plane cluster is determined
Determine the corresponding dove group emergency Robot dodge strategy of unmanned plane i (i=1,2,3...N), i.e., according to the obstruction clearance detected and
Solve the avoidance angle γ to primary labeled fixed obstacleij(j=1,2,3...n) and to secondary mark the unmanned plane crossed
Avoidance angle γik;
Wherein,αjFor obstacle angular coordinate, βkIt is sat for the course angle for k-th of the unmanned plane crossed by secondary mark
Mark, QikFor the distance of k-th of unmanned plane being crossed by secondary mark to unmanned plane i (i=1,2,3...N);
Step 7: imitative dove group's emergency avoidance response of unmanned plane cluster is calculated
The dove group's emergency avoidance for calculating unmanned plane i (i=1,2,3...N) responds αI, exp(i=1,2,3...N), i.e., by unmanned plane i
(i=1,2,3...N) it is aligned at the maximum gap between obstacle;
αI, exp=∑ (αj+γij+βk+γik) (8)
Step 8: subsequent time unmanned plane cluster course angle is calculated
Use unmanned plane direction controllerIt executes the emergency avoidance of unmanned plane i (i=1,2,3...N), that is, calculates down
The course angle β that one moment should executei(i=1,2,3...N);
Wherein, error alphai,error=βi-αi,exp, τ is visual perception sensor time delay, KpGain is controlled for unmanned plane course ratio,
KiFor integration control gain, KDGain, K are controlled for differentialSGain is controlled for stable inertia;
Step 9: unmanned plane cluster subsequent time two-dimensional spatial location is updated
The course angle β being calculated by step 8i(i=1,2,3...N) reality of Lai Gengxin unmanned plane i (i=1,2,3...N)
When two-dimensional spatial location (Xi,Yi);
Step 10: storing and exports unmanned plane cluster position information
The location information at two-dimensional space storage unmanned plane cluster each moment set by step 1, while judging whether it is most
Otherwise the location information at moment afterwards goes to step if the last moment then terminates to calculate and export unmanned plane cluster flight path
Two.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910315523.8A CN110069075B (en) | 2019-04-19 | 2019-04-19 | Cluster super-mobile obstacle avoidance method imitating pigeon group emergency obstacle avoidance mechanism |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910315523.8A CN110069075B (en) | 2019-04-19 | 2019-04-19 | Cluster super-mobile obstacle avoidance method imitating pigeon group emergency obstacle avoidance mechanism |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110069075A true CN110069075A (en) | 2019-07-30 |
CN110069075B CN110069075B (en) | 2020-06-09 |
Family
ID=67368262
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910315523.8A Active CN110069075B (en) | 2019-04-19 | 2019-04-19 | Cluster super-mobile obstacle avoidance method imitating pigeon group emergency obstacle avoidance mechanism |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110069075B (en) |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111324130A (en) * | 2020-03-30 | 2020-06-23 | 江苏大学 | Pigeon-group-imitated intelligent vehicle formation cooperative self-adaptive cruise control switching method |
CN112698664A (en) * | 2020-12-11 | 2021-04-23 | 南京航空航天大学 | Sight line sector dynamic estimation method for unmanned cluster collaborative navigation optimization |
CN113148227A (en) * | 2020-12-11 | 2021-07-23 | 中国空间技术研究院 | Satellite cluster distributed control method and device |
CN113311700A (en) * | 2020-02-27 | 2021-08-27 | 陕西师范大学 | UUV cluster cooperative control method guided by non-average mechanism |
CN113359862A (en) * | 2021-07-28 | 2021-09-07 | 北京理工大学 | Control method and device for unmanned aerial vehicle to enter closed environment |
CN113784042A (en) * | 2021-08-24 | 2021-12-10 | 中国电子科技集团公司电子科学研究院 | Self-organizing reconnaissance monitoring method of unmanned aerial vehicle cluster in obstacle environment |
CN114428516A (en) * | 2022-01-25 | 2022-05-03 | 长春长光博翔无人机有限公司 | Unmanned aerial vehicle cluster obstacle avoidance method |
CN116243729A (en) * | 2023-05-11 | 2023-06-09 | 四川腾盾科技有限公司 | Phase collaborative planning method based on fixed wing cluster unmanned aerial vehicle online grouping |
CN118131778A (en) * | 2024-05-07 | 2024-06-04 | 山东云晟智能科技有限公司 | Intelligent emergency disposal robot and obstacle avoidance method thereof |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20080210175A1 (en) * | 2006-09-28 | 2008-09-04 | United States, As Represented By The Secretary Of The Air Force | Employing millimeter-wave electromagnetic energy in collision avoidance |
CN105549617A (en) * | 2016-01-13 | 2016-05-04 | 北京航空航天大学 | Method for controlling unmanned aerial vehicle formation by imitating bird flock behaviors and using virtual structures |
CN105652664A (en) * | 2016-02-29 | 2016-06-08 | 北京航空航天大学 | Quad-rotor unmanned helicopter explicit prediction control method based on loft optimization |
CN105654500A (en) * | 2016-02-01 | 2016-06-08 | 北京航空航天大学 | Unmanned aerial vehicle target detection method for optimizing visual attention mechanism based on bionic pigeons |
CN107504972A (en) * | 2017-07-27 | 2017-12-22 | 北京航空航天大学 | A kind of aircraft's flight track method and device for planning based on dove group's algorithm |
CN107992065A (en) * | 2017-09-14 | 2018-05-04 | 北京航空航天大学 | A kind of fixed-wing unmanned aerial vehicle group movable object tracking and avoidance collision-proof method |
CN108985549A (en) * | 2018-05-25 | 2018-12-11 | 哈尔滨工程大学 | Unmanned plane method for allocating tasks based on quantum dove group's mechanism |
CN109254588A (en) * | 2018-10-17 | 2019-01-22 | 北京航空航天大学 | A kind of unmanned plane cluster coordinated investigation method based on cross and variation dove group's optimization |
CN109542115A (en) * | 2018-10-29 | 2019-03-29 | 中国航空无线电电子研究所 | A kind of multiple-uav formation flight avoidance obstacle policy development method |
-
2019
- 2019-04-19 CN CN201910315523.8A patent/CN110069075B/en active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20080210175A1 (en) * | 2006-09-28 | 2008-09-04 | United States, As Represented By The Secretary Of The Air Force | Employing millimeter-wave electromagnetic energy in collision avoidance |
CN105549617A (en) * | 2016-01-13 | 2016-05-04 | 北京航空航天大学 | Method for controlling unmanned aerial vehicle formation by imitating bird flock behaviors and using virtual structures |
CN105654500A (en) * | 2016-02-01 | 2016-06-08 | 北京航空航天大学 | Unmanned aerial vehicle target detection method for optimizing visual attention mechanism based on bionic pigeons |
CN105652664A (en) * | 2016-02-29 | 2016-06-08 | 北京航空航天大学 | Quad-rotor unmanned helicopter explicit prediction control method based on loft optimization |
CN107504972A (en) * | 2017-07-27 | 2017-12-22 | 北京航空航天大学 | A kind of aircraft's flight track method and device for planning based on dove group's algorithm |
CN107992065A (en) * | 2017-09-14 | 2018-05-04 | 北京航空航天大学 | A kind of fixed-wing unmanned aerial vehicle group movable object tracking and avoidance collision-proof method |
CN108985549A (en) * | 2018-05-25 | 2018-12-11 | 哈尔滨工程大学 | Unmanned plane method for allocating tasks based on quantum dove group's mechanism |
CN109254588A (en) * | 2018-10-17 | 2019-01-22 | 北京航空航天大学 | A kind of unmanned plane cluster coordinated investigation method based on cross and variation dove group's optimization |
CN109542115A (en) * | 2018-10-29 | 2019-03-29 | 中国航空无线电电子研究所 | A kind of multiple-uav formation flight avoidance obstacle policy development method |
Non-Patent Citations (6)
Title |
---|
FEDERICO S. CATTIVELLI: "Modeling Bird Flight Formations Using Diffusion Adaptation", 《IEEE TRANSACTIONS ON SIGNAL PROCESSING》 * |
GUILFORD T: "Positional entropy during pigeon homing Ⅱ:navigational interpretation of Bayesian latent state models", 《JOURNAL OF THEORETICAL BIOLOGY》 * |
SCHIFFNER I: "Temporal fluctuations of the geomanetic field affect pigeons" entire homing flight", 《JOURNAL OF COMPARATIVE PHYSIOLOGY A》 * |
段海滨等: "鸽群优化算法研究进展", 《北京工业大学学报》 * |
邱华鑫等: "从鸟群群集飞行到无人机自主集群编队", 《工程科学学报》 * |
邱华鑫等: "基于鸽群行为机制的多无人机自主编队", 《控制理论与工程》 * |
Cited By (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113311700A (en) * | 2020-02-27 | 2021-08-27 | 陕西师范大学 | UUV cluster cooperative control method guided by non-average mechanism |
CN111324130A (en) * | 2020-03-30 | 2020-06-23 | 江苏大学 | Pigeon-group-imitated intelligent vehicle formation cooperative self-adaptive cruise control switching method |
CN112698664B (en) * | 2020-12-11 | 2022-03-25 | 南京航空航天大学 | Sight line sector dynamic estimation method for unmanned aerial vehicle cluster collaborative navigation optimization |
CN113148227A (en) * | 2020-12-11 | 2021-07-23 | 中国空间技术研究院 | Satellite cluster distributed control method and device |
CN112698664A (en) * | 2020-12-11 | 2021-04-23 | 南京航空航天大学 | Sight line sector dynamic estimation method for unmanned cluster collaborative navigation optimization |
CN113148227B (en) * | 2020-12-11 | 2024-05-31 | 中国空间技术研究院 | Satellite cluster distributed control method and device |
CN113359862A (en) * | 2021-07-28 | 2021-09-07 | 北京理工大学 | Control method and device for unmanned aerial vehicle to enter closed environment |
CN113784042A (en) * | 2021-08-24 | 2021-12-10 | 中国电子科技集团公司电子科学研究院 | Self-organizing reconnaissance monitoring method of unmanned aerial vehicle cluster in obstacle environment |
CN114428516A (en) * | 2022-01-25 | 2022-05-03 | 长春长光博翔无人机有限公司 | Unmanned aerial vehicle cluster obstacle avoidance method |
CN114428516B (en) * | 2022-01-25 | 2024-05-07 | 长春长光博翔无人机有限公司 | Unmanned aerial vehicle cluster obstacle avoidance method |
CN116243729A (en) * | 2023-05-11 | 2023-06-09 | 四川腾盾科技有限公司 | Phase collaborative planning method based on fixed wing cluster unmanned aerial vehicle online grouping |
CN116243729B (en) * | 2023-05-11 | 2023-08-18 | 四川腾盾科技有限公司 | Phase collaborative planning method based on fixed wing cluster unmanned aerial vehicle online grouping |
CN118131778A (en) * | 2024-05-07 | 2024-06-04 | 山东云晟智能科技有限公司 | Intelligent emergency disposal robot and obstacle avoidance method thereof |
CN118131778B (en) * | 2024-05-07 | 2024-07-12 | 山东云晟智能科技有限公司 | Intelligent emergency disposal robot and obstacle avoidance method thereof |
Also Published As
Publication number | Publication date |
---|---|
CN110069075B (en) | 2020-06-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110069075A (en) | A kind of cluster super maneuver barrier-avoiding method of imitative dove group emergency avoidance mechanism | |
Chen et al. | UAV path planning using artificial potential field method updated by optimal control theory | |
CN106970648B (en) | Unmanned plane multi-goal path plans combined method for searching under the environment of city low latitude | |
Liu et al. | Path planning algorithm for unmanned surface vehicle formations in a practical maritime environment | |
Chen et al. | Path planning for multi-UAV formation | |
Vidal et al. | Probabilistic pursuit-evasion games: theory, implementation, and experimental evaluation | |
CN109871032A (en) | A kind of multiple no-manned plane formation cooperative control method based on Model Predictive Control | |
CN109491376A (en) | The decision and planning declined based on Dynamic Programming and gradient for automatic driving vehicle | |
CN110162035B (en) | Cooperative motion method of cluster robot in scene with obstacle | |
CN112684807A (en) | Unmanned aerial vehicle cluster three-dimensional formation method | |
Yu et al. | Collision-free trajectory generation and tracking for UAVs using Markov decision process in a cluttered environment | |
WO2007126458A2 (en) | Method and system for autonomous tracking of a mobile target by an unmanned aerial vehicle | |
Zhao et al. | A path planning method based on multi-objective cauchy mutation cat swarm optimization algorithm for navigation system of intelligent patrol car | |
Butzke et al. | The University of Pennsylvania MAGIC 2010 multi‐robot unmanned vehicle system | |
Aibin et al. | Survey of RPAS autonomous control systems using artificial intelligence | |
Ramasamy et al. | A heuristic learning algorithm for preferential area surveillance by unmanned aerial vehicles | |
Ahmad et al. | PACNav: a collective navigation approach for UAV swarms deprived of communication and external localization | |
Zhu et al. | An adaptive priority allocation for formation UAVs in complex context | |
Zhao et al. | Autonomous exploration method for fast unknown environment mapping by using UAV equipped with limited FOV sensor | |
Ma et al. | Volcanic Ash Region Path Planning Based on Improved A‐Star Algorithm | |
CN117170410B (en) | Control method for unmanned aerial vehicle formation flight and related products | |
CN116719247B (en) | Digital space simulation system and method | |
CN117150757A (en) | Simulation deduction system based on digital twin | |
CN116859928A (en) | Cluster target tracking method based on navigator self-adaption | |
Wu et al. | Multi-objective reinforcement learning for autonomous drone navigation in urban areas with wind zones |
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 |