Complex waterway ship navigation decision-making method, terminal equipment and storage medium

By judging ship yaw and navigation risks in complex waterways in real time, and using automatic collision avoidance models and ship motion models to calculate the collision risk of each ship, and taking direction and speed change measures, the chaos in navigation order in complex waterways and The frequent accidents have achieved independent and safe navigation of ships.

CN118938909APending Publication Date: 2024-11-12JIMEI UNIV
View PDF 0 Cites 3 Cited by

Patent Information

Application Number
CN202410983986.2
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-22
Publication Date
2024-11-12

AI Technical Summary

Technical Problem

Ship navigation in complex waterways is difficult to effectively reduce navigation risks and collision risks due to the high traffic flow density and complex environment.

Method used

A complex waterway ship navigation decision-making method is proposed. By judging the ship's yaw and navigation risks in real time, using automatic collision avoidance model and ship motion model, the collision risk of each ship is calculated, and corresponding directional and speed change measures are taken to avoid collisions. , ensure that the ship sails safely along the planned route.

Benefits of technology

The autonomous navigation of ships in complex waterways has been achieved, which reduces navigation risks and collision risks, and improves navigation safety and efficiency.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118938909A_ABST
    Figure CN118938909A_ABST
Patent Text Reader

Abstract

The invention relates to a complex water channel ship navigation decision-making method, terminal equipment and a storage medium, and the method comprises the steps: S1, judging whether a ship is yawed in real time in a ship driving process, and entering S2 when the ship is yawed; otherwise, entering S3; s2, judging whether the ship can re-navigate to the planned route or not, and if yes, controlling the ship to re-navigate to the planned route; otherwise, entering S3; s3, judging whether the ship has a navigation risk and a collision risk or not; when the navigation risk exists, taking a corresponding action according to the corresponding navigation risk type; when the collision risk exists, the collision risk degree of each ship forming the collision risk with the ship is calculated, the ship with the maximum collision risk degree is found out to serve as the most dangerous ship, and corresponding actions are taken according to an automatic collision avoidance model based on the most dangerous ship; and if not, controlling the ship to continue to sail along the planned route. According to the invention, autonomous navigation of port entering in a complex water channel is realized.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of navigation technology, and in particular to a complex waterway ship navigation decision-making method, terminal equipment and storage medium. Background Art

[0002] In the context of global economic development, ocean transportation, as a mode of transportation with outstanding environmental protection and economic benefits, undertakes more than 90% of the world's cargo transportation tasks and plays a vital role in promoting global trade and economic development. However, with the continuous prosperity of the shipping industry and the continuous growth in the size and number of ships, the number of maritime traffic accidents has shown an increasing trend. Especially in near-shore waters, due to the increased density of ship traffic and the complex traffic environment, various maritime traffic accidents are common. These accidents not only threaten the safety of human life and property, but also bring significant economic losses.

[0003] Complex waterways refer to nearshore navigable waters with complex navigation environments, multiple traffic flow directions, limited navigable waters, high ship density, and high difficulty in ship maneuvering. As important nearshore waters, they are often the only way for ships to transport by sea. In order to cope with the chaotic navigation order caused by the convergence of traffic flows from different directions in complex waterways, a combined ship routing system is usually set up in the waterway, and the direction of traffic flow is specified, and warning areas and no-fly zones are demarcated to reduce ship intersections, thereby alleviating navigation pressure and reducing navigation risks. However, with the continuous growth of ship traffic flow, traffic accidents in complex waterways, especially those caused by human factors, still occur from time to time. Therefore, studying autonomous navigation of ships in such waters is of great significance to the development of intelligent ships. Summary of the invention

[0004] In order to solve the above problems, the present invention proposes a complex waterway ship navigation decision-making method, terminal equipment and storage medium.

[0005] The specific plan is as follows:

[0006] A complex waterway ship navigation decision method comprises the following steps:

[0007] S1: Determine in real time whether the ship is yawed during its travel. If it is yawed, enter S2; otherwise, enter S3;

[0008] S2: Determine whether the ship can resume sailing to the planned route. If so, control it to resume sailing to the planned route; otherwise, enter S3;

[0009] S3: Determine whether the ship has navigation risk and collision risk; when there is navigation risk, take corresponding actions according to the corresponding navigation risk type; when there is collision risk, calculate the collision risk of each ship that poses a collision risk to the ship, find the ship with the largest collision risk as the most dangerous ship, and take corresponding actions according to the automatic collision avoidance model based on the most dangerous ship; when there is no navigation risk and collision risk, control the ship to continue sailing along the planned route.

[0010] Furthermore, the ship's MMG model is used to determine whether the ship can resume its planned route.

[0011] Furthermore, navigation risks include running aground, hitting a reef and contact with natural static obstacles during navigation; when taking corresponding actions, the virtual environment elements corresponding to each type of navigation risk are abstracted into point-shaped, circular or polygonal obstacles according to their shapes.

[0012] Furthermore, a method for determining whether there is a collision risk is as follows: setting the ship area of ​​the own ship to be an eccentric ellipse, and calculating the distance Dis between the target ship and the boundary of the ship area of ​​the own ship by the following formula:

[0013]

[0014]

[0015] Among them, a and b represent the minor axis and major axis of the ship domain, respectively; It indicates the angle between the bow line of own ship and the azimuth line of target ship to the right; D indicates the distance between target ship and virtual own ship; Indicates the distance between the virtual own ship and the boundary of the ship domain;

[0016] When the distance between the target ship and the boundary of the own ship's ship area is less than 0, it is determined that there is a risk of collision between the own ship and the target ship.

[0017] Furthermore, the method of taking corresponding actions according to the automatic collision avoidance model based on the most dangerous ship is:

[0018] First, try to adopt the solution of steering alone, that is, find the feasible course range of the ship within the range of -50° to 50° for the most dangerous ship; start from the 10° steering angle, increase 1° in sequence to verify whether all feasible steering angles are safe; set the minimum steering angle that can be safely avoided as the best avoidance solution of the ship relying on steering alone; if no feasible steering angle can be found, try to adopt the solution of speed change alone;

