A Multi-Module Ship Cooperative Control Method Based on High-Order CBF

By establishing a ship-to-ship hydrodynamic interaction model and a high-order CBF method, combined with a finite-time disturbance observer and an event triggering mechanism, and optimizing the control torque, the problems of formation control accuracy and collision avoidance safety of multi-module ships in complex environments were solved, achieving high-precision formation maintenance and dynamic collision avoidance.

CN123113586APending Publication Date: 2026-11-17DALIAN MARITIME UNIVERSITY
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202611465553.3
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2026-09-20
Publication Date
2026-11-17

AI Technical Summary

Technical Problem

Existing multi-module ship cooperative control methods have failed to effectively address the impact of ship-to-ship hydrodynamic interactions in close formations, resulting in reduced formation control accuracy and insufficient collision avoidance safety. Furthermore, existing CBF schemes fail to fully utilize the dynamic advantages of fully driven ships, making it difficult to achieve high-precision formation maintenance and dynamic collision avoidance.

Method used

A multi-module ship cooperative control method based on high-order CBF is established. By constructing a ship-ship hydrodynamic interaction force model, combining a finite-time disturbance observer and an event triggering mechanism, the method compensates for composite disturbances and optimizes the control torque under the backstepping formation control framework, thereby improving formation accuracy and collision avoidance safety.

Benefits of technology

It effectively compensates for complex disturbances, improves formation control accuracy and safety, reduces system computing and communication load, fully leverages the lateral translation maneuvering advantages of fully driven vessels, achieves coordinated optimization of formation maintenance and dynamic collision avoidance, and improves the reliability of multi-module vessels in collaborative operations in complex environments.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN123113586A_ABST
    Figure CN123113586A_ABST
Patent Text Reader

Abstract

This embodiment discloses a multi-module ship cooperative control method based on high-order CBF. By establishing a ship-to-ship hydrodynamic interaction force model and combining it with a finite-time disturbance observer, it effectively compensates for complex disturbances under close formation, improving the accuracy and safety of formation control. At the same time, it introduces an event triggering mechanism to replace the traditional fixed-period update, further integrating the backstepping formation control and high-order control obstacle function into a unified framework. It uses quadratic programming to directly solve the actual control torque, which not only overcomes the local minima defect of the artificial potential field method and the lack of rigorous safety proof of the vector field method, but also solves the conservatism or failure problem of existing CBF schemes caused by the mismatch between first-order constraints and second-order dynamics. It fully leverages the lateral translational maneuvering advantages of fully driven ships and achieves the cooperative optimization of formation maintenance and dynamic collision avoidance.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] This invention relates to the field of ship formation control and safe collision avoidance technology, and in particular to a multi-module ship cooperative control method based on high-order CBF. Background Technology

[0002] With the increasing demand for marine resource development and modular offshore operations, multi-module vessel formation technology, represented by mobile offshore bases (MOBs), has attracted widespread attention. Modular vessels are mostly fully powered, dynamic positioning vessels with three degrees of freedom (pitch, sway, and yaw). During operations, they need to navigate in close formation to complete high-precision tasks such as material transfer and equipment docking. Due to the small spacing between vessels and the complex and variable operating environment, ensuring both formation accuracy and collision avoidance safety is a core challenge in the collaborative control of modular vessels. Meanwhile, existing formation control schemes generally employ fixed-period time-triggered update mechanisms. The high-frequency calculations and communications of the controllers result in a heavy system resource load. How to reduce operating costs while ensuring control performance is also a pressing practical problem that needs to be solved for engineering implementation.

[0003] Current ship formation collision avoidance technologies are mainly divided into three categories: artificial potential field method, vector field method, and obstacle function control method. The artificial potential field method guides ships to avoid collisions through an attractive-repulsive field. The principle is intuitive and easy to implement, but it has inherent local minima and cannot guarantee global collision avoidance performance in complex dynamic environments. The vector field method relies on a pre-set path to guide the field to achieve obstacle avoidance. It is essentially a heuristic control method and lacks strict safety theory support, making it difficult to meet the high-precision constraints required for close-range formations.

