Ship path following control method, system, device and storage medium

By obtaining the target path and ship status, combining the LOS guidance strategy to obtain the expected state and generate rudder angle control instructions, the problem of low reliability of the traditional ship path following control algorithm is solved, and more stable and accurate ship path following control is achieved.

CN115016471BActive Publication Date: 2024-11-01WUHAN UNIV OF TECH
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202210598370.4
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2022-05-30
Publication Date
2024-11-01
Estimated Expiration
2042-05-30

AI Technical Summary

Technical Problem

The traditional ship path following control algorithm relies on system models, resulting in low reliability and model-free adaptive control algorithm fluctuates when only taking into account heading angles, resulting in reduced accuracy and reliability of path following control.

Method used

By obtaining the target path and the current ship status, the LOS guidance strategy is used to combine the ship status to obtain the expected state, including the expected heading angle and the expected angle velocity, and input the self-immune controller to generate the rudder angle control command to improve the stability and accuracy of the rudder angle control sex.

Benefits of technology

Improve the stability, accuracy and reliability of ship path follow-up control, ensuring that the ship can follow the target path more accurately.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN115016471B_ABST
    Figure CN115016471B_ABST
Patent Text Reader

Abstract

The present invention discloses a ship path following control method, system, device and storage medium. The ship path following control method obtains the target path and the ship state at the current moment, and obtains the expected state at the current moment according to the LOS guidance strategy in combination with the ship state and the target path, so that the ship's path following control problem is converted into a dynamic heading control problem, and the expected state of the ship at each moment can be obtained more accurately and reliably, thereby improving the reliability and accuracy of the output rudder angle control command; by considering the ship angular velocity at the current moment and the expected angular velocity under the corresponding expected state, and controlling the ship to follow the target path according to the expected angular velocity and the rudder angle control command, the ship's rudder angle control is more stable, thereby further improving the stability, accuracy and reliability of the ship path following control. The present invention can be widely applied to the field of ship control technology.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to the field of ship control technology, and in particular to a ship path following control method, system, device and storage medium. Background Art

[0002] Traditional ship path following control algorithms mostly rely on system models. However, accurate system models are difficult to establish to a certain extent, resulting in low reliability of traditional ship path following control algorithms. Therefore, in recent years, model-free control algorithms have been increasingly applied to ship path following control, such as model-free adaptive control algorithms.

[0003] At present, in the existing research on ship path following control using model-free adaptive control algorithm, the heading angle is generally regarded as the reference output variable of the system, and the rudder angle command is corrected by comparing the error between the heading angle and the desired state, so as to achieve the control effect of ship path following. However, when the reference output variable only considers the heading angle, the ship motion control effect fluctuates greatly, and the ship's heading angle often cannot be stabilized to the desired state, resulting in reduced accuracy and reliability of ship path following control. Summary of the invention

[0004] The purpose of the present invention is to solve one of the technical problems existing in the prior art to at least a certain extent.

[0005] To this end, an object of an embodiment of the present invention is to provide a ship path following control method, system, device and storage medium to achieve more stable and reliable ship path tracking control.

[0006] In order to achieve the above technical objectives, the technical solutions adopted by the embodiments of the present invention include:

[0007] In a first aspect, an embodiment of the present invention provides a ship path following control method, comprising the following steps:

[0008] Obtaining the target path and the ship status at the current moment, wherein the ship status includes the ship position, the ship heading angle and the ship angular velocity;

[0009] According to the LOS guidance strategy, the expected state at the current moment is obtained in combination with the ship state and the target path, wherein the expected state includes an expected heading angle and an expected angular velocity, and the expected angular velocity is a preset maximum value of the ship angular velocity;

[0010] Input the ship heading angle and the desired heading angle into an active disturbance rejection controller, and output a rudder angle control instruction;

[0011] The vessel is controlled to follow the target path according to the rudder angle control instruction and the expected angular velocity.

[0012] A ship path following control method according to an embodiment of the present invention obtains a target path and a ship state at a current moment, and obtains an expected state at a current moment according to a LOS guidance strategy in combination with the ship state and the target path, so that the ship path following control problem is converted into a dynamic heading control problem, and the expected state of the ship at each moment can be obtained more accurately and reliably, thereby improving the reliability and accuracy of the output rudder angle control command; by considering the ship angular velocity at the current moment and the expected angular velocity under the corresponding expected state, and controlling the ship to follow the target path according to the expected angular velocity and the rudder angle control command, the ship's rudder angle control is more stable, thereby further improving the stability, accuracy and reliability of the ship path following control.

