CN113189984B - Unmanned ship path planning method based on improved artificial potential field method - Google Patents

Unmanned ship path planning method based on improved artificial potential field method Download PDF

Info

Publication number
CN113189984B
CN113189984B CN202110408405.9A CN202110408405A CN113189984B CN 113189984 B CN113189984 B CN 113189984B CN 202110408405 A CN202110408405 A CN 202110408405A CN 113189984 B CN113189984 B CN 113189984B
Authority
CN
China
Prior art keywords
unmanned ship
formula
entering
theta
obstacle
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202110408405.9A
Other languages
Chinese (zh)
Other versions
CN113189984A (en
Inventor
孙明晓
原张杰
栾添添
谢春旺
胡占永
王万鹏
付强
张文玉
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Harbin University of Science and Technology
Original Assignee
Harbin University of Science and Technology
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 University of Science and Technology filed Critical Harbin University of Science and Technology
Priority to CN202110408405.9A priority Critical patent/CN113189984B/en
Publication of CN113189984A publication Critical patent/CN113189984A/en
Application granted granted Critical
Publication of CN113189984B publication Critical patent/CN113189984B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/0206Control of position or course in two dimensions specially adapted to water vehicles

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

The invention relates to an unmanned ship path planning method based on an improved artificial potential field method, which comprises the following steps: on the basis of a traditional artificial potential field method, aiming at a complex marine environment and most of obstacles with irregular shapes, the arrangement of the obstacles, which are regarded as particles, is changed, the obstacles are subjected to expansion treatment, and a steering area is reserved; when the attractive force and the repulsive force constructed by the traditional artificial potential field method are collinear and opposite in direction, the unmanned ship turns in a turning area in advance, and the problem that the unmanned ship falls into a local minimum point during path planning is solved; the method has the advantages that the practical application condition of the unmanned ship is considered, the problem of path mutation caused by combination force direction mutation and overlarge corner change in the path planning process is solved, the limitation of the maximum corner and the maximum angular acceleration of the unmanned ship is added, and therefore the planned path can be ensured to smoothly avoid obstacles and the effect of small corner change of the unmanned ship is achieved.

Description

Unmanned ship path planning method based on improved artificial potential field method
Technical Field
The invention relates to an unmanned ship path planning method based on an improved artificial potential field method, and belongs to the field of marine unmanned aerial vehicle motion control and path planning.
Background
At present, unmanned systems represented by unmanned ships are rapidly developing, and a large number of unmanned systems are developed and put into use. But the path planning research for unmanned ship motion control is not mature.
Common path planning methods include simulated annealing algorithm, fuzzy logic algorithm, tabu search algorithm, a-x algorithm, artificial potential field method, and the like. Compared with other algorithms, the artificial potential field method has the advantages of short operation time, strong real-time performance, good hardware adaptability and the like. However, the application of the traditional artificial potential field method in the fields of unmanned ship motion control and path planning has the following problems:
(1) the method has the advantages that the problem of obstacle modeling is solved, an unmanned ship sails on a complex sea surface, obstacles are considered as particles, and a planned path is difficult to achieve the optimal path;
(2) the problem of local minimum points is easily caused by local oscillation of the unmanned ship, so that the target can not be reached;
(3) the corner change is severe, and the corner change is continuous and cannot be suddenly changed and exceed the maximum corner of the unmanned ship in the actual sailing process of the unmanned ship.
In conclusion, how to solve the application of the traditional artificial potential field method under the condition of considering the actual navigation of the unmanned ship becomes a difficult point to be solved urgently.
Disclosure of Invention
The invention aims to provide an unmanned ship path planning method based on an improved artificial potential field method, and solves the problems that the traditional artificial potential field method is ideal in barrier modeling, easy to fall into local minimum points and severe in corner change in the unmanned ship path planning process.
The invention adopts the following technical scheme for solving the problems: an unmanned ship path planning method based on an improved artificial potential field method is designed, and on the basis of a traditional artificial potential field method, an obstacle is subjected to expansion processing, and a steering area is reserved; when the attractive force and the repulsive force constructed by the traditional manual potential field method are collinear and opposite in direction, the unmanned ship is enabled to turn in a turning area in advance, and the problem that the unmanned ship falls into a local minimum point is solved; the limitation of the maximum rotation angle and the maximum angular acceleration of the unmanned ship is added, and the problem of severe change of the rotation angle of the unmanned ship is solved. The method specifically comprises the following steps:
step 1:
establishing a circular equivalent model of the obstacles in the map, performing expansion treatment on the obstacles to reserve a turning area, and then entering the step 2;
step 2:
judging whether the unmanned ship reaches a target point, if so, ending, otherwise, entering the step 3;
and step 3:
constructing a gravity function:
Fg(x)=k·d(x,xgoal) (1)
in the formula: fg(x) Is a gravitation function, k is a gravitation coefficient, x is the current position of the unmanned ship, xgoalAs target point position, d (x, x)goal) Is a vectorAnd measuring, wherein the module length is the distance between the current position of the unmanned ship and the target point, and the direction is that the unmanned ship points to the target point. Gravitation function Fg(x) The gravity is generated on the unmanned ship, and the unmanned ship goes to the target point under the action of the gravity.
Constructing a repulsion function:
Figure GDA0003253424790000021
in the formula: fo(x) Is a function of repulsion, n is the coefficient of repulsion, xobsIs the position of an obstacle, d0Is the radius of influence of the obstacle, d (x, x)obs) Is a vector, the module length is the distance between the current position of the unmanned ship and the obstacle, the direction is the direction of the obstacle pointing to the unmanned ship, | d (x, x)obs) L is d (x, x)obs) Die length of (2). When the unmanned ship influences the radius d on the obstacle0Inner, repulsive force function Fo(x) And a repulsive force is generated to make the obstacle far away. Then entering step 4;
and 4, step 4:
judging whether the attractive force and the repulsive force are collinear and have opposite directions, if so, entering a step 5, and otherwise, entering a step 8;
and 5:
at the moment, in order to get rid of local minimum points and avoid obstacles, the unmanned ship is in a steering area, and a corner formula is constructed:
Figure GDA0003253424790000031
in the formula: theta is the turning angle of the unmanned ship in the turning area, dactIs the actual radius, θ, of the obstacle after it has been inflatedmaxIndicating the maximum turning angle of the unmanned ship itself. Rotation angle formula enables unmanned ship to rotate by maximum rotation angle thetamaxSo as to achieve the effect of getting rid of local minimum points and avoiding obstacles. Then entering step 6;
step 6:
in order to avoid the path abrupt change caused by the overlarge angle theta conversion, an angular acceleration formula is constructed:
Figure GDA0003253424790000032
in the formula: thetacurr(t) represents the angle of rotation of the current unmanned ship, θcurr(t- Δ t) represents a turning angle of the unmanned ship at a previous time, Δ t represents a sampling interval,
Figure GDA0003253424790000033
represents the maximum angular acceleration of the unmanned ship when thetacurr(t) is less than theta, theta is updated using equation (4)curr(t) simultaneously calculating the next motion of the unmanned ship until thetacurr(t) is greater than θ. The angular acceleration formula limits the change in the angle of rotation of the drone at each step to within a maximum angular acceleration. Then entering step 7;
and 7:
judging whether the unmanned ship leaves a steering area, if so, entering a step 2, otherwise, entering a step 5;
and 8:
constructing a resultant force formula:
Fs(x)=Fo(x)+Fg(x) (5)
in the formula: fs(x) Is the resultant force.
Constructing a resultant force unit vector formula:
Figure GDA0003253424790000034
in the formula: thetas(t) is the resultant force unit vector, | Fs(x) L is the resultant force Fs(x) Die length of (2). Resultant force unit vector theta is solved by a resultant force unit vector formulas(t),θsAnd (t) is the next movement direction of the unmanned ship. Then entering step 9;
and step 9:
judging whether the absolute value of the difference value between the next motion direction of the unmanned ship and the current direction of the unmanned ship is greater than the maximum angular acceleration or not, if so, entering a step 11, and otherwise, entering a step 10;
step 10:
calculating the next step of movement of the unmanned ship, and then entering the step 2;
step 11:
and (4) calculating the corner angle of the unmanned ship according to the formula (4), calculating the next step movement of the unmanned ship, and then entering the step 9.
The invention has the following beneficial effects:
1. the method disclosed by the invention escapes from local minimum points on the basis of not changing the traditional potential field function, and is simple, small in calculated amount and good in real-time performance;
2. compared with an improved method provided by a paper 'obstacle avoidance research of a mobile robot based on an improved artificial potential field method', the method has the following advantages:
(1) considering the limitation of the maximum rotation angle and the angular acceleration of the automobile;
(2) the planned path for avoiding the local minimum point is short and smooth;
(3) when the barrier is avoided, the unmanned ship is far away from the barrier, and the unmanned ship is safer.
3. Compared with an improved method provided by a paper unmanned ship path planning algorithm based on an improved artificial potential field method, the method has the following advantages:
(1) when the paper gets rid of local minimum points, an angle of 0-90 degrees is randomly selected for steering, and the turning angle is suddenly changed, but the invention designs a turning angle formula and an angular acceleration formula to ensure that the turning angle is smoothly changed;
(2) the thesis judges that the situation that the unmanned ship sinks into the local minimum point is that three times of oscillation occurs on the path after the unmanned ship sinks into the local minimum point, and the invention turns in advance when the attraction force and the repulsion force are collinear and the directions are opposite, so that the efficiency of getting rid of the local minimum point is high.
Drawings
FIG. 1 is a flow chart of an unmanned ship path planning method based on an improved artificial potential field method;
FIG. 2 is a circular equivalent model of an obstacle;
FIG. 3 is a stress analysis diagram for unmanned ship path planning;
FIG. 4 is a diagram of the maximum turning angle of the unmanned ship;
FIG. 5 is a force analysis diagram of the unmanned ship when the attractive force and the repulsive force are collinear;
FIG. 6 is a unmanned ship path planning diagram;
FIG. 7 is an angle change diagram of unmanned ship path planning;
fig. 8 is a diagram of the angular acceleration change of the unmanned ship path planning.
Detailed Description
FIG. 1 is a flow chart of unmanned ship path planning based on an improved artificial potential field method, which comprises the following steps:
step 1:
establishing a circular equivalent model of the obstacles in the map, expanding the obstacles to reserve a turning area, and expanding the obstacles according to the edges of the obstacles as shown in figure 2, wherein x in the figureobsIs the position of an obstacle, dactThe length of the radius after the expansion treatment of the obstacle, the part enclosed by the solid line circle in the figure, is the result after the expansion of the obstacle, d0In order to construct the influence radius of the function of the obstacle repulsive force, the portion surrounded by the dotted circle in the figure is the influence range of the obstacle repulsive force, i.e., the unmanned ship is subjected to the repulsive force in this range. In the figure, the ring part between the dotted line circle and the solid line circle is defined as a steering area, and if the attraction force and the repulsion force applied to the unmanned ship are collinear and the directions are opposite, the unmanned ship moves forwards again, and a local minimum point can be trapped, so that the unmanned ship enters the steering area to steer.
Then entering step 2;
step 2:
judging whether the unmanned ship reaches a target point, if so, ending, otherwise, entering the step 3;
and step 3:
constructing a gravity function:
Fg(x)=k·d(x,xgoal) (1)
in the formula: fg(x) Is a gravitation function, k is a gravitation coefficient, x is the current position of the unmanned ship, xgoalAs target point position, d (x, x)goal) Is a vector, the module length is the distance between the current position of the unmanned ship and a target point, and the direction is pointed by the unmanned shipTarget point. Gravitation function Fg(x) The gravity is generated on the unmanned ship, and the unmanned ship goes to the target point under the action of the gravity.
Constructing a repulsion function:
Figure GDA0003253424790000061
in the formula: fo(x) Is a function of repulsion, n is the coefficient of repulsion, xobsIs the position of an obstacle, d0Is the radius of influence of the obstacle, d (x, x)obs) Is a vector, the module length is the distance between the current position of the unmanned ship and the obstacle, the direction is the direction of the obstacle pointing to the unmanned ship, | d (x, x)obs) L is d (x, x)obs) Die length of (2). When the unmanned ship influences the radius d on the obstacle0Inner, repulsive force function Fo(x) And a repulsive force is generated to make the obstacle far away. Then entering step 4;
and 4, step 4:
judging the gravitation Fg(x) And repulsive force Fo(x) Whether collinear and opposite, if, as shown in fig. 5, the unmanned ship is subjected to attractive force Fg(x) And repulsive force Fo(x) Collinear and opposite in direction, enter step 5 at this moment, otherwise enter step 8;
and 5:
at the moment, in order to get rid of local minimum points and avoid obstacles, the unmanned ship is in a steering area, and a corner formula is constructed:
Figure GDA0003253424790000062
in the formula: theta is the turning angle of the unmanned ship in the turning area, dactIs the actual radius, θ, of the obstacle after it has been inflatedmaxIndicating the maximum rotation angle of the unmanned ship itself, the unmanned ship can be rotated to the left or right by the maximum rotation angle theta as shown in fig. 4max. Rotation angle formula enables unmanned ship to rotate by maximum rotation angle thetamaxSo as to achieve the effect of getting rid of local minimum points and avoiding obstacles. Then entering step 6;
step 6:
in order to avoid the path abrupt change caused by the overlarge angle theta conversion, an angular acceleration formula is constructed:
Figure GDA0003253424790000063
in the formula: thetacurr(t) represents the angle of rotation of the current unmanned ship, θcurr(t- Δ t) represents a turning angle of the unmanned ship at a previous time, Δ t represents a sampling interval,
Figure GDA0003253424790000071
represents the maximum angular acceleration of the unmanned ship when thetacurr(t) is less than theta, theta is updated using equation (4)curr(t) simultaneously calculating the next motion of the unmanned ship until thetacurr(t) is greater than θ. The angular acceleration formula limits the change in the angle of rotation of the drone at each step to within a maximum angular acceleration. Then entering step 7;
and 7:
judging whether the unmanned ship leaves a steering area, if so, entering a step 2, otherwise, entering a step 5;
and 8:
constructing a resultant force formula:
Fs(x)=Fo(x)+Fg(x) (5)
in the formula: fs(x) Is the resultant force.
Constructing a resultant force unit vector formula:
Figure GDA0003253424790000072
in the formula: thetas(t) is the resultant force unit vector, | Fs(x) L is the resultant force Fs(x) Die length of (2). Resultant force unit vector theta is solved by a resultant force unit vector formulas(t),θsAnd (t) is the next movement direction of the unmanned ship. As shown in FIG. 3, x is the current position of the unmanned ship, xobsIs the position of the obstacle, xgoalAs target point position, Fg(x) Is received by unmanned shipAttraction of target points, Fo(x) Repulsion of obstacles to unmanned ships, Fs(x) For unmanned ship under the gravitation Fg(x) And repulsive force Fo(x) Resultant force under action, resultant force Fs(x) Unit vector thetasAnd (t) is the next movement direction of the unmanned ship. Then entering step 9;
and step 9:
judging whether the absolute value of the difference value between the next motion direction of the unmanned ship and the current direction of the unmanned ship is greater than the maximum angular acceleration or not, if so, entering a step 11, and otherwise, entering a step 10;
step 10:
calculating the next step of movement of the unmanned ship, and then entering the step 2;
step 11:
and (4) calculating the corner angle of the unmanned ship according to the formula (4), calculating the next step movement of the unmanned ship, and then entering the step 9.
The improved artificial potential field method was simulated by Matlab according to the flow chart to obtain the results shown in fig. 6, 7 and 8. FIG. 6 is a planning diagram of unmanned ship path, setting the length of the map to be 5km and the width to be 5km, the coordinates x of the departure point of the unmanned ship to be (3, 0), and the coordinates x of the target pointgoalIs (3, 5), the attraction coefficient k is 9, and the coordinate x of the obstacleobsIs (3, 2.5), the obstacle expands to a radius dobs0.48km, obstacle radius of influence d00.8km, a repulsion coefficient n of 0.3, and a maximum turning angle theta of the unmanned shipmax0.550rad, maximum angular acceleration
Figure GDA0003253424790000081
Is 0.088rad/s2The planned path is short and smooth; FIG. 7 shows the unmanned ship path planning at the maximum rotation angle θmaxThe angle change graph is 0.550rad, the maximum corner can be rotated after the unmanned ship enters a steering area in order to avoid a formula (4) designed by the obstacle, and the angle does not change suddenly due to the limitation of angular acceleration, so that the corner change of the planned path is smooth and the fluctuation is small; FIG. 8 illustrates unmanned ship path planning at maximum angular acceleration
Figure GDA0003253424790000082
Is 0.088rad/s2At maximum angular acceleration
Figure GDA0003253424790000083
Is 0.088rad/s2Under the limit of (2), the angular acceleration change is-0.088 rad/s2~0.088rad/s2Without exceeding this range.