[0004] Control obstacle function (CBF) ensures system safety by constructing a positively invariant safety set. It possesses rigorous mathematical proof and optimal solution capabilities, making it the mainstream technology for collision avoidance control. However, existing ship CBF schemes still suffer from significant limitations in adaptability: First, most designs are based on the kinematic models of underactuated unmanned surface vessels (USVs), using first-order CBFs with velocity and angular velocity as optimization variables. These cannot be directly mapped to the control torque of the propulsion system, requiring an additional underlying velocity tracking controller, which can easily introduce control response delays and reduce the real-time performance of dynamic collision avoidance. Second, the angular constraints in underactuated CBF schemes are forced kinematic constraints designed to compensate for actuation deficiencies, requiring further processing. Forced steering to avoid collisions fails to leverage the lateral translational maneuvering advantages of fully driven vessels, and few solutions integrate bow dynamics and planar translational mechanics into a high-order CBF framework, making it difficult to achieve multi-degree-of-freedom coordinated safety constraints. Third, first-order CBF only constrains relative position and velocity, failing to match the ship's second-order dynamic characteristics. In close-range, high-speed relative motion scenarios, overly conservative constraints can degrade formation performance, while insufficient constraints can lead to collision avoidance failure. Fourth, existing CBF collision avoidance methods are mostly independent of formation control design and are not deeply integrated with high-precision formation strategies such as backstepping, making it impossible to simultaneously achieve formation maintenance and dynamic collision avoidance within a unified framework.

[0005] Furthermore, existing multi-module ship cooperative control methods generally do not consider ship-to-ship hydrodynamic interactions in close formation. When the longitudinal spacing between ships is too small, the hydrodynamic effects between the hulls will generate significant forces. Such complex disturbances can reduce the accuracy of formation control and even lead to the risk of exceeding safety constraints. Currently, there is no publicly available technical solution that can systematically combine ship-to-ship hydrodynamic models with high-precision formation control and high-order CBF collision avoidance systems, making it impossible to simultaneously achieve disturbance compensation and safety constraint optimization. Summary of the Invention

[0006] This invention discloses a multi-module ship cooperative control method based on high-order CBF to overcome the above-mentioned technical problems.

[0007] To achieve the above objectives, the technical solution of the present invention is as follows: A multi-module ship cooperative control method based on high-order CBF includes the following steps: S1: Establish a ship-to-ship hydrodynamic interaction force model based on the relative position and relative velocity of adjacent modular ships, obtain ship-to-ship interaction interference, and obtain external interference including wind, waves and current; and based on the external interference including wind, waves and current, establish a modular ship motion mathematical model describing the three-degree-of-freedom motion of the modular ship in the horizontal plane. S2: Establish a finite-time disturbance observer based on the mathematical model of the modular ship's motion to obtain an estimate of the external disturbance; S3: Based on the estimated value of external disturbances and the event triggering mechanism, establish a multi-module ship formation control law; S4: Based on the position of the modular ships and the multi-module ship formation control law, establish the safety functions between modular ships and between modular ships and obstacles; And establish control obstacle function inequalities between modular ships and between modular ships and obstacles; S5: Based on the safety functions between the modular ships and between the modular ships and obstacles, and based on the control obstacle function inequalities between the modular ships and between the modular ships and obstacles, a quadratic programming method is used to obtain the actual control torque in order to achieve the coordinated control of multiple modular ships.

[0008] Furthermore, the mathematical model for the motion of the modular ship is as follows: In the formula: Indicates the first The position of the modular ship in the northeast coordinate system; Represents the transformation matrix; Indicates the first The velocity of the modular ship in the ship's coordinate system; Indicates the first The system inertia matrix is ​​composed of the ship's rigid body inertia and hydrodynamic added mass of a modular ship. Indicates the first The derivative of the velocity of the modular ship in the ship's coordinate system; The Coriolis centripetal force matrix; Represents the ship's hydrodynamic damping coefficient matrix; Indicates the system's control force; External disturbances, including wind, waves, and currents, , For longitudinal interference force; It is a lateral disturbance force; For bow rocking interference force; Indicates the first The position vector of the ship The derivative; in:

[0009]

[0010]

[0011] In the formula: For other interference; For ship-to-ship interaction interference; For longitudinal hydrodynamics; For lateral hydrodynamics; Powered by water propulsion at the bow; All are scalar hydrodynamic coefficients; The oscillation velocity; The sway speed; The bow roll angular velocity; For the first Longitudinal coordinates of the modular vessel; For the first Longitudinal coordinates of the modular vessel; For the first Lateral position coordinates of the modular vessel; For the first Lateral position coordinates of the modular vessel; This represents the longitudinal modeling error; This refers to lateral modeling error; Modeling errors for bow roll; All are index numbers of the modular ship, where the first... Modular ship and the first The modular ships are adjacent to each other.

[0012] Furthermore, the formula used to obtain the estimate of external disturbances is as follows:

[0013] In the formula: for The estimated value, of which, ; These are the estimated values ​​for longitudinal disturbance force, lateral disturbance force, and bow roll disturbance force, respectively. External disturbances, including wind, waves, and currents; All are positive definite diagonal matrices. , It is a real number; All are constants of a finite-time disturbance observer; ; Let be a sign power function, where, =sign( ) ; For time; To mitigate the observation error of the finite-time disturbance observer; The observation error of the finite-time disturbance observer is expressed as follows:

[0014] In the formula: To represent the inertia matrix that includes hydrodynamic added mass; The velocity is in the ship's coordinate system; for The estimated value; It is the field of real numbers.