[0013] In addition, a ship path following control method according to the above embodiment of the present invention may also have the following additional technical features:

[0014] Furthermore, in a ship path following control method according to an embodiment of the present invention, the target path includes a plurality of position points;

[0015] The obtaining the desired state at the current moment in combination with the ship state and the target path according to the LOS guidance strategy includes:

[0016] Acquire a current position point on the target path according to the position of the ship, the current position point being the position point on the target path closest to the position of the ship;

[0017] Acquire a reference point on the target path according to the current position point and the ship position;

[0018] Acquire the sight angle between the ship and the reference point according to the ship state as the expected heading angle;

[0019] The desired state is generated according to the desired heading angle and the desired angular velocity.

[0020] Further, in one embodiment of the present invention, acquiring a current position point on the target path according to the position of the ship includes:

[0021] Acquire a first position point and a second position point on the target path according to the position of the ship, wherein the first position point is a theoretical position point corresponding to the current moment, and the second position point is a position point next to the first position point;

[0022] Calculate a first distance and a second distance according to the ship position, the first position point and the second position point, the first distance being the distance between the ship position and the first position point, and the second distance being the distance between the ship position and the second position point;

[0023] If the first distance is smaller than the second distance, selecting the first position point as the current position point;

[0024] If the first distance is greater than the second distance, the second position point is selected as the current position point.

[0025] Further, in one embodiment of the present invention, acquiring a reference point on the target path according to the current position point and the ship position includes:

[0026] Get the captain of the vessel;

[0027] Calculating the distance between the first position point and the second position point to obtain a third distance;

[0028] Calculate a fourth distance using a preset formula according to the first distance, the second distance, the third distance and the ship length;

[0029] constructing a dynamic circle with the ship position as the center and the fourth distance as the radius;

[0030] Acquire a set of intersections between the dynamic circle and the target path, wherein the set of intersections includes a plurality of intersections between the dynamic circle and the target path;

[0031] The intersection point of the intersection point set that is closest to the position of the ship is selected as the reference point.

[0032] Further, in one embodiment of the present invention, the step of inputting the ship heading angle and the desired heading angle into an active disturbance rejection controller and outputting a rudder angle control instruction comprises:

[0033] Inputting the ship heading angle and the desired heading angle into the active disturbance rejection controller to obtain a rudder angle control value;

[0034] The rudder angle control instruction is generated according to the rudder angle control amount.

[0035] Furthermore, in one embodiment of the present invention, before the step of acquiring the target path and the ship status at the current moment, the method further includes the following steps:

[0036] Initializing the ship state and the target path, and obtaining the initial position of the ship;

[0037] The initial position is used as the starting point of the target path, and the end of the target path away from the initial position is used as the end point of the target path.

[0038] Furthermore, in one embodiment of the present invention, the method further comprises the following steps:

[0039] Determining whether the ship has reached the end of the target path according to the ship position and the target path;

[0040] If so, terminating the path following control of the vessel;

[0041] If not, the step of acquiring the expected state at the current moment in combination with the ship state and the target path according to the LOS guidance strategy is executed.

[0042] In a second aspect, an embodiment of the present invention provides a ship path following control system, comprising:

[0043] The first acquisition module is used to acquire the target path and the ship status at the current moment;

[0044] A second acquisition module is used to acquire the desired state at the current moment according to the LOS guidance strategy in combination with the ship state and the target path;

[0045] A rudder angle control command output module, used for inputting the ship heading angle and the desired heading angle into an active disturbance rejection controller, and outputting a rudder angle control command;

[0046] A path following control module is used to control the ship to follow the target path according to the rudder angle control instruction and the expected angular velocity.

[0047] In a third aspect, an embodiment of the present invention provides a ship path following control device, comprising:

[0048] at least one processor;

[0049] at least one memory for storing at least one program;

[0050] When the at least one program is executed by the at least one processor, the at least one processor implements the ship path following control method.

[0051] In a fourth aspect, an embodiment of the present invention provides a storage medium, in which a program executable by a processor is stored. When the program executable by the processor is executed by the processor, it is used to implement the ship path following control method.