Claims (1)

1. An unmanned ship path planning method based on an improved artificial potential field method solves the problems that a traditional artificial potential field method is applied to the unmanned ship path planning, the obstacle modeling is idealized, the unmanned ship is prone to falling into local minimum points, and the corner change is severe, and is characterized in that:
step 1:
establishing a circular equivalent model of the obstacles in the map, performing expansion treatment on the obstacles to reserve a turning area, and then entering the step 2;
step 2:
judging whether the unmanned ship reaches a target point, if so, ending, otherwise, entering the step 3;
and step 3:
constructing a gravity function:
Fg(x)=k·d(x,xgoal) (1)
in the formula: fg(x) Is a gravitation function, k is a gravitation coefficient, x is the current position of the unmanned ship, xgoalAs target point position, d (x, x)goal) Is a vector, the modular length is the distance between the current position of the unmanned ship and the target point, the direction is that the unmanned ship points to the target point, and the gravitation function Fg(x) The gravity is generated on the unmanned ship, and the unmanned ship goes to a target point under the action of the gravity;
constructing a repulsion function:
Figure FDA0003253424780000011
in the formula: fo(x) Is a function of repulsion, n is the coefficient of repulsion, xobsAs an obstaclePosition, d0Is the radius of influence of the obstacle, d (x, x)obs) Is a vector, the module length is the distance between the current position of the unmanned ship and the obstacle, the direction is the direction of the obstacle pointing to the unmanned ship, | d (x, x)obs) L is d (x, x)obs) The length of the model (d) when the unmanned ship affects the radius of the obstacle0Inner, repulsive force function Fo(x) Generating repulsive force to the barrier, and enabling the barrier to be far away from the barrier, and then entering the step 4;
and 4, step 4:
judging whether the attractive force and the repulsive force are collinear and have opposite directions, if so, entering a step 5, and otherwise, entering a step 8;
and 5:
at the moment, in order to get rid of local minimum points and avoid obstacles, the unmanned ship is in a steering area, and a corner formula is constructed:
Figure FDA0003253424780000021
in the formula: theta is the turning angle of the unmanned ship in the turning area, dactIs the actual radius, θ, of the obstacle after it has been inflatedmaxThe maximum rotation angle of the unmanned ship is shown, and the unmanned ship is rotated by a rotation angle formula to the maximum rotation angle thetamaxThe effect of getting rid of local minimum points and avoiding obstacles is achieved, and then the step 6 is carried out;
step 6:
in order to avoid the path abrupt change caused by the overlarge angle theta conversion, an angular acceleration formula is constructed:
Figure FDA0003253424780000022
in the formula: thetacurr(t) represents the angle of rotation of the current unmanned ship, θcurr(t- Δ t) represents a turning angle of the unmanned ship at a previous time, Δ t represents a sampling interval,
Figure FDA0003253424780000023
represents the maximum angular acceleration of the unmanned ship when thetacurr(t) is less than theta, theta is updated using equation (4)curr(t) simultaneously calculating the next motion of the unmanned ship until thetacurr(t) if the angular acceleration formula is larger than theta, limiting the change of the rotation angle of each step of the unmanned ship to be within the maximum angular acceleration, and then entering the step 7;
and 7:
judging whether the unmanned ship leaves a steering area, if so, entering a step 2, otherwise, entering a step 5;
and 8:
constructing a resultant force formula:
Fs(x)=Fo(x)+Fg(x) (5)
in the formula: fs(x) For the resultant force, a resultant force unit vector formula is constructed:
Figure FDA0003253424780000024
in the formula: thetas(t) is the resultant force unit vector, | Fs(x) L is the resultant force Fs(x) The resultant unit vector theta is obtained by the formula of the modulus length and the resultant unit vectors(t),θs(t) the next movement direction of the unmanned ship, and then the step 9 is carried out;
and step 9:
judging whether the absolute value of the difference value between the next motion direction of the unmanned ship and the current direction of the unmanned ship is greater than the maximum angular acceleration or not, if so, entering a step 11, and otherwise, entering a step 10;
step 10:
calculating the next step of movement of the unmanned ship, and then entering the step 2;
step 11:
and (4) calculating the corner angle of the unmanned ship according to the formula (4), calculating the next step movement of the unmanned ship, and then entering the step 9.
CN202110408405.9A 2021-04-16 2021-04-16 Unmanned ship path planning method based on improved artificial potential field method Active CN113189984B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110408405.9A CN113189984B (en) 2021-04-16 2021-04-16 Unmanned ship path planning method based on improved artificial potential field method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110408405.9A CN113189984B (en) 2021-04-16 2021-04-16 Unmanned ship path planning method based on improved artificial potential field method

