Layered anti-interference control method oriented to path tracking of tug autonomous towing ship

By designing a layered anti-interference control method in the towing system, combining self-immunity and sliding mode control, the impact of external disturbance and coupled motion on the towed system is solved, and the precise path tracking and speed control of the towed ship is achieved, improving the The immunity of the drag system.

CN119024843APending Publication Date: 2024-11-26SHANGHAI JIAOTONG UNIV +2
View PDF 0 Cites 2 Cited by

Patent Information

Application Number
CN202411131972.4
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-19
Publication Date
2024-11-26

AI Technical Summary

Technical Problem

The prior art is difficult to achieve precise control of the towing system under the influence of external environmental disturbances and coupled motion, resulting in the occurrence of safety accidents during the towing process.

Method used

Adopting a hierarchical anti-isolation control method for autonomous tow vessel path tracking for tugboats, by establishing a coupled motion mathematical model of the towing system, combining self-isolation control and sliding mode control, the top- and bottom-isolation controllers are designed, and the expansion state observer is used to reduce disturbances. and realize layered immunity control of the towing system under the constraints of streamers and thrusters.

Benefits of technology

It significantly improves the immunity performance of the towed system under external environmental interference, ensures that the towed ship can accurately track the expected heading and speed, reduces the impact of disturbance and coupled motion on the towed system, and improves the path tracking capability of autonomous towing operations.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119024843A_ABST
    Figure CN119024843A_ABST
Patent Text Reader

Abstract

A layered anti-interference control method for tug autonomous towing ship path tracking comprises the steps that a tug self-adaptive receiving circle is calculated through a towing sight guidance algorithm of single ship towing navigation, and guidance control over a tugged ship is achieved; through a top-layer anti-disturbance control method based on the combination of active-disturbance-rejection control and sliding-mode control, the output towing force and the towing direction of the tug are obtained; according to the expected towing direction obtained in the top-layer anti-interference control step and the preset expected speed of the tugged ship, the real-time expected longitudinal speed and expected heading of the tug are obtained through calculation, and a top-layer control task is distributed to bottom-layer tug control; a sliding mode bottom layer anti-interference control method based on an extended state observer is adopted, constraint limitation of a towing cable and a propeller is considered, and expected towing cable force and direction output by top layer anti-interference control serve as self control input to complete a distributed control task. Therefore, the towed target ship can track the expected course and the set navigational speed more accurately, the influence of environment disturbance and coupling motion interference on the towing system is reduced, and the path tracking anti-interference performance in the autonomous towing operation process under the condition that external environment interference is considered is remarkably improved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to a technology in the field of surface unmanned ship control, in particular to a layered anti-disturbance control method for autonomously towing a ship by a tugboat. Background Art

[0002] For the ship towing operation system, using a single tugboat to tow the target ship is one of the simplest and fastest towing modes. In this process, the tugboat uses its own power to generate towing force to move the target ship and slowly adjust its course. During the movement of the tugboat, it is necessary to overcome the influence of external environmental disturbances and coupled motion. For a long time, towing operations have mainly relied on the experience of the captain and pilot for scheduling and control. The ship will be affected by the external environment such as sea breeze and waves, making it difficult to accurately control the towing system. In addition, human driving experience has serious limitations, and it is easy to make mistakes in operation, leading to safety accidents. Summary of the invention

[0003] In view of the fact that the prior art does not take into account the disturbances suffered by the towed large ship and the influence of coupled motion, the cable and thruster constraints and the under-driven characteristics of the tugboat, which makes it difficult to achieve ship path tracking when the ultra-large ship loses power and LOS guidance of the towing system, the present invention proposes a layered anti-disturbance control method for autonomous towing ship path tracking by tugboat. The method can enable the towed target ship to more accurately track the expected heading and set speed while considering the constraints of the tow cable and thruster, reduce the influence of environmental disturbances and coupled motion interference on the towing system, and significantly improve the path tracking anti-disturbance performance during autonomous towing operations considering external environmental interference.

[0004] The present invention is achieved through the following technical solutions:

[0005] The invention relates to a hierarchical anti-disturbance control method for autonomous towing ship path tracking by a tugboat. According to the coupled kinematics and dynamics relationship between the towed ship, the tugboat and the tow cable in the towing process, a coupled motion mathematical model of the towing system under the disturbance of the marine environment is established. According to the setting of the expected towing path point, the adaptive acceptance circle of the tugboat is calculated by the towing line of sight guidance algorithm of the single-ship towing navigation, so as to realize the guidance control of the towed ship. The towing cable force and the towing direction output by the tugboat are obtained by the top-level anti-disturbance control method based on the combination of the self-anti-disturbance control and the sliding mode control. According to the control target conversion method, according to the expected towing direction obtained by the top-level anti-disturbance control step and the preset expected speed of the towed ship, the real-time expected longitudinal speed and expected heading of the tugboat are calculated, and the top-level control task is allocated to the bottom-level tugboat control. Then, the sliding mode bottom-level anti-disturbance control method based on the extended state observer is adopted, and the constraint restrictions of the tow cable and the propeller are considered. The expected towing cable force and direction output by the top-level anti-disturbance control are used as the input of the bottom-level controller of the tugboat, and the control task allocated by the top-level control module is completed, so as to realize the hierarchical anti-disturbance and path tracking of the towing system. Technical Effects

[0006] The present invention considers two control levels, the tugboat and the towed ship, and designs a top-level anti-disturbance controller at the towed ship control layer to ensure that the towing system achieves the top-level control target of path tracking, and allocates the control task to the tugboat in real time through the control target conversion design; designs a bottom-level anti-disturbance controller at the tugboat control layer, and the bottom-level anti-disturbance controller uses the expected towline information calculated at the top level as its own control input, and reduces the influence of the towline force and coupled motion under the constraints of the towline and the thruster. In addition, the method introduces an extended state observer and sliding mode technology, and reduces the influence of environmental disturbances and coupled motion on towing operations by designing hierarchical anti-disturbance control; compared with the prior art, the present invention improves the effect of compensating for external interference and model parameter uncertainty to the ship, can effectively improve the anti-interference ability of the towing system under environmental interference, verify the possibility of the tugboat autonomously towing the ship, and provide a theoretical reference for the application of autonomous towing by the tugboat. BRIEF DESCRIPTION OF THE DRAWINGS

[0007] Figure 1 It is a flow chart of the present invention;

[0008] Figure 2 It is a schematic diagram of a single-vessel towing system of the present invention;

[0009] Figure 3 It is a schematic diagram of the towing guidance of the present invention;

[0010] Figure 4 This is a path tracking effect diagram of the present invention;

[0011] Figure 5 A comparison diagram of the bow angle of the towed vessel between the present invention and the prior art;

[0012] Figure 6 A comparison diagram of the bow angle of a tugboat according to the present invention and the prior art;

[0013] Figure 7 A comparison diagram of the towed ship speeds of the present invention and the prior art;

[0014] Figure 8 The figure is a comparison chart of the tugboat speeds of the present invention and the prior art. DETAILED DESCRIPTION

[0015] like Figure 1 As shown, this embodiment relates to a hierarchical anti-disturbance control method for path tracking of an autonomous towing vessel by a tugboat, comprising:

[0016] Step 1: Based on the coupled kinematics and dynamics relationship between the towed vessel, tugboat and tow cable during towing, a mathematical model of the coupled motion of the towing system under the disturbance of the marine environment is established, which specifically includes:

[0017] Step 1.1: Construct a mathematical model of the three-degree-of-freedom motion of the towed ship under the disturbance of the marine environment, specifically: Rewritten in state space form: Where: v0 = [u0, v0, r0] T is the velocity state vector of the towed ship, which represents the sway velocity, the sway velocity and the bow angular velocity respectively; M0 is the inertia matrix of the towed ship including the additional mass, m0 is the mass of the towed ship, m x0 ,m y0 are the longitudinal additional mass and the transverse additional mass in the hull coordinate system of the towed vessel, I z0 is the coordinate system of the towed vessel x Additional moment of inertia of the shaft, J z0 The additional moment of inertia of the z-axis in the hull coordinate system of the towed ship; C0(v0) is the Coriolis centripetal force matrix of the towed ship; D0(v0) is the water damping matrix of the towed ship, X H0 ,Y H0 ,N H0 are the hydrodynamic forces acting on the towed ship; B0(α) is the tension configuration matrix of the towed ship; T0 is the tension on the towed ship along the towline; α is the angle between the towline and the O0-X0 axis of the towed ship; l0 is half of the total length of the towed ship; τ E0 =[X E0 ,Y E0 ,N E0 ] T are the external environment disturbance matrices of the towed ship. η0=[x0,y0,ψ0] T is the position state information of the towed vessel, x0, y0, ψ0 represent the displacement in the sway and surge directions and the heading angle respectively; J(η0) is the coordinate transformation matrix of the towed vessel;