[0052] The advantages and benefits of the present invention will be partially given in the following description, and partially become apparent from the following description, or be understood through the practice of the present application:

[0053] The embodiment of the present invention obtains the target path and the ship state at the current moment, and obtains the expected state at the current moment according to the LOS guidance strategy in combination with the ship state and the target path, so that the path following control problem of the ship is converted into a dynamic heading control problem, and the expected state of the ship at each moment can be obtained more accurately and reliably, thereby improving the reliability and accuracy of the output rudder angle control command; by considering the ship angular velocity at the current moment and the expected angular velocity under the corresponding expected state, and controlling the ship to follow the target path according to the expected angular velocity and the rudder angle control command, the rudder angle control of the ship is more stable, thereby further improving the stability, accuracy and reliability of the ship path following control. BRIEF DESCRIPTION OF THE DRAWINGS

[0054] In order to more clearly illustrate the embodiments of the present application or the technical solutions in the prior art, the following introduction is made to the drawings of the embodiments of the present application or the related technical solutions in the prior art. It should be understood that the drawings introduced below are only for the convenience of clearly describing some embodiments of the technical solutions of the present application. For technical personnel in this field, other drawings can be obtained based on these drawings without paying any creative work.

[0055] Figure 1 A schematic diagram of a flow chart of a specific embodiment of a ship path following control method of the present invention;

[0056] Figure 2 A schematic diagram of an active disturbance rejection controller of a specific embodiment of a ship path following control method of the present invention;

[0057] Figure 3 A schematic diagram of a model-free adaptive control law of a specific embodiment of a ship path following control method of the present invention;

[0058] Figure 4 It is a structural schematic diagram of a specific embodiment of a ship path following control system of the present invention;

[0059] Figure 5 It is a structural schematic diagram of a specific embodiment of a ship path following control device of the present invention. DETAILED DESCRIPTION

[0060] The embodiments of the present invention are described in detail below, and examples of the embodiments are shown in the accompanying drawings, wherein the same or similar reference numerals throughout represent the same or similar elements or elements having the same or similar functions. The embodiments described below with reference to the accompanying drawings are exemplary and are only used to explain the present application, and are not to be construed as limitations on the present application. For the step numbers in the following embodiments, they are only provided for the convenience of explanation, and the order between the steps is not limited in any way. The execution order of each step in the embodiment can be adaptively adjusted according to the understanding of those skilled in the art.

[0061] The terms "first", "second", "third" and "fourth" etc. in the specification and claims of the present invention and the drawings are used to distinguish different objects, rather than to describe a specific order. 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 limited to the listed steps or units, but may optionally include steps or units that are not listed, or may optionally include other steps or units that are inherent to these processes, methods, products or devices.

[0062] Reference to "embodiments" in the present invention means that a particular feature, structure, or characteristic described in conjunction with the embodiments may be included in at least one embodiment of the present invention. The appearance of the phrase in various places in the specification does not necessarily refer to the same embodiment, nor is it an independent or alternative embodiment that is mutually exclusive with other embodiments. It is explicitly and implicitly understood by those skilled in the art that the embodiments described herein may be combined with other embodiments.

[0063] Traditional ship path following control algorithms mostly rely on system models. However, accurate system models are difficult to establish to a certain extent, resulting in low reliability of traditional ship path following control algorithms. Therefore, in recent years, model-free control algorithms have been increasingly applied to ship path following control, such as model-free adaptive control algorithms.

[0064] At present, in the existing research on ship path following control using model-free adaptive control algorithm, the heading angle is generally regarded as the reference output variable of the system, and the rudder angle command is corrected by comparing the error between the heading angle and the desired state, so as to achieve the control effect of ship path following. However, when the reference output variable only considers the heading angle, the ship motion control effect fluctuates greatly, and the ship's heading angle often cannot be stabilized to the desired state, resulting in reduced accuracy and reliability of ship path following control.

[0065] To this end, the present invention proposes a ship path following control method, system, device and storage medium. Different from the traditional ship path following control method which has the problems of low stability and reliability, the present invention obtains the target path and the ship state at the current moment, and obtains the expected state at the current moment according to the LOS guidance strategy in combination with the ship state and the target path, so that the ship's path following control problem is converted into a dynamic heading control problem, and the expected state of the ship at each moment can be obtained more accurately and reliably, thereby improving the reliability and accuracy of the output rudder angle control command; by considering the ship's angular velocity at the current moment and the expected angular velocity under the corresponding expected state, and controlling the ship to follow the target path according to the expected angular velocity and the rudder angle control command, the ship's rudder angle control is more stable, thereby further improving the stability, accuracy and reliability of the ship's path following control.