[0015] Furthermore, the control law for the multi-module ship formation is established as follows:

[0016] In the formula: This is the actual control torque; For the first The system inertia matrix is ​​composed of the ship's rigid body inertia and hydrodynamic added mass of a modular ship. For the first The velocity error vector of the modular ship; For the first The communication topology weighting degree of the modular ship; For the first Position tracking error of the modular vessel; All are positive numbers; for of Power of 1 To compensate for speed errors; The Coriolis centripetal force matrix; Represents the ship's hydrodynamic damping coefficient matrix; for The estimated value; External disturbances, including wind, waves, and currents; for Time of the first The speed of the modular ship; For a specific moment; (10)

[0017] In the formula: For the first Position tracking error of the modular vessel; For the first The set of neighboring modular ships of a modular ship; For the first Modular ships to The communication link weight of a module ship is the [number]th [unit] in the communication topology graph. Line 1 Column elements; Indicates the first The position of the modular ship in the northeast coordinate system; Indicates the first The position of the modular ship in the northeast coordinate system; For the first The expected relative position vector of the modular ships; For the first The expected relative position vector of the modular ships; For virtual navigators to the first The communication link weight of each modular ship; Let be the desired pose vector of the virtual navigator; For the first The velocity error vector of the modular ship; It is a virtual control variable; Indicates the first The velocity of the modular ship in the ship's coordinate system.

[0018] Furthermore, the safety functions between the modular vessels and between the modular vessel and the obstacle are established as follows:

[0019]

[0020]

[0021] In the formula: For the first Modular ship and the first Safety functions between modular ships; All are the planar positions of the modular ship; It is the Euclidean norm; , All are constants greater than 0; For the bow roll angle of the modular ship; For the first The modular ship pointed to the first The azimuth of the modular vessel; This refers to the minimum safe distance between modular vessels; For the first Modular ships and obstacles Safety functions between; The planar position of the obstacle; For the first A modular ship points at an obstacle. The azimuth angle; The set safe distance between the modular vessel and obstacles; in,

[0022] In the formula: It is the first derivative; For the first Modular ship and the first The heading constraints of the modular vessel; For the heading constraints of the modular vessel and obstacles; In the formula: It is the second derivative; These are design parameters that are greater than 0, i.e., the weighting coefficients of the heading angle constraint term; For the first Angular acceleration of a modular ship; for The first derivative, which is also the... The speed of the modular ship; for The first derivative of is also the velocity term of the obstacle;

[0023]

[0024]

[0025] In the formula: This is the coefficient matrix associated with the inertia matrix and the rotation matrix; The offset vector is in the form of a planar acceleration affine. Represents the transformation matrix; Indicates the first The system inertia matrix is ​​composed of the ship's rigid body inertia and hydrodynamic added mass of a modular ship. For the first The sway speed of the modular ship; For the first The sway speed of the modular ship;

[0026] in, , The offset is the affine form of the heading angular acceleration.

[0027] Furthermore, the control obstacle function inequalities between the modular ships and between the block ship and the obstacle are established as follows:

[0028]

[0029] In the formula: and These are all design parameters. ; and All are slack variables. , .

[0030] Beneficial Effects: This invention provides a multi-module ship cooperative control method based on high-order CBF. By establishing a ship-to-ship hydrodynamic interaction force model and combining it with a finite-time disturbance observer, it effectively compensates for complex disturbances in close formation, improving the accuracy and safety of formation control. Simultaneously, it introduces an event-triggered mechanism to replace the traditional fixed-period update, significantly reducing the system's computational and communication load and saving operational resources. Furthermore, it deeply integrates backstepping formation control with high-order control barrier functions (CBF) into a unified framework, directly solving for the actual control torque using quadratic programming. This not only overcomes the local minima defect of the artificial potential field method and the lack of rigorous safety proof in the vector field method, but also solves the conservatism or failure problem of existing CBF schemes caused by the mismatch between first-order constraints and second-order dynamics. It fully leverages the lateral translational maneuvering advantages of fully driven ships, achieving coordinated optimization of formation maintenance and dynamic collision avoidance. Thus, while ensuring high-precision formation, it strictly ensures collision avoidance safety, achieving strict, local minima-free collision avoidance control, significantly improving the reliability and engineering practicality of multi-module ship cooperative operations in complex dynamic environments. Attached Figure Description

[0031] To more clearly illustrate the technical solutions in the embodiments of the present invention or the prior art, the drawings used in the description of the embodiments or the prior art will be briefly introduced below. Obviously, the drawings described below are some embodiments of the present invention. For those skilled in the art, other drawings can be obtained based on these drawings without creative effort.