Publications (2)

Publication Number Publication Date
CN113189984A CN113189984A (en) 2021-07-30
CN113189984B true CN113189984B (en) 2021-10-29

Family

ID=76977262

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110408405.9A Active CN113189984B (en) 2021-04-16 2021-04-16 Unmanned ship path planning method based on improved artificial potential field method

Country Status (1)

Country Link
CN (1) CN113189984B (en)

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113805597B (en) * 2021-09-28 2023-04-11 福州大学 Obstacle self-protection artificial potential field method local path planning method based on particle swarm optimization
CN114003047B (en) * 2021-12-31 2022-04-08 山东科技大学 Path planning method for small unmanned ship
CN114839994B (en) * 2022-05-18 2022-11-15 哈尔滨理工大学 Unmanned ship navigational speed self-adaptive path planning method based on improved artificial potential field method
CN115237139B (en) * 2022-08-10 2023-05-23 哈尔滨理工大学 Unmanned ship path planning method considering virtual target point
CN117093010B (en) * 2023-10-20 2024-01-19 清华大学 Underwater multi-agent path planning method, device, computer equipment and medium

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107015563A (en) * 2016-12-29 2017-08-04 北京航空航天大学 Method for planning path for mobile robot and device
CN109521794A (en) * 2018-12-07 2019-03-26 南京航空航天大学 A kind of multiple no-manned plane routeing and dynamic obstacle avoidance method
CN110850873B (en) * 2019-10-31 2021-06-08 五邑大学 Unmanned ship path planning method, device, equipment and storage medium

