CN105867383A - Automatic collision preventing control method of USV - Google Patents
Automatic collision preventing control method of USV Download PDFInfo
- Publication number
- CN105867383A CN105867383A CN201610322414.5A CN201610322414A CN105867383A CN 105867383 A CN105867383 A CN 105867383A CN 201610322414 A CN201610322414 A CN 201610322414A CN 105867383 A CN105867383 A CN 105867383A
- Authority
- CN
- China
- Prior art keywords
- usv
- obstacle
- unmanned
- unmanned ship
- collision 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 46
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 20
- 230000002068 genetic effect Effects 0.000 claims abstract description 20
- 230000026676 system process Effects 0.000 claims abstract description 7
- 230000004888 barrier function Effects 0.000 claims description 18
- 210000000349 chromosome Anatomy 0.000 claims description 14
- 230000008569 process Effects 0.000 claims description 14
- 238000004891 communication Methods 0.000 claims description 13
- 230000035772 mutation Effects 0.000 claims description 12
- QZXCCPZJCKEPSA-UHFFFAOYSA-N chlorfenac Chemical compound OC(=O)CC1=C(Cl)C=CC(Cl)=C1Cl QZXCCPZJCKEPSA-UHFFFAOYSA-N 0.000 claims description 7
- 238000001514 detection method Methods 0.000 claims description 7
- 238000012544 monitoring process Methods 0.000 claims description 6
- 230000002265 prevention Effects 0.000 claims description 6
- 108090000623 proteins and genes Proteins 0.000 claims description 6
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims description 6
- 238000004364 calculation method Methods 0.000 claims description 5
- 230000007246 mechanism Effects 0.000 claims description 5
- 230000008859 change Effects 0.000 claims description 4
- 238000005457 optimization Methods 0.000 claims description 4
- 238000010353 genetic engineering Methods 0.000 claims description 3
- LFULEKSKNZEWOE-UHFFFAOYSA-N propanil Chemical compound CCC(=O)NC1=CC=C(Cl)C(Cl)=C1 LFULEKSKNZEWOE-UHFFFAOYSA-N 0.000 claims description 3
- 206010064571 Gene mutation Diseases 0.000 claims description 2
- 230000010365 information processing Effects 0.000 claims description 2
- 238000013507 mapping Methods 0.000 claims description 2
- 230000007613 environmental effect Effects 0.000 abstract description 2
- 238000002121 ultrasonic speckle velocimetry Methods 0.000 abstract 2
- 206010063385 Intellectualisation Diseases 0.000 description 3
- 230000009286 beneficial effect Effects 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 2
- 238000002474 experimental method Methods 0.000 description 2
- 230000003993 interaction Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000003068 static effect Effects 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 238000005259 measurement 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/02—Control of position or course in two dimensions
- G05D1/0206—Control of position or course in two dimensions specially adapted to water vehicles
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01D—MEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
- G01D21/00—Measuring or testing not otherwise provided for
- G01D21/02—Measuring two or more variables by means not covered by a single other subclass
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06N—COMPUTING ARRANGEMENTS BASED ON SPECIFIC COMPUTATIONAL MODELS
- G06N3/00—Computing arrangements based on biological models
- G06N3/12—Computing arrangements based on biological models using genetic models
- G06N3/126—Evolutionary algorithms, e.g. genetic algorithms or genetic programming
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Biophysics (AREA)
- Health & Medical Sciences (AREA)
- Life Sciences & Earth Sciences (AREA)
- Bioinformatics & Computational Biology (AREA)
- Theoretical Computer Science (AREA)
- Evolutionary Biology (AREA)
- Bioinformatics & Cheminformatics (AREA)
- Genetics & Genomics (AREA)
- Evolutionary Computation (AREA)
- Remote Sensing (AREA)
- Physiology (AREA)
- Radar, Positioning & Navigation (AREA)
- Artificial Intelligence (AREA)
- Biomedical Technology (AREA)
- Computational Linguistics (AREA)
- Data Mining & Analysis (AREA)
- Automation & Control Theory (AREA)
- General Health & Medical Sciences (AREA)
- Molecular Biology (AREA)
- Computing Systems (AREA)
- General Engineering & Computer Science (AREA)
- Mathematical Physics (AREA)
- Software Systems (AREA)
- Aviation & Aerospace Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
The invention relates to the technical field of maritime searches and rescue and surveys, in particular to an automatic collision preventing control method of a USV, and aims at providing the automatic collision preventing control method of the USV. By means of mutual cooperation among all subsystems of a whole collision preventing system, the unmanned surface vehicle (USV) can automatically search for obstacles and implement collision preventing strategies according to distribution of the obstacles when the USV executes tasks such as rescue and surveys. The method comprises the following steps that 1, environmental image information is collected; 2, the distance between the obstacles and the USV is measured; 3, a GPS measures relative position information of the USV with other USVs, and a tachometer measures the movement velocity of the USV and other USVs; 4, an obstacle judgment system processes received information; 5, the sea clutter situation is transmitted to a genetic algorithm controller; 6, the genetic algorithm controller generates the collision preventing strategies. The automatic collision preventing control method of the USV is suitable for the technical field of the maritime searches and rescue and surveys.
Description
Technical Field
The invention relates to the technical field of marine search and rescue and survey, in particular to a method for controlling autonomous collision avoidance of a universal serial bus (USV).
Background
An Unmanned Surface Vehicle (USV) is a small water surface platform which integrates autonomous planning, autonomous navigation and autonomous completion of tasks such as environment sensing, target detection and the like. The marine environment is complicated changeable, and if want to keep unmanned ship intelligence navigation need rely on inside information and the perfect integration and interaction of external environment. An important prerequisite for such fusion and interaction is that unmanned boats can perform autonomous collision avoidance and can complete a specified mission in a complex marine environment. As an important sign of unmanned ship intellectualization, the autonomous collision avoidance technology of the unmanned ship not only reflects the intelligent level of the maritime unmanned ship to a certain extent, but also is an important research content in the key technical field of the unmanned ship. At present, most of researches on collision avoidance of unmanned boats are focused on collision avoidance algorithms, and the mutual cooperation and cooperation among subsystems of the whole collision avoidance system are rarely involved.
Disclosure of Invention
The invention aims to provide a method for controlling autonomous collision avoidance of a USV (Universal Serial bus), which can realize that an unmanned ship can autonomously search obstacles when executing tasks such as search and rescue, exploration and the like through mutual cooperation among subsystems of a whole collision avoidance system, implements a collision avoidance strategy according to the distribution condition of the obstacles, and ensures the safety of the unmanned ship during autonomous navigation.
In order to realize the method for controlling the autonomous collision avoidance of the USV, an autonomous collision avoidance control device of the USV is adopted, and the method comprises the following steps: the system comprises an obstacle detection device, a positioning system and a genetic algorithm controller, wherein the obstacle detection device comprises a camera, an image identification system, a distance meter, a velocimeter and an obstacle judgment system; the positioning system comprises a GPS positioning system and a communication system; the genetic algorithm controller comprises a wind, wave and water flow detection system, a controller and an execution mechanism.
The main factors that generally affect the collision avoidance effect of the unmanned boat are: course of unmanned shipSpeed v of flight0(ii) a Course of the obstacleSpeed v of flightT(ii) a Distance D between unmanned ship and barrierT(ii) a The course intersection angle of the unmanned ship and the obstacle isThe true orientation of the obstacle relative to the unmanned surface is θT(ii) a The relative speed of the two ships is vR(ii) a The relative course of the two ships isThe minimum passing distance when the unmanned ship meets the obstacle is DCPA; the time when the unmanned boat and the obstacle reach the nearest meeting point is TCPA.
A method for controlling autonomous collision avoidance of a USV comprises the following steps:
the camera shoots an environment image within a 360-degree range taking an unmanned boat as a center, and transmits image information to an image recognition system;
secondly, the image recognition system processes the image information and then transmits the suspected obstacle information to the obstacle judgment system, and meanwhile, the range finder measures the distance between the unmanned ship and an obstacle within 500 meters of the unmanned ship and transmits the information to the obstacle judgment system;
thirdly, a GPS positioning system positions the current position of the unmanned ship in real time, a communication system establishes contact with other unmanned ships to obtain relative position information of the unmanned ship and other unmanned ships, a velocimeter measures the movement speed of the unmanned ship and other unmanned ships, the unmanned ships are equivalent to obstacles, and the information is transmitted to an obstacle judgment system;
fourthly, the barrier judgment system processes all the received information and then transmits the barrier data to the genetic algorithm controller;
fifthly, monitoring the sea surface interference condition of the sea area where the unmanned ship is located by a wind, wave and water flow monitoring system in real time, and transmitting data to a genetic algorithm controller;
and sixthly, the genetic algorithm controller works out a collision prevention strategy according to the barrier data and carries out safe collision prevention through an execution mechanism.
The invention has the following beneficial effects:
1. according to the collision avoidance system, the subsystems of the whole collision avoidance system are matched and cooperated with each other, so that the unmanned ship can independently search for the obstacles when performing tasks such as search and rescue, exploration and the like, a collision avoidance strategy is implemented according to the distribution condition of the obstacles, and the safety of the unmanned ship during autonomous navigation is ensured;
2. according to the unmanned ship collision avoidance system, all collision avoidance subsystems of the unmanned ship are reasonably combined together, a series of processes from searching for a nearby navigation environment, collecting and analyzing barrier information to making collision avoidance strategies and avoiding barriers of the unmanned ship are completed, the intellectualization of the unmanned ship is effectively improved, and the workload of operators is reduced;
3. when the unmanned ship executes tasks such as search and rescue, survey and the like, static and dynamic obstacles in the advancing process can be safely prevented from colliding according to the method provided by the invention.
Drawings
FIG. 1 is a block diagram of a USV autonomous collision avoidance control apparatus;
FIG. 2 is a diagram of USV versus obstacle parameters;
FIG. 3 is a USV barrier collision risk resolution flow chart;
FIG. 4 is a flow chart of a genetic algorithm;
fig. 5 is a schematic view of an unmanned boat avoiding obstacles.
Detailed Description
In order to make the above objects, features and advantages of the present invention more comprehensible, the present invention is further described in detail with reference to fig. 1 to 4 and a detailed embodiment thereof, wherein fig. 1 is a schematic top view of a mounting configuration of a USV sensor, fig. 2 is a schematic relative parameter diagram of a USV and an obstacle, and fig. 3 is a flow chart of USV obstacle collision risk calculation.
In a first specific embodiment, a method for autonomous collision avoidance control of an USV according to this embodiment includes the following steps:
the camera shoots an environment image within a 360-degree range taking an unmanned boat as a center, and transmits image information to an image recognition system;
secondly, the image recognition system processes the image information and then transmits the suspected obstacle information to the obstacle judgment system, and meanwhile, the range finder measures the distance between the unmanned ship and an obstacle within 500 meters of the unmanned ship and transmits the information to the obstacle judgment system;
thirdly, a GPS positioning system positions the current position of the unmanned ship in real time, a communication system establishes contact with other unmanned ships to obtain relative position information of the unmanned ship and other unmanned ships, a velocimeter measures the movement speed of the unmanned ship and other unmanned ships, the unmanned ships are equivalent to obstacles, and the information is transmitted to an obstacle judgment system;
fourthly, the barrier judgment system processes all the received information and then transmits the barrier data to the genetic algorithm controller;
fifthly, monitoring the sea surface interference condition of the sea area where the unmanned ship is located by a wind, wave and water flow monitoring system in real time, and transmitting data to a genetic algorithm controller;
and sixthly, the genetic algorithm controller works out a collision prevention strategy according to the barrier data and carries out safe collision prevention through an execution mechanism.
The embodiment has the following beneficial effects:
1. in the embodiment, the subsystems of the whole collision avoidance system are matched with each other, so that the unmanned ship can independently search for the obstacles when performing tasks such as search and rescue, exploration and the like, a collision avoidance strategy is implemented according to the distribution condition of the obstacles, and the safety of the unmanned ship during autonomous navigation is ensured;
2. according to the implementation mode, all collision avoidance subsystems of the unmanned ship are reasonably combined together, a series of processes from searching for a nearby navigation environment, collecting and analyzing barrier information to making collision avoidance strategies and avoiding barriers of the unmanned ship are completed, the intellectualization of the unmanned ship is effectively improved, and the workload of operators is reduced;
3. when the unmanned ship executes tasks such as search and rescue, survey and the like, static and dynamic obstacles in the advancing process can be safely prevented from being collided according to the method of the embodiment.
In a second embodiment, which is a further description of the method for autonomous collision avoidance control of an USV according to the first embodiment, in the first step, the capture period of the captured environmental image is 0.05s, and each capture period is 10 periods, which takes 0.5 s.
In a third embodiment, the third embodiment is a further description of the method for autonomous collision avoidance control of an USV according to the first or second embodiment, and a measurement period of the distance meter in the second step is 0.5 s.
In a fourth embodiment, the present embodiment is further directed to the method for autonomous collision avoidance control of an USV according to any one of the first to third embodiments, and a communication cycle of the communication system in the third step is 0.5 s.
In a fifth embodiment, the present embodiment is further described with respect to the method for autonomous collision avoidance control of an USV according to any one of the first to fourth embodiments, where in the third step, the position information obtained by the GPS positioning system and the communication system is: the geographic coordinate of the unmanned ship is O (x) measured by a GPS positioning systemO,yO) The communication system obtains the geographic coordinate of the obstacle as T (x)T,yT) Wherein the x-axis is north-south and the y-axis is east-west.
In a sixth embodiment, the present embodiment is a further description of the method for autonomous collision avoidance control of an USV according to any one of the first to fifth embodiments, where the motion speed measured by the velocimeter in the third step is: the motion velocity vector of the unmanned ship is v (v)Ox,vOy) Velocity vector of movement of obstacleIs v (v)Tx,vTy)。
In a seventh embodiment, the present embodiment is a further description of the method for autonomous collision avoidance control of an USV according to any one of the first to sixth embodiments, and the information processing in the fourth step includes: and (3) solving the course of the unmanned ship and the barrier according to the information obtained in the previous three steps:
course of the unmanned ship:
wherein:
the relative distance between the unmanned boat and the obstacle is calculated according to the geographic coordinates of the unmanned boat and the obstacle as follows:
the true orientation of the obstacle relative to the unmanned surface is θT:
The true orientation of the unmanned vehicle relative to the obstacle is theta0:
Wherein,
the phase orientation of the obstacle is αT:
The relative velocity components of the obstacle relative to the unmanned vehicle in the x, y axes are:
relative heading of the obstacle with respect to the unmanned boat:
wherein:
calculating the nearest meeting distance DCPA between the unmanned ship and the target ship:
calculate the time to reach the meeting closest point TCPA:
wherein v isRThe relative speed of the two ships is large or small;
resolving the space collision risk udtComprises the following steps:
in the formula d1=1.5ρ(θT),d2=2d1;
ρ(θT) Obtained from the following formula
Solving the time collision risk utTComprises the following steps:
when TCPA > 0:
when TCPA is less than or equal to 0
Wherein
Obtaining the comprehensive collision risk degree u of the unmanned ship and the barrier according to the time collision risk degree and the space collision risk degreet:
utThe value is divided into three cases, wherein, if udtWhen equal to 0, ut=0;
If udt≠0,utTWhen equal to 0, ut=0;
If udt≠0,utTWhen not equal to 0, ut=max(udt,utT)。
In an eighth embodiment, the present embodiment is further directed to the method for autonomous collision avoidance control of an USV according to any one of the first to seventh embodiments, and the process of the genetic algorithm controller making the collision avoidance policy according to the obstacle data in the fifth step is as follows: as shown in figure 4 of the drawings,
1. encoding the population:
each chromosome represents an initial path of the unmanned ship, in the population initialization process, a population with the number of individuals of n is automatically generated according to the initial position and the target position of the unmanned ship, all feasible paths from the starting point to the end point of the unmanned ship are coded, and each path is an individual in the population;
2. solving a fitness function:
the calculation of the fitness function considers the length of the path, the smoothness of the path and the safety of the path; the following two principles are generally followed when converting the objective function into the fitness function:
(1) the fitness value is non-negative;
(2) the change direction of the objective function in the optimization process is consistent with the change direction of the fitness function in the population evolution process.
For the problem of selecting the collision avoidance path of the unmanned ship, a fitness function with a mapping relation with a target function can be established through the following formula:
F(x)=C-f(x)
in the formula, F(x)Is a fitness function; c is an adjustable parameter whose value is such that the fitness function F(x)Constantly greater than or equal to 0; f (x) is an objective function of the optimization problem.
To ensure F(x)Not less than 0, and therefore, the fitness function is established as follows:
in the formula CmaxIs an adjustable parameter, CmaxThe maximum theoretically possible value of the objective function f (x) can be taken; the selection of the objective function f (x) takes into account the length of the path, the smoothness of the path, and the security of the path.
3. Basic genetic manipulation
The basic genetic operation comprises selection, crossing and mutation, and comprises the following specific operation steps:
(1) selection operation
To select the operationSelecting individuals with high fitness from the population, and eliminating the individuals with low fitness; probability P of individual i being selectediProportional to its fitness value; adopting a roulette model, comprising the following steps:
1) calculating fitness of each chromosome Fi,1≤i≤n;
2) Integrating fitness values of all chromosomes, and recording intermediate integrated values Si:SiS1=F1,Si=Si-1+Fi;
3) Generating a random number x, 0 ≦ x ≦ Sn;
4) Selecting chromosomes if Si-1<x≤SiIf i is more than or equal to 1 and less than or equal to n, the ith chromosome is selected to enter the next generation population;
5) repeating the steps 3) and 4) until enough chromosomes are obtained.
(2) Crossover operation
Crossover operation
Exchanging partial genes of two paired chromosomes according to a certain mode according to the cross probability so as to form two new individuals, wherein the cross rate is 0.5-0.95.
(3) Mutation operation
Mutation operation
And replacing some gene values in the individual codes with other gene values according to the mutation probability so as to form a new individual, wherein the mutation rate is generally set to be between 0 and 0.5, and the gene mutation is carried out with small probability.
In order to verify the beneficial effects of the invention, the following simulation experiments are carried out:
as shown in fig. 5, a total of 5 obstacles are set in the experiment, the position coordinates are (40,30), (80,80), (90,130), (120 ), (150,160), and the radius of the obstacle is 11,11,6,11, 11. The starting point of the unmanned boat is (10,10), and the coordinates of the end point are (190 ).
Wherein the steps of basic genetic manipulation:
1. initialization: mainly setting evolution parameters, setting a maximum evolution algebra and randomly generating n individuals as an initial population P (0);
2. individual evaluation: calculating the fitness of each individual in the population P (t) by a certain large method, wherein t represents an algebra;
3. selecting: acting a selection operator on the population;
4. and (3) crossing: applying a crossover operator to the population;
5. mutation: acting mutation operators on the groups;
6. algorithm termination conditions are as follows: two types can be set, wherein one type is that if the evolution algebra reaches the maximum value, the individual with the maximum fitness obtained in the evolution process is used as the optimal solution output, and the calculation is stopped; and the other method is to set an error, if the error of a certain individual in the population reaches the requirement, the individual with the optimal fitness is output as the optimal approximate solution, and the calculation is terminated.
The experiment realizes the effect of the invention, and when the unmanned ship runs to the target point, the unmanned ship can safely and automatically avoid collision when encountering obstacles on the way through the mutual cooperation of the modules, and can smoothly reach the preset target point.
Claims (8)
1. A method for controlling autonomous collision avoidance of a USV (Universal Serial bus) is realized by adopting an autonomous collision avoidance control device of the USV, and the autonomous collision avoidance control device of the USV comprises the following steps: the system comprises an obstacle detection device, a positioning system and a genetic algorithm controller, wherein the obstacle detection device comprises a camera, an image identification system, a distance meter, a velocimeter and an obstacle judgment system; the positioning system comprises a GPS positioning system and a communication system; the genetic algorithm controller comprises a wind, wave and water flow detection system, a controller and an execution mechanism;
the method is characterized by comprising the following steps of:
the camera shoots an environment image within a 360-degree range taking an unmanned boat as a center, and transmits image information to an image recognition system;
secondly, the image recognition system processes the image information and then transmits the suspected obstacle information to the obstacle judgment system, and meanwhile, the range finder measures the distance between the unmanned ship and an obstacle within 500 meters of the unmanned ship and transmits the information to the obstacle judgment system;
thirdly, a GPS positioning system positions the current position of the unmanned ship in real time, a communication system establishes contact with other unmanned ships to obtain relative position information of the unmanned ship and other unmanned ships, a velocimeter measures the movement speed of the unmanned ship and other unmanned ships, the unmanned ships are equivalent to obstacles, and the information is transmitted to an obstacle judgment system;
fourthly, the barrier judgment system processes all the received information and then transmits the barrier data to the genetic algorithm controller;
fifthly, monitoring the sea surface interference condition of the sea area where the unmanned ship is located by a wind, wave and water flow monitoring system in real time, and transmitting data to a genetic algorithm controller;
and sixthly, the genetic algorithm controller works out a collision prevention strategy according to the barrier data and carries out safe collision prevention through an execution mechanism.
2. The method for autonomous collision avoidance control of an USV according to claim 1, wherein in the first step, the capturing period of the captured environment image is 0.05s, and each capturing period is 10 periods, which takes 0.5 s.
3. The method for autonomous collision avoidance control of an USV according to claim 1 or 2, wherein in step two, the measuring period of the distance meter is 0.5 s.
4. The method as claimed in claim 3, wherein the communication period of the communication system in step three is 0.5 s.
5. The method for autonomous collision avoidance control of an USV according to claim 4, wherein the position information obtained by the GPS positioning system and the communication system in step three is: the geographic coordinate of the unmanned ship is O (x) measured by a GPS positioning systemO,yO) The communication system obtains the geographic coordinate of the obstacle as T (x)T,yT) Wherein the x-axis is north-south and the y-axis is east-west.
6. The method for autonomous collision avoidance control of a USV according to claim 5, wherein the moving speed measured by the speedometer in step three is: the motion velocity vector of the unmanned ship is v (v)Ox,vOy) The obstacle motion velocity vector is v (v)Tx,vTy)。
7. The method for autonomous collision avoidance control of an USV according to claim 6, wherein the specific process of the information processing in step four is as follows: and (3) solving the course of the unmanned ship and the barrier according to the information obtained in the previous three steps:
course of the unmanned ship:
wherein:
the relative distance between the unmanned boat and the obstacle is calculated according to the geographic coordinates of the unmanned boat and the obstacle as follows:
the true orientation of the obstacle relative to the unmanned surface is θT:
The true orientation of the unmanned vehicle relative to the obstacle is theta0:
Wherein,
the phase orientation of the obstacle is αT:
The relative velocity components of the obstacle relative to the unmanned vehicle in the x, y axes are:
relative heading of the obstacle with respect to the unmanned boat:
wherein:
calculating the nearest meeting distance DCPA between the unmanned ship and the target ship:
calculate the time to reach the meeting closest point TCPA:
wherein v isRThe relative speed of the two ships is large or small;
resolving the space collision risk udtComprises the following steps:
in the formula d1=1.5ρ(θT),d2=2d1;
ρ(θT) Obtained from the following formula
Solving the time collision risk utTComprises the following steps:
when TCPA > 0:
when TCPA is less than or equal to 0
Wherein
Obtaining the comprehensive collision risk degree u of the unmanned ship and the barrier according to the time collision risk degree and the space collision risk degreet:
utThe value is divided into three cases,wherein, if udtWhen equal to 0, ut=0;
If udt≠0,utTWhen equal to 0, ut=0;
If udt≠0,utTWhen not equal to 0, ut=max(udt,utT)。
8. The method for autonomous collision avoidance control of an USV according to claim 7, wherein the process of the genetic algorithm controller to make a collision avoidance strategy according to the obstacle data in the fifth step is:
1. encoding the population:
each chromosome represents an initial path of the unmanned ship, in the population initialization process, a population with the number of individuals of n is automatically generated according to the initial position and the target position of the unmanned ship, all feasible paths from the starting point to the end point of the unmanned ship are coded, and each path is an individual in the population;
2. solving a fitness function:
the calculation of the fitness function considers the length of the path, the smoothness of the path and the safety of the path; the following two principles are followed when converting the objective function into the fitness function:
(1) the fitness value is non-negative;
(2) the change direction of the target function in the optimization process is consistent with the change direction of the fitness function in the population evolution process;
for the problem of selecting the collision avoidance path of the unmanned ship, a fitness function with a mapping relation with a target function is established through the following formula:
F(x)=C-f(x)
in the formula, F(x)Is a fitness function; c is an adjustable parameter whose value is such that the fitness function F(x)Constantly greater than or equal to 0; (x) is an objective function of the optimization problem;
to ensure F(x)Not less than 0, the fitness function is established as follows:
in the formula CmaxIs an adjustable parameter, CmaxTaking the maximum value theoretically possible for the objective function f (x); the length of the path, the smoothness of the path and the safety of the path are considered in the selection of the target function f (x);
3. basic genetic manipulation
The basic genetic operation comprises selection, crossing and mutation, and comprises the following specific operation steps:
(1) selection operation
Selecting individuals with high fitness from the population, and eliminating individuals with low fitness; probability P of individual i being selectediProportional to its fitness value; adopting a roulette model, comprising the following steps:
1) calculating fitness of each chromosome Fi,1≤i≤n;
2) Integrating fitness values of all chromosomes, and recording intermediate integrated values Si:SiS1=F1,Si=Si-1+Fi;
3) Generating a random number x, 0 ≦ x ≦ Sn;
4) Selecting chromosomes if Si-1<x≤SiIf i is more than or equal to 1 and less than or equal to n, the ith chromosome is selected to enter the next generation population;
5) repeating steps 3) and 4) until enough chromosomes are obtained;
(2) crossover operation
Crossover operation
Exchanging partial genes of two paired chromosomes according to a certain mode according to the cross probability so as to form two new individuals, wherein the cross rate is 0.5-0.95;
(3) mutation operation
Mutation operation
And replacing some gene values in the individual codes with other gene values according to the mutation probability so as to form a new individual, wherein the mutation rate is set to be between 0 and 0.5, and the gene mutation is carried out with small probability.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610322414.5A CN105867383A (en) | 2016-05-16 | 2016-05-16 | Automatic collision preventing control method of USV |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610322414.5A CN105867383A (en) | 2016-05-16 | 2016-05-16 | Automatic collision preventing control method of USV |
Publications (1)
Publication Number | Publication Date |
---|---|
CN105867383A true CN105867383A (en) | 2016-08-17 |
Family
ID=56634088
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610322414.5A Pending CN105867383A (en) | 2016-05-16 | 2016-05-16 | Automatic collision preventing control method of USV |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105867383A (en) |
Cited By (26)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106444776A (en) * | 2016-10-28 | 2017-02-22 | 中国舰船研究设计中心 | Method for evaluating autonomous performance of unmanned boats |
CN106444759A (en) * | 2016-09-29 | 2017-02-22 | 浙江嘉蓝海洋电子有限公司 | Automatic homeward voyaging method and automatic homeward voyaging system of unmanned boat |
CN106845716A (en) * | 2017-01-25 | 2017-06-13 | 东南大学 | A kind of unmanned surface vehicle local delamination paths planning method based on navigation error constraint |
CN106909145A (en) * | 2017-02-22 | 2017-06-30 | 武汉理工大学 | Unmanned hydrographical survey ship barrier real-time perception obstacle avoidance system and method |
CN106980317A (en) * | 2017-03-31 | 2017-07-25 | 大鹏高科(武汉)智能装备有限公司 | A kind of obstacle avoidance method and system under water |
CN107037809A (en) * | 2016-11-02 | 2017-08-11 | 哈尔滨工程大学 | A kind of unmanned boat collision prevention method based on improvement ant group algorithm |
CN107255923A (en) * | 2017-06-14 | 2017-10-17 | 哈尔滨工程大学 | Drive lacking unmanned boat Track In Track control method based on the RBF ICA CMAC neutral nets recognized |
CN107329477A (en) * | 2017-08-14 | 2017-11-07 | 河海大学常州校区 | A kind of unmanned boat navigation and autopilot facility and its method |
CN107748561A (en) * | 2017-09-25 | 2018-03-02 | 华南理工大学 | A kind of unmanned boat part obstacle avoidance system and method based on more parameter sensings |
WO2018137135A1 (en) * | 2017-01-24 | 2018-08-02 | SZ DJI Technology Co., Ltd. | System and method of radar-based obstacle avoidance for unmanned aerial vehicles |
CN108445879A (en) * | 2018-03-12 | 2018-08-24 | 上海大学 | A kind of unmanned boat barrier-avoiding method based on prediction collision risk region |
CN108489492A (en) * | 2018-02-13 | 2018-09-04 | 上海大学 | A kind of unmanned boat path planning system and method considering sea situation factor |
CN108549372A (en) * | 2018-04-03 | 2018-09-18 | 中国科学院大气物理研究所 | unmanned boat control method and control device |
CN108710372A (en) * | 2018-05-29 | 2018-10-26 | 武汉理工大学 | A kind of autonomous collision avoidance system and method for group's unmanned surface vehicle |
CN109144060A (en) * | 2018-08-22 | 2019-01-04 | 江苏路智达交通科技有限公司 | A kind of dangerous discernment method and system of steamer line |
CN109298708A (en) * | 2018-08-31 | 2019-02-01 | 中船重工鹏力(南京)大气海洋信息系统有限公司 | A kind of unmanned boat automatic obstacle avoiding method merging radar and photoelectric information |
CN109460045A (en) * | 2019-01-14 | 2019-03-12 | 哈尔滨工程大学 | USV is based on the collision-avoidance planning method for improving ant group optimization under dynamic disorder online awareness |
CN109753068A (en) * | 2019-01-14 | 2019-05-14 | 哈尔滨工程大学 | A kind of more USV multi-agent synergy collision-avoidance planning methods considering signal intelligence |
CN109765890A (en) * | 2019-01-14 | 2019-05-17 | 哈尔滨工程大学 | A kind of more USV multi-agent synergy collision-avoidance planning methods based on genetic algorithm |
CN109782760A (en) * | 2019-01-14 | 2019-05-21 | 哈尔滨工程大学 | A kind of more USV multi-agent synergy collision-avoidance planning methods of the consideration without communication |
CN109799823A (en) * | 2019-01-29 | 2019-05-24 | 珠海云洲智能科技有限公司 | A kind of Ocean Surveying method, electronic equipment and storage medium |
CN110174895A (en) * | 2019-05-31 | 2019-08-27 | 中国船舶重工集团公司第七0七研究所 | A kind of verification of unmanned boat Decision of Collision Avoidance and modification method |
CN110188474A (en) * | 2019-05-31 | 2019-08-30 | 中国船舶重工集团公司第七0七研究所 | Decision of Collision Avoidance method based on unmanned surface vehicle |
CN110196598A (en) * | 2019-06-25 | 2019-09-03 | 北京航天控制仪器研究所 | A kind of dynamic collision prevention method of unmanned boat |
CN111694367A (en) * | 2020-05-28 | 2020-09-22 | 哈尔滨工程大学 | Obstacle avoidance device of underwater robot and real-time path planning method |
WO2021022637A1 (en) * | 2019-08-06 | 2021-02-11 | 南京赛沃夫海洋科技有限公司 | Unmanned surface vehicle path planning method and system based on improved genetic algorithm |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102081752A (en) * | 2011-01-27 | 2011-06-01 | 西北工业大学 | Dynamic flight path planning method based on adaptive mutation genetic algorithm |
CN102169347A (en) * | 2011-03-08 | 2011-08-31 | 浙江工业大学 | Multi-robot path planning system based on cooperative co-evolution and multi-population genetic algorithm |
CN202480099U (en) * | 2012-03-27 | 2012-10-10 | 苏州经贸职业技术学院 | Genetic algorithm-based robot capable of automatically searching walking path |
CN102929286A (en) * | 2012-11-26 | 2013-02-13 | 北京理工大学 | Rapid planning method for surface global path of planet |
CN103077425A (en) * | 2012-11-23 | 2013-05-01 | 中国科学院沈阳自动化研究所 | Immune genetic algorithm for AUV (Autonomous Underwater Vehicle) real-time path planning |
-
2016
- 2016-05-16 CN CN201610322414.5A patent/CN105867383A/en active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102081752A (en) * | 2011-01-27 | 2011-06-01 | 西北工业大学 | Dynamic flight path planning method based on adaptive mutation genetic algorithm |
CN102169347A (en) * | 2011-03-08 | 2011-08-31 | 浙江工业大学 | Multi-robot path planning system based on cooperative co-evolution and multi-population genetic algorithm |
CN202480099U (en) * | 2012-03-27 | 2012-10-10 | 苏州经贸职业技术学院 | Genetic algorithm-based robot capable of automatically searching walking path |
CN103077425A (en) * | 2012-11-23 | 2013-05-01 | 中国科学院沈阳自动化研究所 | Immune genetic algorithm for AUV (Autonomous Underwater Vehicle) real-time path planning |
CN102929286A (en) * | 2012-11-26 | 2013-02-13 | 北京理工大学 | Rapid planning method for surface global path of planet |
Non-Patent Citations (9)
Title |
---|
任刚 等: "《交通管理措施下的交通分配模型与算法》", 31 May 2007, 东南大学出版社 * |
刘佳男: "基于进化遗传算法的无人艇避碰系统研究", 《中国优秀硕士学位论文全文数据库工程科技Ⅱ辑》 * |
刘静: "海上多船避碰决策系统的研究", 《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》 * |
周江华 等: "船舶碰撞危险度模型的构建", 《宁波大学学报(理工版)》 * |
曹江丽: "水下机器人路径规划问题的关键技术研究", 《中国博士学位论文全文数据库信息科技辑》 * |
李瑶: "遗传算法在船舶避碰行动决策中的应用研究", 《中国优秀硕士学位论文全文数据库信息科技辑》 * |
王则胜: "基于遗传算法的船舶避碰决策研究", 《中国优秀硕士学位论文全文数据库工程科技Ⅱ辑》 * |
郑中义: "船舶自动避碰决策系统的研究", 《中国博士学位论文全文数据库 工程科技Ⅱ辑》 * |
黄宇峰: "遗传算法在AUV动态规避中的应用研究", 《中国优秀硕士学位论文全文数据库信息科技辑》 * |
Cited By (41)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106444759A (en) * | 2016-09-29 | 2017-02-22 | 浙江嘉蓝海洋电子有限公司 | Automatic homeward voyaging method and automatic homeward voyaging system of unmanned boat |
CN106444776B (en) * | 2016-10-28 | 2019-04-30 | 中国舰船研究设计中心 | A kind of autonomous performance estimating method of unmanned boat |
CN106444776A (en) * | 2016-10-28 | 2017-02-22 | 中国舰船研究设计中心 | Method for evaluating autonomous performance of unmanned boats |
CN107037809A (en) * | 2016-11-02 | 2017-08-11 | 哈尔滨工程大学 | A kind of unmanned boat collision prevention method based on improvement ant group algorithm |
CN110178046A (en) * | 2017-01-24 | 2019-08-27 | 深圳市大疆创新科技有限公司 | The obstacle avoidance system and method based on radar for unmanned plane |
WO2018137135A1 (en) * | 2017-01-24 | 2018-08-02 | SZ DJI Technology Co., Ltd. | System and method of radar-based obstacle avoidance for unmanned aerial vehicles |
CN106845716A (en) * | 2017-01-25 | 2017-06-13 | 东南大学 | A kind of unmanned surface vehicle local delamination paths planning method based on navigation error constraint |
CN106845716B (en) * | 2017-01-25 | 2020-09-08 | 东南大学 | Navigation error constraint-based water surface unmanned ship local hierarchical path planning method |
CN106909145A (en) * | 2017-02-22 | 2017-06-30 | 武汉理工大学 | Unmanned hydrographical survey ship barrier real-time perception obstacle avoidance system and method |
CN106980317A (en) * | 2017-03-31 | 2017-07-25 | 大鹏高科(武汉)智能装备有限公司 | A kind of obstacle avoidance method and system under water |
CN106980317B (en) * | 2017-03-31 | 2019-11-22 | 大鹏高科(武汉)智能装备有限公司 | A kind of underwater obstacle avoidance method and system |
CN107255923A (en) * | 2017-06-14 | 2017-10-17 | 哈尔滨工程大学 | Drive lacking unmanned boat Track In Track control method based on the RBF ICA CMAC neutral nets recognized |
CN107255923B (en) * | 2017-06-14 | 2020-04-03 | 哈尔滨工程大学 | RBF identification-based under-actuated unmanned ship track tracking control method of ICA-CMAC neural network |
CN107329477A (en) * | 2017-08-14 | 2017-11-07 | 河海大学常州校区 | A kind of unmanned boat navigation and autopilot facility and its method |
CN107329477B (en) * | 2017-08-14 | 2020-05-15 | 河海大学常州校区 | Unmanned ship navigation and automatic driving equipment and method thereof |
CN107748561A (en) * | 2017-09-25 | 2018-03-02 | 华南理工大学 | A kind of unmanned boat part obstacle avoidance system and method based on more parameter sensings |
CN107748561B (en) * | 2017-09-25 | 2021-02-19 | 华南理工大学 | Unmanned ship local obstacle avoidance system and method based on multiple sensing parameters |
CN108489492A (en) * | 2018-02-13 | 2018-09-04 | 上海大学 | A kind of unmanned boat path planning system and method considering sea situation factor |
CN108445879A (en) * | 2018-03-12 | 2018-08-24 | 上海大学 | A kind of unmanned boat barrier-avoiding method based on prediction collision risk region |
CN108445879B (en) * | 2018-03-12 | 2021-02-23 | 上海大学 | Unmanned ship obstacle avoidance method based on collision danger prediction area |
CN108549372A (en) * | 2018-04-03 | 2018-09-18 | 中国科学院大气物理研究所 | unmanned boat control method and control device |
CN108710372B (en) * | 2018-05-29 | 2019-09-10 | 武汉理工大学 | A kind of autonomous collision avoidance system and method for group's unmanned surface vehicle |
CN108710372A (en) * | 2018-05-29 | 2018-10-26 | 武汉理工大学 | A kind of autonomous collision avoidance system and method for group's unmanned surface vehicle |
CN109144060A (en) * | 2018-08-22 | 2019-01-04 | 江苏路智达交通科技有限公司 | A kind of dangerous discernment method and system of steamer line |
CN109298708A (en) * | 2018-08-31 | 2019-02-01 | 中船重工鹏力(南京)大气海洋信息系统有限公司 | A kind of unmanned boat automatic obstacle avoiding method merging radar and photoelectric information |
CN109298708B (en) * | 2018-08-31 | 2021-08-17 | 中船重工鹏力(南京)大气海洋信息系统有限公司 | Unmanned ship autonomous obstacle avoidance method integrating radar and photoelectric information |
CN109460045B (en) * | 2019-01-14 | 2022-02-22 | 哈尔滨工程大学 | Improved ant colony optimization-based collision avoidance planning method for USV under dynamic obstacle online perception |
CN109782760A (en) * | 2019-01-14 | 2019-05-21 | 哈尔滨工程大学 | A kind of more USV multi-agent synergy collision-avoidance planning methods of the consideration without communication |
CN109765890B (en) * | 2019-01-14 | 2022-07-29 | 哈尔滨工程大学 | Multi-USV group collaborative collision avoidance planning method based on genetic algorithm |
CN109765890A (en) * | 2019-01-14 | 2019-05-17 | 哈尔滨工程大学 | A kind of more USV multi-agent synergy collision-avoidance planning methods based on genetic algorithm |
CN109753068A (en) * | 2019-01-14 | 2019-05-14 | 哈尔滨工程大学 | A kind of more USV multi-agent synergy collision-avoidance planning methods considering signal intelligence |
CN109782760B (en) * | 2019-01-14 | 2022-06-21 | 哈尔滨工程大学 | Multi-USV group collaborative collision avoidance planning method considering no communication |
CN109753068B (en) * | 2019-01-14 | 2022-06-21 | 哈尔滨工程大学 | Multi-USV group collaborative collision avoidance planning method considering communication situation |
CN109460045A (en) * | 2019-01-14 | 2019-03-12 | 哈尔滨工程大学 | USV is based on the collision-avoidance planning method for improving ant group optimization under dynamic disorder online awareness |
CN109799823A (en) * | 2019-01-29 | 2019-05-24 | 珠海云洲智能科技有限公司 | A kind of Ocean Surveying method, electronic equipment and storage medium |
CN110188474A (en) * | 2019-05-31 | 2019-08-30 | 中国船舶重工集团公司第七0七研究所 | Decision of Collision Avoidance method based on unmanned surface vehicle |
CN110174895A (en) * | 2019-05-31 | 2019-08-27 | 中国船舶重工集团公司第七0七研究所 | A kind of verification of unmanned boat Decision of Collision Avoidance and modification method |
CN110196598A (en) * | 2019-06-25 | 2019-09-03 | 北京航天控制仪器研究所 | A kind of dynamic collision prevention method of unmanned boat |
CN110196598B (en) * | 2019-06-25 | 2022-03-04 | 北京航天控制仪器研究所 | Dynamic collision avoidance method for unmanned ship |
WO2021022637A1 (en) * | 2019-08-06 | 2021-02-11 | 南京赛沃夫海洋科技有限公司 | Unmanned surface vehicle path planning method and system based on improved genetic algorithm |
CN111694367A (en) * | 2020-05-28 | 2020-09-22 | 哈尔滨工程大学 | Obstacle avoidance device of underwater robot and real-time path planning method |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105867383A (en) | Automatic collision preventing control method of USV | |
Polvara et al. | Obstacle avoidance approaches for autonomous navigation of unmanned surface vehicles | |
CN107329477B (en) | Unmanned ship navigation and automatic driving equipment and method thereof | |
CN105807769B (en) | UAV navigation IVFH collision prevention methods | |
CN107608347B (en) | Distributed control unmanned ship cluster enclosure tracking method | |
CN114384920A (en) | Dynamic obstacle avoidance method based on real-time construction of local grid map | |
Myint et al. | Dual-eyes vision-based docking system for autonomous underwater vehicle: an approach and experiments | |
CN109784201B (en) | AUV dynamic obstacle avoidance method based on four-dimensional risk assessment | |
CN104571128B (en) | Underwater robot barrier-avoiding method based on distance with parallax information | |
Phanthong et al. | Application of A* algorithm for real-time path re-planning of an unmanned surface vehicle avoiding underwater obstacles | |
CN113093742B (en) | Unmanned ship path tracking system capable of automatically avoiding multiple obstacles | |
CN103869824A (en) | Biological antenna model-based multi-robot underwater target searching method and device | |
CN108759839A (en) | A kind of unmanned vehicle paths planning method based on situation space | |
CN117250961B (en) | Unmanned moving target ship cooperative formation control method and system | |
Sang et al. | An autonomous underwater vehicle simulation with fuzzy sensor fusion for pipeline inspection | |
Kim | Control laws to avoid collision with three dimensional obstacles using sensors | |
Feng et al. | Automatic tracking method for submarine cables and pipelines of AUV based on side scan sonar | |
Wang et al. | Research on autonomous planning method based on improved quantum Particle Swarm Optimization for Autonomous Underwater Vehicle | |
CN109916400A (en) | A kind of unmanned boat barrier-avoiding method combined based on gradient descent algorithm with VO method | |
Chou et al. | An AI AUV enabling vision-based diver-following and obstacle avoidance with 3D-modeling dataset | |
Mousazadeh et al. | Experimental evaluation of a new developed algorithm for an autonomous surface vehicle and comparison with simulink results | |
CN112799414B (en) | AUV relaxation trajectory planning method | |
CN116859948A (en) | Autonomous navigation control method and system for unmanned ship for channel sweep based on target detection algorithm | |
Zhang et al. | Q-learning Based Obstacle Avoidance Control of Autonomous Underwater Vehicle with Binocular Vision | |
Orłowski | Directions of development of the autonomous unmanned underwater vehicles. A review |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20160817 |