[0032] Figure 1 This is a flowchart of the multi-module ship cooperative control method based on high-order CBF of the present invention; Figure 2 This is a schematic diagram of the modular ship formation cooperative collision avoidance control system in an embodiment of the present invention. Detailed Implementation

[0033] To make the objectives, technical solutions, and advantages of the embodiments of the present invention clearer, the technical solutions of the embodiments of the present invention will be clearly and completely described below with reference to the accompanying drawings. Obviously, the described embodiments are only some embodiments of the present invention, not all embodiments. Based on the embodiments of the present invention, all other embodiments obtained by those skilled in the art without creative effort are within the scope of protection of the present invention.

[0034] This embodiment introduces a multi-module ship cooperative control method based on high-order CBF, including the following steps, such as... Figure 1 and Figure 2 As shown: S1: Establish a ship-to-ship hydrodynamic interaction model based on the relative position and relative velocity of adjacent modular ships, obtain ship-to-ship interaction interference, and obtain external interference including wind, waves and current; then, based on the principles of ship kinematics and dynamics, and based on the external interference including wind, waves and current, establish a mathematical model of modular ship motion describing the three degrees of freedom motion of the modular ship in the horizontal plane. Preferably, the mathematical model for the motion of the modular ship is as follows: (1) In the formula: Indicates the first The position of the modular ship in the northeast coordinate system; Represents the transformation matrix; Indicates the first The velocity of the modular ship in the ship's coordinate system; Indicates the first The system inertia matrix is ​​composed of the ship's rigid body inertia and hydrodynamic added mass of a modular ship. Indicates the first The derivative of the velocity of the modular ship in the ship's coordinate system; The Coriolis centripetal force matrix; Represents the ship's hydrodynamic damping coefficient matrix; Indicates the system's control force; External disturbances, including wind, waves, and currents, , For longitudinal interference force; It is a lateral disturbance force; For bow rocking interference force; Indicates the first The position vector of the ship The derivative of .

[0035] Since the modular vessels may be too close to each other during operation, the hydrodynamic interaction between them needs to be taken into account. Therefore, a ship-to-ship hydrodynamic interaction model based on the relative position and relative velocity of adjacent modular vessels is established and introduced into the modular vessel dynamics model for unified treatment of the total system disturbance.

[0036] Specifically, the hydrodynamic interaction between ships in a formation is affected by factors such as ship geometry, speed, distance between ships, water depth, and environmental conditions.

[0037] in This includes ship-to-ship interactions, making ,in, External disturbances, including wind, waves, and currents, For other interference, The ship-to-ship interaction disturbance is calculated using empirical formulas based on CFD data, and its value depends on the relative position and speed between the two adjacent ships.

[0038] Specifically, for the first The adjacent modular ship A modular ship, through a ship-to-ship hydrodynamic interaction force model, demonstrates the ship-to-ship interaction forces. The model is as follows: (2) In the formula: For other interference; For ship-to-ship interaction interference; For longitudinal hydrodynamics; For lateral hydrodynamics; Powered by water propulsion at the bow; All are scalar hydrodynamic coefficients; The oscillation velocity; The sway speed; The bow roll angular velocity; For the first Longitudinal coordinates of the modular vessel; For the first Longitudinal coordinates of the modular vessel; For the first Lateral position coordinates of the modular vessel; For the first Lateral position coordinates of the modular vessel; This represents the longitudinal modeling error; This refers to lateral modeling error; Modeling errors for bow roll; All are index numbers of the modular ship, where the first... Modular ship and the first The modular ships are adjacent to each other.

[0039] Wherein, the coefficient matrix For scalar hydrodynamic coefficients, the first... The net interaction loads on the modular ship are calculated by pairwise superposition, i.e. Modeling error term Considered a bounded perturbation, satisfying ,in For worst-case identification residual selection.

[0040] S2: Establish a finite-time disturbance observer based on the mathematical model of the modular ship's motion to obtain an estimate of the external disturbance; Preferably, the formula used to obtain the estimate of external disturbance is as follows: (3) In the formula: for The estimated value, of which, ; These are the estimated values ​​for longitudinal disturbance force, lateral disturbance force, and bow roll disturbance force, respectively. External disturbances, including wind, waves, and currents; All are positive definite diagonal matrices. , It is a real number; All of these are constants for finite-time disturbance observers. ; Let be a sign power function, where, =sign( ) ; For time; To mitigate the observation error of the finite-time disturbance observer; The observation error of the finite-time disturbance observer is expressed as follows: (4) In the formula: To represent the inertia matrix that includes hydrodynamic added mass; The velocity is in the ship's coordinate system; for The estimated value; For the real number field; This embodiment first designs a finite-time interference observer to address external environmental disturbances, and then introduces an event triggering mechanism into the formation controller design. The dynamic model of the modular ship with the finite-time observer is designed as follows: (5) In the formula: The acceleration is in the ship's coordinate system; Indicates the system's control force; The Coriolis centripetal force matrix; Here is the damping matrix; for The estimated value, of which, ; These are the estimated values ​​for longitudinal disturbance force, lateral disturbance force, and bow roll disturbance force, respectively.