[0066] A ship path following control method, system, device and storage medium proposed in an embodiment of the present invention will be described in detail below with reference to the accompanying drawings. First, a ship path following control method proposed in an embodiment of the present invention will be described with reference to the accompanying drawings.

[0067] Reference Figure 1 In an embodiment of the present invention, a ship path following control method is provided. A ship path following control method in an embodiment of the present invention can be applied to a terminal, a server, or software running in a terminal or a server. The terminal can be a tablet computer, a laptop computer, a desktop computer, etc., but is not limited thereto. The server can be an independent physical server, or a server cluster or a distributed system composed of multiple physical servers, or a cloud server that provides basic cloud computing services such as cloud services, cloud databases, cloud computing, cloud functions, cloud storage, network services, cloud communications, middleware services, domain name services, security services, content distribution networks (CDNs), and big data and artificial intelligence platforms. A ship path following control method in an embodiment of the present invention mainly includes the following steps:

[0068] S101, obtaining the target path and the ship status at the current moment;

[0069] The ship status includes the ship position, ship heading angle and ship angular velocity.

[0070] In an embodiment of the present invention, before step S101, the following steps are also included:

[0071] 1) Initializing the ship state and the target path, and obtaining the initial position of the ship;

[0072] 2) The initial position is used as the starting point of the target path, and the end of the target path away from the initial position is used as the end point of the target path.

[0073] S102, according to the LOS guidance strategy, combining the ship state and the target path to obtain the expected state at the current moment;

[0074] The desired state includes a desired heading angle and an desired angular velocity, and the desired angular velocity is a preset maximum value of the angular velocity of the ship. The target path includes a plurality of position points.

[0075] In one embodiment of the present invention, the desired angular velocity is zero.

[0076] Specifically, the target path of the embodiment of the present invention is composed of multiple position points (p1, p2, ..., p n ), where p1 represents the starting point of the target path, p n Indicates the end point of the target path.

[0077] S102 can be further divided into the following steps S1021-S1024:

[0078] Step S1021, obtaining a current position point on the target path according to the position of the ship;

[0079] The current position point is the position point on the target path that is closest to the ship position.

[0080] Specifically, the steps include:

[0081] 1) Obtain a first position point p on the target path according to the ship position m and the second position point p m+1 ;

[0082] Among them, the first position point p m is the theoretical position point corresponding to the current moment, and the second position point p m+1 is the first position point p m The next position point, m is an integer, 0 <m≤n-1。

[0083] 2) Calculate a first distance d according to the ship position, the first position point and the second position point a and the second distance d b ;

[0084] Among them, the first distance d a is the ship position and the first position point p m The second distance d b is the ship position and the second position point p m+1 distance;

[0085] 3) If the first distance d a is smaller than the second distance d b , then select the first position point p m is the current position point;

[0086] 4) If the first distance d a Greater than the second distance d b , then select the second position point p m+1 is the current location point.

[0087] Step S1022: acquiring a reference point on the target path according to the current position point and the ship position;

[0088] Specifically, the steps include:

[0089] 1) Get the captain d of the ship boat ;

[0090] 2) Calculate the first position point p m and the second position point p m+1 The third distance d is obtained c ;

[0091] 3) According to the first distance d a The second distance d b , the third distance d c and the captain d boat , calculate the fourth distance R using a preset formula;

[0092] Specifically, when the first distance d a Less than the second distance d b , that is, the first position point p m When it is the current position, the fourth distance:

[0093]

[0094] The first distance d a Greater than the second distance d b , that is, the second position point p m+1 When it is the current position point, the fourth distance is:

[0095]

[0096] 4) constructing a dynamic circle with the ship position as the center and the fourth distance as the radius;

[0097] 5) obtaining a set of intersections between the dynamic circle and the target path, wherein the set of intersections includes a plurality of intersections between the dynamic circle and the target path;

[0098] 6) Selecting the intersection point of the intersection point set that is closest to the position of the ship as the reference point.

[0099] Step S1023, obtaining a sight angle between the ship and the reference point according to the ship state as the expected heading angle;