[0018] Step 1.2: Construct a mathematical model of the three-degree-of-freedom motion of the underactuated tugboat under the disturbance of the marine environment, specifically: Rewritten in state space form: Where: v1 = [u1, v1, r1] T is the tugboat speed state vector, which represents the longitudinal speed, transverse speed and bow angular velocity respectively; M1 is the inertia matrix of the towed vessel taking into account the additional mass, where m1 is the mass of the tugboat, m x1 ,m y1 are the longitudinal additional mass and the transverse additional mass in the tugboat hull coordinate system, I z1 is the tugboat hull coordinate system x Additional moment of inertia of the shaft, J z1 The additional moment of inertia of the z-axis in the tugboat hull coordinate system; C1(v1) is the tugboat Coriolis centripetal force matrix; D1(v1) is the tugboat water damping matrix, X H1 ,Y H1 ,N H1 They are the hydrodynamic forces in three directions of the tugboat; is the thrust matrix of the propeller; B1(β) is the tugboat force configuration matrix; β=ψ0-ψ1+α is the angle between the tow cable and the tugboat O1-X1 axis; ψ0 is the heading angle of the towed vessel; ψ1 is the heading angle of the tugboat; α is the angle between the towline and the O0-X0 axis of the towed vessel; T1 is the pulling force on the tugboat along the towline; δ is the thrust angle of the tugboat propeller; F is the thrust of the propeller; l0 is half of the total length of the tugboat; τ E1 =[X E1 ,Y E1 ,N E1 ] T are the external environmental disturbances on the tugboat in three directions,

[0019] Step 1.3: Figure 2 As shown in the figure, since the towline is in a taut state and its length remains unchanged, the relative positions of the tugboat and the towed ship in the geodetic coordinate system satisfy Rewritten in matrix form η1=η0+l0E1(ψ0)+l1E2(ψ1)+l T E3+(α-β)[0 0 1] T , after the second-order derivation, we get: in: According to the mathematical model of the movement of the tugboat and the towed ship, Since the tow cable is in a taut state, the tension at both ends is equal: T0 = T1; then the three-degree-of-freedom coupled motion mathematical model of the towing system under external disturbance is established, specifically:

[0020] Step 1.4: Set the assumptions and properties of the model transformation constructed in step 1.3, including: the towline is always in a taut state during the towing process, the length is kept constant, and the external environmental interference term is bounded, which can be described by a time-varying interference function.

[0021] Step 2: adopt the towing line-of-sight guidance algorithm suitable for single-ship towing navigation, calculate the tugboat adaptive acceptance circle according to the set expected towing path points, and realize the guidance control of the towed ship, which specifically includes: Figure 3 As shown, the towed vessel path satisfies Among them: the real-time position of the towed ship in the geodetic coordinate system (x0, y0), the previous path point P n (x n ,y n ), the next expected path point P n+1 (x n+1 ,y n+1 ), calculate the expected path deviation angle ψ p =tan(Δy / Δx) and the lateral displacement deviation of the towed vessel According to the designed towing line-of-sight guidance method, the expected heading of the towed vessel is obtained. Where: Δ0 is the forward sight distance of the ship.

[0022] When the ship approaches the target point, the target path needs to switch to the next path. n+1 The center R n+1 is the acceptance circle with radius Start switching to the target path; the towed ship is controlled by the tugboat through the towline, and the adaptive acceptance circle strategy designed for the tugboat is as follows: Where: θ is the angle between adjacent paths, R min is the average turning radius of the towing system.

[0023] The average turning radius of the towing system is obtained by, but not limited to, the following methods:

[0024] 1) Keep the towing system sailing at a certain speed along the heading of 0°, and set a series of expected headings of the towed ship. To simulate different path angles, simulation experiments are carried out.

[0025] 2) Record the turning radius of the towing system at different turning angles, and take the average value of all data as R min.

[0026] Step 3: Use the top-level anti-disturbance control method based on the combination of anti-disturbance control and sliding mode control to calculate the towing cable force and towing direction required by the tugboat to ensure that the towing system achieves the control goal of path tracking, including:

[0027] Step 3.1: Construct heading expansion state observer in: y1=ψ0 is the heading angle of the towed vessel; is the observed value of the ship’s heading; is the observed value of the bow angular velocity of the towed vessel; is the estimated value of the disturbance to the heading of the towed vessel; is the gain to be determined; ω o1 >0 is the set bandwidth coefficient. The observer gain can be configured as According to the expected heading angle of the towed vessel Calculation error Desired drag direction based on active disturbance rejection control Where: k p , k d , is an adjustable parameter, is the estimate of the total disturbance by the towed ship’s bow expansion state observer.

[0028] Step 3.2: Construct the vertical expansion state observer Where: y2=u0, is the estimated value of the longitudinal speed of the towed vessel; is the estimated total disturbance to the towed vessel in the longitudinal direction, is the gain to be determined; is the speed control quantity; ω o2 is the set bandwidth factor. The observer gain can be configured as According to the expected longitudinal speed of the towed vessel The calculated speed error is According to the sliding surface The longitudinal sliding mode control law of the towed vessel is obtained in: constant is the estimated value of the longitudinal disturbance of the towed vessel.

[0029] Step 3.3: Calculate the desired tow cable force based on the desired tow cable angle and the desired longitudinal force.

[0030] Step 4: Using the control target conversion method, according to the expected towing direction obtained in step 3.1 and the preset expected speed of the towed ship, the real-time expected longitudinal speed and expected heading of the tugboat are calculated and the top-level control tasks are assigned to the bottom-level tugboat control, which includes:

[0031] Step 4.1: Convert the desired towing cable angle and towing cable force into the actual control task of the tugboat, that is, through the control target conversion, give the tugboat the real-time desired heading angle The expected longitudinal velocity The desired streamer direction α d Get the real-time expected path of the tugboat The lateral distance between the current position of the tugboat (x1, y1) and the desired path satisfies: Further construct the real-time expected heading angle of the tugboat Among them: Δ1 is the forward distance of the tugboat, which is a parameter to be selected; ψ0 is the current heading angle of the tugboat; α d Desired towing direction;

[0032] Step 4.2: According to the connection point N0(x N0 ,y N0 ) and the connection point between the towing cable and the tugboat N1(x N1 ,y N1 ),get Calculate the real-time expected speed of the tugboat in: is the expected longitudinal speed of the towed vessel, ψ0 is the heading angle of the towed vessel, and ψ1 is the heading angle of the tugboat.

[0033] Step 5: Adopt the sliding mode bottom anti-disturbance control method based on extended state observer, consider the constraints of towline and thruster, take the expected towline force and direction output by top anti-disturbance control as the control input of bottom tugboat controller to complete the assigned control task, and realize the layered anti-disturbance and path tracking of towing system, which includes:

[0034] Step 5.1: Considering the external environmental disturbance and towing cable force on the tugboat, according to the tugboat's real-time expected heading angle Calculate heading error Then construct the sliding surface The extended state observer is used to estimate the disturbance of the tugboat heading. The tugboat bow control law is obtained: in: is the gain to be determined; are constants, is the estimated value of the disturbance of the tugboat’s heading, T dDesired streamer forces calculated for top-level disturbance rejection control.

[0035] Step 5.2: According to the real-time expected longitudinal speed of the tugboat Calculate heading error Then construct the sliding surface The longitudinal sliding mode control law of the tugboat is obtained: in: is the gain to be determined; are constants, is the estimated value of the disturbance in the longitudinal direction of the tugboat, T d Desired streamer forces calculated for top-level disturbance rejection control.