[0019] In the speed change scheme alone, find a feasible propeller speed range; verify whether all feasible gear positions are safe by increasing or decreasing the ship's gear position; set the scheme with the smallest gear change as the best avoidance scheme based on speed change alone; if no feasible gear position is found, try to adopt a combined speed change and direction change scheme;

[0020] In the combined redirection and speed change scheme, according to the feasible heading range and feasible car clock gear obtained in the above steps, the redirection angle is increased and the car clock gear is changed at the same time, and all feasible redirection and speed change avoidance schemes are verified in turn to be safe, and the minimum redirection and speed change combination that can safely avoid is set as the optimal redirection and speed change combined avoidance scheme.

[0021] A terminal device for ship navigation decision in complex waterways includes a processor, a memory, and a computer program stored in the memory and executable on the processor. When the processor executes the computer program, the steps of the above-mentioned method in the embodiment of the present invention are implemented.

[0022] A computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, the steps of the method described above in an embodiment of the present invention are implemented.

[0023] The present invention adopts the above technical solution to achieve autonomous navigation into the port through complex waterways. BRIEF DESCRIPTION OF THE DRAWINGS

[0024] Figure 1 Shown is a flow chart of a method according to a first embodiment of the present invention.

[0025] Figure 2 Shown is a schematic diagram of the ship motion coordinate system in this embodiment.

[0026] Figure 3 The figure shows a schematic diagram of the setting of the safety boundary line of the navigation lane in this embodiment.

[0027] Figure 4 Shown is a risk control diagram of point and circular obstacles in this embodiment.

[0028] Figure 5 Shown is a risk control diagram of a polygonal obstacle in this embodiment.

[0029] Figure 6 Shown is a schematic diagram of a collision risk judgment model for a common motor vessel in this embodiment.

[0030] Figure 7 Shown is a schematic diagram of the speed barrier in this embodiment.

[0031] Figure 8 Shown is a conventional linear velocity obstacle sector in this embodiment.

[0032] Fig. 9 Shown is the improved nonlinear speed barrier sector in this embodiment.

[0033] Fig.10 Shown is a schematic diagram of a dynamic feasible control scheme in this embodiment.

[0034] Fig.11 Shown is a schematic diagram of the latest action plan in this embodiment. DETAILED DESCRIPTION

[0035] To further illustrate various embodiments, the present invention provides drawings. These drawings are part of the disclosure of the present invention, which are mainly used to illustrate the embodiments and can be used in conjunction with the relevant descriptions in the specification to explain the operating principles of the embodiments. With reference to these contents, ordinary technicians in this field should be able to understand other possible implementations and advantages of the present invention.

[0036] The present invention will now be further described with reference to the accompanying drawings and specific implementation methods.

[0037] Embodiment 1:

[0038] The embodiment of the present invention provides a method for ship navigation decision-making in a complex waterway, such as Figure 1 As shown, the method comprises the following steps:

[0039] S1: Determine in real time whether the ship is yawed during its travel. If it is yawed, enter S2; otherwise, enter S3;

[0040] S2: Determine whether the ship can resume sailing to the planned route. If so, control it to resume sailing to the planned route; otherwise, enter S3;

[0041] S3: Determine whether the ship has navigation risk and collision risk; when there is navigation risk, take corresponding actions according to the corresponding navigation risk type; when there is collision risk, calculate the collision risk value of each ship that poses a collision risk to the ship, find the ship with the largest collision risk as the most dangerous ship, and take corresponding actions according to the automatic collision avoidance model based on the most dangerous ship; when neither navigation risk nor collision risk exists, control the ship to continue sailing along the planned route.

[0042] 1. Risk of deviation

[0043] Deviation during the navigation process of a ship includes the ship not sailing in the general direction of the traffic flow or sailing outside the navigation lane. After the ship deviates, it may lead to violations of ship-related regulations and may further lead to marine accidents. The specific method of identifying and controlling deviation risks in this embodiment is as follows.

[0044] Step 1: Determine whether the current ship position is within the navigation channel

[0045] For this embodiment, the autonomous navigation of the ship under any initial conditions should be realized. First, it should be determined whether the initial ship position is located in the navigation channel.

[0046] The constructed digital traffic environment has divided the research waters into multiple segments, and each segment is a quadrilateral. Connect the current position of the ship and the four vertices A, B, C and D of the quadrilateral of any segment to form four triangles, such as Figure 2 . And calculate the following formula (1).

[0047] τ=S ABCD -(S AoB +S BoC +S CoD +S DoA ) (1)

[0048] In the formula, S AoB , S BoC , S CoD , S BoA and S ABCD They represent the areas of the four triangles and quadrilateral enclosed by the subscripts respectively.

[0049] When τ=0, it means that the ship is located in a certain section of the navigation channel; if τ≠0, it means that the ship is not in the navigation channel section, and a navigation risk warning is immediately issued, and the automatic navigation model is used to adjust the ship's status, so that the ship enters the navigation channel and sails along the planned route.

[0050] Step 2: Determine whether to sail in the general direction of traffic flow

[0051] After completing step 1, when the current position of the vessel is within the traffic lane, it is further determined whether the vessel is sailing in the general direction of the traffic flow.

[0052] By comparing the difference between the ship's heading and the general direction of the traffic flow, the judgment is made using expression (2).

[0053] τ=0 ∩ |C0-λ i |≤15° (2)

[0054] In the formula, λ i It is the general direction of traffic flow in the navigation lane where the ship is located, and C0 is the ship's heading.

[0055] When formula (2) is satisfied, it indicates that the ship is in the traffic lane, and the difference between its heading and the general direction of the traffic flow in the traffic lane is no more than ±15°, indicating that the ship is sailing in the general direction of the traffic flow. If formula (2) is not satisfied, adjust the ship's posture and make the ship sail in the general direction of the traffic flow as soon as possible.