[0100] The line of sight angle between the ship and the reference point is the LOS angle. If the ship position at the current moment is (x(k), y(k)), the reference point obtained in step S1022 is (x los ,y los ), the LOS angle is calculated as:

[0101]

[0102] Step S1024: Generate the expected state according to the expected heading angle and the expected angular velocity.

[0103] S103, inputting the ship heading angle and the desired heading angle into an active disturbance rejection controller, and outputting a rudder angle control instruction;

[0104] S103 can be further divided into the following steps S1031-S1032:

[0105] Step S1031, inputting the ship heading angle and the desired heading angle into the active disturbance rejection controller to obtain a rudder angle control value;

[0106] Among them, refer to Figure 2 ,The calculation process of the ADRC includes arranging the ferry process, the extended state observer (ESO), the model-free adaptive control law and disturbance compensation.

[0107] Specifically:

[0108] 1) Arrange the ferry process:

[0109] Tracking differentiator (TD) is used to track the input signal That is, the heading angle of the ship. Let the input signal of TD be v(k), and the output signals be v1(k) and v2(k). The relationship can be expressed as:

[0110]

[0111] Where h is the integration step, v1(k) tracks the input signal v(k), and v2(k) is the first-order differential of v1(k);

[0112] u=fhan(v1-v,v2,r,h0) is the fastest control comprehensive function, and its algorithm is as follows:

[0113]

[0114] Among them, r is the speed factor, which determines the tracking speed. The larger r is, the faster v1(k) tracks the input signal v(k). h0 is a new variable independent of the integration step h, which is taken as a parameter appropriately larger than the integration step h to eliminate overshoot in the speed curve.

[0115] 2) Extended State Observer (ESO):

[0116] ESO is used to estimate the states of the objects and the total disturbance of the system. The total input of the system is z (the state of the heading angle, obtained according to the ship's heading angle and the expected heading angle). Assume that z1 = z, z2 = z (1) , z3=f(.), where z3=f(.) is the extended state variable of the system, and the form of designing the continuous extended state observer is:

[0117]

[0118] Among them, z i (i=1,2,3) are the system states z i (i=1,2) and z3=f(.), For z i The first-order differential of for The first-order differential of , u is the rudder angle control value after disturbance compensation. Appropriately select the adjustable gain parameter β 01 , β 02 and β 03 , so that each state variable of ESO Well track the state variables z of the original system i .

[0119] 3) Model-free adaptive control law:

[0120] Specifically, refer to Figure 3 , including the following steps:

[0121] a) Construct an unknown nonlinear function:

[0122] y(k+1)=f[y(k),y(k-1),...,y(kk y ),u(k),u(k-1),...,u(kk u )]

[0123] Among them, f(…) is an unknown nonlinear function, k y and k u are unknown parameters, y(k) is the system output, and u(k) is the system input (rudder angle).

[0124] System output y(k):

[0125]

[0126] in, is the ship heading angle, r(k) is the ship angular velocity, and K is the weight coefficient.

[0127] b) System linearization:

[0128] The input signal is assumed to be defined as a time-varying parameter, namely the pseudo partial derivative Φ(k), and the system output y(k) is linearized:

[0129] y(k+1)=y(k)+Φ(k)△u(k)

[0130] c) Construct the control input criterion function:

[0131] J(u(k))=∣y*(k+1)-y(k+1)∣ 2 +λ|u(k)-u(k-1)| 2

[0132] Among them, λ>0, is the weight coefficient; is the desired heading angle, r d (k) is the desired angular velocity; |y*(k+1)-y(k+1)| 2 Used to control the system output to converge to the desired state, that is, to control the ship's heading angle Towards the desired heading angle Convergence, the ship angular velocity r(k) to the desired angular velocity r d (k) convergence, optionally, r d (k) = 0; λ | u(k) - u(k-1) | 2 It is used to prevent sudden changes in the rudder angle and soften the control process.

[0133] Substitute the formula obtained in step b) into the formula in step c), take the derivative of u(k) and set it to 0, and the rudder angle control law can be obtained:

[0134]

[0135] Where ρ is the step length sequence.

[0136] d) Calculate the pseudo partial derivative estimate by estimating the criterion function:

[0137] Since the pseudo partial derivative Φ(k) is a time-varying parameter, the estimated value of the pseudo partial derivative Φ(k) is defined as Solving by estimating the criterion function

