Unmanned ship cluster path tracking controller based on non-cooperative game

Through the unmanned boat cluster path tracking controller based on non-cooperative games, combined with the visual line guidance and control obstacle function, the problem of individual tasks and cluster tasks balance and obstacle avoidance in unmanned boat cluster path tracking is solved, and navigation is improved Security and system flexibility.

CN119065372APending Publication Date: 2024-12-03DALIAN MARITIME UNIVERSITY
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411168293.4
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-23
Publication Date
2024-12-03

AI Technical Summary

Technical Problem

The existing unmanned boat cluster path tracking control methods lack individual task balance and obstacle avoidance capabilities in the coordinated formation, and fail to effectively deal with hindered objects in the marine environment, resulting in navigation safety risks.

Method used

Adopt unmanned boat cluster path tracking controller based on non-cooperative games, combining line-of-sight guidance, parameter update law and control obstacle function, design safety guidance law module to achieve the balance between individual interests of unmanned boats and cluster tasks, and pass safety constraints and input constraints to avoid hindering collisions of marine objects.

Benefits of technology

The balance between individual tasks and cluster tasks in unmanned boat cluster path tracking is achieved, navigation safety is ensured, obstacle avoidance and collision avoidance have an impact on the established tasks, and the flexibility and safety of unmanned boat systems are improved.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119065372A_ABST
    Figure CN119065372A_ABST
Patent Text Reader

Abstract

The invention provides an unmanned ship cluster path tracking controller based on a non-cooperative game, which is used for controlling an under-actuated unmanned ship and comprises a nominal guidance law module based on line-of-sight guidance, a parameter updating law module based on the non-cooperative game, a safety guidance law module based on a control barrier function, a safety constraint and an input constraint, the parameter updating law module receives path parameters from a communication network and estimated values of path parameters of the unmanned ships, outputs updating law parameters to the nominal guidance law module, and outputs the path parameters and estimated values of path parameters of other unmanned ships to the communication network; according to the unmanned ship cluster path tracking control method based on the non-cooperative game provided by the invention, the obstacle avoidance and collision avoidance problems between the under-actuated unmanned ship and the static obstacle and between the under-actuated unmanned ship and the dynamic obstacle and between the under-actuated unmanned ship and the neighbor unmanned ship are considered, and cooperative path tracking formation control of multiple unmanned ships is realized on the premise of ensuring the safety of the unmanned ships.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of underactuated unmanned boat cluster control, and in particular to an unmanned boat cluster path tracking controller based on non-cooperative game. Background Art

[0002] With the continuous expansion of marine resource development and offshore operations, unmanned boats are playing an increasingly important role in military reconnaissance, marine monitoring, resource exploration and other fields. Unmanned boat swarm operations can achieve larger-scale, more efficient and more complex maritime tasks such as swarm situational awareness, swarm target encirclement and swarm formation escort. In recent years, unmanned boat swarm control technology has received extensive attention from relevant researchers at home and abroad. As one of the typical unmanned boat swarm control technologies, unmanned boat swarm path tracking control requires swarm unmanned boats to track geometric paths decoupled from time, which can achieve smoother tracking effects. Unmanned boat swarm path tracking is suitable for tasks that do not have strict time requirements, such as pipeline inspection, terrain exploration and hydrological surveys.

[0003] For the path tracking control problem of unmanned boat swarm, existing methods often achieve cluster path tracking through the cooperation between the unmanned boats within the unmanned boat swarm. In practical applications, if the unmanned boats can perform some individual tasks during the cluster path tracking process, the flexibility of the unmanned boat swarm system can be enhanced. However, balancing the conflicts and contradictions between the individual tasks of the unmanned boats and the cluster collaborative tasks is a major challenge. In addition, when the unmanned boats perform cluster path tracking tasks in the actual marine environment, they will inevitably encounter dynamic and static obstacles such as reefs and floats. If the unmanned boats cannot avoid obstacles that affect navigation safety in the environment in time, it may bring devastating consequences to the unmanned boat swarm system. Studying the navigation safety problem in the process of unmanned boat swarm path tracking has extremely high practical value and application prospects. Therefore, in order to adapt to the dynamic changes and uncertainties of the marine environment, designing an unmanned boat swarm path tracking control method that considers the individual interests of the unmanned boats within the cluster and the navigation safety of the unmanned boats has become a technical problem that needs to be solved urgently.

