CN105867383A - Automatic collision preventing control method of USV - Google Patents

Automatic collision preventing control method of USV Download PDF

Info

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
Application number
CN201610322414.5A
Other languages
Chinese (zh)
Inventor
王元慧
迟岑
丁福光
赵亮博
王莎莎
赵强
张赞
杨云龙
张博
张放
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Harbin Engineering University
Original Assignee
Harbin Engineering University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Harbin Engineering University filed Critical Harbin Engineering University
Priority to CN201610322414.5A priority Critical patent/CN105867383A/en
Publication of CN105867383A publication Critical patent/CN105867383A/en
Pending legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/0206Control of position or course in two dimensions specially adapted to water vehicles
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01DMEASURING 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/00Measuring or testing not otherwise provided for
    • G01D21/02Measuring two or more variables by means not covered by a single other subclass
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06NCOMPUTING ARRANGEMENTS BASED ON SPECIFIC COMPUTATIONAL MODELS
    • G06N3/00Computing arrangements based on biological models
    • G06N3/12Computing arrangements based on biological models using genetic models
    • G06N3/126Evolutionary 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

Autonomous collision avoidance control method for USV
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:
D T = ( x T - x O ) 2 + ( y T - y O ) 2
the true orientation of the obstacle relative to the unmanned surface is θT
θ T = a r c t a n x T - x O y T - y O + α 2
The true orientation of the unmanned vehicle relative to the obstacle is theta0
θ 0 = a r c t a n x O - x T y O - y T + α 2
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:
v R x = v T x - v O x v R y = v T y - v O y
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:
u d t = 1 | D C P A | < d 1 1 2 - 1 2 s i n &lsqb; &pi; d 2 - d 1 - D C P A ( d 2 + d 1 ) 2 &rsqb; d 1 < | D C P A | &le; d 2 0 d 2 < | D C P A |
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:
u t T = 1 T C P A &le; 1 ( t 2 - T C P A t 2 - t 1 ) 2 t 1 &le; T C P A &le; t 2 0 T C P A > t 2
when TCPA is less than or equal to 0
u t T = 1 T C P A &le; 1 ( t 2 + T C P A t 2 - t 1 ) 2 t 1 &le; T C P A &le; t 2 0 T C P A > t 2
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
u t = u d t &CirclePlus; u t T
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:
F ( x ) = C m a x - f ( x ) f ( x ) < C m a x 0 f ( x ) &GreaterEqual; C m a x
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:
D T = ( x T - x O ) 2 + ( y T - y O ) 2
the true orientation of the obstacle relative to the unmanned surface is θT
&theta; T = arctan x T - x O y T - y O + &alpha; 2
The true orientation of the unmanned vehicle relative to the obstacle is theta0
&theta; 0 = arctan x O - x T y O - y T + &alpha; 2
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:
v R x = v T x - v O x v R y = v T y - v O y
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:
u d t = 1 | D C P A | < d 1 1 2 - 1 2 s i n &lsqb; &pi; d 2 - d 1 - D C P A ( d 2 + d 1 ) 2 &rsqb; d 1 < | D C P A | &le; d 2 0 d 2 < | D C P A |
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:
u t T = 1 T C P A &le; 1 ( t 2 - T C P A t 2 - t 1 ) 2 t 1 &le; T C P A &le; t 2 0 T C P A > t 2
when TCPA is less than or equal to 0
u t T = 1 T C P A &le; 1 ( t 2 + T C P A t 2 - t 1 ) 2 t 1 &le; T C P A &le; t 2 0 T C P A > t 2
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
u t = u d t &CirclePlus; u t T
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:
F ( x ) = C m a x - f ( x ) f ( x ) < C m a x 0 f ( x ) &GreaterEqual; C m a x
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.
CN201610322414.5A 2016-05-16 2016-05-16 Automatic collision preventing control method of USV Pending CN105867383A (en)

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)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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

Patent Citations (5)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
Title
任刚 等: "《交通管理措施下的交通分配模型与算法》", 31 May 2007, 东南大学出版社 *
刘佳男: "基于进化遗传算法的无人艇避碰系统研究", 《中国优秀硕士学位论文全文数据库工程科技Ⅱ辑》 *
刘静: "海上多船避碰决策系统的研究", 《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》 *
周江华 等: "船舶碰撞危险度模型的构建", 《宁波大学学报(理工版)》 *
曹江丽: "水下机器人路径规划问题的关键技术研究", 《中国博士学位论文全文数据库信息科技辑》 *
李瑶: "遗传算法在船舶避碰行动决策中的应用研究", 《中国优秀硕士学位论文全文数据库信息科技辑》 *
王则胜: "基于遗传算法的船舶避碰决策研究", 《中国优秀硕士学位论文全文数据库工程科技Ⅱ辑》 *
郑中义: "船舶自动避碰决策系统的研究", 《中国博士学位论文全文数据库 工程科技Ⅱ辑》 *
黄宇峰: "遗传算法在AUV动态规避中的应用研究", 《中国优秀硕士学位论文全文数据库信息科技辑》 *

Cited By (41)

* Cited by examiner, † Cited by third party
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