[0138]

[0139] Among them, η is the step sequence and μ is the weight factor.

[0140] In the embodiment of the present invention, in order to improve the stability of the system, the following Reset algorithm:

[0141] like or |△u(k-1)|≤ε

[0142] Among them, ε is a sufficiently small positive number.

[0143] 4) Disturbance compensation:

[0144] Specifically, the final rudder angle control value is formed through disturbance compensation:

[0145]

[0146] Among them, u0 is the initial control variable required by the model-free adaptive control law, f is the total disturbance estimate obtained by ESO calculation, and b0 is the disturbance compensation factor.

[0147] Step S1032: Generate the rudder angle control instruction according to the rudder angle control amount.

[0148] S104: Control the ship to follow the target path according to the rudder angle control instruction and the expected angular velocity.

[0149] Specifically, in an embodiment of the present invention, the following steps are also included:

[0150] 1) judging whether the ship has reached the end point of the target path according to the ship position and the target path;

[0151] 2) If yes, terminate the path following control of the vessel;

[0152] 3) If not, execute step S102.

[0153] In combination with the ship path following control method described in steps S101-S104, it can be known that the present invention obtains the target path and the ship state at the current moment, and obtains the expected state at the current moment according to the LOS guidance strategy in combination with the ship state and the target path, so that the ship's path following control problem is converted into a dynamic heading control problem, and the expected state of the ship at each moment can be obtained more accurately and reliably, thereby improving the reliability and accuracy of the output rudder angle control instructions; by considering the ship's angular velocity at the current moment and the expected angular velocity under the corresponding expected state, and controlling the ship to follow the target path according to the expected angular velocity and the rudder angle control instruction, the ship's rudder angle control is more stable, thereby further improving the stability, accuracy and reliability of the ship's path following control.

[0154] Secondly, a ship path following control system proposed according to an embodiment of the present application is described with reference to the accompanying drawings.

[0155] Figure 4 It is a schematic diagram of the structure of a ship path following control system according to an embodiment of the present application.

[0156] The system specifically comprises:

[0157] The first acquisition module 401 is used to acquire the target path and the ship status at the current moment;

[0158] A second acquisition module 402 is used to acquire the desired state at the current moment according to the LOS guidance strategy in combination with the ship state and the target path;

[0159] A rudder angle control command output module 403 is used to input the ship heading angle and the desired heading angle into an active disturbance rejection controller and output a rudder angle control command;

[0160] The path following control module 404 is used to control the ship to follow the target path according to the rudder angle control instruction and the expected angular velocity.

[0161] It can be seen that the contents of the above method embodiments are all applicable to the present system embodiments, the functions specifically implemented by the present system embodiments are the same as those of the above method embodiments, and the beneficial effects achieved are also the same as those achieved by the above method embodiments.

[0162] Reference Figure 5 , an embodiment of the present application provides a ship path following control device, comprising:

[0163] at least one processor 501;

[0164] At least one memory 502, used to store at least one program;

[0165] When the at least one program is executed by the at least one processor 501, the at least one processor 501 implements the ship path following control method described in steps S101-S104.

[0166] Similarly, the contents of the above method embodiments are all applicable to the present device embodiments. The functions specifically implemented by the present device embodiments are the same as those of the above method embodiments, and the beneficial effects achieved are also the same as those achieved by the above method embodiments.

[0167] In some optional embodiments, the function / operation mentioned in the block diagram may not occur in the order mentioned in the operation diagram. For example, depending on the function / operation involved, the two boxes shown in succession can actually be executed substantially simultaneously or the boxes can sometimes be executed in reverse order. In addition, the embodiment presented and described in the flow chart of the application is provided by way of example, for the purpose of providing a more comprehensive understanding of technology. The disclosed method is not limited to the operation and logic flow presented herein. Optional embodiments are expected, wherein the order of various operations is changed and the sub-operation described as a part of a larger operation is performed independently.

[0168] In addition, although the present application is described in the context of functional modules, it should be understood that, unless otherwise specified, one or more of the functions and / or features can be integrated into a single physical device and / or software module, or one or more functions and / or features can be implemented in a separate physical device or software module. It is also understood that a detailed discussion of the actual implementation of each module is unnecessary for understanding the present application. More specifically, in view of the properties, functions, and internal relationships of the various functional modules in the device disclosed herein, the actual implementation of the module will be understood within the conventional techniques of the engineer. Therefore, those skilled in the art can implement the present application set forth in the claims without excessive experimentation using ordinary techniques. It is also understood that the specific concepts disclosed are merely illustrative and are not intended to limit the scope of the present application, which is determined by the full scope of the attached claims and their equivalents.

