Ship collision avoidance judgment method based on direct navigation ship dynamic potential energy field model, program product, electronic equipment and storage medium
Through the method based on the dynamic potential energy field model of the direct ship, the collision problem caused by wrong judgment in cross-engagement situations is solved, and automatic avoidance judgment with the lowest cost of avoidance is achieved, reducing the risk of maritime traffic accidents.
Patent Information
- Application Number
- CN202410639217.0
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-05-22
- Publication Date
- 2024-12-06
AI Technical Summary
In complex waters, ships have frequent collision accidents in cross-engage situations, mainly due to the wrong judgment of the captain. The existing technology lacks an automatic collision avoidance judgment method that can avoid the least cost in the era of avoidance.
Using the dynamic potential energy field model of the direct ship, by screening and preprocessing AIS data, an asymmetric Gaussian function model is constructed, the cost of the ship during evasion is calculated, the concession ship and the concession ship are determined, and whether avoidance measures are needed are required to reduce the cost of avoidance. .
It realizes objective and quantitative judgment of avoidance costs, coordinates ship avoidance actions, reduces ship costs when making way, and assists the captain in making decisions and reduces maritime traffic collision accidents.
Smart Images

Figure CN119091689A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of maritime ship navigation, and in particular to a ship collision avoidance determination method based on a direct-navigation ship dynamic potential energy field model, a program product, an electronic device and a storage medium. Background Art
[0003] The application of the traffic separation system reduces the probability of collision accidents between ships in encounter situations, but ship collision accidents still often occur in cross-encounter situations, especially in complex waters, such as warning areas and waters with many fishing boats. In addition, according to investigations, human factors still dominate maritime casualties and are the decisive factor in the occurrence of accidents. Among them, "misjudgment" is the key issue of human factors, which is mainly manifested in the captain's misjudgment of whether there is a responsibility to give way. For example, on December 22, 2022, the "Jinwangling" ship, as a way-giving ship in a cross-encounter situation, failed to give way to the "Lu Rishanyu 61027" ship in a timely manner in accordance with the "Collision Prevention Regulations". At the same time, the "Lu Rishanyu 61027" ship, as a direct-travel ship, changed its course several times and significantly before the collision, and failed to fulfill its obligation to maintain direction and speed, which led to the occurrence of a collision accident.
[0004] At present, the judgment of the give-way vessel is mostly based on the traditional method of the Collision Regulations. It is undeniable that it can determine the give-way vessel from a qualitative perspective, but it is still somewhat lacking in objective quantitative aspects. The cost of the give-way vessel stipulated in the regulations when giving way may be greater than the cost of the direct-course vessel when giving way, and there are still many crew members who do not necessarily follow the Collision Regulations. There is a lack of a judgment method that can automatically avoid collisions with the minimum avoidance cost. Therefore, the present invention proposes a method, program product, electronic device and storage medium that can objectively judge the give-way vessel in a crossing encounter situation. Summary of the invention
[0005] The purpose of the present invention is to overcome the defects of the above-mentioned prior art and to provide a ship collision avoidance determination method, program product, electronic device and storage medium based on the dynamic potential energy field model of a straight-line ship.
[0006] The purpose of the present invention can be achieved by the following technical solutions:
[0007] The present invention provides a ship collision avoidance determination method based on a direct-navigation ship dynamic potential field model, comprising the following steps:
[0008] S1. Filter out AIS data information of ships in the research waters, pre-process the AIS data information, and establish a rectangular coordinate system;
[0009] S2. Assume that ship A is the giving way ship and ship B is the given way ship, and use asymmetric Gaussian function to construct a dynamic potential energy field model of the given way ship from the perspective of the giving way ship; re-assume the giving way ship and the given way ship, change the perspective, take ship B as the giving way ship and ship A as the given way ship, and use asymmetric Gaussian function to construct a dynamic potential energy field model of the given way ship from the perspective of the giving way ship;
[0010] S3. Construct a weighted multi-objective cost function, calculate the costs that ship A and ship B need to pay when giving way, re-determine the ship with the smaller giving way cost as the giving way ship, and the other ship as the given way ship. Determine whether the giving way ship needs to take avoidance measures based on whether it will infringe the potential energy field of the given way ship.
[0011] The preprocessing includes: deleting data with missing ship type information, repeated data and ship data causing interference, and using a cubic spline interpolation method to interpolate the AIS data of each ship in the research waters every day at specific time intervals.
[0012] The shape of the potential energy field is an asymmetric ellipse.
[0013] The range of the potential energy field is related to the state of the ship, which includes: speed, length, width and displacement.
[0014] The step S2 specifically includes:
[0015] S21. Construct the power, resistance, repulsion and attraction of the ship being given way;
[0016] S22, obtaining the angle of the vessel being given way from the AIS data information, and converting it into radians;
[0017] S23, decomposing the power, resistance, repulsion and gravity into a coordinate system established with the heading of the ship being given way as the coordinate axis, as the influencing factors of the three-dimensional asymmetric Gaussian function;
[0018] S24, substituting the impact factor into an expression of an asymmetric Gaussian function to obtain a three-dimensional asymmetric Gaussian function distribution diagram;
[0019] S25. According to the AIS data information of the ship in the crossing encounter situation, the actual minimum distance when the ship is avoiding is obtained, and the parameters k and λ in the non-contact force of the ship being given way are used to make the range of the potential energy field consistent with the actual range data of the water area, so as to obtain the potential energy field of the ship being given way.
[0020] The potential energy field is verified using the least squares method.
[0021] The weighted multi-objective cost function includes the following evaluation index functions: path smoothness cost function, speed loss cost function and path deviation cost function. The weights of each evaluation index are obtained by the hierarchical analysis method to determine the weighted multi-objective cost function, which is expressed by the following formula:
[0022] minf(i)=w ru f ru (i)+w v f v (i)+w s f s (i);
[0023] Among them, f(i) is the weighted multi-objective cost function, f ru (i) is the path smoothness cost function, f v (i) is the speed loss cost function, f s (i) is the path deviation cost function, w ru 、w v 、w s are weight coefficients respectively.
[0024] In a second aspect, the present invention provides a computer program product, comprising a computer program / instruction, which implements the steps of any of the above-mentioned methods when executed by a processor.
[0025] In a third aspect, the present invention provides an electronic device, comprising a memory, a processor, and a program stored in the memory, wherein the processor implements the steps of any of the above-mentioned methods when executing the program.
[0026] In a fourth aspect, the present invention provides a storage medium having a program stored thereon, wherein the program, when executed, implements the steps of any of the above-mentioned methods.
[0027] Compared with the prior art, the present invention has the following beneficial effects:
[0028] 1. The present invention proposes a potential energy field model for objectively judging whether a ship is giving way, so as to objectively and quantitatively determine the avoidance cost. When the overall avoidance cost is minimized, it can not only coordinate the avoidance actions between ships, but also reduce the cost of ships when giving way.
[0029] 2. By converting the method provided by the present invention into the intelligent operation of an algorithm program, the autonomous avoidance plan of the unmanned ship can be realized, and the captain can also be assisted in making avoidance decisions, thereby effectively reducing maritime traffic collision accidents caused by "misjudgment" and further ensuring navigation safety. BRIEF DESCRIPTION OF THE DRAWINGS
[0030] Figure 1 It is a schematic diagram of the steps of the present invention;
[0031] Figure 2 This is a schematic diagram of the Yuanyuansha warning area;
[0032] Figure 3 A case diagram for screening out cross-encounter situations;
[0033] Figure 4 Schematic diagram constructed for the potential field;
[0034] Figure 5 It is a schematic diagram of the decomposition and synthesis of forces;
[0035] Figure 6 Provide three-dimensional and top-down views of the hazardous area;
[0036] Figure 7 It is a contour diagram of the danger zone;
[0037] Figure 8 A schematic diagram of the avoidance path. DETAILED DESCRIPTION
[0038] The present invention is described in detail below in conjunction with the accompanying drawings and specific embodiments. This embodiment is implemented based on the technical solution of the present invention, and provides a detailed implementation method and specific operation process, but the protection scope of the present invention is not limited to the following embodiments.
[0039] This embodiment provides a ship collision avoidance method based on a direct-navigation ship dynamic potential field model. Figure 1 As shown, the following steps are included:
[0040] S1. Filter out the AIS data information of the study waters, pre-process the data, and establish a rectangular coordinate system.
[0041] The warning area waters to be studied are delineated on the electronic nautical chart. Generally, they are irregular polygonal shapes containing multiple vertices. The AIS data of the warning area are filtered out according to the waters range framed by the latitude and longitude information of these vertices. The vertex relatively close to the lower left corner of the warning area is selected as the reference point. To facilitate subsequent angle calculations, the x-axis is rotated 90° to establish a rectangular coordinate system with the y-axis as the true north direction.
[0042] Specifically, the Yuanyuansha warning area is one of the key waters where large ships cross and meet in the Shanghai Port waterway. As the intersection of the north and south channels of the South Waterway, it has the distinct characteristics of high ship density, complex navigation situation, and coexistence of crossing and crossing. Therefore, the research waters of this embodiment select the Yuanyuansha warning area. The nautical chart of this water area is as follows: Figure 2 shown.
[0043] AIS data preprocessing, specifically deleting data with missing ship type information, duplicate data, and ships that cause interference such as tugboats and pilot boats, uses the cubic spline interpolation method to interpolate the AIS data of each ship in the study waters every day at intervals of 15 seconds. It is worth noting that if a ship passes through this area multiple times a day, there will be data redundancy if the interpolation method is used alone, that is, a piece of data will be automatically interpolated between the position of the last exit from the area and the position of the current entry into the area, which is inconsistent with the actual situation. Therefore, the interpolation method is changed to mark the state of entering the area. If there is no AIS data for more than 10 minutes between a ship, it will be marked as a state, and interpolation will be performed according to the state to avoid the existence of false data.
[0044] like Figure 3 As shown, this is the time trajectory diagram of the intersection situation of the two cargo ships in the Yuanyuansha warning area. The dark blue is the starting time of the situation, and the light blue is the end time of the avoidance.
[0045] S2. Constructing a dynamic potential energy field model of the given way ship (in this embodiment, the given way ship is a straight-route ship) from the perspective of the giving way ship.
[0046] The potential energy field expresses the interaction between the ship and the surrounding objects in time and space as the psychological pressure on the ship driver from the perspective of physics and psychology. This force is a non-contact virtual force, and its magnitude is related to the properties and state of the ship itself. In a cross-encounter situation, first assume that ship A is a way-giving ship, and construct the potential energy field of the ship B (in this embodiment, the ship is a straight-line ship, and the two have the same meaning) from the perspective of ship A. Then, change the perspective, assume that ship B is a way-giving ship, and construct the potential energy field of the ship A from the perspective of ship B. From the perspective of the way-giving ship, if it sails into the potential energy field of the straight-line ship, the psychological pressure it bears is extremely great, and the closer to the center of the potential energy field, the greater the pressure. Therefore, the potential energy field of a straight-navigating ship is an inviolable ship danger field. Since the danger around a straight-navigating ship is not evenly distributed, the closer to the obstacle, the greater the danger, the larger the range of the field, and the attention to the ship's sailing direction will be higher than that to the rear, and the danger will extend to the speed direction in front. Therefore, the shape of the field is an asymmetric ellipse, and its range is related to the state of the ship, such as speed, length and width, displacement, etc.
[0047] Specifically, the construction of the dynamic potential field model of the direct-navigation ship from the perspective of the give-way ship includes the following five aspects:
[0048] 1. The structure of force
[0049] In a cross-encounter situation, we first assume that ship A is a give-way ship, and construct a potential energy field model of the straight-line ship B from the perspective of the give-way ship A. Since the scales of ships at sea vary greatly, the psychological pressure they cause is different. Therefore, considering the ship's own properties such as length and width, the decomposed forces in the four directions of the ship's coordinate system, including power, resistance, repulsion and gravity, are used as the influencing factors of the three-dimensional asymmetric Gaussian function to construct the potential energy field of the straight-line ship.
[0050] Among them, since gravity is universal, any object with mass will be affected by a certain amount of gravity. Therefore, the gravity is used as the ship's gravity, and the direction points to the direction of the give-way ship. The expression is: in k is the parameter adjustment coefficient, and its size is determined by the actual minimum encounter distance between the two ships. Since an object will generate centrifugal force when it makes a curved motion around another object, similarly, when the give-way ship makes a curved motion around the straight-line ship, it uses its centrifugal force as a repulsive force, and its direction points to the opposite direction of the give-way ship. The expression is: According to Newton's second law as the expression of power, the direction points to the direction of the ship's forward movement, and the expression is F d =m1a1, where Due to the psychological constraints of obeying traffic rules and avoiding collisions, the driver has an insatiable desire for the maneuverability of the ship. This psychological constraint is expressed as resistance, expressed as F z =m1a1(V / v1) λ , where V = 1, the meaning of the λ parameter is the same as k, and is reflected as an exponent in the resistance formula.
[0051] 2. Angle determination
[0052] Then, based on the expressions of the non-contact forces of each part, the potential field model of the ship being given way is described, as follows: Figure 4 As shown. TC represents the heading of the ship being given way. The angle value can be directly obtained from the AIS data. The angle system is converted into radians to facilitate subsequent calculations. TB represents the true position of the particle point of the giving way ship relative to the ship being given way. The formula is: % represents remainder; TB minus TC obtains the relative position TR of the particle of the giving way ship relative to the course of the given way ship. The same method of adding 4π and then taking the remainder is adopted to adapt to a variety of different orientation situations. The relative position is α=(TB-TC+4π)%2π.
[0053] 3. Decomposition and synthesis of forces
[0054] According to the obtained α, the forces of each ship are decomposed into the coordinate system established with the course of the ship being given way as the coordinate axis, as follows: Figure 3As shown, it is necessary to consider that if the giving way ship particle is located in a different orientation of the coordinate system of the given way ship, the decomposition formula is also different. Therefore, it is necessary to judge the size of α: if the giving way ship particle is located in the first quadrant of the given way ship, that is, Then F f =F w cosα, F r =F w cos(π-α), F b =F c cosα, F l =F c cosα; if the give-way ship particle is located in the fourth quadrant of own ship, that is Then F f =F c cos(π-α), F r =F w sin(π-α), F b =F w cos(π-α), F l =F c sin(π-α); if the particle of the giving way ship is located in the third quadrant of the given way ship, that is, Then F f =F c cos(α-π), F r =F c sin(α-π), F b =F w cos(α-π), F l =F w sin(α-π); if the give-way ship particle is located in the second quadrant of own ship, that is Then F f =F w cos(2π-α), F r =F c sin(2π-α), F b =F c cos(2π-α), F l =F w sin(2π-α).
[0055] Furthermore, the forces on the four axes are synthesized, and the force on the f axis is σ f =F f +F d , the force on the b-axis is σ b =F b +F z , the force on the l-axis is σ l =F l , the force on the r axis is σ r =Fr ,like Figure 5 shown.
[0056] 4. Asymmetric Gaussian function graph
[0057] The impact factor σ i Substitute (i=f,b,l,r) into the expression of the asymmetric Gaussian function:
[0058]
[0059] in, (i,j)=((f,l),(f,r),(b,r),(b,l)), (t-t1)=(x-x1,y-y1), thus we get a three-dimensional asymmetric Gaussian function distribution diagram, which is the prototype of the potential energy field.
[0060] 5. Determination of boundaries
[0061] According to the AIS information of the ship in the crossing encounter situation, the actual distance when the ship is avoiding is obtained, and the parameters k and λ in the non-contact force of the ship being given way are adjusted to make the range of the potential energy field of the ship being given way consistent with the actual range data of the water area, and obtain the constructed potential energy field model. Finally, the least squares method is used for verification to obtain the ship collision danger field. Similarly, the perspective is transformed. Assuming that B is the giving way ship, the ship collision danger field of the given way ship A from the perspective of the giving way ship B is constructed. Its physical meaning is that if the giving way ship passes through the danger field of the given way ship during the avoidance process, there is a risk of collision between the two ships, and as shown by the three-dimensional graph and contour lines, the closer the two ships are to the middle, the greater the risk of collision, as shown in Figure 6 , 7 As shown, Figure 6 (a) is a three-dimensional diagram of the danger zone. Figure 6 (b) is a top view of the danger zone.
[0062] S3. Construct a cost function to calculate the cost that the giving-way ship needs to pay when giving way, and the ship with the smallest giving-way cost is the giving-way ship. Specifically: in the crossing encounter situation, assume that ship A is the giving-way ship, construct the potential field of the given-way ship B from the perspective of the giving-way ship A, and thus determine its avoidance cost; change the perspective, assume that ship B is the giving-way ship, and calculate the avoidance cost of ship B in the same way, and comprehensively consider and select the avoiding ship with the minimum cost value as the giving-way ship.
[0063] According to the Collision Avoidance Rules, the cost of giving way to a ship is not necessarily the lowest. The ship giving way may be able to avoid danger by turning its rudder slightly. To this end, the present invention designs a weighted multi-objective cost function to evaluate candidate avoidance paths, comprehensively considering the path driving comfort and the global path following ability. The navigation comfort is expressed as the path smoothness cost function (rudder loss cost function) f ruAnd the speed loss cost function f v , the global path following ability is expressed as the path deviation cost function f s , the weights of each evaluation index are obtained through the hierarchical analysis method, and the weighted multi-objective cost function is expressed as:
[0064] minf(i)=w ru f ru (i)+w v f v (i)+w s f s (i);
[0065] Where f(i) represents the total cost function of the i-th candidate path, w ru 、w v and w s are the weight coefficients of each cost function respectively.
[0066] The cost function that defines the path smoothness is the cumulative value of the heading change angle over time, specifically:
[0067] Define the speed change in the track Where v t+1 and v t are the speeds at time t+1 and time t respectively;
[0068] Define the path deviation cost function as Among them l z is the length of the actual navigation path, l j is the length of the planned navigation path.
[0069] Since safety is the primary consideration when ships avoid collision, the giving way ship must not infringe the danger zone of the given way ship when avoiding. If it infringes the danger zone of the given way ship, there will be a risk of collision. Considering that the straight-line ship poses a threat to the planned route of the giving way ship, the giving way ship should take efficient avoidance measures. Therefore, the path cost of the giving way ship particle avoiding along the edge of the straight-line ship's danger zone is compared, such as Figure 8 As shown in (a), when ship A is the give-way ship, the avoidance path with the minimum cost among s1 and s2 is calculated and the perspective is changed, as shown in Figure 8 As shown in (b), when ship B is the give-way ship, the avoidance path with the lowest cost among s3 and s4 is calculated. After comprehensive consideration, the ship with the lowest avoidance cost is determined as the give-way ship, which not only reduces the cost of giving way, but also avoids uncoordinated avoidance between ships.
[0070] This embodiment provides a computer program product, including a computer program / instruction, which implements the steps of the method mentioned in the above embodiment when the computer program / instruction is executed by a processor.
[0071] This embodiment provides an electronic device, including a memory, a processor, and a program stored in the memory, and when the processor executes the program, the steps of the method mentioned in the above embodiment are implemented.
[0072] This embodiment provides a storage medium on which a program is stored, and when the program is executed, the steps of the method mentioned in the above embodiment are implemented. The storage medium includes: a USB flash drive, a mobile hard disk, a read-only memory (ROM), a random access memory (RAM), a magnetic disk or an optical disk, and other media that can store program codes.
[0073] The preferred specific embodiments of the present invention are described in detail above. It should be understood that a person skilled in the art can make many modifications and changes based on the concept of the present invention without creative work. Therefore, any technical solution that can be obtained by a person skilled in the art through logical analysis, reasoning or limited experiments based on the concept of the present invention on the basis of the prior art should be within the scope of protection determined by the claims.
Claims
1. A ship collision avoidance determination method based on a direct-navigation ship dynamic potential field model, characterized in that: The following steps are involved: S1. Filter out AIS data information of ships in the research waters, pre-process the AIS data information, and establish a rectangular coordinate system; S2. Assume that ship A is the giving way ship and ship B is the given way ship, and use asymmetric Gaussian function to construct a dynamic potential energy field model of the given way ship from the perspective of the giving way ship; re-assume the giving way ship and the given way ship, change the perspective, take ship B as the giving way ship and ship A as the given way ship, and use asymmetric Gaussian function to construct a dynamic potential energy field model of the given way ship from the perspective of the giving way ship; S3. Construct a weighted multi-objective cost function, calculate the costs that ship A and ship B need to pay when giving way, re-determine the ship with the smaller giving way cost as the giving way ship, and the other ship as the given way ship. Determine whether the giving way ship needs to take avoidance measures based on whether it will infringe the potential energy field of the given way ship.
2. A ship collision avoidance determination method based on a direct-navigation ship dynamic potential field model according to claim 1, characterized in that: The preprocessing includes: deleting data with missing ship type information, repeated data and ship data causing interference, and using a cubic spline interpolation method to interpolate the AIS data of each ship in the research waters every day at specific time intervals.
3. The ship collision avoidance determination method based on the direct-navigation ship dynamic potential field model according to claim 1 is characterized in that: The shape of the potential energy field is an asymmetric ellipse.
4. A ship collision avoidance determination method based on a direct-navigation ship dynamic potential field model according to claim 3, characterized in that: The range of the potential energy field is related to the state of the ship, which includes: speed, length, width and displacement.
5. The ship collision avoidance determination method based on the direct-navigation ship dynamic potential field model according to claim 1 is characterized in that: The step S2 specifically includes: S21. Construct the power, resistance, repulsion and attraction of the ship being given way; S22, obtaining the angle of the vessel being given way from the AIS data information, and converting it into radians; S23, decomposing the power, resistance, repulsion and gravity into a coordinate system established with the heading of the ship being given way as the coordinate axis, as the influencing factors of the three-dimensional asymmetric Gaussian function; S24, substituting the impact factor into an expression of an asymmetric Gaussian function to obtain a three-dimensional asymmetric Gaussian function distribution diagram; S25. According to the AIS data information of the ship in the crossing encounter situation, the actual distance when the ship is avoiding is obtained, and the parameters k and λ in the non-contact force of the ship being given way are used to make the range of the potential energy field consistent with the actual range data of the water area, so as to obtain the potential energy field of the ship being given way.
6. A ship collision avoidance determination method based on a direct-navigation ship dynamic potential field model according to claim 5, characterized in that: The potential energy field is verified using the least squares method.
7. The method for ship collision avoidance based on the dynamic potential energy field model of a straight-line ship according to claim 1 is characterized in that: The weighted multi-objective cost function includes the following evaluation index functions: path smoothness cost function, speed loss cost function and path deviation cost function. The weights of each evaluation index are obtained by the hierarchical analysis method to determine the weighted multi-objective cost function, which is expressed by the following formula: min f(i)=w ru f ru (i)+w v f v (i)+w s f s (i); Among them, f(i) is the weighted multi-objective cost function, f ru (i) is the path smoothness cost function, f v (i) is the speed loss cost function, f s (i) is the path deviation cost function, w ru 、w v 、w s are weight coefficients respectively.
8. A computer program product comprising a computer program / instructions, characterized in that When the computer program / instructions are executed by a processor, the steps of the method according to any one of claims 1 to 7 are implemented.
9. An electronic device comprising a memory, a processor, and a program stored in the memory, characterized in that: When the processor executes the program, the steps of the method according to any one of claims 1 to 7 are implemented.
10. A storage medium having a program stored thereon, characterized in that: When the program is executed, the steps of the method according to any one of claims 1 to 7 are implemented.
Citation Information
Cited By
Unmanned aerial vehicle traffic control method fused with dynamic obstacle avoidance
CN120295204A