[0036] Step 5.3: Since the tugboat adopts full rotation propulsion mode, according to dynamic analysis Solve the thruster force F and angle according to the controller output And impose restrictions on towing cables and tugboat thrusters, specifically: Towing cables: Thrusters:

[0037] After specific actual experiments, according to the towing system coupling model and the designed controller, the initial position of the towed ship is set to x0(0)=0(m), y0(0)=0(m), ψ0(0)=π, and the initial speed is: u0(0)=0(m / s), v0(0)=0(m / s), r0(0)=0(rad / s); the initial position of the tugboat is set to x1(0)=0(m), y1(0)=14(m), ψ1(0)=π, and the initial speed is: u1(0)=0(m / s), v1(0)=0(m / s), r1(0)=0(rad / s); the length of the tow cable is fixed to l T =7m. Constraints are imposed on the thruster and the tow cable, specifically: Thruster The expected longitudinal velocity of the towing system is set to 0.6 m / s. Assuming that the towing system is affected by time-varying interference and constant interference in the port area during towing, the following time-varying interference function is used to simulate the time-varying interference of regular waves on the actual ship in sea conditions of about level 4: When the simulation time is 600-800s, the towed ship is assumed to be subjected to a constant disturbance torque of 200N·m, and the tugboat is assumed to be subjected to a constant disturbance torque of 100N·m.

[0038] According to the above simulation settings and initialization parameter definitions, the following is obtained through simulation experiment verification: Figure 4 The path tracking effect comparison diagram is shown in FIG. 1 , and the various indicators of the path tracking process are shown in Table 1 .

[0039] like Figure 5 Figure 6 As shown in the figure, there are comparison diagrams of the heading changes of the towed ship and the tugboat, respectively. It can be seen that the layered anti-disturbance strategy of the present invention has a smaller overshoot, and the tugboat can complete the heading control of the towing of the tugboat under a smaller heading angle fluctuation, so that the average heading angle error of the towed ship is increased by 34.6%, and the average heading error of the tugboat is increased by 51.9%.

[0040] like Figure 7 and Figure 8 As shown, they are the comparison diagrams of the longitudinal speeds of the two ships. Combined with Table 1, it can be seen that the control strategy of the present invention has good ship speed retention, can quickly converge to the predetermined speed, and has small fluctuations. Compared with the existing control strategy, the tugboat speed error is improved by 52.2%, and the towed ship speed error is improved by 67.5%.

[0041] Table 1 Path tracking performance indicators

[0042] Table They are the average lateral distance error, average heading error and average speed error of the towed vessel respectively;

[0043] Compared with the prior art, the present invention can use an autonomous tugboat to tow an unpowered ship to achieve path tracking control. Compared with the prior art, the lateral error of the towing system path tracking is improved by 16.9%, among which the average heading error of the tugboat is improved by 51.9%, and the speed error is improved by 52.2%. The average heading angle error of the towed ship is improved by 34.6%, and the speed error is improved by 67.5%. Therefore, this method has better anti-interference effect for towing path tracking control.

[0044] The above-mentioned specific implementation can be partially adjusted in different ways by those skilled in the art without departing from the principle and purpose of the present invention. The protection scope of the present invention shall be based on the claims and shall not be limited by the above-mentioned specific implementation. Each implementation scheme within its scope shall be subject to the constraints of the present invention.

Claims

1. A hierarchical anti-disturbance control method for path tracking of autonomous towing vessels by tugboats, characterized in that: According to the coupled kinematic and dynamic relationship between the towed vessel, tugboat and towline during the towing process, a mathematical model of the coupled motion of the towing system under the disturbance of the marine environment is established. According to the setting of the expected towing path points, the adaptive acceptance circle of the tugboat is calculated by the towing line of sight guidance algorithm of single-ship towing navigation to realize the guidance control of the towed vessel; the output towline force and towing direction of the tugboat are obtained by the top-level anti-disturbance control method based on the combination of self-anti-disturbance control and sliding mode control; the control target conversion method is adopted to calculate the real-time expected longitudinal speed and expected bow direction of the tugboat according to the expected towing direction and the preset expected speed of the towed vessel, and the top-level control task is assigned to the bottom-level tugboat control; then the sliding mode bottom-level anti-disturbance control method based on the extended state observer is adopted, and the constraints of the towline and the thruster are considered. The expected towline force and direction output by the top-level anti-disturbance control are used as the input of the bottom-level controller of the tugboat to complete the control tasks assigned by the top-level control module, and the layered anti-disturbance and path tracking of the towing system are realized.