[0056] Step 3: Control of deviation risk

[0057] After completing the first two steps, in order to further prevent the risk of ships deviating from their course, a navigation lane safety boundary line can be set at a certain distance from the navigation lane boundary line along the general direction of traffic flow on both sides of the navigation lane. Considering the complex waterway environment of the Singapore Strait and the narrow navigation lanes, this embodiment sets the distance between the navigation lane safety boundary line and the navigation lane boundaries on both sides. Set to 0.8Loa. Figure 3 shown.

[0058] Calculate the distance between the current position of the ship and the boundary lines on both sides of the traffic lane and As shown in formula (3).

[0059]

[0060] Where m is the slope of the traffic lane boundary line, and They represent the position coordinates of the upper boundary points on the left and right sides of the traffic lane respectively, and (X0, Y0) is the coordinates of the current position of the ship.

[0061] Compare and if or Greater than If or Less than When the deviation risk warning is displayed, it means that the ship is sailing outside the safety boundary line of the navigation lane and may leave the navigation lane at any time. The ship will immediately issue a deviation risk warning and adjust the ship's posture.

[0062] 2. Navigation risks

[0063] In this embodiment, the navigation risks include running aground, hitting a reef, and contact with natural static obstacles during navigation. Running aground refers to the accidental situation where a ship touches the seabed, shoal, etc. under unexpected circumstances; hitting a reef refers to the accidental situation where a ship touches rocks, sunken ships, and other obstacles in the water. Contact with natural static obstacles refers to the violent contact between a ship and a fixed object, such as a bridge, a dock, a beacon, etc. When a ship encounters the above navigation risks, it may cause serious maritime traffic accidents and requires special precautions. In order to better judge and control the above-mentioned navigation risks, the virtual environment elements corresponding to each type of navigation risk in this embodiment are abstracted into point-shaped, circular or polygonal obstacles according to their shapes, which are specifically introduced as follows.

[0064] (1) Point-shaped and circular obstacles

[0065] The mathematical model of point-shaped and circular obstacles is a circle with different radius a. To avoid point-shaped and circular obstacles, a circular ship field with the center of gravity of the ship located at the center of the circle is selected. It is required that the ship maintain a certain safety distance when passing through obstacles, such as Figure 4 .

[0066] Calculate the distance D between the center of the obstacle circle and the center of the ship's area at any time s As shown in formula (4).

[0067]

[0068] In the formula, and They represent the position of the ship at time k·t and the current time respectively. is the position of the center of the obstacle circle at time k·t; t is the time step, which is set to 1s; k is a parameter.

[0069] Since there are many obstacles in the research waters, this embodiment only considers obstacles that have entered the ship area within a period of time. Set k to a positive integer in the range of [1,1200], that is, only consider obstacles that have entered the ship area within 20 minutes.

[0070] Compare The distance D between the ship and point-shaped or circular obstacles s ′=a+r, determine whether there is k in the range [1,1200] that satisfies D s <D s ′.

[0071] If it exists, it means that the point or circular obstacle will enter the ship's area at time k·t, so the ship may be at risk of navigation, and the ship's situation should be adjusted immediately and continue to judge. If there is no k in the range [1,1200] that satisfies D s <D s ', indicating no, and continuing with the original navigation plan.

[0072] (2) Polygonal obstacles

[0073] The mathematical model of polygonal obstacles is polygons of different shapes. The avoidance requirement is that the inside of the polygon cannot be passed, and only the outermost vertex of the polygon can be passed. The polygonal obstacle avoidance also uses a circular ship field with the center of gravity of the ship at the center of the circle, such as Figure 5 .

[0074] First, determine the outermost vertex of the polygon, and do it as follows. Calculate the direction from the bow line of the ship to any vertex of the polygon and record it as Find the maximum and minimum directions and judge Is it less than π? and The corresponding vertex is the outermost vertex; when Will and Subtract 2π from the larger term to get the new and The corresponding vertex is the outermost vertex.

[0075] Formula (4) is used to calculate the distance between the two outermost vertices A and B of the polygon and the center of the ship area at any time. and

[0076] Compare and the radius of the ship's area r. When there exists k in the range [1,1200] that satisfies or If the radius is smaller than r, it means that the polygonal obstacle will enter the ship's area at time k·t, and the ship may be at risk of navigation. The ship's situation should be adjusted immediately and the judgment should be continued. If there is no k in the range [1,1200] that satisfies or If it is smaller than the radius r, it means no, and the original navigation plan should be continued.

[0077] (3) Determine the feasible control range

[0078] Calculate the coordinates of the obstacle in the xoy coordinate system at time k·t Such as formula (5) and formula (6).

[0079]

[0080] In the above formula, and The position of the center of a point or circular obstacle or the outermost vertex of a polygonal obstacle at time k·t and at the current time in the xoy coordinate system; C cs u is the position, heading and speed of the center of a point or circular obstacle or the outermost vertex of a polygonal object in the geodetic coordinate system at the current moment; cs and v cs are the velocity components in the ox and oy directions respectively.

[0081] Combining equation (6) with the ship domain expression, we can get equation (7).

[0082]

[0083] make When B 2When -4AC>0, point, circular or polygonal obstacles will not enter the ship's area. 2 When -4AC=0, the ship's area is just tangent to the outermost vertex of the point-shaped, circular obstacle circle or polygonal obstacle, and the boundary of the feasible maneuvering range is obtained.

[0084] When there are multiple obstacles, search for a feasible avoidance steering angle for the ship within the heading range [-50°, 50°] by increasing the steering angle by 1° at a time, and search for a feasible avoidance steering angle for the ship within the heading range [-50°, 50°] by increasing or decreasing the gear position by one gear at a time within the gear range [DS AH ,F AH ] and combine the discretized elements into one or more continuous intervals.

[0085] 3. Collision risk

[0086] (1) Collision risk judgment model

