A method for automatic collision avoidance route planning for ship navigation
By obtaining the movement characteristics of obstacle targets and calculating the regular movement characteristics, dividing obstacle categories and building a moving model, the problem of inaccurate handling of dynamic obstacles in the prior art is solved, and the safety of ship navigation and the reliability of route planning are improved.
Patent Information
- Application Number
- CN202411356153.X
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-09-27
- Publication Date
- 2024-12-06
- Estimated Expiration
- 2044-09-27
AI Technical Summary
The existing automatic collision avoidance route planning method for ship navigation is difficult to accurately deal with irregularly moving dynamic obstacles in the ocean, resulting in inaccurate route planning and collision warning.
By continuously obtaining the movement characteristics of the obstacle target, calculating its regular movement characteristic parameters, dividing explicit and implicit regular movement categories, building a moving model of the obstacle target and the hull, simulating the intersection situation to generate a recommended route, and adapting to the hidden offset area to improve the accuracy of collision warning and route planning.
It improves the safety of ship navigation and the accuracy of collision warning, and enhances the reliability of route planning, especially when facing dynamic obstacles.
Smart Images

Figure CN118882658B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of intelligent control technology, and in particular to an automatic collision avoidance route planning method for ship navigation. Background Art
[0002] Ship collision avoidance is a crucial technology in navigation and an important part of navigation safety. It is directly related to the safety of ships, cargo and personnel. In the ocean, ship navigation is affected by many factors, such as weather, currents, tides, waterways, etc. At the same time, ship communication and navigation equipment may also fail, making it difficult for crew members to accurately judge the position and dynamics of surrounding ships. These factors increase the risk of ship collision accidents. Therefore, it is crucial for crew members to master the skills and methods of ship collision avoidance.
[0003] Chinese patent application publication number: CN111240334A, discloses a method and model for automatic collision avoidance route planning for ship navigation, including collecting information on obstacles, starting points, and destination points. According to the collected information, in the process of route planning, when encountering an obstacle, first calculate the minimum angle line that the ship can avoid the obstacle, that is, the line with the largest angle with the test line, and directly record the two possible driving paths on the left and right sides of the obstacle; then, when bypassing the obstacle, test each vertex of the obstacle with the middle waypoint, calculate and select the lines with the largest angles with the test line on the left and right sides respectively, and after comparing the sizes of the two, take the line with the smaller angle as the alternative segment to determine the only bypassable route.
[0004] However, there are still the following problems in the prior art:
[0005] When planning automatic collision avoidance routes for ship navigation, most of the time only static obstacles are targeted. However, in reality, there are many dynamic obstacles with irregular movement, such as floating objects and marine life, in the ocean, which leads to inaccurate route planning and collision warnings. Summary of the invention
[0006] To this end, the present invention provides an automatic collision avoidance route planning method for ship navigation, which is used to solve the problem that in actual situations, there are many irregularly moving dynamic obstacles such as floating objects and marine life in the ocean, which lead to inaccurate route planning and collision warning.
[0007] To achieve the above object, the present invention provides an automatic collision avoidance route planning method for ship navigation, which comprises:
[0008] Step S1, continuously acquiring the movement characteristics of obstacle targets in the target area, and determining the movement vector of each obstacle target at different times, wherein the movement characteristics include coordinates, movement speed, and movement direction;
[0009] Step S2, calculating a regular movement characteristic parameter for the obstacle target based on the relative distance difference between the obstacle target and the main movement vector at different times and the movement vector angle difference, wherein the main movement vector is determined based on the movement vector of the obstacle target within a predetermined time;
[0010] Step S3, determining the regular movement category of each obstacle target based on the regular movement feature representation parameters, including the explicit regular movement category and the implicit regular movement category;
[0011] Step S4, generating a recommended route for the obstacle target according to the regular movement category of the obstacle target, including:
[0012] Construct obstacle target movement model and hull movement model and simulate movement situation, determine whether there is a collision risk based on the intersection of obstacle target movement model and hull movement model, and generate a recommended route;
[0013] Or, construct an implicit offset area for the obstacle target, determine the main movement vector as the movement direction of the implicit offset area, construct a hull movement model, simulate the movement of the implicit offset area and the current hull, determine whether there is a collision risk based on the relative position relationship between the hull movement model and the implicit offset area, and generate a recommended route;
[0014] The area of the implicit offset region is determined based on the regular movement feature characterization parameter.
[0015] Furthermore, the process of determining the main motion vector of the obstacle target includes:
[0016] Determine the movement vector of the obstacle target at different times;
[0017] Identify the noise vector based on the angle difference between the motion vector corresponding to a single moment and the motion vectors corresponding to the remaining moments;
[0018] Eliminate the noise vector and determine the sum of the remaining motion vectors as the main motion vector;
[0019] If the angle difference between the motion vector corresponding to a single moment and the motion vectors corresponding to the remaining moments is greater than a predetermined angle difference threshold, the motion vector corresponding to the single moment is identified as a noise vector.
[0020] Furthermore, according to formula (1), the regular movement characteristic parameter is calculated:
[0021] ,
[0022] In formula (1), A represents the parameter representing the regular movement feature. represents the relative distance between the obstacle target and the main moving vector at the i-th moment, n represents the number of moments, represents the mean relative distance between the obstacle target and the main motion vector at each moment, represents the mean angular difference between the obstacle target moving vector at the i-th moment and the moving vector at the remaining moments, Indicates the preset base angle difference.
[0023] Furthermore, the regular movement category of each obstacle target is determined based on the regular movement characteristic parameters, where:
[0024] If the regular movement characteristic representation parameter is less than or equal to the reference regular movement characteristic representation parameter, the obstacle target is determined to be an explicit regular movement category;
[0025] If the regular movement characteristic representation parameter is greater than the baseline regular movement characteristic representation parameter, the obstacle target is determined to be an implicit regular movement category.
[0026] Furthermore, a recommended route for the obstacle target is generated according to the regular movement category of the obstacle target, wherein:
[0027] If the obstacle target is of the dominant regular movement category, then the obstacle target movement model and the hull movement model are constructed and the movement is simulated. Based on the intersection of the obstacle target movement model and the hull movement model, it is determined whether there is a collision risk and a recommended route is generated.
[0028] If the obstacle target is of the implicit regular movement category, an implicit offset area for the obstacle target is constructed, the main movement vector is determined as the moving direction of the implicit offset area, a hull movement model is constructed, the movement of the implicit offset area and the current hull is simulated, and whether there is a collision risk is determined based on the relative position relationship between the hull movement model and the implicit offset area, and a recommended route is generated.
[0029] Furthermore, the process of constructing the obstacle target movement model and the hull movement model and simulating the movement includes:
[0030] The movement of the ship movement model is simulated based on the movement direction of the ship;
[0031] The movement of the obstacle target movement model is simulated based on the current movement direction of the obstacle target;
[0032] The size of the hull movement model is determined based on the actual size of the hull, and the size of the obstacle target movement model is determined based on the actual size of the obstacle target.
[0033] Further, determining whether there is a collision risk based on the intersection of the obstacle target movement model and the hull movement model includes:
[0034] If the obstacle target moving model does not intersect with the hull moving model, it is determined that there is no collision risk between the obstacle target and the hull;
[0035] If the obstacle target moving model intersects with the hull moving model, it is determined that there is a collision risk between the obstacle target and the hull.
[0036] Furthermore, the process of constructing a hull movement model and simulating the hidden offset area and the current movement of the hull includes:
[0037] Determine the radius length based on the regular movement characteristic characterization parameter;
[0038] Constructing a circular area on the main movement vector of the obstacle target according to the radius length, and determining the circular area as the implicit offset area of the obstacle target;
[0039] The movement of the invisible offset area is simulated based on the vector direction of the main movement vector, and the movement of the hull movement model is simulated based on the movement direction of the hull.
[0040] Furthermore, the process of determining whether there is a collision risk between the hull movement model and the invisible offset area includes:
[0041] Determine whether the ship movement model is within the implicit offset region during the simulation;
[0042] If the hull movement model is within the implicit offset area during the simulation, it is determined that there is a collision risk.
[0043] Furthermore, the process of generating the recommended route includes:
[0044] Continuously changing the moving direction and moving speed of the ship moving model to complete the simulation, obtain the simulation results, and record the simulated route of the ship moving model in each simulation;
[0045] If the simulation result shows that there is no collision risk, the corresponding simulated route will be determined as the recommended route.
[0046] Compared with the prior art, the present invention obtains the movement characteristics of obstacle targets in the target area, determines the movement vectors of each obstacle target at different times, calculates the regular movement characteristic characterization parameters for the obstacle target based on the relative distance difference between the obstacle target and the main movement vector at different times and the movement vector angle difference, determines the regular movement category of each obstacle target based on the regular movement characteristic characterization parameters, constructs an obstacle target movement model and a hull movement model and simulates the movement situation, determines whether there is a collision risk based on the intersection of the obstacle target movement model and the hull movement model, generates a recommended route, constructs an invisible offset area for the obstacle target, determines whether there is a collision risk based on the relative position relationship between the hull movement model and the invisible offset area, and generates a recommended route, thereby improving the safety of ship navigation.
[0047] In particular, the present invention calculates regular movement characteristic characterization parameters to provide data basis for classifying regular movement categories. In actual situations, a ship will encounter various types of obstacle targets when sailing. For dynamic obstacle targets, the movement patterns of some obstacle targets are relatively obvious. For example, most sailing ships present a certain movement speed and movement direction. However, the movement patterns of some obstacle targets are not obvious and there are certain hidden patterns. For example, migrating marine organisms and floating objects affected by multi-dimensional turbulence flowing with ocean currents present a certain movement direction as a whole. However, there are partial offsets during the movement process. Therefore, the present invention constructs a main movement vector to estimate the movement direction of the obstacle target, calculates the regular movement characteristic characterization parameters for the obstacle target through the relative distance difference between the obstacle target and the main movement vector at different times and the movement vector angle difference, and then characterizes the regular movement category of the obstacle target. Subsequently, targeted analysis is performed on different situations to determine whether there is a collision risk and generate a recommended route, thereby improving the accuracy of ship collision warning and the reliability of route planning when dynamic obstacles exist.
[0048] In particular, for obstacle targets with unclear movement patterns, although they present a certain movement direction as a whole, they are prone to deviation during the movement. Therefore, the present invention constructs an implicit deviation area, takes the implicit deviation area as a benchmark, and performs simulation in combination with the hull movement model. The moving direction of the implicit deviation area is determined according to the direction of the main movement vector, and the size of the implicit deviation area is adaptively adjusted to be more in line with the actual situation. Based on the simulation results, it is determined whether there is a collision risk and a recommended route is generated, thereby improving the accuracy of ship collision warning and the reliability of route planning when there are dynamic obstacles. BRIEF DESCRIPTION OF THE DRAWINGS
[0049] Figure 1 A schematic diagram of the method steps of an automatic collision avoidance route planning method for ship navigation according to an embodiment of the invention;
[0050] Figure 2 A logic block diagram of determining the regular movement category of each obstacle target based on regular movement feature characterization parameters according to an embodiment of the invention;
[0051] Figure 3 A logic block diagram of an embodiment of the invention for determining whether there is a collision risk based on the intersection of an obstacle target movement model and a hull movement model;
[0052] Figure 4 A logical block diagram of recommending routes based on simulation results according to an embodiment of the invention. DETAILED DESCRIPTION
[0053] In order to make the objects and advantages of the present invention more clearly understood, the present invention is further described below in conjunction with embodiments; it should be understood that the specific embodiments described herein are only used to explain the present invention and are not used to limit the present invention.
[0054] The preferred embodiments of the present invention are described below with reference to the accompanying drawings. It should be understood by those skilled in the art that these embodiments are only used to explain the technical principles of the present invention and are not intended to limit the protection scope of the present invention.
[0055] It should be noted that in the description of the present invention, unless otherwise clearly specified and limited, the terms "installed", "connected" and "connected" should be understood in a broad sense, for example, it can be a fixed connection, a detachable connection, or an integral connection; it can be a mechanical connection or an electrical connection; it can be a direct connection or an indirect connection through an intermediate medium, or it can be the internal communication of two components. For those skilled in the art, the specific meanings of the above terms in the present invention can be understood according to specific circumstances.
[0056] See also Figures 1 to 4 As shown, Figure 1 This is a schematic diagram of the method steps of the automatic collision avoidance route planning method for ship navigation according to an embodiment of the invention. Figure 2 This is a logic block diagram of determining the regular movement category of each obstacle target based on regular movement feature characterization parameters according to an embodiment of the invention. Figure 3 This is a logic block diagram of an embodiment of the invention for determining whether there is a collision risk based on the intersection of an obstacle target movement model and a hull movement model. Figure 4 The following is a logic block diagram of a route recommendation based on simulation results according to an embodiment of the invention. The automatic collision avoidance route planning method for ship navigation of the present invention comprises:
[0057] Step S1, continuously acquiring the movement characteristics of obstacle targets in the target area, and determining the movement vector of each obstacle target at different times, wherein the movement characteristics include coordinates, movement speed, and movement direction;
[0058] Step S2, calculating a regular movement characteristic parameter for the obstacle target based on the relative distance difference between the obstacle target and the main movement vector at different times and the movement vector angle difference, wherein the main movement vector is determined based on the movement vector of the obstacle target within a predetermined time;
[0059] Step S3, determining the regular movement category of each obstacle target based on the regular movement feature representation parameters, including the explicit regular movement category and the implicit regular movement category;
[0060] Step S4, generating a recommended route for the obstacle target according to the regular movement category of the obstacle target, including:
[0061] Construct obstacle target movement model and hull movement model and simulate movement situation, determine whether there is a collision risk based on the intersection of obstacle target movement model and hull movement model, and generate a recommended route;
[0062] Or, construct an implicit offset area for the obstacle target, determine the main movement vector as the movement direction of the implicit offset area, construct a hull movement model, simulate the movement of the implicit offset area and the current hull, determine whether there is a collision risk based on the relative position relationship between the hull movement model and the implicit offset area, and generate a recommended route;
[0063] The area of the implicit offset region is determined based on the regular movement feature characterization parameter.
[0064] Specifically, there is no limitation on the method of acquiring the mobile characteristics. For example, a radar can be installed on the hull to obtain the radar's return data to determine the coordinates, moving speed and moving direction of the obstacle target in the target area. Of course, other methods can also be used. Technical personnel in this field can choose according to actual conditions, which will not be elaborated here.
[0065] Specifically, the relative distance between the obstacle target and the main motion vector at different times is determined based on the coordinates of the obstacle target, and the distance between the coordinates and the main motion vector is determined as the relative distance.
[0066] Specifically, the process of determining the main motion vector of the obstacle target includes:
[0067] Determine the movement vector of the obstacle target at different times;
[0068] Identify the noise vector based on the angle difference between the motion vector corresponding to a single moment and the motion vectors corresponding to the remaining moments;
[0069] Eliminate the noise vector and determine the sum of the remaining motion vectors as the main motion vector;
[0070] If the angle difference between the motion vector corresponding to a single moment and the motion vectors corresponding to the remaining moments is greater than a predetermined angle difference threshold, the motion vector corresponding to the single moment is identified as a noise vector.
[0071] Specifically, the starting point of the moving vector is the coordinates of the obstacle target, the direction of the moving vector is the moving direction of the obstacle target, the vector size can be determined based on the speed of the obstacle target, the vector size is positively correlated with the speed, and the conversion ratio can be set by technicians in this field, which will not be repeated here.
[0072] It is understandable that the obstacle target may suddenly have a large offset during the movement. The appearance of such large offset data is accidental, but it will have a great impact on the result. Therefore, technical personnel in this field can eliminate the noise vector according to the actual situation to improve the computability and accuracy of the main movement vector.
[0073] Specifically, to characterize the difference, the predetermined angle difference threshold is selected from the interval [60°, 90°].
[0074] Specifically, according to formula (1), the regular movement feature characterization parameters are calculated.
[0075] ,
[0076] In formula (1), A represents the parameter representing the regular movement feature. represents the relative distance between the obstacle target and the main moving vector at the i-th moment, n represents the number of moments, represents the mean relative distance between the obstacle target and the main motion vector at each moment, represents the mean angular difference between the obstacle target moving vector at the i-th moment and the moving vector at the remaining moments, Indicates the preset base angle difference.
[0077] In order to reflect whether the direction of the movement vector corresponding to the obstacle target at different times is highly consistent with the direction of the main movement vector, the preset reference angle difference Set from the interval [15°, 30°].
[0078] Specifically, the present invention calculates regular movement characteristic characterization parameters to provide data basis for classifying regular movement categories. In actual situations, a ship will encounter various types of obstacle targets when sailing. For dynamic obstacle targets, the movement patterns of some obstacle targets are relatively obvious. For example, most sailing ships present a certain movement speed and movement direction. However, the movement patterns of some obstacle targets are not obvious, and there are certain hidden patterns. For example, migrating marine organisms and floating objects affected by multi-dimensional turbulence flowing with ocean currents present a certain movement direction as a whole. However, there are partial offsets during the movement process. Therefore, the present invention constructs a main movement vector to estimate the movement direction of the obstacle target, calculates the regular movement characteristic characterization parameters for the obstacle target through the relative distance difference between the obstacle target and the main movement vector at different times and the movement vector angle difference, and then characterizes the regular movement category of the obstacle target. Subsequently, targeted analysis is performed on different situations to determine whether there is a collision risk and generate a recommended route, thereby improving the accuracy of ship collision warning and the reliability of route planning when dynamic obstacles exist.
[0079] Specifically, the regular movement category of each obstacle target is determined based on the regular movement feature characterization parameters, where:
[0080] If the regular movement characteristic representation parameter is less than or equal to the reference regular movement characteristic representation parameter, the obstacle target is determined to be an explicit regular movement category;
[0081] If the regular movement characteristic representation parameter is greater than the baseline regular movement characteristic representation parameter, the obstacle target is determined to be an implicit regular movement category.
[0082] Specifically, the benchmark regularity moving feature characterization parameters are selected from the interval [1.5, 2].
[0083] Specifically, a recommended route for the obstacle target is generated based on the regular movement category of the obstacle target, where:
[0084] If the obstacle target is of the dominant regular movement category, then the obstacle target movement model and the hull movement model are constructed and the movement is simulated. Based on the intersection of the obstacle target movement model and the hull movement model, it is determined whether there is a collision risk and a recommended route is generated.
[0085] If the obstacle target is of the implicit regular movement category, an implicit offset area for the obstacle target is constructed, the main movement vector is determined as the moving direction of the implicit offset area, a hull movement model is constructed, the movement of the implicit offset area and the current hull is simulated, and whether there is a collision risk is determined based on the relative position relationship between the hull movement model and the implicit offset area, and a recommended route is generated.
[0086] Specifically, the process of constructing the obstacle target movement model and the hull movement model and simulating the movement situation includes:
[0087] The movement of the ship movement model is simulated based on the movement direction of the ship;
[0088] The movement of the obstacle target movement model is simulated based on the current movement direction of the obstacle target;
[0089] The size of the hull movement model is determined based on the actual size of the hull, and the size of the obstacle target movement model is determined based on the actual size of the obstacle target.
[0090] It can be understood that the actual sizes of the hull and the obstacle target can be determined, the size of the hull movement model is proportional to the actual size of the hull, and the size of the obstacle target movement model is proportional to the actual size of the obstacle target.
[0091] Specifically, the simulation can be performed by a computer, for example, a two-dimensional coordinate system can be constructed, in which the obstacle target movement model and the hull movement model are simulated;
[0092] It can be understood that the obstacle target movement model is proportional to the movement speed of the obstacle target. Correspondingly, the hull movement model is proportional to the movement speed of the obstacle target, which will not be elaborated here.
[0093] Specifically, determining whether there is a collision risk based on the intersection of the obstacle target movement model and the hull movement model includes:
[0094] If the obstacle target moving model does not intersect with the hull moving model, it is determined that there is no collision risk between the obstacle target and the hull;
[0095] If the obstacle target moving model intersects with the hull moving model, it is determined that there is a collision risk between the obstacle target and the hull.
[0096] Specifically, the process of constructing a hull movement model and simulating the implicit offset area and the current movement of the hull includes:
[0097] Determine the radius length based on the regular movement characteristic characterization parameter;
[0098] Constructing a circular area on the main movement vector of the obstacle target according to the radius length, and determining the circular area as the implicit offset area of the obstacle target;
[0099] The movement of the invisible offset area is simulated based on the vector direction of the main movement vector, and the movement of the hull movement model is simulated based on the movement direction of the hull.
[0100] Specifically, the radius length is positively correlated with the regular movement characteristic parameter, and optionally,
[0101] ,
[0102] In formula (2), R represents the radius length, A represents the regular motion characteristic parameter, μ represents the influence coefficient of the regular motion characteristic parameter, 0.75<μ<0.95, Re represents the reference radius, which is determined based on the average relative distance between the obstacle target and the main motion vector at different times and is set to 1.2 to 1.5 times the average relative distance.
[0103] Specifically, for obstacle targets whose movement patterns are not obvious, although they present a certain movement direction as a whole, they are prone to deviation during the movement process. Therefore, the present invention constructs an implicit deviation area, takes the implicit deviation area as a benchmark, and performs simulation in combination with the hull movement model. The moving direction of the implicit deviation area is determined according to the direction of the main movement vector, and the size of the implicit deviation area is adaptively adjusted to be more in line with the actual situation. Based on the simulation results, it is determined whether there is a collision risk and a recommended route is generated, thereby improving the accuracy of ship collision warning and the reliability of route planning when there are dynamic obstacles.
[0104] Specifically, the process of determining whether there is a collision risk between the hull movement model and the invisible offset area includes:
[0105] Determine whether the ship movement model is within the implicit offset region during the simulation;
[0106] If the hull movement model is within the implicit offset area during the simulation, it is determined that there is a collision risk.
[0107] Specifically, the process of generating recommended routes includes:
[0108] Continuously changing the moving direction and moving speed of the ship moving model to complete the simulation, obtain the simulation results, and record the simulated route of the ship moving model in each simulation;
[0109] If the simulation result shows that there is no collision risk, the corresponding simulated route will be determined as the recommended route.
[0110] It is understandable that there are multiple simulated routes without collision risk. Preferably, the recommended route can be a simulated route with the shortest navigation distance.
[0111] So far, the technical solutions of the present invention have been described in conjunction with the preferred embodiments shown in the accompanying drawings. However, it is easy for those skilled in the art to understand that the protection scope of the present invention is obviously not limited to these specific embodiments. Without departing from the principle of the present invention, those skilled in the art can make equivalent changes or substitutions to the relevant technical features, and the technical solutions after these changes or substitutions will fall within the protection scope of the present invention.
Claims
1. A method for automatic collision avoidance route planning for ship navigation, characterized in that: include: Step S1, continuously acquiring the movement characteristics of obstacle targets in the target area, and determining the movement vector of each obstacle target at different times, wherein the movement characteristics include coordinates, movement speed, and movement direction; Step S2, calculating a regular movement characteristic parameter for the obstacle target based on the relative distance difference between the obstacle target and the main movement vector at different times and the movement vector angle difference, wherein the main movement vector is determined based on the movement vector of the obstacle target within a predetermined time; Step S3, determining the regular movement category of each obstacle target based on the regular movement feature representation parameters, including the explicit regular movement category and the implicit regular movement category; Step S4, generating a recommended route for the obstacle target according to the regular movement category of the obstacle target, including: Construct obstacle target movement model and hull movement model and simulate movement situation, determine whether there is a collision risk based on the intersection of obstacle target movement model and hull movement model, and generate a recommended route; Or, construct an implicit offset area for the obstacle target, determine the main movement vector as the movement direction of the implicit offset area, construct a hull movement model, simulate the movement of the implicit offset area and the current hull, determine whether there is a collision risk based on the relative position relationship between the hull movement model and the implicit offset area, and generate a recommended route; Wherein, the area of the implicit offset region is determined based on the regular movement characteristic characterization parameter; According to formula (1), the regular movement characteristic characterization parameters are calculated. ; In formula (1), A represents the parameter representing the regular movement feature. represents the relative distance between the obstacle target and the main moving vector at the i-th moment, n represents the number of moments, represents the mean relative distance between the obstacle target and the main motion vector at each moment, represents the mean angular difference between the obstacle target moving vector at the i-th moment and the moving vector at the remaining moments, Indicates the preset reference angle difference; The regular movement category of each obstacle target is determined based on the regular movement characteristic parameters, where: If the regular movement characteristic representation parameter is less than or equal to the reference regular movement characteristic representation parameter, the obstacle target is determined to be an explicit regular movement category; If the regular movement characteristic representation parameter is greater than the reference regular movement characteristic representation parameter, the obstacle target is determined to be a hidden regular movement category; The process of constructing a hull movement model and simulating the hidden offset area and the current movement of the hull includes: Determine the radius length based on the regular movement characteristic characterization parameter; Constructing a circular area on the main movement vector of the obstacle target according to the radius length, and determining the circular area as the implicit offset area of the obstacle target; The movement of the invisible offset area is simulated based on the vector direction of the main movement vector, and the movement of the hull movement model is simulated based on the movement direction of the hull.
2. The automatic collision avoidance route planning method for ship navigation according to claim 1, characterized in that: In step S2, the process of determining the main movement vector of the obstacle target includes: Determine the movement vector of the obstacle target at different times; Identify the noise vector based on the angle difference between the motion vector corresponding to a single moment and the motion vectors corresponding to the remaining moments; Eliminate the noise vector and determine the sum of the remaining motion vectors as the main motion vector; If the angle difference between the motion vector corresponding to a single moment and the motion vectors corresponding to the remaining moments is greater than a predetermined angle difference threshold, the motion vector corresponding to the single moment is identified as a noise vector.
3. The automatic collision avoidance route planning method for ship navigation according to claim 1, characterized in that: In step S4, a recommended route for the obstacle target is generated according to the regular movement category of the obstacle target, wherein: If the obstacle target is of the dominant regular movement category, then the obstacle target movement model and the hull movement model are constructed and the movement is simulated. Based on the intersection of the obstacle target movement model and the hull movement model, it is determined whether there is a collision risk and a recommended route is generated. If the obstacle target is of the implicit regular movement category, an implicit offset area for the obstacle target is constructed, the main movement vector is determined as the moving direction of the implicit offset area, a hull movement model is constructed, the movement of the implicit offset area and the current hull is simulated, and whether there is a collision risk is determined based on the relative position relationship between the hull movement model and the implicit offset area, and a recommended route is generated.
4. The automatic collision avoidance route planning method for ship navigation according to claim 1, characterized in that: In step S4, the process of constructing the obstacle target movement model and the hull movement model and simulating the movement situation includes: The movement of the ship movement model is simulated based on the movement direction of the ship; The movement of the obstacle target movement model is simulated based on the current movement direction of the obstacle target; The size of the hull movement model is determined based on the actual size of the hull, and the size of the obstacle target movement model is determined based on the actual size of the obstacle target.
5. The automatic collision avoidance route planning method for ship navigation according to claim 1, characterized in that: In step S4, determining whether there is a collision risk based on the intersection of the obstacle target movement model and the hull movement model includes: If the obstacle target moving model does not intersect with the hull moving model, it is determined that there is no collision risk between the obstacle target and the hull; If the obstacle target moving model intersects with the hull moving model, it is determined that there is a collision risk between the obstacle target and the hull.
6. The automatic collision avoidance route planning method for ship navigation according to claim 5, characterized in that: In step S4, the process of determining whether there is a collision risk between the hull movement model and the invisible offset area includes: Determine whether the ship movement model is within the implicit offset region during the simulation; If the hull movement model is within the implicit offset area during the simulation, it is determined that there is a collision risk.
7. The automatic collision avoidance route planning method for ship navigation according to claim 1, characterized in that: In step S4, the process of generating the recommended route includes: Continuously changing the moving direction and moving speed of the ship moving model to complete the simulation, obtain the simulation results, and record the simulated route of the ship moving model in each simulation; If the simulation result shows that there is no collision risk, the corresponding simulated route will be determined as the recommended route.