[0041] The observer error vector is differentiated using formula (3): (6) In the formula: for The derivative; Introduce auxiliary variables: (7) (8) In the formula: As an auxiliary variable; The auxiliary state variable corresponding to the observation error w; To and The corresponding auxiliary state variables; The parameters are used to rewrite the dynamic equations for observation errors into the second-order sliding mode canonical form, thereby ensuring that the finite-time disturbance observer can handle total external disturbances including wind, waves, currents, and ship-to-ship hydrodynamic disturbances. Make accurate estimates.

[0042] According to equations (4) and (5), it can be written as: (9) If If it can approach 0 within a finite time frame, then It can approach 0 within a finite time frame, which is the estimated value of external disturbances. It can approximate the actual value within a finite time frame. Actual value.

[0043] By selecting appropriate observer parameters, the observation error can be reduced. It can converge to zero in a finite amount of time, that is It can accurately track actual interference within a limited time. .

[0044] S3: Based on the estimated value of external disturbances and the event triggering mechanism, establish a multi-module ship formation control law; In this embodiment, a multi-module ship finite-time distributed formation controller based on an event-triggered mechanism is designed. The formation control law for the multi-module ship formation is designed using a backstepping method and a finite-time command filter. The formation tracking error equation needs to be given. First, the structure of the finite-time instruction filter is shown in the following equation: (10) (11) (12) In the formula: for The output signal after passing through a finite-time command filter; The first internal state variable of the finite-time command filter has the physical meaning of the output signal. The derivative; and All are positive constants; For input signals; It is a symbolic function; This is the second state variable of the finite-time command filter; For the second state variable The derivative; Based on the communication network structure, the position tracking error of the modular ship is defined as: (13) In the formula: For the first Position tracking error of the modular vessel; For the first The set of neighboring modular ships of a modular ship; For the first Modular ships to The communication link weight of a module ship is the [number]th [unit] in the communication topology graph. Line 1 Column elements; Indicates the first The position of the modular ship in the northeast coordinate system; Indicates the first The position of the modular ship in the northeast coordinate system; For the first The expected relative position vector of the modular ships; For the first The expected relative position vector of the modular ships; For the virtual navigator (number 0) to the The communication link weight of each modular ship; Let be the desired pose vector of the virtual navigator; right Taking the derivative, we get: (14) In the formula: for The derivative; This is the transformation matrix; for Time of the first The speed of the modular ship; for The derivative; Define the velocity error vector of the modular ship as: (15) In the formula: For the first The velocity error vector of the modular ship; for The output signal after passing through a finite-time command filter.

[0045] To eliminate filtering errors, the first Taking a modular ship as an example, design a filtered compensation signal: (16) In the formula, The first The position error compensation signal and velocity error compensation signal of the modular ship, and ; All are positive numbers; , All are the first The positive gain constant of a modular ship, and . For the first The system control of a modular ship; For the first The communication topology weighting degree of the modular ship, and ; Define position compensation error and speed compensation error .

[0046] Based on the position compensation vector, the Lyapunov function is selected: (17) Design virtual control quantity : (18) In the formula: All are positive numbers. .

[0047] Based on the velocity compensation vector, the Lyapunov function is selected:

[0048] Based on this, the control law for multi-module ship formations is established as follows: (19) In the formula: This is the actual control torque; For the first The system inertia matrix is ​​composed of the ship's rigid body inertia and hydrodynamic added mass of a modular ship. For the first The velocity error vector of the modular ship; For the first The communication topology weighting degree of the modular ship, and , For the first Position tracking error of the modular vessel; All are positive numbers; for of Power of 1 To compensate for speed errors; The Coriolis centripetal force matrix; Represents the ship's hydrodynamic damping coefficient matrix; for The estimated value; External disturbances, including wind, waves, and currents; for Time of the first The speed of the modular ship; This refers to the bow angle of the modular ship.

[0049] For ease of calculation, variables are introduced. . This is a positive constant. The control law ensures that, in the absence of collision avoidance requirements, the formation tracking error converges to a bounded small neighborhood within a finite time.

[0050] In this embodiment, the measurement error of the event triggering mechanism is defined as follows: (20) In the formula: For the first The velocity measurement error of the module at time t; for t The expected speed of the module ship at any given moment; This refers to the controller's trigger update time; in, It is the expected speed value of the module ship at the previous trigger moment. The expected speed value from the previous trigger moment will be carried over until the next new trigger moment arrives before it is updated.

[0051] In this embodiment, the event triggering condition of the event triggering mechanism is: (twenty one) In the formula: It is the controller's update time. The infimum; The velocity measurement error at time t; k This is the sequence number of the event trigger sequence.