[0004] There is a certain research foundation in the field of unmanned boat swarm path tracking at home and abroad, and many control methods have been proposed. However, the existing control methods still have the following shortcomings:

[0005] First, almost all existing path tracking control methods for multiple unmanned boat swarms require full cooperation between the unmanned boats to achieve the global collaborative formation control goal. In actual applications, in addition to the cooperation goals within the unmanned boat group, the unmanned boats may also be required to achieve their individual goals based on their own mission requirements.

[0006] Second, most of the existing path tracking control methods for multiple unmanned boat swarms do not consider the obstacle avoidance and collision avoidance problems of unmanned boats or consider them incompletely. When unmanned boats move in the actual marine environment, they will inevitably encounter various static and dynamic obstacles. If no corresponding measures are taken, collisions may occur between the unmanned boats and obstacles, and even lead to catastrophic consequences.

[0007] Third, most of the existing unmanned boat obstacle avoidance and collision avoidance methods do not consider the contradiction between the obstacle avoidance and collision avoidance tasks and the established work tasks. When unmanned boats perform tasks in actual marine environments, the obstacle avoidance and collision avoidance tasks and the established work tasks are equally important. It is of great significance to ensure the navigation safety of unmanned boats while minimizing the impact on the established tasks. Summary of the invention

[0008] In view of this, the purpose of the present invention is to propose an unmanned boat cluster path tracking controller based on non-cooperative game, which can not only balance the contradiction between the collaborative task of multiple unmanned boats and the individual interests of a single unmanned boat, but also achieve the effect of minimizing the impact of obstacle avoidance and collision avoidance tasks on the established path tracking tasks.

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

[0010] A non-cooperative game-based unmanned boat cluster path tracking controller is used to control underactuated unmanned boats, including: a nominal guidance law module based on line-of-sight guidance, a parameter update law module based on non-cooperative game, a safety guidance law module based on control obstacle function, safety constraints and input constraints;

[0011] The parameter update law module receives the path parameters and the estimated values ​​of the path parameters from the communication network, the parameter update law module outputs the update law parameters to the nominal guidance law module, and the parameter update law module outputs the path parameters and the estimated values ​​of the path parameters of other unmanned boats to the communication network;

[0012] The nominal guidance law module receives the update law parameters from the parameter update law module and the manually input parameterized path, the nominal guidance law module outputs the desired speed guidance signal to the underactuated unmanned vehicle, and the nominal guidance law module outputs the desired angular velocity guidance signal to the safety guidance law module;

[0013] The safety guidance law module receives the expected angular velocity guidance signal, safety constraints and input constraints from the nominal guidance law module, and the safety guidance law module outputs the optimal angular velocity guidance signal to the underactuated unmanned boat.

[0014] Further, the underactuated unmanned boat receives a desired speed guidance signal from a nominal guidance law module, the underactuated unmanned boat receives an optimal angular velocity guidance signal from a safety guidance law module, and the underactuated unmanned boat outputs an unmanned boat state to the nominal guidance law module;

[0015] The kinematic model of the underactuated unmanned vehicle is as follows:

[0016]

[0017] Where i represents the i-th underactuated unmanned boat; x i represents the position of the underactuated unmanned vehicle on the x-axis in the earth coordinate system, and y i represents the position of the underactuated unmanned vehicle on the y-axis in the earth coordinate system, ψ iw Represents the actual movement direction of the underactuated unmanned vehicle; represents the total speed of the underactuated unmanned vehicle; r i represents the bow angular velocity of the underactuated unmanned vehicle; β i =arctan2(ν i / u i ) represents the sideslip angle.

[0018] Furthermore, the design steps of the parameter update law module are as follows:

[0019] The derivative of the path parameter is defined as follows

[0020]

[0021] In the formula, u s is the reference speed, ω i is the path parameter variable;