[0087] In this embodiment, the collision risk is determined by the collision risk judgment model, which is as follows: to judge the collision risk with an ordinary motor ship, an eccentric elliptical ship field is selected, and it is assumed that the distance between the target ship and the virtual ship is D; along the direction of the line between the target ship and the virtual ship, the distance between the virtual ship and the boundary of the ship field is The distance between the target ship and the boundary of the ship domain is Dis, such as Figure 6 shown.

[0088] The distance between the target ship and the boundary of the ship area is Dis, which can be calculated by formula (8).

[0089]

[0090] In formula (8), a and b represent the minor axis and major axis of the ship ellipse, respectively. Indicates the angle between the bow line of own ship to the right and the azimuth line of target ship.

[0091] The collision risk can be determined by equations (9) and (10).

[0092] Dis (i·t) <0 (9)

[0093] Dis (i·t+1) >Dis (i·t) >0 (10)

[0094] Where i is a positive integer and t is the time step, which is set to 1s.

[0095] When there exists i that satisfies equation (9), it means that the target ship will enter the ship area of ​​the own ship and there is a risk of collision between the two ships. At this time, the i·t moment is the moment when the target ship enters the ship area of ​​the own ship.

[0096] For two approaching ships, the distance Dis between the target ship and the boundary of the own ship's ship territory first decreases and then increases. Once i satisfies formula (10), it means that the target ship will not enter the own ship's ship territory, and it is considered that there is no collision risk between the two ships.

[0097] (2) Collision risk

[0098] In traditional navigation, T is usually used. CPA With D CPA The collision risk between ships is evaluated and measured, but these two quantities cannot be directly determined by weighted average to determine the collision risk. In order to more comprehensively evaluate the collision risk, the collision risk index (CRI) is used in this embodiment as a comprehensive indicator to reflect whether there is a collision risk and the urgency of the risk. It is determined based on multiple factors such as the maneuvering characteristics, position and relative motion relationship of the two encountering ships. The degree of collision risk can be more accurately evaluated and the degree of ship collision risk can be objectively quantified.

[0099] The evaluation angles of collision risk include space and time. The collision risk can be divided into space collision risk and time collision risk.

[0100] 1) Space collision risk

[0101] The spatial collision risk is used to measure whether there is a collision risk between two ships at the current moment, and can be calculated by formula (11).

[0102]

[0103] Where, T s Indicates the time included in the calculation, Indicates the position of the i-th target ship at time t. t represents the point set of all points in the ship area at time t. In this embodiment, in order to reduce the disturbance of the system, the time T is included in the calculation s Set to 1200 seconds. If the target ship is far away or the time it takes to enter the ship's area is greater than 1200 seconds, it will not be taken into consideration.

[0104] 2) Time collision risk

[0105] The time collision risk refers to the urgency of the collision risk between two ships. It is calculated as shown in formula (12).

[0106]

[0107] Where, T csis the time from the current moment to the moment when the target ship enters the ship's area, which can be obtained through the collision risk judgment model; T s is the time threshold, which is set to 1200 seconds in this embodiment.

[0108] 3) Collision risk

[0109] The collision risk is the synthesis of spatial and temporal collision risks, expressed as formula (13).

[0110]

[0111] In the formula, is the value of the time collision risk, is the value of space collision risk, C RI is the collision risk value.

[0112] The collision risk value is between 0 and 1. RI >0 indicates that there is a risk of collision between the two ships. By comparing the collision risk value C between the ship and any other ship RI The size of the target ship is used to determine the target ship that poses the greatest threat to the ship. RI The target ship with the largest value is the most dangerous target ship, and avoidance maneuvers should be taken on it first.

[0113] Combining the collision risk judgment model and the time threshold, in this embodiment, when the target ship meets the conditions of the collision risk judgment model and the time it enters the ship area is less than 1200 seconds, it is considered that there is a collision risk between the two ships.

[0114] (3) Judgment of the situation you will encounter

[0115] Analyzing the motion situation between ships and judging the encounter situation between ships is the premise for correct collision avoidance action. The encounter situation between two ships is divided into three situations: overtaking, crossing and encountering. In this embodiment, combined with existing research, the encounter situation judgment model shown in Table 1 is established.

[0116] Table 1

[0117]

[0118] in, The angle between the bow line of the own ship and the azimuth line of the target ship is called the side angle. The angle between the target ship's bow line and the ship's azimuth line is called the relative side angle. The calculation method is as shown in formula (14).

[0119]

[0120] The specific judgment steps are as follows.

[0121] 1) First, determine whether there is a risk of collision between the two ships or T CPA ≤0 (whether it belongs to the second category).

[0122] 2) When the two-ship situation does not belong to the second category, use formula (14) to obtain and And determine whether the two ships are in an overtaking situation or a head-on situation.

[0123] 3) If none of the above is true, then the two ships are in a cross-meeting situation.

[0124] (4) Collision avoidance mechanism

[0125] 1) Speed ​​barrier

[0126] Whether the current speed vector of the ship and the speed vector after speed change and redirection can safely avoid all targets and the law between the change of ship speed vector and the avoidance effect are called collision avoidance mechanism.

[0127] Speed ​​barrier theory is widely used to explore the collision avoidance mechanism of ships. According to speed barrier theory, when the host ship and the target ship keep their current motion states unchanged, the set of all speed vectors that may cause the host ship and the target ship to collide is the speed barrier zone of the host ship. The principle is as follows: Figure 7 shown.

[0128] Figure 7 In, V OS 、V TS are the velocity vectors of the own ship and the dynamic target, respectively, is the relative velocity vector of the two, and the relationship between the three is as shown in equation (15). cc and A cc are the relative collision area and the absolute collision area, respectively, and are expressed by formula (16).

[0129]

[0130] In the above two equations, V OS (t) 、V TS (t) are the speeds of own ship and target ship at time t respectively; is the Minkowski vector sum operation.