[0052] When the trigger condition is met, the controller's desired speed will be updated to... of When time is The control signal will remain at a constant value. Stability analysis proves that the system does not exhibit the Zeno phenomenon.

[0053] S4: Based on the position of the modular ships and the multi-module ship formation control law, establish the safety functions between modular ships and between modular ships and obstacles; And establish control obstacle function inequalities between modular ships and between modular ships and obstacles; To address the collision avoidance problem between adjacent modular ships in a formation and the obstacle avoidance problem between modular ships and obstacles, a second-order higher-order control obstacle function based on the two-dimensional planar position, velocity, and angular velocity of the modular ships is constructed. Relaxed variables are introduced to form soft constraints, transforming the safety requirements for collision avoidance and obstacle avoidance into linear inequality constraints on the actual control output.

[0054] The safety functions between the modular vessels and between the modular vessel and the obstacle are established as follows: (twenty two) (twenty three) The first Modular ships and obstacles The security functions between them are established as follows: (twenty four) In the formula: For the first Modular ship and the first Safety functions between modular ships; All of these are the planar positions of the modular ship, among which, , The first The horizontal and vertical coordinates of the planar position of the modular ship. , The first The horizontal and vertical coordinates of the planar position of the modular ship; Euclidean distance; For each module ship, there is a constant greater than 0 in the safety function. For the bow roll angle of the modular ship; For the first The modular ship pointed to the first The azimuth of the modular vessel; This refers to the minimum safe distance between modular vessels; For the first Modular ships and obstacles Safety functions between; The planar position of the obstacle; This is a constant greater than 0 in the safety function between the modular vessel and the obstacle; For the first A modular ship points at an obstacle. The azimuth angle; The set safe distance between the modular vessel and obstacles; If it is a static obstacle, then its speed... The value is set to 0. For ease of representation, let's assume... To proceed with the subsequent expression, For the first Modular ship and the first The heading constraints of a modular vessel.

[0055] The first derivative is calculated separately: (25) In the formula: It is the first derivative; For the first Modular ship and the first The heading constraints of the modular vessel; For the heading constraints of the modular vessel and obstacles; Calculate the second derivatives separately: (26) In the formula: It is the second derivative; These are design parameters that are greater than 0, i.e., the weighting coefficients of the heading angle constraint term; For the first The bow roll rate of the modular ship; for The first derivative, which is also the... The speed of the modular ship; for The first derivative of is also the velocity term of the obstacle; Among them, according to the dynamic equation, plane acceleration Torque that can be actually controlled Affine representation: (27)

[0056]

[0057] In the formula: This is the coefficient matrix associated with the inertia matrix and the rotation matrix; The offset vector is in the form of a planar acceleration affine. Represents the transformation matrix; Indicates the first The system inertia matrix is ​​composed of the ship's rigid body inertia and hydrodynamic added mass of a modular ship. For the first The sway speed of the modular ship; For the first The sway speed of the modular ship; Bow angular acceleration Also by Affine representation: (28) in, , The offset in the affine form of the heading angular acceleration, i.e. The component in the direction of bow roll, .

[0058] In this embodiment, for ease of calculation, the sideslip angle is assumed to be... Since the sway angle closed-loop controller has directly controlled it to 0 through sway thrust, in this embodiment, the heading is considered to be consistent with the actual direction of motion.

[0059] Preferably, based on the theory of higher-order control obstacle functions, the control obstacle function inequalities between second-order modular ships and between second-order modular ships and obstacles are constructed as follows:

[0060] (29) In the formula: and These are all design parameters. ; and All are slack variables. , .

[0061] Will and Substituting the affine expression into (15), we obtain the expression for... Linear inequality constraints: (30) In the formula: For the first i Modular ship and the first j The row vector of safety constraint coefficients between the modular vessels is derived from the dynamic inverse matrix of the modular vessels. Coordinate transformation matrix Together with the direction vector Δp ​​of the relative positions of the two ships at the current moment, it forms the ship formation control law. The mapping is to the one-dimensional scalar coefficients on the left-hand side of the security constraint inequality. For the first i The row vector of safety constraint coefficients between the modular vessel and the o-th obstacle; For the first i Modular ship and the first j The scalar term on the right-hand side of the safety constraint inequality between the modular ships includes the current state variables of the system (such as velocity, relative position, and angular velocity) and the CBF gain parameter. and And known quantities such as the estimated acceleration of adjacent ships; For the first i The scalar term on the right side of the safety constraint inequality between the module ship and the o-th obstacle; in, and Includes , , , and , Related items.

[0062] in:

[0063] (31)