[0022] Define the cost function of the i-th unmanned boat as J i (θ), and we have:

[0023]

[0024] In the formula, ξ ij represents the estimation of the path parameters of the jth unmanned boat by the i-th unmanned boat, ξ ij The calculation formula is as follows:

[0025]

[0026] In the formula, The communication adjacency matrix is a ij is the element in the i-th row and j-th column of the communication adjacency matrix, a ik is the element in the i-th row and k-th column of the communication adjacency matrix;

[0027] ω i The calculation formula is as follows:

[0028]

[0029] In the formula,

[0030] ω i Substitution The derivative of the path parameter becomes as follows:

[0031]

[0032] Furthermore, the design steps of the nominal guidance law module are as follows:

[0033] Given a parameterized path as follows:

[0034]

[0035] In the formula, θ i is a path parameter, and has:

[0036]

[0037] The calculation formula for the path tangent angle corresponding to the i-th unmanned boat is as follows:

[0038]

[0039] The position error calculation formula is as follows:

[0040]

[0041] The guidance angle calculation formula is as follows:

[0042]

[0043] In the formula, Δ i is the foresight distance parameter; the direction tracking error is:

[0044] z iψ =ψ iw -ψ ir

[0045] The output signal calculation formula of the nominal guidance law module is as follows:

[0046]

[0047] In the formula, k i1 and k i2 is the controller parameter;

[0048] Furthermore, the design steps of the safety constraints and input constraints are as follows:

[0049] S1. Safety constraints:

[0050] 1. Static obstacle avoidance;

[0051] The control barrier function is designed as:

[0052]

[0053] In the formula, ζ il ≥0; l=1,...,L; Λ il =ψ iw -(π / 2+ψ il );ψ il =atan2(y l -y i ,x l -x i );p i =[x i ,y i ] is the position of the i-th unmanned boat, p l =[x l ,y l ] T is the position of the static obstacle; d S The safe distance from static obstacles;

[0054] The calculation formula for the static obstacle safety constraint condition is as follows:

[0055] 2ζ il Λ il r i -h il γ il ≤Π il

[0056] Among them, γ il ≥0 is a slack variable;

[0057] 2. Avoid collision with dynamic obstacles;

[0058] Design the following control barrier function:

[0059]

[0060] In the formula, ζ im ≥0,m=1,...,M,Λ im =ψ iw -(π / 2+ψ im ), ψ im =atan2(y m -y i,x m -x i ), p m =[x m ,y m ] T is the position of the dynamic obstacle; d D To ensure safe distance from dynamic obstacles;

[0061] The calculation formula of dynamic obstacle safety constraint condition is as follows:

[0062] 2ζ im Λ im r i -h im γ im ≤Π im

[0063] In the formula, γ im ≥0 is a slack variable;

[0064] 3. Avoid collision with neighbor’s unmanned boat;

[0065] Design the following control barrier function:

[0066]

[0067] In the formula, ζ ij ≥0,j=1,...,N,Λ ij =ψ iw -(π / 2+ψ ij ), ψ ij =atan2(y j -y i ,x j -x i ), p j =[x j ,y j ] T is the location of the neighbor’s unmanned boat, d N To maintain a safe distance from neighboring unmanned boats;

[0068] The calculation formula of the safety constraint condition of the neighbor unmanned boat is as follows:

[0069] 2ζ ij Λ ij r i -h ij γ ij ≤Π ij

[0070] In the formula, γ ij ≥0 is a slack variable,

[0071] S2. Input constraints

[0072] The present invention only considers the angular velocity constraints as follows:

[0073] r min ≤r i ≤r max

[0074] In the formula, r mi n is the minimum value that the guidance angular velocity should meet, r max is the maximum value that the guidance angular velocity should satisfy;

[0075] Furthermore, the safety guidance law module formula based on the control obstacle function is as follows:

[0076]

[0077] The present invention also provides a non-cooperative game-based unmanned boat cluster path tracking control method, which is implemented based on any one of the above-mentioned non-cooperative game-based unmanned boat cluster path tracking controllers, comprising the following steps:

[0078] The parameter update law module based on non-cooperative game receives the path parameters and their estimated values ​​from the communication network, calculates the update law parameters and path parameters as well as the estimated values ​​of the path parameters of other unmanned boats, transmits the update law parameters to the nominal guidance law module based on line-of-sight guidance, and the path parameters of the unmanned boat and the estimated values ​​of the path parameters of other unmanned boats are transmitted back to the communication network;

[0079] The nominal guidance law module based on line-of-sight guidance receives the update law parameters from the parameter update law module, the manually input parameterized path and the state information transmitted by the unmanned boat, calculates the expected speed guidance signal and the expected angular velocity guidance signal, transmits the expected speed guidance signal to the unmanned boat, and transmits the expected angular velocity guidance signal to the safety guidance law module based on the control obstacle function;

[0080] The safety guidance law module based on the control obstacle function receives the expected angular velocity guidance signal, safety constraints and input constraints transmitted by the nominal guidance law module, calculates the current optimal angular velocity guidance signal and transmits it to the unmanned boat;

[0081] The unmanned boat receives the optimal angular velocity guidance signal from the safety guidance law module and the expected velocity guidance signal from the nominal guidance law, and transmits its own status information to the nominal guidance law module.

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

[0083] First, the control method proposed in the present invention aims to solve the problem of multi-unmanned boat formation control from the perspective of non-cooperative game. The parameter update law module based on non-cooperative game transforms the parameter coordination problem in traditional collaborative path tracking into the problem of seeking Nash equilibrium points, thus balancing the contradiction between the unmanned boat cluster formation task and the individual task of a single unmanned boat.

[0084] Second, the unmanned boat cluster path tracking control method based on non-cooperative game proposed in the present invention takes into account the obstacle avoidance and collision avoidance problems between under-actuated unmanned boats and static obstacles, dynamic obstacles and neighboring unmanned boats, and realizes the collaborative path tracking formation control of multiple unmanned boats while ensuring the safety of the unmanned boats.

[0085] Third, the obstacle avoidance and collision avoidance method proposed by the safety guidance law module based on the control obstacle function of the present invention adopts a secondary optimization method to perform online real-time optimization on the guidance signal of the nominal guidance law module based on line-of-sight guidance to obtain a safety guidance signal, thereby minimizing the impact of the safety obstacle avoidance and collision avoidance task on the established cluster path tracking control task. BRIEF DESCRIPTION OF THE DRAWINGS

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

[0087] Figure 1 It is a schematic diagram of the structure of the controller of the present invention.

[0088] Figure 2 It is a trajectory diagram of the safe path tracking of the unmanned boat cluster of the present invention.

[0089] Figure 3 It is a diagram of the guidance speed and the safety guidance angular velocity of the present invention.

[0090] Figure 4 It is a diagram of the longitudinal tracking error and the lateral tracking error of the present invention.

[0091] Figure 5 It is a diagram of the path parameters and parameter estimation effects of the present invention.

[0092] Figure 6 It is a curve diagram of the minimum distance variation between the unmanned boat of the present invention and a static obstacle, a dynamic obstacle and a neighboring unmanned boat. DETAILED DESCRIPTION

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

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

[0095] like Figure 1 As shown, the present invention provides an unmanned boat cluster path tracking controller based on non-cooperative game, including a nominal guidance law module based on line-of-sight guidance, a parameter update law module based on non-cooperative game, a safety guidance law module based on control obstacle function, safety constraints and input constraints, a communication network and an underactuated unmanned boat; the parameter update law module based on non-cooperative game has an input from the communication network, and an output end is connected to the communication network and the nominal guidance law module based on line-of-sight guidance, the nominal guidance law module based on line-of-sight guidance has an input from the parameter update law module based on non-cooperative game, manually input parameterized path points and unmanned boats, and an output end is connected to the unmanned boat and the safety guidance law module based on control obstacle function, the safety guidance law module based on control obstacle function has an input from the nominal guidance law module based on line-of-sight guidance and safety constraints and input constraints, and an output end is connected to the unmanned boat, the unmanned boat has an input from the nominal guidance law module based on line-of-sight guidance and the safety guidance law module based on control obstacle function, and an output end is connected to the nominal guidance law module based on control obstacle function.