[0131] Own ship's velocity vector V OS The range falling into the speed obstacle area is the absolute speed obstacle area R of the ship. cc ; Solve the relative velocity vector between the ship and the dynamic target Relative velocity vector The range falling into the speed obstacle area is the relative speed obstacle area A of the ship. cc When V OS(t) ∈A cc That is, the velocity vector of the ship at any time t falls into the absolute collision zone or That is, when the relative velocity vector falls into the relative collision zone at any time t, the two ships will collide if no avoidance action is taken.

[0132] 2) Collision avoidance mechanism based on improved speed barrier

[0133] The traditional speed obstacle model does not consider the process of ship speed vector change, and assumes that the speed change is a linear change. Figure 8 shown.

[0134] In fact, the speed and heading of cargo ships at sea change nonlinearly. The feasible heading range obtained by the traditional speed obstacle model has a certain error from the actual one. When the speed vector changes greatly, the error will be further increased, which may make the obtained maneuvering plan unable to avoid safely.

[0135] Therefore, based on the traditional speed obstacle model, this embodiment considers the nonlinear change of the speed vector and proposes an improved speed obstacle model such as Fig. 9 As shown, it provides a theoretical basis for collision avoidance decision-making in complex waterways.

[0136] Combined with the redirection range under different car clock gears at the current moment, we can get different car clock gears (using DS AH , S AH , H AH and F AH The nonlinear speed obstacle area of ​​the own ship under the condition of ( ) is shown in formula (17).

[0137]

[0138] In the formula, and Indicates DS AH , S AH , H AH and F AH The absolute collision zone under the car clock command. The improved speed obstacle model takes into account the nonlinear motion process and variable speed motion of the ship, and is more suitable for the scenario of this embodiment than the traditional speed obstacle model.

[0139] 3) Dynamically feasible control scheme

[0140] Based on the improved speed obstacle model, the feasible maneuvering scheme for the ship's avoidance action at a certain moment is the collection of all feasible course intervals corresponding to different engine clock positions. The feasible and infeasible course intervals at a specific engine clock position are as follows: Fig.10 shown.

[0141] Fig.10In the case of the two ships crossing each other, there is a risk of collision, and the ship is the one giving way. Considering the nonlinear change of the ship's velocity vector, the minimum feasible turning angles of the ship to the left and right are C m and C n , when the redirection range is [C m ,C n ], the target ship will enter the ship's area. Therefore, the redirection range [C n ,C m ] is the feasible navigation range of the ship under this gear position.

[0142] There are many different feasible control schemes corresponding to different gear positions of the car clock. The set of feasible control schemes including all direction changes and speed changes is expressed as formula (18).

[0143]

[0144] In the formula, C (t) represents the feasible redirection angle. Considering the water environment of this embodiment, the redirection range is limited to [-50°, 50°]. α, β, γ and σ represent the corresponding DS AH , S AH , H AH and F AH The number of feasible operating options under the clock gear; PO (t) represents the set of all feasible manipulation schemes at time t.

[0145] (5) Collision avoidance actions

[0146] 1) Timing and method of collision avoidance action

[0147] In this embodiment, the collision risk value C of the target ship is selected. RI As the standard for the timing of the ship's collision avoidance action. The specific timing and method of action are shown in Table 2. The implementation steps are as follows.

[0148] 1) First calculate the collision risk value C of all target ships RI , when the collision risk value of the target ship is C RI <0, indicating that there is no collision risk between the two ships and the two ships are in the free action stage. RI >0, the target ship and the own ship are in danger of collision, and the collision risk value C is found. RI The largest ship.

[0149] 2) Further judge the encounter situation of the two ships and make judgments based on the results of the encounter situation. When the two ships are in a head-on encounter situation or the ship is the give-way ship in other situations, the ship should take the evasive action of changing direction or changing speed as specified in Table 2.

[0150] 3) When the ship is a direct voyage ship and CRI <0.4, own vessel maintains course and speed. However, if the give-way vessel does not take the give-way action and C RI >0.4, as a straight-line vessel, the vessel should take collision avoidance actions such as changing direction or changing speed as shown in Table 2.

[0151] In addition, since the ship needs to make drastic changes when taking evasive action. In navigation practice, the standard for drastic changes in direction and speed is usually considered to be a 30° turn or a reduction in speed of more than half. Considering the constraints of the water traffic environment, the turning range is limited to between -50° and 50°. When it is necessary to turn more than 50° from one side to avoid, try to change direction from the other side. If the avoidance cannot be completed by turning alone, consider changing speed or a combination of speed change and direction change to avoid.

[0152] Table 2

[0153]

[0154] 2) Latest Action Plan

[0155] In navigation practice, when ships take evasive action, they usually give priority to turning, that is, the give-way ship in danger of collision takes evasive action by turning 90 degrees. The action position when it passes just outside the minimum safe distance is called the latest steering point.

[0156] Combined with the requirements of the ship area and complex waterways in this embodiment, the latest action method adopted in this embodiment is that the ship, as a way-giving ship, takes the action plan of changing direction and speed to avoid, including turning to any side by no more than 50 degrees and slowing down to no less than a slow speed, when the target ship just does not enter the ship area of ​​the ship. After that, the way-giving ship alone cannot avoid other ships from entering the ship area of ​​the ship, no matter what action it takes. The calculation model of the latest action plan is as follows.

[0157] Assume that all the avoidance action plans of own ship A CP The collection is expressed as formula (19).

[0158]

[0159] In the formula, is the distance from the target ship to the boundary of the ship’s area at time t, t α The moment when own ship takes collision avoidance action; R PM α and θ α The ship t α The vehicle command and steering angle executed at the moment, where R PM α The corresponding main engine speeds at micro-speed forward, slow speed forward, half-speed forward and full-speed forward are 35rpm, 48rpm, 70rpm and 85rpm respectively.