[0064] in, The acceleration estimate for the neighboring ship. for The derivative; For the first Modular ship and the first The relative position vectors between the modular ships; This is an estimate of the line-of-sight angular acceleration of the neighboring ship; For the first Modular ship and the first The Euclidean distance between the modular ships; For the first Modular ship and the first The heading constraints of the modular vessel; The offset vector is in the form of a planar acceleration affine. For each module ship, there is a constant greater than 0 in the safety function. For the first i The affine offset of the bow angular acceleration of a ship; For the first j Estimates of the angular acceleration of the ships; Design parameters that are greater than 0; S5: Based on the safety functions between the modular ships and between the modular ships and obstacles, and based on the control obstacle function inequalities between the modular ships and between the modular ships and obstacles, a quadratic programming method is used to obtain the actual control torque in order to achieve the coordinated control of multiple modular ships.

[0065] This embodiment aims to minimize the difference between the actual control torque and the nominal control torque. It constructs a quadratic programming (QP) problem by combining safety constraints and solves it to obtain the optimized actual control torque.

[0066] For each modular ship, the following quadratic programming problem is constructed: The quadratic programming problem is constructed as follows: (32) in, This is a weighted diagonal matrix. To relax the penalty weights, and For modular ships The set of neighboring objects at risk of collision. This is the nominal control law; For weighted norm; The weight matrix Used to adjust the tolerance for torque correction in various directions. To relax the penalty weights. By adjusting This approach balances the requirements of formation tracking and collision avoidance. The QP problem can be solved efficiently using a standard solver. This is the weighting coefficient for the longitudinal force; This is the weighting coefficient for the lateral force; This is the weighting coefficient for the steering force.

[0067] Specifically, the optimized actual control output obtained from the solution is applied to the thrusters of each modular ship, driving the modular ships to perform formation movements and collision avoidance maneuvers, thereby achieving coordinated safe collision avoidance of multi-module ship formations.

[0068] Specifically, the optimized actual control torque is applied to each modular vessel to achieve coordinated safe collision avoidance in a multi-module vessel formation.

[0069] Specifically, the actual control torque Input module ship The propulsion system utilizes distributed QP solving to enable each modular vessel in the formation to generate cooperative control torques that meet safety constraints in real time, achieving dynamic collision avoidance between modular vessels while maintaining formation formation.

[0070] This embodiment describes the establishment of a mathematical model of the modular ship, the calculation of the nominal control torque using a backstepping formation controller, and the optimization of the actual control torque by solving a second-order higher-order control obstacle function and quadratic programming. Finally, the optimized control torque is applied to the modular ship to achieve cooperative safe collision avoidance.

[0071] Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present invention, and not to limit them; although the present invention has been described in detail with reference to the foregoing embodiments, those skilled in the art should understand that modifications can still be made to the technical solutions described in the foregoing embodiments, or equivalent substitutions can be made to some or all of the technical features; and these modifications or substitutions 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 multi-module ship cooperative control method based on high-order CBF, characterized in that, Includes the following steps: S1: Establish a ship-to-ship hydrodynamic interaction force model based on the relative position and relative velocity of adjacent modular ships, obtain ship-to-ship interaction interference, and obtain external interference including wind, waves and current; and based on the external interference including wind, waves and current, establish a modular ship motion mathematical model describing the three-degree-of-freedom motion of the modular ship in the horizontal plane. S2: Establish a finite-time disturbance observer based on the mathematical model of the modular ship's motion to obtain an estimate of the external disturbance; S3: Based on the estimated value of external disturbances and the event triggering mechanism, establish a multi-module ship formation control law; S4: Based on the position of the modular ships and the multi-module ship formation control law, establish the safety functions between modular ships and between modular ships and obstacles; And establish control obstacle function inequalities between modular ships and between modular ships and obstacles; S5: Based on the safety functions between the modular ships and between the modular ships and obstacles, and based on the control obstacle function inequalities between the modular ships and between the modular ships and obstacles, a quadratic programming method is used to obtain the actual control torque in order to achieve the coordinated control of multiple modular ships.

2. The multi-module ship cooperative control method based on high-order CBF according to claim 1, characterized in that, The mathematical model for the motion of the modular ship is as follows: wherein: represents the position of the nth module ship in the North-East coordinate system; represents the position of the nth module ship in the North-East coordinate system; represents the transformation matrix; represents the velocity of the nth module ship in the body coordinate system; represents the velocity of the nth module ship in the body coordinate system; represents the system inertia matrix of the nth module ship composed of the ship rigid body inertia and the hydrodynamic added mass; represents the system inertia matrix of the nth module ship composed of the ship rigid body inertia and the hydrodynamic added mass; represents the derivative of the velocity of the nth module ship in the body coordinate system; represents the derivative of the velocity of the nth module ship in the body coordinate system; is the Coriolis centripetal force matrix; represents the ship hydrodynamic damping coefficient matrix; represents the control force of the system; is the external disturbance including wind, wave and current, , is the longitudinal disturbance force; is the transverse disturbance force; is the yaw disturbance force; represents the derivative of the position vector of the nth ship; represents the derivative of the position vector of the nth ship; in: In the formula: For other interference; For ship-to-ship interaction interference; For longitudinal hydrodynamics; For lateral hydrodynamics; Powered by water propulsion at the bow; All are scalar hydrodynamic coefficients; The oscillation velocity; The sway speed; The bow roll angular velocity; For the first Longitudinal coordinates of the modular vessel; For the first Longitudinal coordinates of the modular vessel; For the first Lateral position coordinates of the modular vessel; For the first Lateral position coordinates of the modular vessel; This represents the longitudinal modeling error; This refers to lateral modeling error; Modeling errors for bow roll; All are index numbers of the modular ship, where the first... Modular ship and the first The modular ships are adjacent to each other.