2. The hierarchical anti-disturbance control method for path tracking of autonomous towing vessels according to claim 1 is characterized in that: The mathematical model of coupled motion of the towing system under the disturbance of the marine environment is specifically: Where: v0 = [u0, v0, r0] T is the velocity state vector of the towed vessel, which respectively represents the sway velocity, the sway velocity and the bow angular velocity, M0 is the inertia matrix of the towed vessel including the additional mass, m0 is the mass of the towed vessel, m x0 ,m y0 are the longitudinal additional mass and the transverse additional mass in the hull coordinate system of the towed vessel, I z0 is the coordinate system of the towed vessel x Additional moment of inertia of the shaft, J z0 The additional moment of inertia of the z-axis in the hull coordinate system of the towed ship, C0(v0) is the Coriolis centripetal force matrix of the towed ship, D0(v0) is the water damping matrix of the towed ship, X H0 ,Y H0 ,N H0 are the hydrodynamic forces acting on the towed ship, B0(α) is the tension configuration matrix of the towed ship, T0 is the tension on the towed ship along the towline, α is the angle between the towline and the O0-X0 axis of the towed ship, l0 is half of the total length of the towed ship, τ E0 =[X E0 ,Y E0 ,N E0 ] T are the external environment disturbance matrices of the towed ship, η0=[x0,y0,ψ0] T is the position state information of the towed vessel, x0, y0, ψ0 represent the displacement in the sway and surge directions and the heading angle respectively, J(η0) is the coordinate transformation matrix of the towed vessel, v1=[u1,v1,r1] T is the tugboat speed state vector, which represents the longitudinal speed, transverse speed and bow angular velocity respectively, M1 is the inertia matrix of the towed vessel taking into account the additional mass, where m1 is the mass of the tugboat, m x1 ,m y1 are the longitudinal additional mass and the transverse additional mass in the tugboat hull coordinate system, I z1 is the tugboat hull coordinate system x Additional moment of inertia of the shaft, J z1 The additional moment of inertia of the z-axis in the tugboat hull coordinate system, C1(v1) is the tugboat Coriolis centripetal force matrix, D1(v1) is the tugboat water damping matrix, X H1 ,Y H1 ,N H1 They are the water forces in three directions of the tugboat. is the thrust matrix of the propeller, B1(β) is the tugboat force configuration matrix, β=ψ0-ψ1+α is the angle between the towline and the tugboat O1-X1 axis, ψ0 is the heading angle of the towed ship, ψ1 is the heading angle of the tugboat, α is the angle between the towline and the O0-X0 axis of the towed ship, T1 is the pulling force on the tugboat along the towline, δ is the thrust angle of the tugboat propeller, F is the thrust of the propeller, l0 is half of the total length of the tugboat, τ E1 =[X E1 ,Y E1 ,N E1 ] T are the external environmental disturbances on the tugboat in three directions, 3. The hierarchical anti-disturbance control method for path tracking of autonomous towing vessels according to claim 1 is characterized in that: The guidance and control of the towed vessel specifically includes: Step 2.1: The towed ship path satisfies Among them: the real-time position of the towed ship in the geodetic coordinate system (x0, y0), the previous path point P n (x n ,y n ), the next expected path point P n+1 (x n+1 ,y n+1 ), calculate the expected path deviation angle ψ p =tan(Δy / Δx) and the lateral displacement deviation of the towed vessel According to the designed towing line-of-sight guidance method, the expected heading of the towed vessel is obtained. Where: Δ0 is the forward distance of the ship; when the ship approaches the target point, the target path needs to switch to the next path. n+1 The center R n+1 is the acceptance circle with radius Start switching to the target path; the towed ship is controlled by the tugboat through the towline, and the adaptive acceptance circle strategy designed for the tugboat is as follows: Where: θ is the angle between adjacent paths, R min is the average turning radius of the towing system.