[0169] If the functions are implemented in the form of software functional units and sold or used as independent products, they can be stored in a computer-readable storage medium. Based on this understanding, the technical solution of the present application can be essentially or partly embodied in the form of a software product that contributes to the prior art. The computer software product is stored in a storage medium, including several programs to enable a computer device (which can be a personal computer, server, or network device, etc.) to perform all or part of the steps of the methods described in each embodiment of the present application. The aforementioned storage medium includes: various media that can store program codes, such as a USB flash drive, a mobile hard disk, a read-only memory (ROM), a random access memory (RAM), a magnetic disk or an optical disk.

[0170] The logic and / or steps represented in the flowchart or otherwise described herein, for example, may be considered as an ordered list of executable programs for implementing the logical functions, and may be embodied in any computer-readable medium for use by a program execution system, device or apparatus (such as a computer-based system, a system including a processor, or other system that can fetch and execute a program from a program execution system, device or apparatus), or in conjunction with such program execution systems, devices or apparatuses. For purposes of this specification, a "computer-readable medium" may be any device that can contain, store, communicate, propagate or transmit a program for use by a program execution system, device or apparatus, or in conjunction with such program execution systems, devices or apparatuses.

[0171] More specific examples of computer-readable media (a non-exhaustive list) include the following: an electrical connection with one or more wires (electronic device), a portable computer disk case (magnetic device), a random access memory (RAM), a read-only memory (ROM), an erasable and programmable read-only memory (EPROM or flash memory), an optical fiber device, and a portable compact disk read-only memory (CDROM). In addition, the computer-readable medium may even be a paper or other suitable medium on which the program is printed, since the program may be obtained electronically, for example, by optically scanning the paper or other medium, followed by editing, deciphering or, if necessary, processing in another suitable manner, and then stored in a computer memory.

[0172] It should be understood that the various parts of the present application can be implemented by hardware, software, firmware or a combination thereof. In the above-mentioned embodiments, multiple steps or methods can be implemented by software or firmware stored in a memory and executed by a suitable program execution system. For example, if implemented by hardware, as in another embodiment, it can be implemented by any one of the following technologies known in the art or their combination: a discrete logic circuit having a logic gate circuit for implementing a logic function for a data signal, a dedicated integrated circuit having a suitable combination of logic gate circuits, a programmable gate array (PGA), a field programmable gate array (FPGA), etc.

[0173] In the above description of this specification, the description with reference to the terms "one embodiment / example", "another embodiment / example" or "certain embodiments / examples" etc. means that the specific features, structures, materials or characteristics described in conjunction with the embodiment or example are included in at least one embodiment or example of the present application. In this specification, the schematic representation of the above terms does not necessarily refer to the same embodiment or example. Moreover, the specific features, structures, materials or characteristics described may be combined in any one or more embodiments or examples in a suitable manner.

[0174] Although the embodiments of the present application have been shown and described, those skilled in the art will appreciate that various changes, modifications, substitutions and variations may be made to the embodiments without departing from the principles and spirit of the present application, and that the scope of the present application is defined by the claims and their equivalents.

[0175] The above is a specific description of the preferred implementation of the present application, but the present application is not limited to the described embodiments. Technical personnel familiar with the field may make various equivalent modifications or substitutions without violating the spirit of the present application. These equivalent modifications or substitutions are all included in the scope defined by the claims of the present application.

Claims