3. The multi-module ship cooperative control method based on high-order CBF according to claim 1, characterized in that, The formula used to obtain the estimate of external disturbances is as follows: In the formula: for The estimated value, of which, ; These are the estimated values ​​for longitudinal disturbance force, lateral disturbance force, and bow roll disturbance force, respectively. External disturbances, including wind, waves, and currents; All are positive definite diagonal matrices. , It is a real number; All are constants of a finite-time disturbance observer; ; Let be a sign power function, where, =sign( ) ; For time; To mitigate the observation error of the finite-time disturbance observer; The observation error of the finite-time disturbance observer is expressed as follows: In the formula: To represent the inertia matrix that includes hydrodynamic added mass; The velocity is in the ship's coordinate system; for The estimated value; It is the field of real numbers.

4. The multi-module ship cooperative control method based on high-order CBF according to claim 1, characterized in that, The control law for the multi-module ship formation is established as follows: In the formula: This is the actual control torque; For the first The system inertia matrix is ​​composed of the ship's rigid body inertia and hydrodynamic added mass of a modular ship. For the first The velocity error vector of the modular ship; For the first The communication topology weighting degree of the modular ship; For the first Position tracking error of the modular vessel; All are positive numbers; for of Power of 1 To compensate for speed errors; The Coriolis centripetal force matrix; Represents the ship's hydrodynamic damping coefficient matrix; for The estimated value; External disturbances, including wind, waves, and currents; for Time of the first The speed of the modular ship; For a specific moment; (10) In the formula: For the first Position tracking error of the modular vessel; For the first The set of neighboring modular ships of a modular ship; For the first Modular ships to The communication link weight of a module ship is the [number]th [unit] in the communication topology graph. Line 1 Column elements; Indicates the first The position of the modular ship in the northeast coordinate system; Indicates the first The position of the modular ship in the northeast coordinate system; For the first The expected relative position vector of the modular ships; For the first The expected relative position vector of the modular ships; For virtual navigators to the first The communication link weight of each modular ship; Let be the desired pose vector of the virtual navigator; For the first The velocity error vector of the modular ship; It is a virtual control variable; Indicates the first The velocity of the modular ship in the ship's coordinate system.

5. The multi-module ship cooperative control method based on high-order CBF according to claim 1, characterized in that, The safety functions between the modular vessels and between the modular vessel and the obstacle are established as follows: In the formula: For the first Modular ship and the first Safety functions between modular ships; All are the planar positions of the modular ship; It is the Euclidean norm; , All are constants greater than 0; For the bow roll angle of the modular ship; For the first The modular ship pointed to the first The azimuth of the modular vessel; This refers to the minimum safe distance between modular vessels; For the first Modular ships and obstacles Safety functions between; The planar position of the obstacle; For the first A modular ship points at an obstacle. The azimuth angle; The set safe distance between the modular vessel and obstacles; in, In the formula: It is the first derivative; For the first Modular ship and the first The heading constraints of the modular vessel; For the heading constraints of the modular vessel and obstacles; In the formula: It is the second derivative; These are design parameters that are greater than 0, i.e., the weighting coefficients of the heading angle constraint term; For the first Angular acceleration of a modular ship; for The first derivative, which is also the... The speed of the modular ship; for The first derivative of is also the velocity term of the obstacle; In the formula: This is the coefficient matrix associated with the inertia matrix and the rotation matrix; The offset vector is in the form of a planar acceleration affine. Represents the transformation matrix; Indicates the first The system inertia matrix is ​​composed of the ship's rigid body inertia and hydrodynamic added mass of a modular ship. For the first The sway speed of the modular ship; For the first The sway speed of the modular ship; in, , The offset is the affine form of the heading angular acceleration.

6. The multi-module ship cooperative control method based on high-order CBF according to claim 5, characterized in that, The control obstacle function inequalities between modular ships and between block ships and obstacles are established as follows: In the formula: and These are all design parameters. ; and All are slack variables. , .