[0096] The kinematic model of the unmanned boat is as follows:

[0097]

[0098] Where, the subscript i represents the i-th underactuated unmanned boat; x i ,y i , ψ iwThey represent the positions of the under-actuated unmanned vehicle on the x-axis and y-axis in the earth coordinate system and the actual movement direction of the under-actuated unmanned vehicle respectively; represents the total speed of the underactuated unmanned vehicle; r i represents the bow angular velocity of the underactuated unmanned vehicle; β i =arctan2(ν i / u i ) represents the sideslip angle.

[0099] The design method comprises the following steps:

[0100] A. Design of path parameter update law module based on non-cooperative game:

[0101] The derivatives of the path parameters are defined as follows:

[0102]

[0103] In the formula, u s is the reference speed, ω i is a path parameter variable.

[0104] Define the cost function of the i-th unmanned boat as J i (θ), and

[0105]

[0106] In the formula, ξ ij represents the estimation of the path parameters of the jth unmanned boat by the i-th unmanned boat, and ξ ij It can be calculated by the following formula

[0107]

[0108] In the formula The communication adjacency matrix is a ij is the element in the i-th row and j-th column of the communication adjacency matrix, a ik is the element in the i-th row and k-th column of the communication adjacency matrix;

[0109] Variable ω i It can be calculated by the following formula

[0110]

[0111] In the formula Formula (2) becomes the following form

[0112]

[0113] B. Design of nominal guidance law module based on line-of-sight guidance:

[0114] Given a parameterized path:

[0115]

[0116] In the formula, θ i is a path parameter, and has

[0117]

[0118] The path tangent angle corresponding to the i-th unmanned boat can be calculated by the following formula:

[0119]

[0120] The position error can be calculated by the following formula:

[0121]

[0122] The guidance angle can be calculated by the following formula

[0123]

[0124] In the formula, Δ i is the foresight distance parameter; the direction tracking error is

[0125] z iψ =ψ iw -ψ ir (12)

[0126] The output signal of the nominal guidance law module can be calculated as follows:

[0127]

[0128] Where k i1 and k i2 is the controller parameter;

[0129] C. Safety constraints and input constraints design:

[0130] (1) Static obstacle avoidance:

[0131] The control barrier function is designed as

[0132]

[0133] Where ζ il ≥0; l=1,...,L; Λ il =ψ iw -(π / 2+ψ il );ψ il =atan2(y l -yi ,x l -x i );p i =[x i ,y i ] is the position of the i-th unmanned boat, p l =[x l ,y l ] T is the position of the static obstacle; d S For a safe distance.

[0134] The static obstacle safety constraint condition can be obtained by the following formula:

[0135] 2ζ il Λ il r i -h il γ il ≤Π il (15)

[0136] where γ il ≥0 is a slack variable;

[0137] (2) Dynamic obstacle avoidance:

[0138] Design the following control barrier function

[0139]

[0140] Where ζ im ≥0,m=1,...,M,Λ im =ψ iw -(π / 2+ψ im ), ψ im =atan2(y m -y i ,x m -x i ), p m =[x m ,y m ] T is the position of the dynamic obstacle; d D For a safe distance.

[0141] The safety constraint condition of dynamic obstacles can be obtained as follows:

[0142] 2ζ im Λ im r i -h im γ im ≤Π im (17)

[0143] Where γim ≥0 is a slack variable;

[0144] (3) Avoiding collision with neighbor’s unmanned boat:

[0145] Design the following control barrier function

[0146]

[0147] Where ζ ij ≥0,j=1,...,N,Λ ij =ψ iw -(π / 2+ψ ij ), ψ ij =atan2(y j -y i ,x j -x i ), p j =[x j ,y j ] T is the location of the neighbor’s unmanned boat, d N For a safe distance.

[0148] The safety constraint condition of the neighbor unmanned boat can be obtained by the following formula:

[0149] 2ζ ij Λ ij r i -h ij γ ij ≤Π ij (19)

[0150] Where γ ij ≥0 is a slack variable,

[0151] (4) Angular velocity constraint:

[0152] Consider the angular velocity constraint as follows

[0153] r min ≤r i ≤r max (20)

[0154] Where r min and r max are the minimum and maximum values ​​that the guidance angular velocity should meet.

[0155] D. Design of safety guidance law module based on control obstacle function:

[0156] Safety guidance signal based on quadratic optimization:

[0157]

[0158] The present invention also provides a non-cooperative game-based unmanned boat cluster path tracking control method, and the unmanned boat cluster path tracking controller based on the non-cooperative game is implemented, comprising the following steps:

[0159] The parameter update law module based on non-cooperative game receives the path parameters and their estimated values ​​from the communication network, calculates the update law parameters and path parameters as well as the estimated values ​​of the path parameters of other unmanned boats, transmits the update law parameters to the nominal guidance law module based on line-of-sight guidance, and the path parameters of the unmanned boat and the estimated values ​​of the path parameters of other unmanned boats are transmitted back to the communication network;

[0160] The nominal guidance law module based on line-of-sight guidance receives the update law parameters from the parameter update law module, the manually input parameterized path and the state information transmitted by the unmanned boat, calculates the expected speed guidance signal and the expected angular velocity guidance signal, transmits the expected speed guidance signal to the unmanned boat, and transmits the expected angular velocity guidance signal to the safety guidance law module based on the control obstacle function;

[0161] The safety guidance law module based on the control obstacle function receives the expected angular velocity guidance signal, safety constraints and input constraints transmitted by the nominal guidance law module, calculates the current optimal angular velocity guidance signal and transmits it to the unmanned boat;

[0162] The unmanned boat receives the optimal angular velocity guidance signal from the safety guidance law module and the expected velocity guidance signal from the nominal guidance law, and transmits its own status information to the nominal guidance law module.

[0163] Example

[0164] A path tracking controller for an unmanned boat swarm based on non-cooperative game, in which the kinematic model of the underactuated unmanned boat is as follows:

[0165]

[0166] The controller used in this example satisfies the controller structure described by equations (2)-(22), and the specific parameters are as follows:

[0167] The initial position of the unmanned boat is distributed on a circle with a radius of 30m, and the given parameterized reference path is Three static obstacles numbered 1 to 3 and one dynamic obstacle are set in the environment. The positions of the static obstacles are set to [-25, 0] respectively. T ,[0,25] T , [25,0] T , the initial position of the dynamic obstacle is [0,0] T , and moves at a constant speed and direction. The simulation parameters are selected as k iu=0.5, k ir =0.5,Δ iψ =1,d s =5m,d N =5m,γ il =30,γ im =30,γ ij =30, r min =-0.5rad / s, r max =-0.5rad / s, k iθ =5, k iυ =5,u s =0.03,

[0168] The simulation results are as follows Figure 2-Figure 6 shown. Figure 2 The safe path tracking trajectory diagram of the unmanned boat cluster is given. It can be seen that the six unmanned boats start from the initial position and track the given parameterized path after a period of time, and successfully avoid the static and dynamic obstacles on the path during the path tracking process. Figure 3 The guidance speed and safety guidance angular velocity of multiple unmanned boats are given. It can be seen that the guidance speed of the unmanned boat is always around 1m / s during path tracking. When performing obstacle avoidance and collision avoidance actions, the safety angular velocity guidance signal is quickly adjusted to successfully avoid static and dynamic obstacles in the environment. At the same time, it can be seen that the angular velocity guidance signal is always kept within ±0.5rad / s, within the set maximum and minimum value range. Figure 4 It is the longitudinal tracking error and lateral tracking error of path tracking. The longitudinal tracking error converges to near zero after a period of time. Because each unmanned boat will deviate from the pre-given parameterized path when performing obstacle avoidance and collision avoidance actions, a large lateral tracking error will occur. After the obstacle avoidance and collision avoidance is completed, the position of the unmanned boat will gradually converge to the given parameterized path, and the lateral tracking error will also gradually converge to near zero. Figure 5 The estimation effect of each unmanned boat on the path parameters of unmanned boat No. 1 is given, and it can be seen that it has a good estimation effect. Figure 6 is the variation curve of the minimum distance between the unmanned boat and the static obstacle, dynamic obstacle and neighboring unmanned boat. It can be seen that in the process of path tracking, the distance between the unmanned boat and the static obstacle is always greater than the set limit distance d s =5m, indicating that the six unmanned boats did not collide with any static obstacles in the environment. From the minimum distance change curve between the unmanned boat and the dynamic obstacle, it can be seen that the unmanned boat encountered a dynamic obstacle between 250s and 300s, but the distance still satisfied that it was greater than d D=5m, indicating that the unmanned boat did not collide with the dynamic obstacle. From the minimum distance change curve between the unmanned boat and its neighboring unmanned boat, it can be seen that the distance between the unmanned boats is always greater than the set limit collision avoidance distance d N =5m, indicating that there was no collision between the unmanned boats.

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