1. A ship path following control method, characterized in that: The following steps are involved: Obtaining the target path and the ship status at the current moment, wherein the ship status includes the ship position, the ship heading angle and the ship angular velocity; According to the LOS guidance strategy, the expected state at the current moment is obtained in combination with the ship state and the target path, wherein the expected state includes an expected heading angle and an expected angular velocity, and the expected angular velocity is a preset maximum value of the ship angular velocity; Input the ship heading angle and the desired heading angle into an active disturbance rejection controller, and output a rudder angle control instruction; Controlling the vessel to follow the target path according to the rudder angle control instruction and the desired angular velocity; The target path includes a plurality of location points; The step of obtaining the desired state at the current moment in combination with the ship state and the target path according to the LOS guidance strategy includes: Acquire a current position point on the target path according to the position of the ship, the current position point being the position point on the target path closest to the position of the ship; Acquire a reference point on the target path according to the current position point and the ship position; Acquire the sight angle between the ship and the reference point as the expected heading angle according to the ship state; generating the desired state according to the desired heading angle and the desired angular velocity; The step of inputting the ship heading angle and the desired heading angle into an active disturbance rejection controller and outputting a rudder angle control instruction comprises: Inputting the ship heading angle and the desired heading angle into the active disturbance rejection controller to obtain a rudder angle control value; The rudder angle control instruction is generated according to the rudder angle control amount.

2. A ship path following control method according to claim 1, characterized in that: The obtaining of the current position point on the target path according to the position of the ship comprises: Acquire a first position point and a second position point on the target path according to the position of the ship, wherein the first position point is a theoretical position point corresponding to the current moment, and the second position point is a position point next to the first position point; Calculate a first distance and a second distance according to the ship position, the first position point and the second position point, the first distance being the distance between the ship position and the first position point, and the second distance being the distance between the ship position and the second position point; If the first distance is smaller than the second distance, selecting the first position point as the current position point; If the first distance is greater than the second distance, the second position point is selected as the current position point.

3. A ship path following control method according to claim 2, characterized in that: The acquiring a reference point on the target path according to the current position point and the ship position comprises: Get the captain of the vessel; Calculating the distance between the first position point and the second position point to obtain a third distance; Calculate a fourth distance using a preset formula according to the first distance, the second distance, the third distance and the ship length; constructing a dynamic circle with the ship position as the center and the fourth distance as the radius; Acquire a set of intersections between the dynamic circle and the target path, wherein the set of intersections includes a plurality of intersections between the dynamic circle and the target path; The intersection point of the intersection point set that is closest to the position of the ship is selected as the reference point.

4. A ship path following control method according to claim 1, characterized in that: Before the step of obtaining the target path and the ship status at the current moment, the method further comprises the following steps: Initializing the ship state and the target path, and obtaining the initial position of the ship; The initial position is used as the starting point of the target path, and the end of the target path away from the initial position is used as the end point of the target path.

5. A ship path following control method according to claim 4, characterized in that: The following steps are also included: Determining whether the ship has reached the end of the target path according to the ship position and the target path; If so, terminating the path following control of the vessel; If not, the step of acquiring the expected state at the current moment in combination with the ship state and the target path according to the LOS guidance strategy is executed.

6. A ship path following control system, characterized in that: include: A first acquisition module is used to acquire a target path and a ship state at a current moment; the ship state includes a ship position, a ship heading angle, and a ship angular velocity; A second acquisition module is used to acquire the expected state at the current moment according to the LOS guidance strategy, in combination with the ship state and the target path; the expected state includes an expected heading angle and an expected angular velocity, and the expected angular velocity is a preset maximum value of the ship angular velocity; A rudder angle control command output module, used for inputting the ship heading angle and the desired heading angle into an active disturbance rejection controller, and outputting a rudder angle control command; A path following control module, used for controlling the ship to follow the target path according to the rudder angle control instruction and the expected angular velocity; The target path includes a plurality of location points; The obtaining the desired state at the current moment in combination with the ship state and the target path according to the LOS guidance strategy includes: Acquire a current position point on the target path according to the position of the ship, the current position point being the position point on the target path closest to the position of the ship; Acquire a reference point on the target path according to the current position point and the ship position; Acquire the sight angle between the ship and the reference point as the expected heading angle according to the ship state; generating the desired state according to the desired heading angle and the desired angular velocity; The step of inputting the ship heading angle and the desired heading angle into an active disturbance rejection controller and outputting a rudder angle control instruction comprises: Inputting the ship heading angle and the desired heading angle into the active disturbance rejection controller to obtain a rudder angle control value; The rudder angle control instruction is generated according to the rudder angle control amount.

7. A ship path following control device, characterized in that: include: at least one processor; at least one memory for storing at least one program; When the at least one program is executed by the at least one processor, the at least one processor implements a ship path following control method as described in any one of claims 1-5.

8. A storage medium storing a program executable by a processor, characterized in that: The processor-executable program is used to implement a ship path following control method as described in any one of claims 1 to 5 when executed by the processor.