[0160] At the initial stage of the collision risk, the ship has a variety of feasible collision avoidance action plans at different times. Among them, the feasible avoidance action is to ensure that the target ship passes outside the area of ​​the ship. As the two ships approach, the feasible collision avoidance plans become fewer and fewer. last At this moment, the vessel has only one feasible avoidance plan to ensure that the other ship does not enter the vessel's ship area, such as Fig.11 shown.

[0161] t last is the latest action time of own ship. last The position P at the moment sn (t last ,R PM last ,θ max ) is the latest action position, and the avoidance plan adopted (t last ,R PM last ,θ max ) is the latest action plan.

[0162] Among them, t last The time can be calculated using equations (8) and (9), and the conditions that need to be met are Just less than 0. When the time exceeds t last After that, no matter what actions this ship takes, it cannot prevent the target ship from entering its ship area.

[0163] 3) Automatic collision avoidance action process

[0164] When sailing into a port in a complex waterway, it is very common for multiple ordinary motor vessels to encounter each other. At this time, it is necessary to decompose the multi-ship encounter situation into multiple two-ship encounter situations. First, find the most dangerous ship, and then take corresponding actions according to the automatic collision avoidance model. The specific implementation steps are as follows.

[0165] Step 1: Find the most dangerous ship

[0166] According to the target ship data (speed, course and position) within 5 nautical miles of the ship, determine whether the target ship poses a collision risk with the ship. And calculate the collision risk value C of all target ships that pose a collision risk with the ship. RI , C RI The target ship with the largest value is the most dangerous ship.

[0167] Step 2: Calculate the solution based on steering alone

[0168] For the most dangerous ship, find the feasible course range of the ship within the range of -50° to 50° [C n ,C m]. Start with a 10° steering angle and increase by 1° to verify whether all possible steering angles are safe. The minimum steering angle that can be safely avoided is the best avoidance plan for the ship by steering alone. If no feasible steering angle is found, try to avoid by changing speed.

[0169] Step 3: Calculate the speed-shifting solution

[0170] Find the feasible propeller speed range in DS AH and F AH The propeller speed of the ship at creep speed and full speed ahead. By increasing or decreasing the ship's gear, verify whether all feasible gears are safe. The solution with the smallest gear change is the best avoidance solution based on speed change alone. If no feasible gear is found, try to avoid it by changing direction and speed.

[0171] Step 4: Calculate the combination of direction change and speed change

[0172] According to the feasible course range and feasible gear position obtained in steps 2 and 3, the steering angle is increased and the gear position is changed, and all feasible steering and speed change avoidance schemes are verified to be safe. The minimum steering and speed change combination that can safely avoid is the best steering and speed change avoidance scheme.

[0173] Furthermore, in this embodiment, the judgment on whether the ship can resume the planned route can be performed through the ship MMG model, which only considers the three degrees of freedom of the ship's pitch, sway and surge, that is, only considers the movement of the ship on a two-dimensional plane, and does not consider the ship's pitch, heave and roll motion. When controlling the ship to resume the planned route and controlling the ship to continue sailing along the planned route, it is also performed through the ship MMG model.

[0174] In addition, for ships entering ports in complex waterways, the ship speed and propeller speed will often change during navigation, and directly using the classic MMG model to deduce and predict the ship maneuvering motion process will produce large errors. Therefore, this embodiment corrects the thrust reduction coefficient and propeller speed as follows to obtain a ship variable speed MMG model suitable for entering ports in complex waterways.

[0175] 1)Thrust reduction factor t p Correction

[0176] Thrust reduction factor t p It is related to the ship type, propeller size and propeller load. For a given ship, the ship type and propeller size are fixed, and only the change of propeller load will affect the thrust reduction factor t p , and its influence is shown in formula (20).

[0177]

[0178] Where v0 and v are the speed at the rated speed of the propeller and the speed of the ship at the current moment, respectively. p0 is the thrust derating coefficient at the rated speed of the propeller; ε(v) is the influence function of the thrust derating coefficient.

[0179] ε(v) is calculated by formula (21).

[0180]

[0181] In the formula, α R and α are the ship drift angles at the rudder and the center of the ship respectively; B, d, L oa , D ρ and x c are respectively the ship width, draft, length, propeller diameter and longitudinal coordinate of the center of buoyancy; k t , γ A , C b , l cb and l R They are correction coefficient, hull straightening coefficient, square coefficient, buoyancy coefficient and drift angle coefficient. The above parameters can be found from the ship data.

[0182] 2) Propeller speed R PM Adjustment

[0183] Assuming that the ship sends a command to adjust the speed at time t1, the propeller speeds before and after the ship changes speed are t2 is the time when the propeller speed reaches the indicated speed command, so the propeller speed R at any time t is PM (t) As shown in formula (22).

[0184]

[0185] Wherein, η is the propeller speed change rate. In this embodiment, according to the ship parameters and the captain's experience, η is set to 0.25 in the standby state where the car clock command can be adjusted at any time.

[0186] In addition, it should be noted that for systems that can operate automatically and autonomously, the parameters can be set before the system is operated and remain unchanged during the operation of the system. The selection of parameters in this embodiment depends on multiple initial conditions such as ship type, traffic and natural environment. Using a fixed parameter cannot cover all scenarios with different initial conditions.

[0187] In a decision-making framework that conforms to navigation practice, once the external environment and the ship are determined, the captain who is familiar with the ship's maneuverability has the right and the best ability to determine these parameters. In the application of autonomous navigation, the designer or the captain of the ship can set and modify the parameters accordingly before the ship arrives at the application waters. These modifications and adjustments can be made according to the actual environmental conditions and ship conditions to achieve the best autonomous navigation effect. The selection of other parameters in this embodiment also follows the above principles.

[0188] In addition, ships are affected by external environments such as wind, waves, and currents during navigation. Complex waterways are usually located in coastal waters such as straits or harbors, where the sea conditions are usually good and the impact of waves can be temporarily ignored. Therefore, this embodiment further modifies the classic MMG ship maneuvering motion mathematical model for the effects of wind and current.

[0189] 1) Influence of wind