Claims

1. A non-cooperative game-based unmanned boat cluster path tracking controller for controlling underactuated unmanned boats. It is characterized in that include: Nominal guidance law module based on line-of-sight guidance, parameter update law module based on non-cooperative game, safety guidance law module based on control obstacle function, safety constraints and input constraints; The parameter update law module receives the path parameters from the communication network and the estimated values ​​of the path parameters of the unmanned boat, the parameter update law module outputs the update law parameters to the nominal guidance law module, and the parameter update law module outputs the path parameters and the estimated values ​​of the path parameters of other unmanned boats to the communication network; The nominal guidance law module receives the update law parameters from the parameter update law module and the manually input parameterized path, the nominal guidance law module outputs the desired speed guidance signal to the underactuated unmanned vehicle, and the nominal guidance law module outputs the desired angular velocity guidance signal to the safety guidance law module; The safety guidance law module receives the expected angular velocity guidance signal, safety constraints and input constraints from the nominal guidance law module, and the safety guidance law module outputs the optimal angular velocity guidance signal to the underactuated unmanned boat.

2. The unmanned boat swarm path tracking controller based on non-cooperative game according to claim 1, It is characterized in that The underactuated unmanned boat receives a desired speed guidance signal from a nominal guidance law module, the underactuated unmanned boat receives an optimal angular velocity guidance signal from a safety guidance law module, and the underactuated unmanned boat outputs an unmanned boat state to the nominal guidance law module; The kinematic model of the underactuated unmanned vehicle is as follows: Where i represents the i-th underactuated unmanned boat; x i represents the position of the underactuated unmanned vehicle on the x-axis in the earth coordinate system, and y i represents the position of the underactuated unmanned vehicle on the y-axis in the earth coordinate system, ψ iw Represents the actual movement direction of the underactuated unmanned vehicle; represents the total speed of the underactuated unmanned vehicle; r i represents the bow angular velocity of the underactuated unmanned vehicle; β i =arctan2(ν i / u i ) represents the sideslip angle.

3. The unmanned boat cluster path tracking controller based on non-cooperative game according to claim 1, It is characterized in that The design steps of the parameter update law module are as follows: The derivatives of the path parameters are defined as follows: In the formula, u s is the reference speed, ω i is the path parameter variable; Define the cost function of the i-th unmanned boat as J i (θ), and we have: In the formula, ξ ij represents the estimation of the path parameters of the jth unmanned boat by the i-th unmanned boat, ξ ij The calculation formula is as follows: In the formula, The communication adjacency matrix is a ij is the element in the i-th row and j-th column of the communication adjacency matrix, a ik is the element in the i-th row and k-th column of the communication adjacency matrix; ω i The calculation formula is as follows: In the formula, ω i Substitution The derivative of the path parameter becomes as follows:

4. The unmanned boat cluster path tracking controller based on non-cooperative game according to claim 1, It is characterized in that The design steps of the nominal guidance law module are as follows: Given a parameterized path as follows: In the formula, θ i is a path parameter, and has: The calculation formula for the path tangent angle corresponding to the i-th unmanned boat is as follows: The position error calculation formula is as follows: The guidance angle calculation formula is as follows: In the formula, Δ i is the foresight distance parameter; the direction tracking error is: z iψ =ψ iw -ψ ir The output signal calculation formula of the nominal guidance law module is as follows: In the formula, k i1 and k i2 is the controller parameter; ψ iδ =(ψ iw -ψ id ) / 2, 5. The unmanned boat swarm path tracking controller based on non-cooperative game according to claim 1, It is characterized in that The design steps of the safety constraints and input constraints are as follows: S1. Safety constraints:

1. Static obstacle avoidance; The control barrier function is designed as: In the formula, ζ il ≥0; l=1,...,L; Λ il =ψ iw -(π / 2+ψ il );ψ il =atan2(y l -y i ,x l -x i );p i =[x i ,y i ] is the position of the i-th unmanned boat, p l =[x l ,y l ] T is the position of the static obstacle; d S The safe distance from static obstacles; The calculation formula for the static obstacle safety constraint condition is as follows: 2g il L il r i -h il c il ≤P il Among them, γ il ≥0 is a slack variable; 2. Avoid collision with dynamic obstacles; Design the following control barrier function: In the formula, ζ im ≥0,m=1,...,M,Λ im =ψ iw -(π / 2+ψ im ), ψ im =atan2(y m -y i ,x m -x i ), p m =[x m ,y m ] T is the position of the dynamic obstacle; d D To ensure safe distance from dynamic obstacles; The calculation formula of dynamic obstacle safety constraint condition is as follows: 2g im L im r i -h im c im ≤P im In the formula, γ im ≥0 is a slack variable; 3. Avoid collision with neighbor’s unmanned boat; Design the following control barrier function: In the formula, ζ ij ≥0,j=1,...,N,Λ ij =ψ iw -(π / 2+ψ ij ), ψ ij =atan2(y j -y i ,x j -x i ), p j =[x j ,y j ] T is the location of the neighbor’s unmanned boat, d N To maintain a safe distance from neighboring unmanned boats; The calculation formula of the safety constraint condition of the neighbor unmanned boat is as follows: 2g ij L ij r i -h ij c ij ≤P ij In the formula, γ ij ≥0 is a slack variable, S2. Input constraints Consider the angular velocity constraint as follows: r min ≤r i ≤r max In the formula, r min is the minimum value that the guidance angular velocity should satisfy, r max is the maximum value that the guidance angular velocity should satisfy.

6. The unmanned boat swarm path tracking controller based on non-cooperative game according to claim 1, It is characterized in that The formula of the safety guidance law module based on the control obstacle function is as follows:

7. A non-cooperative game-based unmanned boat cluster path tracking control method, which is implemented based on the non-cooperative game-based unmanned boat cluster path tracking controller described in any one of claims 1 to 6. It is characterized in that The steps include: The parameter update law module based on non-cooperative game receives the path parameters and their estimated values ​​from the communication network, calculates the update law parameters and path parameters as well as the estimated values ​​of the path parameters of other unmanned boats, transmits the update law parameters to the nominal guidance law module based on line-of-sight guidance, and the path parameters of the unmanned boat and the estimated values ​​of the path parameters of other unmanned boats are transmitted back to the communication network; The nominal guidance law module based on line-of-sight guidance receives the update law parameters from the parameter update law module, the manually input parameterized path and the state information transmitted by the unmanned boat, calculates the expected speed guidance signal and the expected angular velocity guidance signal, transmits the expected speed guidance signal to the unmanned boat, and transmits the expected angular velocity guidance signal to the safety guidance law module based on the control obstacle function; The safety guidance law module based on the control obstacle function receives the expected angular velocity guidance signal, safety constraints and input constraints transmitted by the nominal guidance law module, calculates the current optimal angular velocity guidance signal and transmits it to the unmanned boat; The unmanned boat receives the optimal angular velocity guidance signal from the safety guidance law module and the expected velocity guidance signal from the nominal guidance law, and transmits its own status information to the nominal guidance law module.