CN110471427A - A kind of ship formation intelligent Collision Avoidance method based on path planning and Artificial Potential Field Method - Google Patents
A kind of ship formation intelligent Collision Avoidance method based on path planning and Artificial Potential Field Method Download PDFInfo
- Publication number
- CN110471427A CN110471427A CN201910844061.9A CN201910844061A CN110471427A CN 110471427 A CN110471427 A CN 110471427A CN 201910844061 A CN201910844061 A CN 201910844061A CN 110471427 A CN110471427 A CN 110471427A
- Authority
- CN
- China
- Prior art keywords
- ship
- potential field
- obstacle
- collision avoidance
- information
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 58
- 230000015572 biosynthetic process Effects 0.000 title claims abstract description 34
- 230000004888 barrier function Effects 0.000 claims abstract description 14
- 101150080778 INPP5D gene Proteins 0.000 claims description 181
- 239000002131 composite material Substances 0.000 claims description 9
- 230000014509 gene expression Effects 0.000 claims description 4
- 230000008569 process Effects 0.000 claims description 4
- 238000004891 communication Methods 0.000 claims description 3
- 238000005516 engineering process Methods 0.000 abstract description 6
- 230000002265 prevention Effects 0.000 abstract description 5
- 239000003643 water by type Substances 0.000 abstract 1
- 230000006870 function Effects 0.000 description 12
- 230000009286 beneficial effect Effects 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 230000009471 action Effects 0.000 description 1
- 238000013473 artificial intelligence Methods 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000008447 perception Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000001960 triggered effect Effects 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
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)
- Traffic Control Systems (AREA)
Abstract
The present invention provides a kind of ship formation intelligent Collision Avoidance method based on path planning and Artificial Potential Field Method, belong to information technology and ship formation distributed control technology field, to solve technical problem present in existing Artificial Potential Field, the method of the present invention, real-time navigation safety information is obtained by Electronic Chart System, in conjunction with indexs such as the ship performance setting navigation safety depth of waters, the path of origin-to-destination is gone out using paths planning method pre-planning.The navigation safety information of ship is obtained by equipment such as ship automatic identification system, global positioning systems.In form into columns ship between ship at a distance from or ship between barrier at a distance from when being less than corresponding safe distance, trigger collision prevention or avoidance Artificial Potential Field, pass through Artificial Potential Field repulsive force and ship path trace bimoment controls ship course and the speed of a ship or plane.Path planning in conjunction with Artificial Potential Field Method, is made full use of ship's navigation global information and real-time local message by the present invention, realizes ship intelligently navigation and control of collision avoidance.
Description
Technical Field
The invention relates to the technical field of information technology and ship formation distributed control, in particular to an intelligent ship formation collision prevention method based on path planning and an artificial potential field method.
Background
With the development of artificial intelligence technology and computer technology, the sensing capability of ships and the computing capability of ship controllers are rapidly improved, and the intelligent requirement of ships is increased. And because the operation capacity of a single ship is limited, the formation and cooperation of multiple ships are beneficial to improving the operation efficiency and the operation capacity, and the formation of multiple ships becomes an intelligent ship research hotspot. In the actual application of ship formation, the practical problems of ship path planning, collision of ships in the formation and collision of the ships with obstacles are necessarily involved. The ship is required to sense various channel information and self safety and dynamic states in real time, realize omnibearing sensing of the ship by combining the interaction and data fusion in the ship formation, and eliminate navigation danger by controlling the moving states of ship speed, course and the like.
Because the artificial potential field method model is simple, the demand of computing resources is small, the real-time performance is high, and the like, the method is widely applied to real-time collision avoidance and obstacle avoidance control of the mobile intelligent body. The core theory is that by establishing a composite potential field, when the relative distance between other ships or obstacles and the ship in the environment is smaller than a preset value, the potential field generates a virtual repulsive force to push the intelligent body away from other ships or obstacles. The artificial potential field method only utilizes local information sensed by a ship, and the situation that the resultant force of trapped composite acting force is zero exists in practical application.
Disclosure of Invention
According to the technical problems existing in the existing artificial potential field, the intelligent ship formation collision avoiding method based on the path planning and the artificial potential field method is provided. The invention combines the path planning with the artificial potential field method, fully utilizes the global information and the real-time local information of the ship navigation, and realizes the intelligent navigation and collision avoidance control of the ship. The technical means adopted by the invention are as follows:
an intelligent ship formation collision avoidance method based on path planning and an artificial potential field method comprises the following steps:
s1, setting the sailing safety condition of the ship by combining the ship maneuverability, the ship width and length and the ship draft parameters according to the known chart information and the water channel information;
s2, according to the specified navigation safety conditions, regarding the area which does not accord with the conditions in the electronic chart as a non-navigable area, establishing a chart coordinate system containing a navigation starting point and a navigation ending point, regarding the non-navigable area as an obstacle by using a path planning method, and planning a ship navigation path;
s3, in the process of following the planned route, sensing external obstacles and information of adjacent ships by acquiring the self state of the ships and the information of the external environment in real time;
s4, establishing a collision and obstacle avoidance repulsive force field of the ship through a ship-associated coordinate system, and setting a trigger distance of the potential field and a force gradient of the potential field through a ship speed and a sensor sensing range;
and S5, calculating the control moment borne by the ship according to the local environment information, the planned route and the real-time dynamic state of the ship.
Further, the step S2 specifically includes:
s21, establishing a longitude and latitude coordinate system containing a ship motion starting point and a ship motion finishing point according to the electronic chart and the AIS data;
s22, dividing navigable areas and non-navigable areas according to preset ship navigation safety conditions and the isophote data in a coordinate system;
and S23, defining the non-sailing area as an obstacle, and carrying out global path planning by an RRT path planning method, wherein the planned path is used as an expected path for ship tracking.
Further, the step S4 specifically includes:
s41, establishing a ship-associated coordinate system, establishing a rectangular coordinate system with the ship as an origin through a global positioning system, radar images, AIS data and channel data acquired by a sensor on the ship, and determining position coordinates of the obstacle and other adjacent ships in the formation in the coordinate system through acquired information;
s42, extracting data of the channel and the barrier, obtaining position information of all ships in the fleet through a formation communication network, and establishing a repulsive force field between the ships and a repulsive force field at the boundary of the barrier according to the obtained information:
in the formula, i and j are the ship and the ship entering the ship potential field respectively,as a collision avoidance auxiliary function, whereinijIs the relative distance between other vessels and the ship in team, sigma1Is a constant number of times, and is,χ candfor avoiding collision of the inner and outer boundaries of the potential field, Ψc(ζij) Is a collision avoidance potential field function centered on other ships;
the repulsive force of the adjacent j ships on the ship is the negative gradient of the adjacent ship collision avoidance potential field function, and is expressed as follows:
in the formula, kcThe coefficient of the collision avoidance is positive,the gradient of the relative positions of the two ships;
the resultant force of the repulsion forces of the collision avoidance potential field experienced by the ship is expressed as:
in the formula, NiThe ship is an adjacent ship set entering the collision avoidance potential field of the i ship;
establishing an obstacle potential field, wherein the function expression of the obstacle potential field is as follows:
in the formula,as an obstacle avoidance auxiliary function, where xiikIs the distance between the ship and the obstacle theta1Is a constant number of times, and is,χ oandis the external world of the obstacle potential field, Ψo(ξik) An obstacle avoidance potential field function with an obstacle as a center;
the magnitude of the repulsive force of the potential field generated by the obstacle is as follows:
in the formula, koThe current time is a positive obstacle avoidance coefficient,a gradient of relative positions of the vessel and the obstacle;
the resultant force of the obstacle avoidance potential field repulsive force borne by the ship is as follows:
in the formula, koPositive obstacle avoidance coefficient, k is an obstacle label, and P is the total number of obstacles near the ship;
s43, establishing a boundary repulsive field and a circular repulsive field, describing the small-sized barrier as a circular barrier, and establishing the circular barrier repulsive field; for medium or large obstacles, potential fields are established along the boundary, and the collision avoidance potential field between ships is a circular potential field surrounding the whole ship.
Further, the step S5 specifically includes:
s51, establishing a shipborne sensing information platform by using the electronic chart, the shipborne differential GPS and AIS data, a shipborne camera and a distance sensor, and early warning the ship navigation danger;
and S52, calculating the resultant moment of the composite potential field to the ship, and decomposing the moment into a moment in the ship heading direction and a moment perpendicular to the ship heading direction according to the ship heading.
Further, the calculating the resultant moment of the composite potential field to the ship specifically includes:
Fi all＝Fi c(t)+Fi o(t)
in the formula, Fi allThe combined force of the collision avoidance potential field and the obstacle avoidance potential field on the acting force of the ship is obtained.
The moment is decomposed into a moment in the ship heading direction and a moment perpendicular to the ship heading direction according to the ship heading direction, and the moment is specifically as follows:
Fi T＝Fi allsinθ，Fi L＝Fi allcosθ
wherein θ is the heading of the vessel, Fi TAnd Fi LTransverse sum of potential field to vesselLongitudinal force.
Compared with the prior art, the invention has the following advantages:
1. the intelligent ship formation collision avoidance method based on the path planning and the artificial potential field method provided by the invention considers the problems of path planning and intelligent collision avoidance from the departure point to the destination of the ship formation.
2. The invention provides an intelligent ship formation collision avoidance method based on path planning and an artificial potential field method. And taking the non-sailing area as an obstacle to plan the path. And when the framed area can not meet the navigation condition and can not plan a path, enlarging the framed area until the path can be planned.
3. Because the problem of collision avoidance between the real-time obstacle avoidance and the ship is not considered in the path planning, the method introduces an artificial potential field method to solve the problem of real-time collision avoidance control of the ship. When the ship navigates to the destination along the planned path, the motion state of the ship and the state of the external environment are monitored in real time, the collision which possibly occurs is sensed in advance, and then the course speed of the ship is adjusted by the scheme, so that the collision is avoided.
4. The intelligent ship formation collision avoidance method based on the path planning and the artificial potential field method is small in calculated amount, easy to apply to a real ship and beneficial to realization of unmanned ship formation.
Based on the reasons, the method can be widely popularized in the fields of information technology, ship formation distributed control and the like.
Drawings
In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings needed to be used in the description of the embodiments or the prior art will be briefly introduced below, and it is obvious that the drawings in the following description are some embodiments of the present invention, and for those skilled in the art, other drawings can be obtained according to these drawings without creative efforts.
Fig. 1 is a flowchart of a method provided in an embodiment of the present invention.
Fig. 2 is a diagram illustrating a conventional RRT path planning process and effect provided by an embodiment of the present invention.
Fig. 3 is a design diagram of an artificial potential field area provided in an embodiment of the present invention.
Fig. 4 is a schematic diagram of collision avoidance and obstacle avoidance according to an embodiment of the present invention.
Detailed Description
It should be noted that the embodiments and features of the embodiments may be combined with each other without conflict. The present invention will be described in detail below with reference to the embodiments with reference to the attached drawings.
In order to make the objects, technical solutions and advantages of the embodiments of the present invention clearer, the technical solutions in the embodiments of the present invention will be clearly and completely described below with reference to the drawings in the embodiments of the present invention, and it is obvious that the described embodiments are only a part of the embodiments of the present invention, and not all of the embodiments. The following description of at least one exemplary embodiment is merely illustrative in nature and is in no way intended to limit the invention, its application, or uses. All other embodiments, which can be derived by a person skilled in the art from the embodiments given herein without making any creative effort, shall fall within the protection scope of the present invention.
It is noted that the terminology used herein is for the purpose of describing particular embodiments only and is not intended to be limiting of exemplary embodiments according to the invention. As used herein, the singular forms "a", "an" and "the" are intended to include the plural forms as well, and it should be understood that when the terms "comprises" and/or "comprising" are used in this specification, they specify the presence of stated features, steps, operations, devices, components, and/or combinations thereof, unless the context clearly indicates otherwise.
The relative arrangement of the components and steps, the numerical expressions and numerical values set forth in these embodiments do not limit the scope of the present invention unless specifically stated otherwise. Meanwhile, it should be understood that the sizes of the respective portions shown in the drawings are not drawn in an actual proportional relationship for the convenience of description. Techniques, methods, and apparatus known to those of ordinary skill in the relevant art may not be discussed in detail but are intended to be part of the specification where appropriate. Any specific values in all examples shown and discussed herein are to be construed as exemplary only and not as limiting. Thus, other examples of the exemplary embodiments may have different values. It should be noted that: like reference numbers and letters refer to like items in the following figures, and thus, once an item is defined in one figure, further discussion thereof is not required in subsequent figures.
The invention provides an intelligent ship formation collision prevention method based on a path planning and artificial potential field method. The collision prevention part needs to generate a control instruction and send the control instruction to the autopilot and the engine rotating speed controller by utilizing the cooperation of a ship-borne sensing information platform containing ship dynamic information and environmental information and a ship collision prevention controller for calculating a ship motion control instruction. Thereby changing the course and speed of the ship. Wherein, the equipment that the on-board perception information platform need be utilized has: ranging cameras, differential GPS systems, marine radar, compass direction finders, shipborne AIS systems, and the like. The ship collision avoidance controller is triggered when the ship meets an obstacle or is too close to other ships, and calculates a ship course and speed control instruction.
Examples
As shown in fig. 1, the invention provides an intelligent ship formation collision avoidance method based on a path planning and artificial potential field method, which comprises the following steps:
s1, setting the sailing safety condition of the ship by combining the ship maneuverability, the ship width and length and the ship draft parameters according to the known chart information and the water channel information;
step S1 specifically includes:
and S11, determining the position of the ship by the shore-based information platform through the AIS data and the shipborne information sensing platform.
And S12, the shore-based information system receives the marine traffic information in real time and updates the chart data.
S2, according to the specified navigation safety conditions, regarding the area which does not accord with the conditions in the electronic chart as a non-navigable area, establishing a chart coordinate system containing a navigation starting point and a navigation ending point, regarding the non-navigable area as an obstacle by using a path planning method, and planning a ship navigation path;
step S2 specifically includes:
s21, establishing a longitude and latitude coordinate system containing a ship motion starting point and a ship motion finishing point according to the electronic chart and the AIS data;
s22, dividing navigable areas and non-navigable areas according to preset ship navigation safety conditions and the isophote data in a coordinate system;
s23, defining the above-mentioned non-navigable area as an obstacle, and as shown in fig. 2, performing global path planning by the RRT path planning method, where the planned path is used as a desired path for ship tracking.
S3, in the process of following the planned route, sensing external obstacles and information of adjacent ships by acquiring the self state of the ships and the information of the external environment in real time;
s4, as shown in figure 3, establishing a collision and obstacle avoidance repulsive force field of the ship through a ship-associated coordinate system, and setting a trigger distance and a force gradient of the potential field through a ship speed and a sensor sensing range;
step S4 specifically includes:
s41, establishing a ship-associated coordinate system, establishing a rectangular coordinate system with the ship as an origin through a Global Positioning System (GPS), a radar image, AIS data and channel data acquired by a sensor on the ship, and determining position coordinates of the obstacle and other adjacent ships in the formation in the coordinate system through acquired information;
s42, as shown in fig. 4, extracting data of the channel and the obstacle, obtaining position information of all ships in the fleet through the formation communication network, and establishing a repulsive force field between the ships and a repulsive force field at the boundary of the obstacle according to the obtained information:
in the formula, i and j are the ship and the ship entering the ship potential field respectively,as a collision avoidance auxiliary function, whereinijIs the relative distance between other vessels and the ship in team, sigma1Is a constant number of times, and is,χ candfor avoiding collision of the inner and outer boundaries of the potential field, Ψc(ζij) Is a collision avoidance potential field function centered on other ships;
the repulsive force of the adjacent j ships on the ship is the negative gradient of the adjacent ship collision avoidance potential field function, and is expressed as follows:
in the formula, kcThe coefficient of the collision avoidance is positive,the gradient of the relative positions of the two ships;
the resultant force of the repulsion forces of the collision avoidance potential field experienced by the ship is expressed as:
in the formula, NiThe ship is an adjacent ship set entering the collision avoidance potential field of the i ship;
establishing an obstacle potential field, wherein the function expression of the obstacle potential field is as follows:
in the formula,as an obstacle avoidance auxiliary function, where xiikIs the distance between the ship and the obstacle theta1Is a constant number of times, and is,χ oandis the external world of the obstacle potential field, Ψo(ξik) An obstacle avoidance potential field function with an obstacle as a center;
the magnitude of the repulsive force of the potential field generated by the obstacle is as follows:
in the formula, koThe current time is a positive obstacle avoidance coefficient,a gradient of relative positions of the vessel and the obstacle;
the resultant force of the obstacle avoidance potential field repulsive force borne by the ship is as follows:
in the formula, koPositive obstacle avoidance coefficient, k is an obstacle label, and P is the total number of obstacles near the ship;
s43, establishing a boundary repulsive field and a circular repulsive field, describing the small-sized barrier as a circular barrier, and establishing the circular barrier repulsive field; for medium or large obstacles, potential fields are established along the boundary, and the collision avoidance potential field between ships is a circular potential field surrounding the whole ship. The tangential distance between the outside and the inner boundary of the designed potential field is set according to the sensing distance or the accuracy of equipment such as radar and the like.
And S5, calculating the control moment borne by the ship according to the local environment information, the planned route and the real-time dynamic state of the ship. Under the action of the composite torque, the marshalling of the ship is controlled to safely bypass the obstacles, and meanwhile, the embarrassment situation that the marshalling enters a narrow and long water channel without an outlet and the like is avoided.
Step S5 specifically includes:
s51, establishing a shipborne sensing information platform by using the electronic chart, the shipborne differential GPS and AIS data, a shipborne camera and a distance sensor, and early warning the ship navigation danger;
and S52, calculating the resultant moment of the composite potential field to the ship, and decomposing the moment into a moment in the ship heading direction and a moment perpendicular to the ship heading direction according to the ship heading. Wherein,
calculating the resultant moment of the composite potential field to the ship, specifically:
Fi all＝Fi c(t)+Fi o(t)
in the formula, Fi allThe combined force of the collision avoidance potential field and the obstacle avoidance potential field on the acting force of the ship is obtained.
According to the ship heading, the moment is decomposed into a moment in the ship heading direction and a moment perpendicular to the ship heading direction, and the method specifically comprises the following steps:
Fi T＝Fi allsinθ，Fi L＝Fi allcosθ
wherein θ is the heading of the vessel, Fi TAnd Fi LThe transverse and longitudinal acting force of the potential field on the ship.
In conclusion, the invention considers the problems of route planning and intelligent collision avoidance from the departure point to the destination of the ship formation. When a shore-based information system carries out path planning, a chart area comprising a starting point and a destination is divided into a navigable area and a non-navigable area according to the safety index of a ship. And taking the non-sailing area as an obstacle to plan the path. And when the framed area can not meet the navigation condition and can not plan a path, enlarging the framed area until the path can be planned. Because the collision avoidance problem between the real-time obstacle avoidance and the ship is not considered in the path planning, an artificial potential field method is introduced to solve the real-time collision avoidance control problem of the ship. When the ship navigates to the destination along the planned path, the motion state of the ship and the state of the external environment are monitored in real time, the collision which possibly occurs is sensed in advance, and then the course speed of the ship is adjusted by the scheme, so that the collision is avoided.
The collision avoidance method has small calculation amount, is easy to be applied in a real ship and is beneficial to the realization of unmanned ship formation.
Finally, it should be noted that: the above examples are only intended to illustrate the technical solution of the present invention, but not to limit it; although the present invention has been described in detail with reference to the foregoing embodiments, it will be understood by those of ordinary skill in the art that: the technical solutions described in the foregoing embodiments may still be modified, or some or all of the technical features may be equivalently replaced; and the modifications or the substitutions do not make the essence of the corresponding technical solutions depart from the scope of the technical solutions of the embodiments of the present invention.
Claims (5)
1. An intelligent ship formation collision avoidance method based on path planning and an artificial potential field method is characterized by comprising the following steps:
s1, setting the sailing safety condition of the ship by combining the ship maneuverability, the ship width and length and the ship draft parameters according to the known chart information and the water channel information;
s2, according to the specified navigation safety conditions, regarding the area which does not accord with the conditions in the electronic chart as a non-navigable area, establishing a chart coordinate system containing a navigation starting point and a navigation ending point, regarding the non-navigable area as an obstacle by using a path planning method, and planning a ship navigation path;
s3, in the process of following the planned route, sensing external obstacles and information of adjacent ships by acquiring the self state of the ships and the information of the external environment in real time;
s4, establishing a collision and obstacle avoidance repulsive force field of the ship through a ship-associated coordinate system, and setting a trigger distance of the potential field and a force gradient of the potential field through a ship speed and a sensor sensing range;
and S5, calculating the control moment borne by the ship according to the local environment information, the planned route and the real-time dynamic state of the ship.
2. The intelligent ship formation collision avoidance method based on the path planning and artificial potential field method according to claim 1, wherein the step S2 specifically comprises:
s21, establishing a longitude and latitude coordinate system containing a ship motion starting point and a ship motion finishing point according to the electronic chart and the AIS data;
s22, dividing navigable areas and non-navigable areas according to preset ship navigation safety conditions and the isophote data in a coordinate system;
and S23, defining the non-sailing area as an obstacle, and carrying out global path planning by an RRT path planning method, wherein the planned path is used as an expected path for ship tracking.
3. The intelligent ship formation collision avoidance method based on the path planning and artificial potential field method according to claim 1 or 2, wherein the step S4 specifically comprises:
s41, establishing a ship-associated coordinate system, establishing a rectangular coordinate system with the ship as an origin through a global positioning system, radar images, AIS data and channel data acquired by a sensor on the ship, and determining position coordinates of the obstacle and other adjacent ships in the formation in the coordinate system through acquired information;
s42, extracting data of the channel and the barrier, obtaining position information of all ships in the fleet through a formation communication network, and establishing a repulsive force field between the ships and a repulsive force field at the boundary of the barrier according to the obtained information:
in the formula, i and j are the ship and the ship entering the ship potential field respectively,as a collision avoidance auxiliary function, whereinijIs the relative distance between other vessels and the ship in team, sigma1Is a constant number of times, and is,χ candfor avoiding collision of the inner and outer boundaries of the potential field, Ψc(ζij) Is a collision avoidance potential field function centered on other ships;
the repulsive force of the adjacent j ships on the ship is the negative gradient of the adjacent ship collision avoidance potential field function, and is expressed as follows:
in the formula, kcThe coefficient of the collision avoidance is positive,the gradient of the relative positions of the two ships;
the resultant force of the repulsion forces of the collision avoidance potential field experienced by the ship is expressed as:
in the formula, NiThe ship is an adjacent ship set entering the collision avoidance potential field of the i ship;
establishing an obstacle potential field, wherein the function expression of the obstacle potential field is as follows:
in the formula,as an obstacle avoidance auxiliary function, where xiikIs the distance between the ship and the obstacle theta1Is a constant number of times, and is,χ oandis the external world of the obstacle potential field, Ψo(ξik) An obstacle avoidance potential field function with an obstacle as a center;
the magnitude of the repulsive force of the potential field generated by the obstacle is as follows:
in the formula, koThe current time is a positive obstacle avoidance coefficient,a gradient of relative positions of the vessel and the obstacle;
the resultant force of the obstacle avoidance potential field repulsive force borne by the ship is as follows:
in the formula, koPositive obstacle avoidance coefficient, k is an obstacle label, and P is the total number of obstacles near the ship;
s43, establishing a boundary repulsive field and a circular repulsive field, describing the small-sized barrier as a circular barrier, and establishing the circular barrier repulsive field; for medium or large obstacles, potential fields are established along the boundary, and the collision avoidance potential field between ships is a circular potential field surrounding the whole ship.
4. The intelligent ship formation collision avoidance method based on the path planning and artificial potential field method according to claim 1, wherein the step S5 specifically comprises:
s51, establishing a shipborne sensing information platform by using the electronic chart, the shipborne differential GPS and AIS data, a shipborne camera and a distance sensor, and early warning the ship navigation danger;
and S52, calculating the resultant moment of the composite potential field to the ship, and decomposing the moment into a moment in the ship heading direction and a moment perpendicular to the ship heading direction according to the ship heading.
5. The intelligent ship formation collision avoidance method based on the path planning and artificial potential field method according to claim 4, wherein the calculating of the resultant moment of the composite potential field to the ship specifically comprises:
in the formula,the resultant force of the acting force of the collision avoidance potential field and the obstacle avoidance potential field on the ship;
the moment is decomposed into a moment in the ship heading direction and a moment perpendicular to the ship heading direction according to the ship heading direction, and the moment is specifically as follows:
in the formula, theta is the heading of the ship,andthe transverse and longitudinal acting force of the potential field on the ship.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201910844061.9A CN110471427B (en) | 2019-09-06 | 2019-09-06 | Intelligent ship formation collision avoidance method based on path planning and artificial potential field method |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201910844061.9A CN110471427B (en) | 2019-09-06 | 2019-09-06 | Intelligent ship formation collision avoidance method based on path planning and artificial potential field method |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN110471427A true CN110471427A (en) | 2019-11-19 |
| CN110471427B CN110471427B (en) | 2022-05-10 |
Family
ID=68515136
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201910844061.9A Active CN110471427B (en) | 2019-09-06 | 2019-09-06 | Intelligent ship formation collision avoidance method based on path planning and artificial potential field method |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN110471427B (en) |
Cited By (29)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111142533A (en) * | 2020-01-03 | 2020-05-12 | 大连民族大学 | Multi-potential-field obstacle avoidance method for multiple unmanned surface vessels and multi-USV multi-mode formation obstacle avoidance control method in complex environment |
| CN111208835A (en) * | 2020-02-27 | 2020-05-29 | 大连海事大学 | Ship formation switching control method based on topology reconstruction |
| CN111367285A (en) * | 2020-03-18 | 2020-07-03 | 华东理工大学 | Coordinated formation and path planning method for wheeled mobile trolleys |
| CN111469983A (en) * | 2020-04-20 | 2020-07-31 | 上海船舶研究设计院（中国船舶工业集团公司第六0四研究院） | Intelligent ship berthing and departing method, device and system |
| CN111694355A (en) * | 2020-06-02 | 2020-09-22 | 武汉理工大学 | Ship formation navigation control method, system and storage medium |
| CN111857140A (en) * | 2020-07-07 | 2020-10-30 | 智慧航海（青岛）科技有限公司 | Global path planning method based on channel information |
| CN111964678A (en) * | 2020-07-16 | 2020-11-20 | 武汉长江船舶设计院有限公司 | River channel navigation decision-making method, device and system |
| CN112130562A (en) * | 2020-09-04 | 2020-12-25 | 浙江嘉蓝海洋电子有限公司 | Multi-rolling-window-based artificial potential field unmanned surface vessel obstacle avoidance method |
| CN112650231A (en) * | 2020-12-15 | 2021-04-13 | 哈尔滨工程大学 | Under-actuated ship formation control system for realizing collision and obstacle avoidance |
| CN112650236A (en) * | 2020-12-21 | 2021-04-13 | 武汉理工大学 | Collision avoidance system based on autopilot |
| CN112859871A (en) * | 2021-01-21 | 2021-05-28 | 江苏大学 | Dynamic obstacle avoidance control method based on model prediction |
| CN112925321A (en) * | 2021-01-26 | 2021-06-08 | 武汉理工大学 | Ship path planning method and device based on artificial potential field method and storage medium |
| CN112965496A (en) * | 2021-02-23 | 2021-06-15 | 武汉理工大学 | Path planning method and device based on artificial potential field algorithm and storage medium |
| US20210295708A1 (en) * | 2020-03-18 | 2021-09-23 | Ship And Ocean Industries R&D Center | Vessel collision avoiding method and system based on artificial potential field |
| CN113625723A (en) * | 2021-08-22 | 2021-11-09 | 广东海洋大学 | Unmanned ship dynamic collision avoidance control system |
| CN113935170A (en) * | 2021-10-15 | 2022-01-14 | 大连海事大学 | Environmental potential field modeling method based on real ship electronic chart data |
| CN114019984A (en) * | 2021-12-13 | 2022-02-08 | 大连民族大学 | Unmanned ship and unmanned ship formation online track planning method and system |
| CN114384917A (en) * | 2022-01-14 | 2022-04-22 | 上海大学 | Ship real-time collision avoidance method based on field theory |
| CN114578819A (en) * | 2022-03-01 | 2022-06-03 | 大连海事大学 | Control method for multi-surface ship distributed formation based on artificial potential field method |
| CN114625134A (en) * | 2022-03-08 | 2022-06-14 | 大连海事大学 | Rapid control method for ship navigation situation |
| CN114675651A (en) * | 2022-04-01 | 2022-06-28 | 中电科（宁波）海洋电子研究院有限公司 | Intelligent ship navigation control system and operation control method thereof |
| CN114675652A (en) * | 2022-04-01 | 2022-06-28 | 中电科（宁波）海洋电子研究院有限公司 | Multi-target ship route planning method based on AIS data in dynamic environment |
| CN115407785A (en) * | 2022-11-01 | 2022-11-29 | 中国船舶集团有限公司第七〇七研究所 | Ship collision avoidance control method, device, equipment and storage medium |
| CN115542927A (en) * | 2022-09-16 | 2022-12-30 | 哈尔滨工程大学 | Submarine topography isobath aided navigation path planning method |
| CN115599102A (en) * | 2022-10-31 | 2023-01-13 | 中国舰船研究设计中心（Cn） | Unmanned ship path tracking method based on obstacle avoidance information fusion |
| CN116107319A (en) * | 2023-04-12 | 2023-05-12 | 中国船舶集团有限公司第七一九研究所 | Intelligent ship energy-saving course formation method, system and storage medium |
| CN116612668A (en) * | 2023-06-09 | 2023-08-18 | 大连海事大学 | Automatic collision avoidance algorithm for water area ships in lane navigation based on improved APF |
| CN116859960A (en) * | 2023-07-28 | 2023-10-10 | 哈尔滨理工大学 | Adaptive method for switching and forming multiple UUV formations to avoid obstacle |
| CN115542927B (en) * | 2022-09-16 | 2024-09-24 | 哈尔滨工程大学 | Submarine topography isopachous auxiliary navigation path planning method |
Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101408772A (en) * | 2008-11-21 | 2009-04-15 | 哈尔滨工程大学 | AUV intelligent touching-avoiding apparatus and method |
| CN106272411A (en) * | 2016-08-24 | 2017-01-04 | 上海交通大学 | Multirobot based on gravitation source collaborative carrying hatch cargo method |
| CN107168329A (en) * | 2017-06-20 | 2017-09-15 | 南京长峰航天电子科技有限公司 | Based on the speed of a ship or plane course Collaborative Control formation navigation control method for following pilotage people's method |
| CN107608347A (en) * | 2017-09-04 | 2018-01-19 | 广东华中科技大学工业技术研究院 | A kind of distributed AC servo system unmanned boat cluster surrounds tracking |
| CN107608346A (en) * | 2017-08-30 | 2018-01-19 | 武汉理工大学 | Ship intelligent barrier avoiding method and system based on Artificial Potential Field |
| WO2018026095A1 (en) * | 2016-08-04 | 2018-02-08 | 한국해양과학기술원 | Multiple ships-collision avoidance guiding system using time series graphic display |
| CN109582028A (en) * | 2019-01-22 | 2019-04-05 | 大连海事大学 | A kind of automatic obstacle avoiding sailing boat robot system based on APP terminal monitoring |
-
2019
- 2019-09-06 CN CN201910844061.9A patent/CN110471427B/en active Active
Patent Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101408772A (en) * | 2008-11-21 | 2009-04-15 | 哈尔滨工程大学 | AUV intelligent touching-avoiding apparatus and method |
| WO2018026095A1 (en) * | 2016-08-04 | 2018-02-08 | 한국해양과학기술원 | Multiple ships-collision avoidance guiding system using time series graphic display |
| CN106272411A (en) * | 2016-08-24 | 2017-01-04 | 上海交通大学 | Multirobot based on gravitation source collaborative carrying hatch cargo method |
| CN107168329A (en) * | 2017-06-20 | 2017-09-15 | 南京长峰航天电子科技有限公司 | Based on the speed of a ship or plane course Collaborative Control formation navigation control method for following pilotage people's method |
| CN107608346A (en) * | 2017-08-30 | 2018-01-19 | 武汉理工大学 | Ship intelligent barrier avoiding method and system based on Artificial Potential Field |
| CN107608347A (en) * | 2017-09-04 | 2018-01-19 | 广东华中科技大学工业技术研究院 | A kind of distributed AC servo system unmanned boat cluster surrounds tracking |
| CN109582028A (en) * | 2019-01-22 | 2019-04-05 | 大连海事大学 | A kind of automatic obstacle avoiding sailing boat robot system based on APP terminal monitoring |
Non-Patent Citations (2)
| Title |
|---|
| 0. KHATIB: "REAL-TIME OBSTACLE AVOIDANCE FOR M.ANIPULATORS AND MQUIEE ROBOTS", 《1985 IEEE INTERNATIONAL CONFERENCE ON ROBOTICS AND AUTOMATION》 * |
| HAICHUAN ZHAI 等: "Formation Control of Multiple Robot Fishes Based on Artificial Potential Field and Leader-follower Framework", 《2013 25TH CHINESE CONTROL AND DECISION CONFERENCE (CCDC)》 * |
Cited By (45)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111142533B (en) * | 2020-01-03 | 2023-08-15 | 大连民族大学 | Multi-potential field obstacle avoidance method for multiple unmanned surface vessels and multi-USV multi-mode formation obstacle avoidance control method in complex environment |
| CN111142533A (en) * | 2020-01-03 | 2020-05-12 | 大连民族大学 | Multi-potential-field obstacle avoidance method for multiple unmanned surface vessels and multi-USV multi-mode formation obstacle avoidance control method in complex environment |
| CN111208835A (en) * | 2020-02-27 | 2020-05-29 | 大连海事大学 | Ship formation switching control method based on topology reconstruction |
| CN111208835B (en) * | 2020-02-27 | 2023-08-01 | 大连海事大学 | Ship formation switching control method based on topology reconstruction |
| US20210295708A1 (en) * | 2020-03-18 | 2021-09-23 | Ship And Ocean Industries R&D Center | Vessel collision avoiding method and system based on artificial potential field |
| CN111367285A (en) * | 2020-03-18 | 2020-07-03 | 华东理工大学 | Coordinated formation and path planning method for wheeled mobile trolleys |
| TWI756647B (en) * | 2020-03-18 | 2022-03-01 | 財團法人船舶暨海洋產業研發中心 | A vessel collision avoiding method and system based on artificial potential field |
| US11676494B2 (en) * | 2020-03-18 | 2023-06-13 | Ship And Ocean Industries R&D Center | Vessel collision avoiding method and system based on artificial potential field |
| CN113495556A (en) * | 2020-03-18 | 2021-10-12 | 财团法人船舶暨海洋产业研发中心 | Ship collision avoidance method and system based on artificial potential field method |
| CN111469983A (en) * | 2020-04-20 | 2020-07-31 | 上海船舶研究设计院（中国船舶工业集团公司第六0四研究院） | Intelligent ship berthing and departing method, device and system |
| CN111469983B (en) * | 2020-04-20 | 2022-06-14 | 上海船舶研究设计院（中国船舶工业集团公司第六0四研究院） | Intelligent ship berthing and departing method, device and system |
| CN111694355A (en) * | 2020-06-02 | 2020-09-22 | 武汉理工大学 | Ship formation navigation control method, system and storage medium |
| CN111857140A (en) * | 2020-07-07 | 2020-10-30 | 智慧航海（青岛）科技有限公司 | Global path planning method based on channel information |
| CN111857140B (en) * | 2020-07-07 | 2023-11-17 | 智慧航海（青岛）科技有限公司 | Global path planning method based on channel information |
| CN111964678A (en) * | 2020-07-16 | 2020-11-20 | 武汉长江船舶设计院有限公司 | River channel navigation decision-making method, device and system |
| CN112130562A (en) * | 2020-09-04 | 2020-12-25 | 浙江嘉蓝海洋电子有限公司 | Multi-rolling-window-based artificial potential field unmanned surface vessel obstacle avoidance method |
| CN112650231A (en) * | 2020-12-15 | 2021-04-13 | 哈尔滨工程大学 | Under-actuated ship formation control system for realizing collision and obstacle avoidance |
| CN112650236A (en) * | 2020-12-21 | 2021-04-13 | 武汉理工大学 | Collision avoidance system based on autopilot |
| CN112859871A (en) * | 2021-01-21 | 2021-05-28 | 江苏大学 | Dynamic obstacle avoidance control method based on model prediction |
| CN112859871B (en) * | 2021-01-21 | 2022-12-16 | 江苏大学 | Dynamic obstacle avoidance control method based on model prediction |
| CN112925321A (en) * | 2021-01-26 | 2021-06-08 | 武汉理工大学 | Ship path planning method and device based on artificial potential field method and storage medium |
| CN112965496A (en) * | 2021-02-23 | 2021-06-15 | 武汉理工大学 | Path planning method and device based on artificial potential field algorithm and storage medium |
| CN113625723A (en) * | 2021-08-22 | 2021-11-09 | 广东海洋大学 | Unmanned ship dynamic collision avoidance control system |
| CN113935170A (en) * | 2021-10-15 | 2022-01-14 | 大连海事大学 | Environmental potential field modeling method based on real ship electronic chart data |
| CN113935170B (en) * | 2021-10-15 | 2024-05-28 | 大连海事大学 | Environmental potential field modeling method based on real ship electronic chart data |
| CN114019984B (en) * | 2021-12-13 | 2024-07-12 | 大连民族大学 | Unmanned ship and unmanned ship formation online track planning method and system |
| CN114019984A (en) * | 2021-12-13 | 2022-02-08 | 大连民族大学 | Unmanned ship and unmanned ship formation online track planning method and system |
| CN114384917A (en) * | 2022-01-14 | 2022-04-22 | 上海大学 | Ship real-time collision avoidance method based on field theory |
| CN114384917B (en) * | 2022-01-14 | 2023-11-17 | 上海大学 | Real-time ship collision prevention method based on field theory |
| CN114578819A (en) * | 2022-03-01 | 2022-06-03 | 大连海事大学 | Control method for multi-surface ship distributed formation based on artificial potential field method |
| CN114578819B (en) * | 2022-03-01 | 2024-05-17 | 大连海事大学 | Control method for distributed formation of multi-surface ship based on artificial potential field method |
| CN114625134A (en) * | 2022-03-08 | 2022-06-14 | 大连海事大学 | Rapid control method for ship navigation situation |
| CN114625134B (en) * | 2022-03-08 | 2024-04-16 | 大连海事大学 | Rapid control method for ship navigation situation |
| CN114675652A (en) * | 2022-04-01 | 2022-06-28 | 中电科（宁波）海洋电子研究院有限公司 | Multi-target ship route planning method based on AIS data in dynamic environment |
| CN114675651A (en) * | 2022-04-01 | 2022-06-28 | 中电科（宁波）海洋电子研究院有限公司 | Intelligent ship navigation control system and operation control method thereof |
| CN115542927A (en) * | 2022-09-16 | 2022-12-30 | 哈尔滨工程大学 | Submarine topography isobath aided navigation path planning method |
| CN115542927B (en) * | 2022-09-16 | 2024-09-24 | 哈尔滨工程大学 | Submarine topography isopachous auxiliary navigation path planning method |
| CN115599102B (en) * | 2022-10-31 | 2024-04-30 | 中国舰船研究设计中心 | Unmanned ship path tracking method based on obstacle avoidance information fusion |
| CN115599102A (en) * | 2022-10-31 | 2023-01-13 | 中国舰船研究设计中心（Cn） | Unmanned ship path tracking method based on obstacle avoidance information fusion |
| CN115407785A (en) * | 2022-11-01 | 2022-11-29 | 中国船舶集团有限公司第七〇七研究所 | Ship collision avoidance control method, device, equipment and storage medium |
| CN116107319A (en) * | 2023-04-12 | 2023-05-12 | 中国船舶集团有限公司第七一九研究所 | Intelligent ship energy-saving course formation method, system and storage medium |
| CN116612668B (en) * | 2023-06-09 | 2024-02-06 | 大连海事大学 | Automatic collision avoidance algorithm for water area ships in lane navigation based on improved APF |
| CN116612668A (en) * | 2023-06-09 | 2023-08-18 | 大连海事大学 | Automatic collision avoidance algorithm for water area ships in lane navigation based on improved APF |
| CN116859960A (en) * | 2023-07-28 | 2023-10-10 | 哈尔滨理工大学 | Adaptive method for switching and forming multiple UUV formations to avoid obstacle |
| CN116859960B (en) * | 2023-07-28 | 2024-02-20 | 哈尔滨理工大学 | Adaptive method for switching and forming multiple UUV formations to avoid obstacle |
Also Published As
| Publication number | Publication date |
|---|---|
| CN110471427B (en) | 2022-05-10 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN110471427B (en) | Intelligent ship formation collision avoidance method based on path planning and artificial potential field method | |
| Huang et al. | Generalized velocity obstacle algorithm for preventing ship collisions at sea | |
| Zhang et al. | Collision-avoidance navigation systems for Maritime Autonomous Surface Ships: A state of the art survey | |
| CN107329477B (en) | Unmanned ship navigation and automatic driving equipment and method thereof | |
| Larson et al. | Advances in autonomous obstacle avoidance for unmanned surface vehicles | |
| CN107608346A (en) | Ship intelligent barrier avoiding method and system based on Artificial Potential Field | |
| KR102099699B1 (en) | Device and method avoiding collision of autonomous surface vehicle considering uncertainty of trajectory prediction | |
| CN110727274B (en) | Unmanned ship system-based formation control method with collision avoidance and connectivity maintenance functions | |
| CA3067576A1 (en) | Cooperative autonomous navigation systems and methods for multiple unmanned surface vehicles considering communication | |
| US8849483B2 (en) | Target trailing with safe navigation with colregs for maritime autonomous surface vehicles | |
| Qiao et al. | Survey of deep learning for autonomous surface vehicles in marine environments | |
| Pinto et al. | An autonomous surface-aerial marsupial robotic team for riverine environmental monitoring: Benefiting from coordinated aerial, underwater, and surface level perception | |
| CN111966106B (en) | Intelligent ship formation berthing method based on ship-ship cooperation | |
| AU2021205099B2 (en) | Systems and associated methods for generating navigation charts and navigable routes in an open environment | |
| Sun et al. | Collision avoidance of podded propulsion unmanned surface vehicle with COLREGs compliance and its modeling and identification | |
| Han et al. | A COLREGs-compliant guidance strategy for an underactuated unmanned surface vehicle combining potential field with grid map | |
| Park et al. | Probabilistic quantification of ship collision risk considering trajectory uncertainties | |
| CN114088094A (en) | Intelligent route planning method and system for unmanned ship | |
| Zhao et al. | Decision-making for the autonomous navigation of USVs based on deep reinforcement learning under IALA maritime buoyage system | |
| Kim et al. | A numerical and experimental study on the obstacle collision avoidance system using a 2D LiDAR sensor for an autonomous surface vehicle | |
| Wu et al. | An overview of developments and challenges for unmanned surface vehicle autonomous berthing | |
| Wang et al. | Roboat III: An autonomous surface vessel for urban transportation | |
| Liu et al. | Development of USV autonomy: Architecture, implementation and sea trials | |
| Kim et al. | Field experiment of autonomous ship navigation in canal and surrounding nearshore environments | |
| Wen et al. | Online heuristically planning for relative optimal paths using a stochastic algorithm for USVs |
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 |