[0190] The effect of wind on the motion of a ship is manifested as wind pressure exerted on the ship, which causes the ship to sway violently and yaw, affecting the stability and maneuverability of the ship. The effect of wind on the three degrees of freedom can be calculated by formula (23).

[0191]

[0192] Where ρ represents the air density, L oa Indicates the captain, U R is the relative wind speed, which is the vector sum of the true wind speed and the ship speed, A LP and A OP Respectively represent the side projection and front projection areas of the ship above sea level. wx , C wy , C wn They represent the lateral and longitudinal wind pressure coefficients and wind pressure moment coefficients respectively, and can be calculated using the Isherwood regression formula.

[0193] 2) Impact of flow

[0194] Ocean current refers to the large-scale, relatively stable movement of seawater. When a ship sails in a flow field environment with constant velocity and direction, it will not generate fluid dynamics to affect the ship's attitude, but will only affect the ship's speed, and its impact is calculated by formula (24).

[0195]

[0196] In the formula, u c 、v c are the components of the corrected ship speed in the x-axis and y-axis directions, C c 、V c are flow direction and flow velocity respectively, and C0 is the ship's heading.

[0197] When a ship sails in a narrow waterway, the parameters in the equation of the classic MMG ship maneuvering motion model will change compared with deep-water navigation due to the limited navigation area. The study waters belong to a narrow waterway. In order to make the ship maneuvering motion model more consistent with the narrow waterway navigation scenario, this embodiment modifies the classic MMG ship maneuvering motion model as follows.

[0198] 1) Correction of additional mass and additional moment of inertia

[0199] When a ship is sailing in a narrow waterway, the additional mass and additional moment of inertia change significantly compared to deep-water navigation. The corrected additional mass and moment of inertia are calculated using formula (25).

[0200]

[0201] In the formula, m x 、m y and J ZZ Represent the additional mass and additional moment of inertia in deep water, m xH 、m yH and J ZZH They represent the corrected additional mass and additional moment of inertia, respectively, C b is the ship square coefficient, d m is the average draft, B is the ship's width, and h is the water depth.

[0202] 2) Correction of hydrodynamic forces and moments acting on the bare hull

[0203] When the ship's draft ratio H / d is less than 3, the shallow water effect will be more obvious. The basic trend is that as the water depth gradually decreases, the force and moment acting on the hull will gradually increase.

[0204] The corrected hydrodynamic force and moment can be calculated using equations (26) and (27).

[0205]

[0206] Where ρ represents the air density, L oa represents the length of the ship, d is the draft of the ship, A w is the area of ​​the ship’s waterline, C t is the total drag coefficient during straight sailing. Other parameters are shown in Table 3.

[0207] Table 3

[0208]

[0209] 3) Correction of hydrodynamic forces and moments acting on the rudder

[0210] In this embodiment, the distance x from the center of the lateral force of the steering-induced hull to the center of gravity of the ship is corrected.H and the correction factor a of the lateral force induced on the hull after the ship is steered H To correct the hydrodynamic force and moment acting on the rudder, the correction method is expressed as (28).

[0211]

[0212] Where d is the ship's draft, h is the water depth; the superscripts s and d represent narrow channel and deep water conditions, respectively.

[0213] 4) Correction of forces and moments acting on the propeller

[0214] By the propeller semi-flow coefficient ω p and thrust derating factor t p The correction method is expressed as (29) to correct the force and torque acting on the propeller.

[0215]

[0216] In the formula, d is the ship's draft, h is the water depth, C b represents the square coefficient. The superscripts s and d represent narrow channel and deep water conditions, respectively.

[0217] The embodiments of the present invention realize adaptive autonomous navigation into a port through a complex waterway.

[0218] Embodiment 2:

[0219] The present invention also provides a complex waterway ship navigation decision terminal device, including a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor implements the steps in the above-mentioned method embodiment of the first embodiment of the present invention when executing the computer program.

[0220] Further, as an executable solution, the complex waterway ship navigation decision terminal device can be a computing device such as a desktop computer, a notebook, a PDA, and a cloud server. The complex waterway ship navigation decision terminal device may include, but is not limited to, a processor and a memory. Those skilled in the art can understand that the composition structure of the above-mentioned complex waterway ship navigation decision terminal device is only an example of a complex waterway ship navigation decision terminal device, and does not constitute a limitation on the complex waterway ship navigation decision terminal device. It may include more or less components than the above, or a combination of certain components, or different components. For example, the complex waterway ship navigation decision terminal device may also include input and output devices, network access devices, buses, etc., and the embodiments of the present invention do not limit this.

[0221] Further, as an executable solution, the processor may be a central processing unit (CPU), or other general-purpose processors, digital signal processors (DSP), application-specific integrated circuits (ASIC), field-programmable gate arrays (FPGA) or other programmable logic devices, etc. The general-purpose processor may be a microprocessor or any conventional processor, etc. The processor is the control center of the complex waterway ship navigation decision terminal device, and uses various interfaces and lines to connect various parts of the entire complex waterway ship navigation decision terminal device.

[0222] The memory can be used to store the computer program and / or module, and the processor realizes various functions of the complex waterway ship navigation decision terminal device by running or executing the computer program and / or module stored in the memory, and calling the data stored in the memory. The memory can mainly include a program storage area and a data storage area, wherein the program storage area can store an operating system and at least one application required for a function; the data storage area can store data created according to the use of the mobile phone, etc. In addition, the memory can include a high-speed random access memory, and can also include a non-volatile memory, such as a hard disk, a memory, a plug-in hard disk, a smart memory card (Smart Media Card, SMC), a secure digital (Secure Digital, SD) card, a flash card (Flash Card), at least one disk storage device, a flash memory device, or other volatile solid-state storage devices.

[0223] The present invention also provides a computer-readable storage medium, wherein the computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, the steps of the above method in the embodiment of the present invention are implemented.

[0224] If the module / unit integrated in the complex waterway ship navigation decision terminal device is implemented in the form of a software functional unit and sold or used as an independent product, it can be stored in a computer-readable storage medium. Based on this understanding, the present invention implements all or part of the processes in the above-mentioned embodiment method, and can also be completed by instructing the relevant hardware through a computer program. The computer program can be stored in a computer-readable storage medium. When the computer program is executed by the processor, the steps of the above-mentioned method embodiments can be implemented. Among them, the computer program includes computer program code, and the computer program code can be in source code form, object code form, executable file or some intermediate form. The computer-readable medium may include: any entity or device that can carry the computer program code, recording medium, U disk, mobile hard disk, disk, optical disk, computer memory, read-only memory (ROM, Read-Only Memory), random access memory (RAM, Random Access Memory) and software distribution medium, etc.

[0225] Although the present invention has been specifically shown and described in conjunction with the preferred embodiments, it should be understood by those skilled in the art that various changes may be made to the present invention in form and details without departing from the spirit and scope of the present invention as defined by the appended claims, all of which are within the scope of protection of the present invention.

Claims

1. A complex waterway ship navigation decision-making method, characterized in that: The following steps are involved: S1: Determine in real time whether the ship is yawed during its travel. If it is yawed, enter S2; otherwise, enter S3; S2: Determine whether the ship can resume sailing to the planned route. If so, control it to resume sailing to the planned route; otherwise, enter S3; S3: Determine whether the ship has navigation risk and collision risk; when there is navigation risk, take corresponding actions according to the corresponding navigation risk type; when there is collision risk, calculate the collision risk of each ship that poses a collision risk to the ship, find the ship with the largest collision risk as the most dangerous ship, and take corresponding actions based on the most dangerous ship according to the automatic collision avoidance model; when neither navigation risk nor collision risk exists, control the ship to continue sailing along the planned route.

2. The complex waterway ship navigation decision-making method according to claim 1 is characterized by: The ship MMG model is used to determine whether the ship can resume sailing on the planned route. The ship MMG model corrects the thrust reduction coefficient and propeller speed based on the classic MMG model, as follows: Among them, t p represents the thrust reduction coefficient; v0 represents the speed at the rated speed of the propeller; v represents the current speed of the ship; t p0 represents the thrust derating coefficient at the rated speed of the propeller; ε(v) represents the influence function of the thrust derating coefficient; α R represents the ship drift angle at the rudder; α represents the ship drift angle at the center of the ship; B, d, L oa , D ρ and x c They represent the ship width, draft, length, propeller diameter and longitudinal coordinate of the center of buoyancy respectively; k t , γ A , C b , l cb and l R They represent the correction factor, hull straightening factor, squareness factor, buoyancy coefficient and drift angle coefficient respectively; Among them, R PM (t) represents the propeller speed at time t, Indicates the propeller speed before the ship changes speed; It indicates the propeller speed after the ship changes speed; t1 indicates the moment when the ship speed is adjusted by the ship clock command; t2 indicates the moment when the propeller speed reaches the indicated ship clock command; η is the propeller speed change rate.

3. The complex waterway ship navigation decision-making method according to claim 1 is characterized by: Navigation risks include grounding, hitting reefs and contact with natural static obstacles during navigation; When taking corresponding actions, the virtual environment elements corresponding to various types of navigation risks are abstracted into point-shaped, circular or polygonal obstacles according to their shapes.

4. The complex waterway ship navigation decision-making method according to claim 1 is characterized by: The method for determining whether there is a collision risk is to set the ship's ship area as an eccentric ellipse and calculate the distance Dis between the target ship and the boundary of the ship's ship area by the following formula: Among them, a and b represent the minor axis and major axis of the ship domain, respectively; It indicates the angle between the bow line of own ship and the azimuth line of target ship to the right; D indicates the distance between target ship and virtual own ship; Indicates the distance between the virtual own ship and the boundary of the ship domain; When the distance between the target ship and the boundary of the own ship's ship area is less than 0, it is determined that there is a risk of collision between the own ship and the target ship.

5. The complex waterway ship navigation decision-making method according to claim 1 is characterized by: The method of taking corresponding actions based on the automatic collision avoidance model based on the most dangerous ship is: First, try to adopt the solution of steering alone, that is, find the feasible course range of the ship within the range of -50° to 50° for the most dangerous ship; start from the 10° steering angle, increase 1° in sequence to verify whether all feasible steering angles are safe; set the minimum steering angle that can be safely avoided as the best avoidance solution of the ship relying on steering alone; if no feasible steering angle can be found, try to adopt the solution of speed change alone; In the speed change scheme alone, find a feasible propeller speed range; verify whether all feasible gear positions are safe by increasing or decreasing the ship's gear position; set the scheme with the smallest gear change as the best avoidance scheme based on speed change alone; if no feasible gear position is found, try to adopt a combined speed change and direction change scheme; In the combined redirection and speed change scheme, according to the feasible heading range and feasible car clock gear obtained in the above steps, the redirection angle is increased and the car clock gear is changed at the same time, and all feasible redirection and speed change avoidance schemes are verified in turn to be safe, and the minimum redirection and speed change combination that can safely avoid is set as the optimal redirection and speed change combined avoidance scheme.

6. A terminal device for ship navigation decision-making in complex waterways, characterized by: The method comprises a processor, a memory and a computer program stored in the memory and running on the processor, wherein the processor implements the steps of any one of the methods of claims 1 to 5 when executing the computer program.

7. A computer-readable storage medium storing a computer program, characterized in that: When the computer program is executed by a processor, the steps of the method according to any one of claims 1 to 5 are implemented.

Citation Information

Cited By

  • Ship control method and device, electronic equipment, readable storage medium and chip

    CN120993912A

  • Trailing suction dredger sailing collision risk dynamic assessment and collision avoidance decision-making method

    CN121122074A

  • Dynamic assessment of collision risk and collision avoidance decision-making method for trailing suction hopper dredger

    CN121122074B