4. The hierarchical anti-disturbance control method for path tracking of autonomous towing vessels according to claim 3 is characterized in that: The average turning radius of the towing system is obtained in the following manner: 1) Keep the towing system sailing at a certain speed along the heading of 0°, and set a series of expected headings of the towed ship. To simulate different path angles and conduct simulation tests; 2) Record the turning radius of the towing system at different turning angles, and take the average value of all data as R min .

5. The hierarchical anti-disturbance control method for path tracking of autonomous towing vessels by tugboats according to claim 1 is characterized in that: The top-level anti-disturbance control method specifically includes: Step 3.1: Construct heading expansion state observer Where: y1 = ψ0 is the heading angle of the towed vessel; is the observed value of the ship’s heading; is the observed value of the bow angular velocity of the towed vessel; is the estimated value of the disturbance to the heading of the towed vessel; is the gain to be determined; ω o1 >0 is the set bandwidth coefficient, and the observer gain is configured as According to the expected heading angle of the towed vessel Calculation error Desired drag direction based on active disturbance rejection control Where: k p , k d , is an adjustable parameter, is the estimated value of the total disturbance by the towed ship’s bow expansion state observer; Step 3.2: Construct the vertical expansion state observer Where: y2=u0, is the estimated value of the longitudinal speed of the towed vessel; is the estimated total disturbance to the towed vessel in the longitudinal direction, is the gain to be determined; is the speed control quantity; ω o2 For the set bandwidth coefficient, the observer gain is configured as According to the expected longitudinal speed of the towed vessel The calculated speed error is According to the sliding surface The longitudinal sliding mode control law of the towed vessel is obtained in: constant is the estimated value of the longitudinal disturbance of the towed vessel; Step 3.3: Calculate the desired tow cable force based on the desired tow cable angle and the desired longitudinal force.

6. The hierarchical anti-disturbance control method for path tracking of autonomous towing vessels according to claim 1 is characterized in that: The control target conversion method specifically includes: Step 4.1: Convert the desired towing cable angle and towing cable force into the actual control task of the tugboat, that is, through the control target conversion, give the tugboat the real-time desired heading angle The expected longitudinal velocity The desired streamer direction α d Get the real-time expected path of the tugboat The lateral distance between the current position of the tugboat (x1, y1) and the desired path satisfies: Further construct the real-time expected heading angle of the tugboat Among them: Δ1 is the forward distance of the tugboat, which is a parameter to be selected; ψ0 is the current heading angle of the tugboat; α d Desired towing direction; Step 4.2: According to the connection point N0(x N0 ,y N0 ) and the connection point between the towing cable and the tugboat N1(x N1 ,y N1 ),get Calculate the real-time expected speed of the tugboat in: is the expected longitudinal speed of the towed vessel, ψ0 is the heading angle of the towed vessel, and ψ1 is the heading angle of the tugboat.

7. The hierarchical anti-disturbance control method for path tracking of autonomous towing vessels according to claim 1 is characterized in that: The sliding mode bottom layer anti-disturbance control method specifically includes: Step 5.1: Considering the external environmental disturbance and towing cable force on the tugboat, according to the tugboat's real-time expected heading angle Calculate heading error Then construct the sliding surface The extended state observer is used to estimate the disturbance of the tugboat heading. The tugboat bow turning control law is obtained: in: is the gain to be determined; are constants, is the estimated value of the disturbance of the tugboat’s heading, T d The expected streamer forces calculated for top disturbance rejection control; Step 5.2: According to the real-time expected longitudinal speed of the tugboat Calculate heading error Then construct the sliding surface The longitudinal sliding mode control law of the tugboat is obtained: in: is the gain to be determined; are constants, is the estimated value of the disturbance in the longitudinal direction of the tugboat, T d The expected streamer forces calculated for top disturbance rejection control; Step 5.3: Since the tugboat adopts full rotation propulsion mode, according to dynamic analysis According to the controller output, the thruster force F and angle δ are solved: And impose restrictions on towing cables and tugboat thrusters, specifically: Towing cables: Thrusters:

Citation Information

Cited By

  • Optimal fault-tolerant control method and system for robust path tracking of coastal tugboat

    CN119668111A

  • Method and system for planning and controlling route of ship towing underwater operation equipment

    CN122131779A