Also Published As

Publication number Publication date
CN113189984A (en) 2021-07-30

Similar Documents

Publication Publication Date Title
CN113189984B (en) Unmanned ship path planning method based on improved artificial potential field method
CN110632931B (en) Mobile robot collision avoidance planning method based on deep reinforcement learning in dynamic environment
CN109582027B (en) Improved particle swarm optimization algorithm-based USV cluster collision avoidance planning method
CN109597417B (en) Multi-USV group collaborative collision avoidance planning method based on collision avoidance criterion
Phanthong et al. Application of A* algorithm for real-time path re-planning of an unmanned surface vehicle avoiding underwater obstacles
CN109318890A (en) A kind of unmanned vehicle dynamic obstacle avoidance method based on dynamic window and barrier potential energy field
CN106959698A (en) A kind of path trace avoidance method of guidance
CN105022270A (en) Automatic ship collision avoidance method based on velocity vector coordinate system
CN109050835A (en) Full driving autonomous underwater robot structure and recycling three-dimensional path tracking
CN111506068B (en) Water surface unmanned ship local path planning method for multi-beam sonar scanning operation
Guo et al. Development and control of a vectored water-jet-based spherical underwater vehicle
KR101278708B1 (en) Underwater robot and Method for controlling the same
CN104571128A (en) Obstacle avoidance method used for underwater robot and based on distance and parallax information
Kim Control laws to avoid collision with three dimensional obstacles using sensors
CN105549600A (en) Evading method based on opposite-direction sailing of virtual puffed motion obstacle and UUV
CN111881580A (en) Movement planning method for unmanned ship to avoid obstacles
CN109916400B (en) Unmanned ship obstacle avoidance method based on combination of gradient descent algorithm and VO method
Qi et al. Longitudinal motion control of AUV based on fuzzy sliding mode method
Wang et al. Formation control of unmanned surface vehicles with sensing constraints using exponential remapping method
Zhang et al. Multi-UUV path planning based on improved artificial potential field method
Zhang et al. Research on Path Planning Method of Unmanned Boat Based on Improved Artificial Potential Field Method
CN113359762A (en) Dynamic planning method for unmanned surface vehicle
CN113467483A (en) Local path planning method and device based on space-time grid map in dynamic environment
CN117369441A (en) Self-adaptive intelligent ship path planning method considering ship kinematics and COLLEGs
Selje et al. Gps-denied three dimensional leader-follower formation control using deep reinforcement learning

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant