Under-actuated ship berthing control method with collision avoidance function

Through the velocity line-of-view guidance method and control obstacle function, the collision avoidance problem in the automatic berthing control method of ships is transformed into constraints of speed and bow angular velocity. The solution is made by using the secondary planning problem to solve the collision between ships and obstacles in the existing technology. The risk issue has achieved safe and efficient berth control.

CN119002485APending Publication Date: 2024-11-22DALIAN MARITIME UNIVERSITY
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411085739.7
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-08
Publication Date
2024-11-22

AI Technical Summary

Technical Problem

The existing automatic berthing control method of ships ignores the risk of collision between ships and static obstacles, dynamic obstacles and coastlines during berthing, resulting in failure and safety issues of berthing tasks.

Method used

The velocity line-of-sight guidance method and control obstacle function are used to transform the collision avoidance problems between static obstacles, dynamic obstacles and coastlines in the ship and the port area into constraints of ship speed and bow shaking angular velocity. Through the solution of the secondary planning problem, the design of non- Linear control method to ensure that the ship's speed converges to zero upon arrival at the berth and avoids collisions.

Benefits of technology

It improves the safety of automatic berthing of ships, ensures that the ship avoids collisions with static obstacles, dynamic obstacles and coastlines during berthing, and achieves safe and efficient berthing control.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119002485A_ABST
    Figure CN119002485A_ABST
Patent Text Reader

Abstract

The invention provides an under-actuated ship berthing control method with a collision avoidance function, which comprises the following steps of: S1, providing expected speed distribution and virtual expected yawing angular velocity for berthing control by using a speed sight guidance method; s2, converting the collision avoidance problem of the ship with static obstacles, dynamic obstacles and coastlines in the harbor district into constraints of ship speed and yawing angular speed by using a control obstacle function; s3, constructing a quadratic programming problem to solve an expected speed and an expected yawing angular speed meeting constraint conditions; and S4, designing a berthing controller by using a nonlinear control method, controlling the speed and the yawing angular velocity to converge to the expected speed and the yawing angular velocity provided by the guidance module, and ensuring that the speed of the ship converges to zero when the ship arrives at the berth. The method not only can ensure that the speed of the ship converges to zero when the ship reaches the target berth at the specified course, but also can prevent the ship from colliding with static obstacles, dynamic obstacles and a coastline, and improves the safety of automatic berthing of the ship.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of intelligent ships, and in particular to a berthing control method for an underactuated ship with a collision avoidance function. Background Art

[0002] In recent years, automatic berthing has attracted much attention as the "last mile" of full-range autonomous navigation for smart ships. Automatic berthing not only requires that the speed of the ship converges to zero when it arrives at the berth at a specified heading, but also requires the ship to avoid collisions with static obstacles, dynamic obstacles and coastlines in the port area. In order to ensure the safety of berthing, it is imperative to realize berthing control with collision avoidance function; however, most of the existing berthing control research has ignored the collision avoidance problem.

[0003] Existing research has developed a ship automatic berthing control method based on fuzzy backstepping, which ensures that the ship's speed converges to zero when it reaches the target berth while tracking the desired berthing trajectory at an appropriate speed. However, this study ignores the risk of collision between the ship and static obstacles, dynamic obstacles and coastlines during the berthing process, which may lead to the failure of the berthing mission and even cause economic losses and casualties. Therefore, this study has certain limitations. Summary of the invention

[0004] In view of this, the purpose of the present invention is to propose an under-actuated ship berthing control method with collision avoidance function. The technology provided by the present invention can not only ensure that the speed of the ship converges to zero when it reaches the target berth at a specified heading, but also avoid collision between the ship and static obstacles, dynamic obstacles and coastline in the port area, thereby improving the safety of automatic berthing of the ship.

[0005] The technical means adopted by the present invention are as follows:

[0006] A berthing control method for an underactuated ship with a collision avoidance function comprises the following steps:

[0007] S1. Establishing a guidance module, wherein the guidance module uses a speed line of sight guidance method to provide a desired speed distribution and a virtual desired bow angular velocity for berthing control;

[0008] S2, the guidance module uses the control obstacle function to convert the collision avoidance problem between the ship and the static obstacles, dynamic obstacles and coastline in the port area into the first constraint, the second constraint and the third constraint of the ship speed and the bow angular velocity;

[0009] S3, constructing a quadratic programming problem to solve the desired speed and the desired yaw angular velocity under the conditions of satisfying the first constraint, the second constraint and the third constraint;

[0010] S4. Design a berthing control module, which includes a heading controller and a speed controller. The heading controller and the speed controller are designed using a nonlinear control method to control the speed and the yaw angular velocity to converge to the desired speed and yaw angular velocity provided by the guidance module, ensuring that the ship avoids collision while the speed converges to zero when reaching the berth.

[0011] Furthermore, S1 specifically includes the following steps:

[0012] Given a parameterized reference trajectory ξ R (γ(t))=[x R (γ(t)),y R (γ(t))] T , where γ(t) represents a continuous function related to time;

[0013] The trajectory tangent angle χ of the reference trajectory R (γ) is defined as follows:

[0014] χ R (γ) = atan2[y′ R (γ),x′ R (γ)] (1)

[0015] in,

[0016] The tracking error of the ship in the trajectory tangent coordinate system is expressed as follows:

[0017]

[0018] Among them, x e represents the longitudinal tracking error, y e represents the lateral tracking error;

[0019] The guidance system is designed to:

[0020]

[0021] Among them, U γ Indicates virtual speed;

[0022] Taking the derivative of both ends of the tracking error at the same time, we get:

[0023]

[0024] Among them, β c =arctan(v / u) represents the sideslip angle;

[0025] The ship's expected course is designed as follows:

[0026]

[0027] Among them, Δ represents the foresight distance;

[0028] The heading error is defined as:

[0029] ψ e =ψ-ψ R (6)

[0030] Taking the derivative of both ends of the heading error at the same time, we get:

[0031]

[0032] In order to stabilize the heading error, the virtual desired yaw angular velocity is designed as:

[0033]

[0034] Among them, μ R >0 and Δ R >0 indicates design parameters;

[0035] In order to stabilize the longitudinal tracking error, the virtual speed U γ Designed for:

[0036]

[0037] Among them, μ U >0 indicates design parameters;

[0038] According to the virtual speed U γ The trajectory variable γ of the reference trajectory can be calculated as follows:

[0039]

[0040] The speed distribution system enables the trajectory speed Converge to the desired speed Right now:

[0041]

[0042] According to the speed distribution system, the desired speed distribution variable It can be calculated as follows:

[0043]

[0044] In summary, the desired speed distribution variable is obtained and the virtual desired yaw angular velocity r OR .

[0045] Furthermore, S2 specifically includes the following steps:

[0046] S21, converting the collision avoidance between the ship and the static obstacle into the first constraint of the ship speed and the yaw angular velocity;

[0047] In order to avoid collision between ships and static obstacles, the first safety set η is designed. S :

[0048]

[0049] Where P = [y, x] T Indicates the current position of the ship; P S =[y S ,x S ] T Indicates the location of static obstacles; d S Indicates the safe distance between the ship and the static obstacle;

[0050] According to the first-order inequality:

[0051]

[0052] Control barrier function Φ S (P,P S ) is as follows:

[0053]

[0054] According to equations 14 and 15, the first constraint condition of the ship speed U is expressed as follows:

[0055]

[0056] in:

[0057]

[0058] Among them, κ S >0 indicates design parameters;

[0059] According to the second-order inequality:

[0060]

[0061] Control barrier function Φ S (P,P S ) is as follows:

[0062]

[0063] According to equations 18 and 19, the first constraint condition of the ship's bow angular velocity r is expressed as follows:

[0064]

[0065] in:

[0066]

[0067] In summary, the first constraint of ship speed and bow angular velocity is obtained;

[0068] S22, converting the collision avoidance between the ship and the dynamic obstacle into constraints on the ship speed and the bow angular velocity;

[0069] In order to avoid collision between ships and dynamic obstacles, the second safety set η is defined D :

[0070]

[0071] Among them, P D =[y D ,x D ] T Indicates the position of dynamic obstacles; d D Indicates the safe distance between the ship and the dynamic obstacle;

[0072] According to the first-order inequality:

[0073]

[0074] Control barrier function Φ D (P,P D ) is as follows:

[0075]

[0076] According to Equation 23 and Equation 24, the second constraint condition of the ship speed U is expressed as follows:

[0077]

[0078] in:

[0079]

[0080] According to the second-order inequality:

[0081]

[0082] The second constraint condition of the ship's pitch angular velocity r is expressed as follows:

[0083]

[0084] in:

[0085]

[0086] In summary, the second constraint of ship speed and bow angular velocity can be obtained;

[0087] S23, converting the collision avoidance between the ship and the coastline into constraints on the ship speed and the pitch angular velocity;

[0088] In order to avoid collision between ships and coastlines, the third safety set η is defined C :

[0089]

[0090] Among them, d C Indicates the safe distance between the ship and the coastline; P j =[y j ,x j ] T , j = 1, 2, ..., 5 represents the positions of the other vertices of the ship, which can be obtained from the position of the center point of the ship P = [y, x] T Calculated:

[0091]

[0092] Among them, Δ jx and Δ jy Indicates the longitudinal and transverse position offset between the center position of the ship and other vertices of the ship;

[0093] According to the first-order inequality:

[0094]

[0095] Control barrier function Φ C (P,P j ) is as follows:

[0096]

[0097] According to equations 32 and 33, the third constraint condition of the ship speed U is expressed as follows:

[0098]

[0099] in:

[0100]

[0101] According to the second-order inequality:

[0102]

[0103] The third constraint condition of the ship's pitch angular velocity r is expressed as follows:

[0104]

[0105] in:

[0106]

[0107] In summary, by designing the control obstacle function, the collision avoidance between the ship and the coastline can be transformed into the third constraint of the ship speed and the bow angular velocity.

[0108] Furthermore, S3 specifically includes the following steps:

[0109] Assume that the ship's speed U can keep up with the expected speed U O , the ship's pitch angular velocity r can keep up with the expected pitch angular velocity r O , then the expected speed U O The following quadratic programming problem is solved:

[0110]

[0111] Limited by:

[0112]

[0113] The ship's desired pitch angular velocity r O Solving the quadratic programming problem:

[0114]

[0115] Limited by:

[0116]

[0117] Furthermore, in S4, the design method of the mathematical model of the three-degree-of-freedom underactuated ship is as follows:

[0118]

[0119] Where ξ=[x,y,ψ] T Indicates the position and heading of the ship; υ=[u,v,r] T Indicates the speed of forward movement, horizontal drift, and bow swing; represents the transformation matrix; represents the inertia matrix; represents the Coriolis centripetal matrix; represents the damping matrix, D W =[D Wu ,D Wv ,D Wr ] T Indicates environmental interference;

[0120] τ represents the control force and torque, and τ is expressed by an actuator model τ with a tail propeller and a bow thruster as follows:

[0121] τ=ΒΝ (48)

[0122] Where, Β=TK represents the input matrix; represents the thrust configuration matrix; represents the thrust coefficient matrix; l represents the thrust arm of the thruster, Ν=[|n1|n1,|n2|n2] T represents the control input, where n1 represents the speed of the propeller and n2 represents the speed of the thruster.

[0123] Further, in S4, the design method of the heading controller is as follows:

[0124] The error system is expressed as follows:

[0125]

[0126] Define the Lyapunov function:

[0127]

[0128] Taking the derivative at both ends simultaneously, we get:

[0129]

[0130] Among them, n 32 , n 33 and m 33 represents the model parameters;

[0131] Control input τ r Designed for:

[0132]

[0133] Among them, c r >0 and n r >0 indicates design parameters;

[0134] According to the actuator model, the control signal of the bow thruster is:

[0135]

[0136] Wherein, Ν2=|n2|n2, n2 represents the rotation speed of the bow thruster;

[0137] Substituting equation 52 into equation 51 yields:

[0138]

[0139] Further, in S4, the speed controller is designed as follows:

[0140] The velocity error system is defined as follows:

[0141] u e=uU O (55)

[0142] Define the Lyapunov function:

[0143]

[0144] Taking the derivative at both ends simultaneously, we get:

[0145]

[0146] Among them, n 11 and m 11 represents the model parameters;

[0147] Control input τ u Designed for:

[0148]

[0149] Among them, c u >0 and n u >0 indicates design parameters;

[0150] According to the actuator model, the control signal of the tail propeller is:

[0151]

[0152] Wherein, N1=|n1|n1, n1 represents the rotation speed of the tail propeller;

[0153] Substituting equation 58 into equation 57, we obtain

[0154]

[0155] The present invention also provides a storage medium, which includes a stored program, wherein when the program is run, any of the above-mentioned under-actuated ship berthing control methods with collision avoidance function is executed.

[0156] The present invention also provides an electronic device, comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor executes any of the above-mentioned methods for controlling berthing of an under-actuated ship with a collision avoidance function through the operation of the computer program.

[0157] Compared with the prior art, the present invention has the following advantages:

[0158] Firstly, the present invention combines the speed distribution system with the line-of-sight guidance method, and proposes a speed line-of-sight guidance method, which provides the desired speed distribution and virtual bow angular velocity for berthing control; secondly, the present invention transforms the collision avoidance problem between the ship and the static obstacles, dynamic obstacles and coastline in the port area into the constraints of the ship speed and bow angular velocity by using the control obstacle function; finally, the present invention solves the desired speed and desired bow angular velocity that meet the above-mentioned collision avoidance constraints by constructing a quadratic programming problem, and provides a reference signal for berthing control.

[0159] The present invention designs a berthing controller by using a nonlinear control method, controls the speed and the bow angular velocity to converge to the desired speed and the bow angular velocity provided by the guidance module, and ensures that the ship avoids collision while the speed converges to zero when arriving at the berth. BRIEF DESCRIPTION OF THE DRAWINGS

[0160] In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, the drawings described below are some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative labor.

[0161] Figure 1 This is a control block diagram of the method of the present invention.

[0162] Figure 2 This is a performance diagram of the berthing trajectory tracking according to an embodiment of the present invention.

[0163] Figure 3 This is a distance diagram between a ship and static obstacles, dynamic obstacles and a coastline according to an embodiment of the present invention.

[0164] Figure 4 This is a diagram of the forward speed, drift speed and bow angular velocity of a ship according to an embodiment of the present invention.

[0165] Figure 5 This is a rotation speed diagram of the tail propeller and the bow propeller according to an embodiment of the present invention. DETAILED DESCRIPTION

[0166] In order to enable those skilled in the art to better understand the scheme of the present invention, the technical scheme in the embodiments of the present invention will be clearly and completely described below in conjunction with the drawings in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work should fall within the scope of protection of the present invention.

[0167] It should be noted that the terms "first", "second", etc. in the specification and claims of the present invention and the above-mentioned drawings are used to distinguish similar objects, and are not necessarily used to describe a specific order or sequence. It should be understood that the data used in this way can be interchanged where appropriate, so that the embodiments of the present invention described herein can be implemented in an order other than those illustrated or described herein. In addition, the terms "including" and "having" and any variations thereof are intended to cover non-exclusive inclusions, for example, a process, method, system, product or device that includes a series of steps or units is not necessarily limited to those steps or units that are clearly listed, but may include other steps or units that are not clearly listed or inherent to these processes, methods, products or devices.

[0168] like Figure 1 As shown, the present invention provides a berthing control method for an underactuated ship with a collision avoidance function. First, the speed distribution is combined with the line-of-sight guidance method, and a speed line-of-sight guidance method is proposed to provide the desired speed distribution and virtual desired bow angular velocity for berthing control; secondly, the collision avoidance problem with static obstacles, dynamic obstacles and coastlines is converted into constraints on ship speed and bow angular velocity by using the control obstacle function; finally, a quadratic programming problem is constructed to solve the desired speed and desired bow angular velocity that meet the above-mentioned collision avoidance constraints, and a reference signal is provided for berthing control. For the berthing control module, a berthing controller is designed by using a nonlinear control method to control the speed and bow angular velocity to converge to the desired speed and bow angular velocity provided by the guidance module, ensuring that the ship avoids collision while the speed converges to zero when arriving at the berth.

[0169] Figure 1 In R (γ(t))=[x R (γ(t)),y R (γ(t))] T represents a parameterized reference trajectory, where γ(t) represents a time-dependent continuous function; U γ Indicates virtual speed; r OR represents the virtual desired yaw angular velocity; U O and r O represents the desired speed and desired pitching angular velocity that meet the collision avoidance requirements; n1 and n2 represent the propeller speed of the actuator; D W Indicates environmental interference; U R represents the designed desired speed; ξ and υ represent the current state of the ship.

[0170] The present invention specifically comprises the following steps:

[0171] S1. Establishing a guidance module, wherein the guidance module uses a speed line of sight guidance method to provide a desired speed distribution and a virtual desired yaw angular velocity for berthing control;

[0172] Given a parameterized reference trajectory ξ R (γ(t))=[x R (γ(t)),y R (γ(t))] T , where γ(t) represents a continuous function related to time;

[0173] The trajectory tangent angle χ of the reference trajectory R (γ) is defined as follows:

[0174]

[0175] in,

[0176] The tracking error of the ship in the trajectory tangent coordinate system is expressed as follows:

[0177]

[0178] Among them, x e represents the longitudinal tracking error, y e represents the lateral tracking error;

[0179] The guidance system is designed to:

[0180]

[0181] Among them, U γ Indicates virtual speed;

[0182] Taking the derivative of both ends of the tracking error at the same time, we get:

[0183]

[0184] Among them, β c =arctan(v / u) represents the sideslip angle;

[0185] The ship's expected course is designed as follows:

[0186]

[0187] Among them, Δ represents the foresight distance;

[0188] The heading error is defined as:

[0189] ψ e =ψ-ψ R (6)

[0190] Taking the derivative of both ends of the heading error at the same time, we get:

[0191]

[0192] In order to stabilize the heading error, the virtual desired yaw angular velocity is designed as:

[0193]

[0194] Among them, μ R >0 and Δ R >0 indicates design parameters;

[0195] In order to stabilize the longitudinal tracking error, the virtual speed U γ Designed for:

[0196]

[0197] Among them, μ U >0 indicates design parameters;

[0198] According to the virtual speed U γ The trajectory variable γ of the reference trajectory can be calculated as follows:

[0199]

[0200] The speed distribution system enables the trajectory speed Converge to the desired speed Right now:

[0201]

[0202] According to the speed distribution system, the desired speed distribution variable It can be calculated as follows:

[0203]

[0204] In summary, the desired speed distribution variable is obtained and the virtual desired yaw angular velocity r OR .

[0205] S2. In order to avoid collision between the ship and static obstacles, dynamic obstacles and coastline during berthing, the guidance module uses the control obstacle function to convert the collision avoidance problem between the ship and static obstacles, dynamic obstacles and coastline in the port area into the first constraint, the second constraint and the third constraint of the ship speed and the bow angular velocity respectively;

[0206] S21, converting the collision avoidance between the ship and the static obstacle into the first constraint of the ship speed and the yaw angular velocity;

[0207] In order to avoid collision between ships and static obstacles, the first safety set η is designed. S :

[0208]

[0209] Where P = [y, x] T Indicates the current position of the ship; P S =[y S ,x S ] T Indicates the location of static obstacles; d S Indicates the safe distance between the ship and the static obstacle;

[0210] According to the first-order inequality:

[0211]

[0212] Control barrier function Φ S (P,P S ) is as follows:

[0213]

[0214] According to equations 14 and 15, the first constraint condition of the ship speed U is expressed as follows:

[0215]

[0216] in:

[0217]

[0218] Among them, κ S >0 indicates design parameters;

[0219] According to the second-order inequality:

[0220]

[0221] Control barrier function Φ S (P,P S ) is as follows:

[0222]

[0223] According to equations 18 and 19, the first constraint condition of the ship's bow angular velocity r is expressed as follows:

[0224]

[0225] in:

[0226]

[0227] In summary, the first constraint of ship speed and bow angular velocity is obtained;

[0228] S22, converting the collision avoidance between the ship and the dynamic obstacle into constraints on the ship speed and the heading angular velocity;

[0229] In order to avoid collision between ships and dynamic obstacles, the second safety set η is defined D :

[0230]

[0231] Among them, P D =[y D ,x D ] T Indicates the position of dynamic obstacles; d D Indicates the safe distance between the ship and the dynamic obstacle;

[0232] According to the first-order inequality:

[0233]

[0234] Control barrier function Φ D (P,P D ) is as follows:

[0235]

[0236] According to Equation 23 and Equation 24, the second constraint condition of the ship speed U is expressed as follows:

[0237]

[0238] in:

[0239]

[0240] According to the second-order inequality:

[0241]

[0242] The second constraint condition of the ship's pitch angular velocity r is expressed as follows:

[0243]

[0244] in:

[0245]

[0246] In summary, the second constraint of ship speed and bow angular velocity can be obtained;

[0247] S23, converting the collision avoidance between the ship and the coastline into constraints on the ship speed and the pitch angular velocity;

[0248] In order to avoid collision between ships and coastlines, the third safety set η is defined C :

[0249]

[0250] Among them, d C Indicates the safe distance between the ship and the coastline; P j =[y j ,x j ] T , j = 1, 2, ..., 5 represents the positions of the other vertices of the ship, which can be obtained from the position of the center point of the ship P = [y, x] T Calculated:

[0251]

[0252] Among them, Δ jx and Δ jy Indicates the longitudinal and transverse position offset between the center position of the ship and other vertices of the ship;

[0253] According to the first-order inequality:

[0254]

[0255] Control barrier function Φ C (P,P j ) is as follows:

[0256]

[0257] According to equations 32 and 33, the third constraint condition of the ship speed U is expressed as follows:

[0258]

[0259] in:

[0260]

[0261] According to the second-order inequality:

[0262]

[0263] The third constraint condition of the ship's pitch angular velocity r is expressed as follows:

[0264]

[0265] in:

[0266]

[0267] In summary, by designing the control obstacle function, the collision avoidance between the ship and the coastline can be transformed into the third constraint of the ship speed and the bow angular velocity.

[0268] S3. Construct a quadratic programming problem to solve the expected speed U under the conditions of satisfying the first constraint, the second constraint and the third constraint. O and the desired yaw angular velocity r O , providing reference signal for berthing control.

[0269] Assume that the ship's speed U can keep up with the expected speed U O , the ship's pitch angular velocity r can keep up with the expected pitch angular velocity r O , then the expected speed U O The following quadratic programming problem is solved:

[0270]

[0271] Limited by:

[0272]

[0273] The desired yaw angular velocity r of the ship O Solving the quadratic programming problem:

[0274]

[0275] Limited by:

[0276]

[0277] Define the Lyapunov function:

[0278]

[0279] Taking the derivative at both ends simultaneously, we get:

[0280]

[0281] Where rΔ=r O -r OR , 0<ξ R <1. Let We can get:

[0282]

[0283] In summary, the speed sight guidance system with collision avoidance function proposed by the present invention is stable.

[0284] S4. Design a berthing control module, which includes a heading controller and a speed controller. The heading controller and the speed controller are designed using a nonlinear control method to control the speed and the yaw angular velocity to converge to the desired speed and yaw angular velocity provided by the guidance module, ensuring that the ship avoids collision while the speed converges to zero when reaching the berth.

[0285] The design method of the mathematical model of a three-degree-of-freedom underactuated ship is as follows:

[0286]

[0287] Where ξ=[x,y,ψ] T Indicates the position and heading of the ship; υ=[u,v,r] T Indicates the speed of forward movement, horizontal drift, and bow swing; represents the transformation matrix; represents the inertia matrix; represents the Coriolis centripetal matrix; represents the damping matrix, D W =[D Wu ,D Wv ,D Wr ] T Indicates environmental interference;

[0288] τ represents the control force and torque, and τ is expressed by an actuator model τ with a tail propeller and a bow thruster as follows:

[0289] τ=ΒΝ (48)

[0290] Where, Β=TK represents the input matrix; represents the thrust configuration matrix; represents the thrust coefficient matrix; l represents the thrust arm of the thruster, Ν=[|n1|n1,|n2|n2] T represents the control input, where n1 represents the speed of the propeller and n2 represents the speed of the thruster.

[0291] The design method of the heading controller is as follows:

[0292] The error system is expressed as follows:

[0293] r e =rr O (49)

[0294] Define the Lyapunov function:

[0295]

[0296] Taking the derivative at both ends simultaneously, we get:

[0297]

[0298] Among them, n 32 , n 33 and m 33 represents the model parameters;

[0299] Control input τ r Designed for:

[0300]

[0301] Among them, c r >0 and n r >0 indicates design parameters;

[0302] According to the actuator model, the control signal of the bow thruster is:

[0303]

[0304] Wherein, Ν2=|n2|n2, n2 represents the rotation speed of the bow thruster;

[0305] Substituting equation 52 into equation 51 yields:

[0306]

[0307] The design method of the speed controller is as follows:

[0308] The velocity error system is defined as follows:

[0309] u e =uU O (55)

[0310] Define the Lyapunov function:

[0311]

[0312] Taking the derivative at both ends simultaneously, we get:

[0313]

[0314] Among them, n 11 and m 11 represents the model parameters;

[0315] Control input τ u Designed for:

[0316]

[0317] Among them, c u >0 and n u >0 indicates design parameters;

[0318] According to the actuator model, the control signal of the tail propeller is:

[0319]

[0320] Wherein, N1=|n1|n1, n1 represents the rotation speed of the tail propeller;

[0321] Substituting equation 58 into equation 57, we obtain

[0322]

[0323] In summary, the closed-loop system is stable.

[0324] The present invention also provides a storage medium, which includes a stored program, wherein when the program is run, a berthing control method for an under-actuated ship with a collision avoidance function is executed.

[0325] The present invention also provides an electronic device, comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor executes a method for controlling berthing of an under-actuated ship with a collision avoidance function through the operation of the computer program.

[0326] Example

[0327] like Figure 2-5 As shown, in order to verify the effectiveness of the underactuated ship berthing control method with collision avoidance function proposed by the present invention, the following embodiment is used for explanation. The expected berthing trajectory of this embodiment consists of two parts. The expected trajectory of the first part is ξ R (γ(t))=[γ(t),k R γ(t)+b R ] T , where k R =0.405, b R =67.583; the expected speed is Among them U REF =1m / s, T R = 300. The expected trajectory of part 2 is The expected speed is U R (t) = ρ[1-γ(t) / γ B ], where ρ = 6. The parameters of the speed sight guidance method with collision avoidance function proposed by the present invention are: Δ = L, μ U =1,Δ R =0.5L, μ R =150,κ S =0.1,κ D =0.1,κ C =0.1. The controller parameter is c r =0.1, n r =10 -10 , c u =0.1, n u =10 -10From the simulation results of the embodiment, it can be seen that the ship can not only converge its speed to zero when arriving at the target berth at a specified course, but also avoid collision with static obstacles, dynamic obstacles and coastline during berthing.

[0328] Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present invention, rather than to limit it. Although the present invention has been described in detail with reference to the aforementioned embodiments, those skilled in the art should understand that they can still modify the technical solutions described in the aforementioned embodiments, or replace some or all of the technical features therein with equivalents. However, these modifications or replacements do not cause the essence of the corresponding technical solutions to deviate from the scope of the technical solutions of the embodiments of the present invention.

Claims

1. A berthing control method for an underactuated ship with collision avoidance function, It is characterized in that The steps include: S1. Establishing a guidance module, wherein the guidance module uses a speed line of sight guidance method to provide a desired speed distribution and a virtual desired bow angular velocity for berthing control; S2, the guidance module uses the control obstacle function to convert the collision avoidance problem between the ship and the static obstacles, dynamic obstacles and coastline in the port area into the first constraint, the second constraint and the third constraint of the ship speed and the bow angular velocity; S3, constructing a quadratic programming problem to solve the desired speed and the desired yaw angular velocity under the conditions of satisfying the first constraint, the second constraint and the third constraint; S4. Design a berthing control module, which includes a heading controller and a speed controller. The heading controller and the speed controller are designed using a nonlinear control method to control the speed and the yaw angular velocity to converge to the desired speed and yaw angular velocity provided by the guidance module, ensuring that the ship avoids collision while the speed converges to zero when reaching the berth.

2. The berthing control method for an underactuated ship with a collision avoidance function according to claim 1, It is characterized in that S1 specifically includes the following steps: Given a parameterized reference trajectory ξ R (γ(t))=[x R (γ(t)),y R (γ(t))] T , where γ(t) represents a continuous function related to time; The trajectory tangent angle χ of the reference trajectory R (γ) is defined as follows: in, The tracking error of the ship in the trajectory tangent coordinate system is expressed as follows: Among them, x e represents the longitudinal tracking error, y e represents the lateral tracking error; The guidance system is designed to: Among them, U γ Indicates virtual speed; Taking the derivative of both ends of the tracking error at the same time, we get: Among them, β c =arctan(v / u) represents the sideslip angle; The ship's expected course is designed as follows: Among them, Δ represents the foresight distance; The heading error is defined as: ψ e =ψ-ψ R (6) Taking the derivative of both ends of the heading error at the same time, we get: In order to stabilize the heading error, the virtual desired yaw angular velocity is designed as: Among them, μ R >0 and Δ R >0 indicates design parameters; In order to stabilize the longitudinal tracking error, the virtual speed U γ Designed for: Among them, μ U >0 indicates design parameters; According to the virtual speed U γ The trajectory variable γ of the reference trajectory can be calculated as follows: The speed distribution system enables the trajectory speed Converge to the desired speed Right now: According to the speed distribution system, the desired speed distribution variable It can be calculated as follows: In summary, the desired speed distribution variable is obtained and the virtual desired yaw angular velocity r OR .

3. The berthing control method for an underactuated ship with a collision avoidance function according to claim 1, It is characterized in that S2 specifically includes the following steps: S21, converting the collision avoidance between the ship and the static obstacle into the first constraint of the ship speed and the yaw angular velocity; In order to avoid collision between ships and static obstacles, the first safety set η is designed. S : Where P = [y, x] T Indicates the current position of the ship; P S =[y S ,x S ] T Indicates the location of static obstacles; d S Indicates the safe distance between the ship and the static obstacle; According to the first-order inequality: Control barrier function Φ S (P,P S ) is as follows: According to equations 14 and 15, the first constraint condition of the ship speed U is expressed as follows: in: Among them, κ S >0 indicates design parameters; According to the second-order inequality: Control barrier function Φ S (P,P S ) is as follows: According to equations 18 and 19, the first constraint condition of the ship's bow angular velocity r is expressed as follows: in: In summary, the first constraint of ship speed and bow angular velocity is obtained; S22, converting the collision avoidance between the ship and the dynamic obstacle into constraints on the ship speed and the bow angular velocity; In order to avoid collision between ships and dynamic obstacles, the second safety set η is defined D : Among them, P D =[y D ,x D ] T Indicates the position of dynamic obstacles; d D Indicates the safe distance between the ship and the dynamic obstacle; According to the first-order inequality: Control barrier function Φ D (P,P D ) is as follows: According to Equation 23 and Equation 24, the second constraint condition of the ship speed U is expressed as follows: in: According to the second-order inequality: The second constraint condition of the ship's pitch angular velocity r is expressed as follows: in: In summary, the second constraint of ship speed and bow angular velocity can be obtained; S23, converting the collision avoidance between the ship and the coastline into constraints on the ship speed and the pitch angular velocity; In order to avoid collision between ships and coastlines, the third safety set ηC is defined: Among them, d C Indicates the safe distance between the ship and the coastline; P j =[y j ,x j ] T , j = 1, 2, ..., 5 represents the positions of the other vertices of the ship, which can be obtained from the position of the center point of the ship P = [y, x] T Calculated: Among them, Δ jx and Δ jy Indicates the longitudinal and transverse position offset between the center position of the ship and other vertices of the ship; According to the first-order inequality: Control barrier function Φ C (P,P j ) is as follows: According to equations 32 and 33, the third constraint condition of the ship speed U is expressed as follows: in: According to the second-order inequality: The third constraint condition of the ship's pitch angular velocity r is expressed as follows: in: In summary, by designing the control obstacle function, the collision avoidance between the ship and the coastline can be transformed into the third constraint of the ship speed and the bow angular velocity.

4. The berthing control method for an underactuated ship with collision avoidance function according to claim 1, It is characterized in that S3 specifically includes the following steps: Assume that the ship's speed U can keep up with the expected speed U O , the ship's pitch angular velocity r can keep up with the expected pitch angular velocity r O , then the expected speed U O The following quadratic programming problem is solved: Limited by: The desired yaw angular velocity r of the ship O Solving the quadratic programming problem: Limited by:

5. The berthing control method for an underactuated ship with collision avoidance function according to claim 1, It is characterized in that In S4, the design method of the mathematical model of the three-degree-of-freedom underactuated ship is as follows: Where ξ=[x,y,ψ] T Indicates the position and heading of the ship; υ=[u,v,r] T Indicates the speed of forward movement, horizontal drift, and bow swing; represents the transformation matrix; represents the inertia matrix; represents the Coriolis centripetal matrix; represents the damping matrix, D W =[D Wu ,D Wv ,D Wr ] T Indicates environmental interference; τ represents the control force and torque. τ is modeled by an actuator with a tail propeller and a bow thruster. τ is expressed as follows: τ=ΒΝ (48) Where, Β=TK represents the input matrix; represents the thrust configuration matrix; represents the thrust coefficient matrix; l represents the thrust arm of the propeller, N = [n 1 |n 1 ,|n 2 |n 2 ] T represents the control input, where n 1 Indicates the propeller speed, n 2 Indicates the propeller speed.

6. The berthing control method for an underactuated ship with collision avoidance function according to claim 5, It is characterized in that In S4, the design method of the heading controller is as follows: The error system is expressed as follows: r e =r-r O (49) Define the Lyapunov function: Taking the derivative at both ends simultaneously, we get: Among them, n 32 , n 33 and m 33 represents the model parameters; Control input τ r Designed for: Among them, c r >0 and n r >0 indicates design parameters; According to the actuator model, the control signal of the bow thruster is: Among them, N 2 =|n 2 |n 2 , n 2 Indicates the rotation speed of the bow thruster; Substituting equation 52 into equation 51 yields:

7. The berthing control method for an underactuated ship with collision avoidance function according to claim 5, It is characterized in that In S4, the speed controller is designed as follows: The velocity error system is defined as follows: in e =uU O (55) Define the Lyapunov function: Taking the derivative at both ends simultaneously, we get: Among them, n 11 and m 11 represents the model parameters; Control input τ u Designed for: Among them, c u >0 and n u >0 indicates design parameters; According to the actuator model, the control signal of the tail propeller is: Among them, N 1 =|n 1 |n 1 , n 1 Indicates the speed of the tail propeller; Substituting equation 58 into equation 57, we obtain 8. A storage medium, It is characterized in that The storage medium includes a stored program, wherein when the program is run, the under-actuated ship berthing control method with collision avoidance function described in any one of claims 1 to 7 is executed.

9. An electronic device comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, It is characterized in that The processor executes the berthing control method for an under-actuated ship with a collision avoidance function as described in any one of claims 1 to 7 by running the computer program.