Unmanned surface vehicle three-body pursuit game planning and control method

By designing the three-body pursuit game planning and control method of unmanned boats, we construct the target-defense unmanned boat team state constraints and initial states, combined with the self-immune disturbance dynamic controller, we solve the collaborative game and nonlinear kinematics in the existing strategy. Application problems improve the interception capability and stability of unmanned boats in complex environments.

CN118897550APending Publication Date: 2024-11-05DALIAN MARITIME UNIVERSITY
View PDF 0 Cites 2 Cited by

Patent Information

Application Number
CN202410944693.3
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-15
Publication Date
2024-11-05

AI Technical Summary

Technical Problem

The existing unmanned boat three-body pursuit game strategy fails to effectively design the coordinated game strategy of protected targets and defenders, and is difficult to apply to nonlinear kinematic systems, and does not consider the impact of unknown complex marine environments and disturbances.

Method used

A three-body pursuit game planning and control method was designed for unmanned boats. By constructing the target-defense unmanned boat team state constraints and initial state constraints, the cost function is designed to output vertical sway velocity, horizontal sway velocity and angular velocity information, combined with Heading self-immunity dynamic controller and bow shaking angular velocity self-immunity dynamic controller to achieve the escape of target unmanned boats and defend against unmanned boat interception.

Benefits of technology

Optimize the path and strategies of target unmanned boats, improve the success rate of defense unmanned boats intercepting attack unmanned boats, enhance robustness and stability, is suitable for nonlinear kinematic systems and operates effectively in complex marine environments. .

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118897550A_ABST
    Figure CN118897550A_ABST
Patent Text Reader

Abstract

The invention relates to a three-body pursuit game planning and control method for an unmanned ship. Comprising the following steps: constructing a target-defense unmanned ship team game strategy based on a target-defense unmanned ship team input constraint, a target unmanned ship resultant velocity constraint, a target-defense unmanned ship team initial state constraint, a target-defense unmanned ship team state constraint and a target-defense unmanned ship team cost function; outputting the surging speed information of the target unmanned ship, the swaying speed information of the target unmanned ship and the angular speed information of the defense unmanned ship; designing a course active-disturbance-rejection dynamic controller, and realizing pursuit control of the target unmanned surface vehicle for escaping and attacking the unmanned surface vehicle based on the target unmanned surface vehicle control input torque; according to the method, a yawing angular velocity active-disturbance-rejection dynamic controller is designed, a surging velocity active-disturbance-rejection dynamic controller is designed, interception control of the defense unmanned ship on the attack unmanned ship is achieved based on control input force of the defense unmanned ship and control input torque of the defense unmanned ship, and the method has high robustness and stability.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention belongs to the technical field of unmanned boat pursuit and escape game control, and discloses an unmanned boat three-body pursuit and escape game planning and control method. Background Art

[0002] The 21st century is the century of the ocean. The ocean not only contains rich biological resources, oil and gas resources and mineral resources, but also is a strategic space and resource base for human survival and sustainable development. With the implementation of the strategy of building a strong maritime nation, the ocean has become the "main battlefield" for the game between major powers. Therefore, in the process of building a strong maritime nation, high-tech new marine intelligent equipment such as unmanned boats is the key support for our move towards a strong maritime nation. In a complex and changeable marine environment, the load configuration of a single unmanned boat is very limited, the mission capability is weak, and the combat style is relatively single, which cannot guarantee the smooth completion of the task to a large extent. The coordinated combat of unmanned boat clusters can make up for the shortcomings of single boat capabilities and give full play to the advantages of flexible deployment, wide monitoring range, flexible combat organization, and strong anti-destruction reconstruction. In order to deal with attacking unmanned boats, the most effective way is to use unmanned boat clusters to intercept, drive away or round up invading unmanned boats, thereby forming a game confrontation between unmanned boat clusters.

[0003] Domestic and foreign scholars have conducted extensive research on the control problem of multi-agent games and proposed a variety of application scenarios and technical solutions. At present, multi-agent games mainly include boundary defense, pursuit and escape games, target encirclement and target interception. In the field of multi-agent pursuit and escape games, Josef Shinar proposed a pursuit-avoidance differential game with bounded control and a hybrid dynamics of a specified duration for a one-to-one two-agent pursuit and escape scenario. By introducing the hybrid dynamics of the escaper, the escaper can change the state according to the actual situation in the game, realizing the expansion of the escape area of ​​the escaper. Xu Fang proposed a distributed pursuit-escape game algorithm for multiple pursuers and a single escaper for a many-to-one multi-agent pursuit and escape scenario, so that the pursuer can form an encirclement and approach the faster escaper. Zachariah E.Fuchs proposed a differential game with a single pursuer and two escapers with a new cost function for a one-to-many multi-agent pursuit and escape scenario. By reversely integrating the generated ordinary differential equations, the optimal trajectory of the three-agent system is generated, thereby generating the trajectory between the two escapers with cooperative behavior. For the multi-agent pursuit and escape game problem, most of the former do not introduce the protected role. Target-Attacker-Defender (TAD) is a special pursuit and escape problem that includes the protected person, including two sets of pursuit and escape relationships: attacker-target and defender-attacker. The attacker's goal is to pursue the target object while avoiding the interception of the defender. The target object and the defender are the same team. During the game, they need to avoid the target being attacked by the attacker and intercept the attacker by sending the defender. For the multi-agent target-attacker-defender (TAD) pursuit and escape problem, Ashwini Ratnoo proposed a CLOS instruction for the defender and a collaborative guidance law for the target for the three-agent interception scenario, in order to maximize the lateral acceleration ratio between the attacker and the defender, so that the defender can stay on the line between the target and the attacker and achieve better control. At present, there are few studies on TAD-type pursuit and escape problems in the field of unmanned boats. Bin Lin proposed two strategies for the unmanned boat target-attacker-defender (TAD) pursuit and escape problem with finite speed and angular velocity. He gave a novel RCS trajectory framework to evaluate the time for the unmanned boat to reach the pre-arranged coordinates, and applied it to the TAD game strategy of both parties to achieve the interception behavior of the defending unmanned boat against the attacking unmanned boat. The existing three-body pursuit and escape game strategy has the following problems:

[0004] First, most of the existing multi-agent pursuit and escape game strategies only consider how the defender can intercept the attacker unilaterally, but do not consider how to design a collaborative game strategy between the protected target and the defender to intercept and evade the attacker.

[0005] Second, the existing three-body pursuit and escape game strategies usually only target particle models or only consider linear kinematic systems, which makes the planning strategies not smooth enough and difficult to apply to unmanned boat systems with highly nonlinear kinematics.

[0006] Third, the existing unmanned boat three-body pursuit and escape game strategy does not take into account the impact of the uncertainty of the model parameters and the unknown ocean environment wind, waves, and ocean current disturbances on the three-body pursuit and escape game results when the unmanned boat operates in an unknown and complex ocean environment. Summary of the invention

[0007] In order to solve the above problems, the technical solution adopted by the present invention is: a three-body pursuit and escape game planning and control method for an unmanned boat, comprising the following steps:

[0008] Obtain the current position information and direction angle information of the target unmanned boat, the defending unmanned boat and the attacking unmanned boat;

[0009] Based on the current position information and azimuth information of the target unmanned boat, the defending unmanned boat and the attacking unmanned boat, the state constraint of the target-defense unmanned boat team is constructed;

[0010] Based on the initial position information and initial direction angle information of the target unmanned boat, the defending unmanned boat and the attacking unmanned boat, the initial state constraints of the target-defense unmanned boat team are constructed;

[0011] Design goal - defense unmanned boat team cost function;

[0012] Based on the input constraints of the target-defense unmanned boat team, the combined speed constraints of the target unmanned boat, the initial state constraints of the target-defense unmanned boat team, the state constraints of the target-defense unmanned boat team and the cost function of the target-defense unmanned boat team, the target-defense unmanned boat team game strategy is constructed, and the target unmanned boat longitudinal speed information, the target unmanned boat transverse speed information and the angular velocity information of the defense unmanned boat are output;

[0013] Based on the target unmanned boat's longitudinal and transverse velocity information, a heading self-disturbance rejection dynamic controller is designed to output the target unmanned boat's control input torque. Based on the target unmanned boat's control input torque, the target unmanned boat can escape from the attacking unmanned boat and achieve pursuit control.

[0014] Based on the angular velocity information of the defense unmanned boat, the bow angular velocity anti-disturbance dynamic controller is designed to output the control input torque of the defense unmanned boat.

[0015] Based on the reference forward speed of the defense unmanned boat, the surge velocity anti-disturbance dynamic controller is designed to output the control input force of the defense unmanned boat.

[0016] The interception control of the attacking unmanned boat by the defense unmanned boat is realized based on the defense unmanned boat control input force and the defense unmanned boat control input torque.

[0017] Further: the target-defense unmanned boat team status constraint as follows:

[0018]

[0019] Where X = {x T ,y T ,ψ T ,x A ,y A ,ψ AW ,x D ,y D ,ψ DW ,R1,R2,θ1,θ2} is the target-defense unmanned boat team state; the derivative expression of X (x T ,y T ) is the target unmanned boat position information; ψ T is the target unmanned boat track angle information; R1 is the distance between the attacking unmanned boat and the defending unmanned boat; R2 is the distance between the attacking unmanned boat and the target unmanned boat; θ1 is the sight angle between the attacking unmanned boat and the defending unmanned boat; θ2 is the sight angle between the attacking unmanned boat and the target unmanned boat; the target-defense unmanned boat team cooperation strategy u={u Tf ,v Tf ,r Df}, namely the longitudinal and transverse velocity information of the target unmanned boat and the angular velocity information of the defense unmanned boat; f(·) is the derivative of the state of the target-defense unmanned boat team, (x A ,y A ) is the current position information of the attacking unmanned boat and ψ AW The current direction angle information of the unmanned boat;

[0020] and:

[0021]

[0022] Among them, U T ,U A They represent the actual moving speeds of the target unmanned boat and the attacking unmanned boat respectively.

[0023] Further: The target-defense unmanned boat team initial state constraint formula is as follows:

[0024] X0={x 0T ,y 0T ,ψ 0T ,x 0A ,y 0A,ψ 0AW ,x 0D ,y 0D ,ψ 0DW ,R 10 ,R 20 ,θ 10 ,θ 20};

[0025] Among them, R 10 is the initial Euclidean distance between the attacking unmanned boat and the defending unmanned boat; R 20 is the initial Euclidean distance between the attacking unmanned boat and the target unmanned boat; θ 10 is the initial sight angle between the attacking unmanned boat and the defending unmanned boat; θ 20 is the initial sight angle between the attacking UAV and the target UAV; and

[0026]

[0027] The initial position of the target unmanned boat (x 0T ,y 0T ) and track angle information ψ 0T , initial position of the defense unmanned boat (x 0D ,y 0D ) and direction angle information ψ 0DW and the initial position of the attacking unmanned boat (x 0A ,y 0A ) and direction angle information ψ 0AW .

[0028] Further: The cost function J of the target-defense unmanned boat team is expressed as follows:

[0029]

[0030] Among them, τ h is the sampling time; is the threshold, that is, when the distance between the target unmanned boat and the attacking unmanned boat is less than e, the target unmanned boat starts to move.

[0031] Further: the target-defense unmanned boat team input constraint module formula is as follows:

[0032] u∈[u min ,u max ](9)

[0033] Among them, u is the target-defense unmanned boat team cooperation strategy; u min Goal - defense unmanned boat team cooperation strategy quantity lower bound constraint; u max Upper bound constraints on the target-defense unmanned boat teamwork strategy.

[0034] Further: the target unmanned boat combined speed constraint output signal is the target unmanned boat combined speed constraint

[0035]

[0036] Among them, u Tf v is the target unmanned boat's longitudinal speed; Tf is the lateral swing speed of the target unmanned boat.

[0037] Further: the target-defense unmanned boat team game strategy formula is as follows:

[0038]

[0039] constraint:

[0040]

[0041] X(0)=X0 (13)

[0042] u∈[u min ,u max ](14)

[0043]

[0044] Among them, the target-defense unmanned boat team cooperation strategy u={u Tf ,v Tf ,r Df};u Tf ,v Tf ,r Df They are the longitudinal velocity information of the target unmanned boat, the transverse velocity information of the target unmanned boat and the angular velocity information of the defending unmanned boat; Indicates that in the time interval [t,t+τ h ] is the space of piecewise continuous functions defined in .

[0045] An unmanned boat three-body pursuit and escape game planning and control device, comprising:

[0046] Acquisition module: used to obtain the current position information and direction angle information of the target unmanned boat, the defense unmanned boat and the attacking unmanned boat;

[0047] Target-defense unmanned boat team state constraint module: constructs the target-defense unmanned boat team state constraint based on the current position information and direction angle information of the target unmanned boat, defense unmanned boat and attack unmanned boat;

[0048] Target-defense unmanned boat team initial state constraint module: Based on the initial position information and initial direction angle information of the target unmanned boat, the defense unmanned boat and the attacking unmanned boat, the target-defense unmanned boat team initial state constraint is constructed;

[0049] Target-defense unmanned boat team cost function design module: used to design the target-defense unmanned boat team cost function;

[0050] Target unmanned boat combined speed constraint module: used to determine the combined speed constraint of the target unmanned boat;

[0051] Target-defense unmanned boat team input constraint module: used to determine the target-defense unmanned boat team input constraints;

[0052] Target-defense unmanned boat team game strategy design module: used to construct the target-defense unmanned boat team game strategy for design based on the target-defense unmanned boat team input constraints, target unmanned boat combined speed constraints, target-defense unmanned boat team initial state constraints, target-defense unmanned boat team state constraints and target-defense unmanned boat team cost function, and output the target unmanned boat longitudinal speed information, target unmanned boat transverse speed information and defense unmanned boat angular velocity information;

[0053] Heading ADRC dynamic controller design module: used to design a heading ADRC dynamic controller based on the target unmanned boat's longitudinal and transverse velocity information, output the target unmanned boat's control input torque, and achieve the target unmanned boat's escape control based on the target unmanned boat's control input torque;

[0054] Bow angular velocity anti-disturbance dynamic controller module: used to design the bow angular velocity anti-disturbance dynamic controller based on the angular velocity information of the defense unmanned boat, output the control input torque of the defense unmanned boat, and output the control input torque of the defense unmanned boat based on the reference forward speed of the defense unmanned boat;

[0055] Surge velocity anti-disturbance dynamics controller module: used to design a surge velocity anti-disturbance dynamics controller based on the reference forward velocity of the defense unmanned boat and output the control input force of the defense unmanned boat;

[0056] The interception control of the attacking unmanned boat by the defense unmanned boat is realized based on the defense unmanned boat control input force and the defense unmanned boat control input torque.

[0057] The present invention provides a three-body pursuit and escape game planning and control method for an unmanned boat, which has the following advantages:

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

[0059] First, compared with the existing multi-agent pursuit and escape game strategy, the present invention designs a three-body cooperative planning pursuit and escape game method for unmanned boats. By designing the cost function of the target-defense unmanned boat team, its path and strategy are optimized, so that the defense unmanned boat can intercept the target unmanned boat at the lowest cost before the attacking unmanned boat captures it, and the target unmanned boat successfully escapes.

[0060] Second, compared with the existing three-body pursuit and escape game strategy, the present invention designs an unmanned boat three-body model prediction game planning method, which introduces a nonlinear kinematic model of the target-defense unmanned boat team system. According to the prediction model, the action mode of the target-defense unmanned boat team is adjusted accordingly in the planning, thereby improving the success rate of the defense unmanned boat intercepting the attacking unmanned boat.

[0061] Third, compared with the existing unmanned boat three-body pursuit and escape game strategy, the present invention designs an unmanned boat three-body pursuit and escape game self-disturbance rejection control method. By introducing a self-disturbance rejection controller based on an extended state observer, it achieves accurate estimation of the uncertainty of the target-defense unmanned boat team model and external disturbances, making the target-defense unmanned boat team have higher robustness and stability. BRIEF DESCRIPTION OF THE DRAWINGS

[0062] 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.

[0063] Figure 1 It is a flow chart of the three-body pursuit and escape game planning and control method of the unmanned boat of the present invention;

[0064] Figure 2 It is a schematic diagram of the structure of the unmanned boat three-body pursuit and escape game planning and control device of the present invention.

[0065] Figure 3 It is a schematic diagram of the movement trajectory of the defense unmanned boat intercepting the attacking unmanned boat of the present invention.

[0066] Figure 4 It is a target-attack-defense unmanned boat movement distance curve diagram of the present invention.

[0067] Figure 5 It is a curve diagram of the target unmanned boat cooperation strategy of the present invention.

[0068] Figure 6 It is a curve diagram of the defense unmanned boat cooperation strategy of the present invention.

[0069] Figure 7It is a track angle tracking curve diagram of the target unmanned boat of the present invention.

[0070] Figure 8 It is a bow angular velocity tracking curve diagram of the target unmanned boat of the present invention.

[0071] Fig. 9 It is a forward speed tracking curve diagram of the defense unmanned boat of the present invention.

[0072] Fig.10 It is a curve diagram of the bow angular velocity tracking of the unmanned boat defense device according to the present invention.

[0073] Fig.11 It is a control torque curve diagram of the target unmanned boat of the present invention.

[0074] Fig.12 It is a forward thrust curve diagram of the defense unmanned boat of the present invention.

[0075] Fig.13 It is a torque curve diagram of the bow roll angle direction of the defense unmanned boat of the present invention. DETAILED DESCRIPTION

[0076] It should be noted that, in the absence of conflict, the embodiments of the present invention and the features in the embodiments may be combined with each other. The present invention will be described in detail below with reference to the accompanying drawings and in combination with the embodiments.

[0077] In order to make the purpose, technical solutions and advantages of the embodiments of the present invention clearer, the technical solutions 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. The following description of at least one exemplary embodiment is actually only illustrative and is by no means intended to limit the present invention and its application or use. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.

[0078] A three-body pursuit and escape game planning and control method for an unmanned boat includes the following steps:

[0079] S1: Obtain the current position information and direction angle information of the target unmanned boat, the defending unmanned boat and the attacking unmanned boat;

[0080] S2: Based on the current position information and direction angle information of the target unmanned boat, the defense unmanned boat and the attack unmanned boat, a target-defense unmanned boat team state constraint is constructed;

[0081] S3: Based on the initial position information and initial direction angle information of the target unmanned boat, the defense unmanned boat and the attack unmanned boat, the initial state constraint of the target-defense unmanned boat team is constructed;

[0082] S4: Design goal-defense unmanned boat team cost function;

[0083] S5: Based on the input constraints of the target-defense unmanned boat team, the combined speed constraints of the target unmanned boat, the initial state constraints of the target-defense unmanned boat team, the state constraints of the target-defense unmanned boat team and the cost function of the target-defense unmanned boat team, a target-defense unmanned boat team game strategy is constructed and designed, and the target unmanned boat longitudinal speed information, the target unmanned boat transverse speed information and the angular velocity information of the defense unmanned boat are output;

[0084] S6: Based on the target unmanned boat's longitudinal speed information and the target unmanned boat's lateral speed information, a heading self-disturbance rejection dynamics controller is designed to output the target unmanned boat's control input torque, and based on the target unmanned boat's control input torque, the target unmanned boat is controlled to escape from the attacking unmanned boat;

[0085] S7: Based on the angular velocity information of the defense unmanned boat, a bow angular velocity self-disturbance rejection dynamic controller is designed to output the control input torque of the defense unmanned boat;

[0086] S8: Based on the reference forward speed of the defense unmanned boat, a surge speed self-disturbance rejection dynamics controller is designed to output the control input force of the defense unmanned boat;

[0087] The interception control of the attacking unmanned boat by the defense unmanned boat is realized based on the defense unmanned boat control input force and the defense unmanned boat control input torque.

[0088] Steps: First, perform step S1, then perform S2 / S3 / S4 simultaneously, then perform S5, and then perform S6 / S7 / S8 simultaneously;

[0089] The kinematic model of the target unmanned boat is:

[0090]

[0091] Among them, u T is the longitudinal speed of the target unmanned boat, v T is the swaying speed of the target unmanned boat, r T is the bow angular velocity of the target unmanned boat, ψ T is the track angle of the target unmanned boat, x T and T are the horizontal and vertical coordinates of the target unmanned boat in the earth coordinate system respectively.

[0092] The target unmanned boat dynamics model is:

[0093]

[0094] Among them, m Tu ,m Tv ,mTr are the mass in the longitudinal and transverse directions and the moment of inertia coefficient of the target unmanned boat respectively; f Tu (·),f Tv (·),f Tr (·) represents the unknown nonlinear functions, including hydrodynamic damping force, Coriolis force, and unmodeled fluid dynamics; τ Tiu ,τ Tir are the control input force and moment in the surge direction and the yaw angle direction respectively; τ Twu ,τ Twv ,τ Twr Represents the time-varying environmental disturbance forces and moments caused by wind, waves, and currents;

[0095] The kinematic model of the defense unmanned boat is:

[0096]

[0097] Among them, (x D ,y D ) is the position of the defense unmanned boat; ψ DW =ψ D +β D The actual moving angle of the defense unmanned boat, ψ D To defend the bow angle of the unmanned boat; β D =atan(v D / u D ) represents the sideslip angle of the defense unmanned boat; Indicates the actual movement speed of the defense unmanned boat; u D ,v D ,r D are the surge velocity, sway velocity and bow angular velocity in the hull coordinate system respectively;

[0098] The dynamic model of the defense unmanned boat is:

[0099]

[0100] Among them, m Du ,m Dr are the mass and moment of inertia coefficient of the defense unmanned boat in the longitudinal direction respectively; f Du (·),f Dr (·) represents the unknown nonlinear functions, including hydrodynamic damping force, Coriolis force, and unmodeled fluid dynamics; τ Du ,τ Dr are the control input force and moment in the surge direction and the yaw angle direction respectively; τ Dwu ,τ Dwr Represents the time-varying environmental disturbance forces and moments caused by wind, waves, and currents;

[0101] The target unmanned boat kinematic model and the defense unmanned boat kinematic model are used for trajectory planning and design of the target-defense unmanned boat team;

[0102] The target unmanned boat dynamics model and the defense unmanned boat dynamics model are used for the design of the bow angular velocity self-disturbance rejection dynamics controller, the longitudinal velocity self-disturbance rejection dynamics controller, and the heading self-disturbance rejection dynamics controller;

[0103] Furthermore, the target-defense unmanned boat team initial state constraint formula is as follows:

[0104] X0={x 0T ,y 0T ,ψ 0T ,x 0A ,y 0A ,ψ 0AW ,x 0D ,y 0D ,ψ 0DW ,R 10 ,R 20 ,θ 10 ,θ 20};

[0105] Among them, R 10 is the initial Euclidean distance between the attacking unmanned boat and the defending unmanned boat; R 20 is the initial Euclidean distance between the attacking unmanned boat and the target unmanned boat; θ 10 is the initial sight angle between the attacking unmanned boat and the defending unmanned boat; θ 20 is the initial sight angle between the attacking UAV and the target UAV; and

[0106]

[0107] The initial position of the target unmanned boat (x 0T ,y 0T ) and track angle information ψ 0T , initial position of the defense unmanned boat (x 0D ,y 0D ) and direction angle information ψ 0DW and the initial position of the attacking unmanned boat (x 0A ,y 0A ) and direction angle information ψ 0AW .

[0108] Further: the target-defense unmanned boat team status constraint as follows:

[0109]

[0110] Where X = {x T ,yT ,ψ T ,x A ,y A ,ψ AW ,x D ,y D ,ψ DW ,R1,R2,θ1,θ2} is the target-defense unmanned boat team state; the derivative expression of X (x T ,y T ) is the target unmanned boat position information; ψ T is the target unmanned boat track angle information; R1 is the distance between the attacking unmanned boat and the defending unmanned boat; R2 is the distance between the attacking unmanned boat and the target unmanned boat; θ1 is the sight angle between the attacking unmanned boat and the defending unmanned boat; θ2 is the sight angle between the attacking unmanned boat and the target unmanned boat; the target-defense unmanned boat team cooperation strategy u={u Tf ,v Tf ,r Df}, namely the longitudinal and transverse velocity information of the target unmanned boat and the angular velocity information of the defense unmanned boat; f(·) is the derivative of the state of the target-defense unmanned boat team, (x A ,y A ) is the current position information of the attacking unmanned boat and ψ AW The current direction angle information of the unmanned boat;

[0111] and:

[0112]

[0113] Among them, U T ,U A They represent the actual moving speeds of the target unmanned boat and the attacking unmanned boat respectively.

[0114] Further: The cost function J of the target-defense unmanned boat team is expressed as follows:

[0115]

[0116] Among them, τ h is the sampling time; is the threshold, that is, when the distance between the target unmanned boat and the attacking unmanned boat is less than e, the target unmanned boat starts to move.

[0117] Further: the target-defense unmanned boat team input constraint module formula is as follows:

[0118] u∈[u min ,u max ](9)

[0119] Among them, u is the target-defense unmanned boat team cooperation strategy; u min Goal - defense unmanned boat team cooperation strategy quantity lower bound constraint; u max Upper bound constraints on the target-defense unmanned boat teamwork strategy.

[0120] Further: the target unmanned boat combined speed constraint output signal is the target unmanned boat combined speed constraint

[0121] Among them, u T f is the longitudinal speed of the target unmanned boat; v T f is the swaying speed of the target unmanned boat.

[0122] Further: the target-defense unmanned boat team game strategy formula is as follows:

[0123]

[0124] constraint:

[0125]

[0126] X(0)=X0 (13)

[0127] u∈[u min ,u max ](14)

[0128]

[0129] Among them, the target-defense unmanned boat team cooperation strategy u={u Tf ,v Tf ,r Df};u Tf ,v Tf ,r Df They are the longitudinal velocity information of the target unmanned boat, the transverse velocity information of the target unmanned boat and the angular velocity information of the defending unmanned boat; Indicates that in the time interval [t,t+τ h ] is the space of piecewise continuous functions defined in .

[0130] Furthermore, based on the target unmanned boat longitudinal speed information u Tf 、Target unmanned boat swaying speed information v Tf , design the heading self-disturbance rejection dynamic controller, and output the target unmanned boat control input torque τ Tr , based on the control input torque of the target unmanned boat, the pursuit control of the target unmanned boat to escape the attacking unmanned boat is realized;

[0131] According to formula (2), the heading control system model of the target unmanned boat is:

[0132]

[0133] in,

[0134] The form of the extended state observer is designed as:

[0135]

[0136] Among them, k T1 , k T2 , k T3 is the observer parameter; They are respectively T ,r T ,σ Tr An estimated value of

[0137] The heading ADRC dynamic controller is in the form of:

[0138]

[0139] Among them, k Tp , k Td is a constant value; and is Tf The first derivative of ; is Tf The second derivative of

[0140] Furthermore, based on the angular velocity information r of the defense unmanned boat Df , design the bow angular velocity anti-disturbance dynamic controller, and output the control input torque r of the defense unmanned boat Dr The process is as follows;

[0141] According to formula (4), the form of the extended state observer is designed as:

[0142]

[0143] in, is the observer parameter; For r D An estimated value of is Dr an estimated value of

[0144] The form of the yaw angular velocity anti-disturbance dynamic controller is:

[0145]

[0146] Among them, k Dτr is a constant value; For rDf The first derivative of ;

[0147] Furthermore, the defense unmanned boat reference forward speed U Df , design the surge velocity self-disturbance rejection dynamic controller, and output the control input force τ of the defense unmanned boat Du ;

[0148] According to formula (4), the form of the extended state observer is designed as:

[0149]

[0150] in, is the observer parameter; For U D An estimated value of is DU an estimated value of

[0151]

[0152] The form of the surge velocity anti-disturbance dynamic controller is:

[0153]

[0154] Among them, k Dτu is a constant value; U Df To defend against unmanned boats, the reference forward speed is set to a fixed value; For U Df The first derivative of .

[0155] An unmanned boat three-body pursuit and escape game planning and control device, comprising:

[0156] Acquisition module: used to obtain the current position information and direction angle information of the target unmanned boat, the defense unmanned boat and the attacking unmanned boat;

[0157] Target-defense unmanned boat team state constraint module: constructs the target-defense unmanned boat team state constraint based on the current position information and direction angle information of the target unmanned boat, defense unmanned boat and attack unmanned boat;

[0158] Target-defense unmanned boat team initial state constraint module: Based on the initial position information and initial direction angle information of the target unmanned boat, the defense unmanned boat and the attacking unmanned boat, the target-defense unmanned boat team initial state constraint is constructed;

[0159] Target-defense unmanned boat team cost function design module: used to design the target-defense unmanned boat team cost function;

[0160] Target unmanned boat combined speed constraint module: used to determine the combined speed constraint of the target unmanned boat;

[0161] Target-defense unmanned boat team input constraint module: used to determine the target-defense unmanned boat team input constraints;

[0162] Target-defense unmanned boat team game strategy design module: used to construct the target-defense unmanned boat team game strategy for design based on the target-defense unmanned boat team input constraints, target unmanned boat combined speed constraints, target-defense unmanned boat team initial state constraints, target-defense unmanned boat team state constraints and target-defense unmanned boat team cost function, and output the target unmanned boat longitudinal speed information, target unmanned boat transverse speed information and defense unmanned boat angular velocity information;

[0163] Heading ADRC dynamic controller design module: used to design a heading ADRC dynamic controller based on the target unmanned boat's longitudinal and transverse velocity information, output the target unmanned boat's control input torque, and achieve the target unmanned boat's escape control based on the target unmanned boat's control input torque;

[0164] Bow angular velocity anti-disturbance dynamic controller module: used to design the bow angular velocity anti-disturbance dynamic controller based on the angular velocity information of the defense unmanned boat, output the control input torque of the defense unmanned boat, and output the control input torque of the defense unmanned boat based on the reference forward speed of the defense unmanned boat;

[0165] Surge velocity anti-disturbance dynamics controller module: used to design a surge velocity anti-disturbance dynamics controller based on the reference forward velocity of the defense unmanned boat and output the control input force of the defense unmanned boat;

[0166] The interception control of the attacking unmanned boat by the defense unmanned boat is realized based on the defense unmanned boat control input force and the defense unmanned boat control input torque.

[0167] The input end of the target-defense unmanned boat team initial state design module is the target unmanned boat initial position and track angle information, the defense unmanned boat team initial position and direction angle information, and the sensor detection attack unmanned boat initial position and direction angle information, and the output end of the target-defense unmanned boat team initial state design module is connected to the input end of the target-defense unmanned boat team game strategy design module; the target-defense unmanned boat team initial state design module is used for the state information of the target unmanned boat team at the initial moment;

[0168] The input end of the target-defense unmanned boat team state constraint module is the current position and angular direction information of the attacking unmanned boat detected by the sensor, and at the same time, it is connected to the target-defense unmanned boat team game strategy design module and the output end of the target unmanned boat and defense unmanned boat model; the output end of the target-defense unmanned boat team state constraint module is connected to the input end of the target-defense unmanned boat team game strategy design module; the target-defense unmanned boat team state constraint module is used to calculate the target-defense unmanned boat team state constraint;

[0169] The output end of the target-defense unmanned boat team cost function design module is connected to the input end of the target-defense unmanned boat team game strategy design module; the target-defense unmanned boat team cost function design module is used to give the cost function of the target-defense unmanned boat team;

[0170] The output end of the target-defense unmanned boat team input constraint module is connected to the input end of the target-defense unmanned boat team game strategy design module; the target-defense unmanned boat team input constraint module is used to provide the upper and lower bound constraint information of the target-defense unmanned boat team cooperation strategy;

[0171] The output end of the target unmanned boat combined speed constraint module is connected to the input end of the target-defense unmanned boat team game strategy design module; the target unmanned boat combined speed constraint module is used to give the target unmanned boat combined speed constraint;

[0172] The input end of the target-defense unmanned boat team game strategy design module is connected to the output end of the target-defense unmanned boat team initial state design module, the target-defense unmanned boat team state constraint module, the target-defense unmanned boat team cost function design module, the target-defense unmanned boat team input constraint module and the target unmanned boat combined speed constraint module; the output end of the target-defense unmanned boat team game strategy design module is connected to the input end of the heading self-disturbance rejection dynamics controller module, the bow angular velocity self-disturbance rejection dynamics control module and the surge speed self-disturbance rejection dynamics control module; the target-defense unmanned boat team game strategy design module is used to calculate the target-defense unmanned boat team cooperation strategy signal;

[0173] The input end of the heading self-disturbance rejection dynamics controller module is connected to the output end of the target-defense unmanned boat team game strategy design module, and the output end of the heading self-disturbance rejection dynamics controller module is connected to the input end of the target unmanned boat model; the heading self-disturbance rejection dynamics controller module is used to give the target unmanned boat control input torque;

[0174] The input end of the bow angular velocity self-disturbance rejection dynamics control module is connected to the output end of the target-defense unmanned boat team game strategy design module, and the output end of the bow angular velocity self-disturbance rejection dynamics control module is connected to the input end of the defense unmanned boat model; the bow angular velocity self-disturbance rejection dynamics control module is used to give the defense unmanned boat bow angular velocity direction control input torque;

[0175] The input end of the longitudinal swell speed self-disturbance rejection dynamics control module is given a forward reference speed of the defense unmanned boat, and the output end of the longitudinal swell speed self-disturbance rejection dynamics control module is connected to the input end of the defense unmanned boat model; the longitudinal swell speed self-disturbance rejection dynamics control module is used to give the forward speed direction control input force of the defense unmanned boat.

[0176] The control parameters for equations (2), (4), (8), (9), (10), (11), (14), (15), (17), (18), (19), (20), (21), and (22) are selected as follows: m u =25.8, m v =33.8, m r =2.76, τ h =0.3,dt=0.05,u min =[-2,-2,-0.5], u max =[2,2,0.5], k T1 =20, k T2 =5, k T3 =1, k Tp =10, k Td =20, k Dτu =1, k Dτr =1.

[0177] The simulation results are as follows Figure 3-Figure 13 shown.

[0178] Figure 3 A schematic diagram of the movement trajectory of the defensive unmanned boat intercepting the attacking unmanned boat is given. It can be seen that the defensive unmanned boat successfully intercepts the target unmanned boat before the attacking unmanned boat captures it.

[0179] Figure 4 A target-attack-defense unmanned boat motion distance curve is given, and it can be seen that the distance between the defense unmanned boat and the attack unmanned boat converges to near zero.

[0180] Figure 5 Given the target unmanned boat cooperation strategy curve, it can be seen that the objective function is effective for the target unmanned boat path planning.

[0181] Figure 6The defense unmanned boat cooperation strategy curve is given, and it can be seen that the objective function is effective for the defense unmanned boat path planning.

[0182] Figure 7 The track angle tracking curve of the target unmanned boat is given. It can be seen that the actual track angle information and estimated track angle information of the target unmanned boat can achieve good tracking of the guidance signal.

[0183] Figure 8 The target unmanned boat's bow angular velocity tracking curve is given. It can be seen that the target unmanned boat's actual bow angular velocity signal can achieve good tracking of the estimated bow angular velocity signal.

[0184] Fig. 9 The forward speed tracking curve of the defense unmanned boat is given. It can be seen that the actual forward speed information and the estimated forward speed information of the defense unmanned boat both achieve good tracking of the guidance signal.

[0185] Fig.10 The curve diagram of bow angular velocity tracking of the defense unmanned boat is given. It can be seen that the actual bow angular velocity and estimated bow angular velocity information of the defense unmanned boat can track the guidance signal well.

[0186] Fig.11 The control torque curve of the target unmanned boat is given, and it can be seen that the forward control input thrust of the target unmanned boat tends to be stable after the transient process.

[0187] Fig.12 The forward thrust curve of the defense unmanned boat is given. It can be seen that the forward control input thrust of the defense unmanned boat tends to be stable after the transient process.

[0188] Fig.13 The torque curve of the bow roll angle direction of the defense unmanned boat is given. It can be seen that the control input torque of the bow roll angle direction of the defense unmanned boat tends to be stable after the transient process.

[0189] 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 three-body pursuit and escape game planning and control method for an unmanned boat, characterized by: The following steps are involved: Obtain the current position information and direction angle information of the target unmanned boat, the defending unmanned boat and the attacking unmanned boat; Based on the current position information and azimuth information of the target unmanned boat, the defending unmanned boat and the attacking unmanned boat, the state constraint of the target-defense unmanned boat team is constructed; Based on the initial position information and initial direction angle information of the target unmanned boat, the defending unmanned boat and the attacking unmanned boat, the initial state constraints of the target-defense unmanned boat team are constructed; Design goal - defense unmanned boat team cost function; Based on the input constraints of the target-defense unmanned boat team, the combined speed constraints of the target unmanned boat, the initial state constraints of the target-defense unmanned boat team, the state constraints of the target-defense unmanned boat team and the cost function of the target-defense unmanned boat team, the target-defense unmanned boat team game strategy is constructed, and the target unmanned boat longitudinal speed information, the target unmanned boat transverse speed information and the angular velocity information of the defense unmanned boat are output; Based on the target unmanned boat's longitudinal and transverse velocity information, a heading self-disturbance rejection dynamic controller is designed to output the target unmanned boat's control input torque. Based on the target unmanned boat's control input torque, the target unmanned boat can escape from the attacking unmanned boat and achieve pursuit control. Based on the angular velocity information of the defense unmanned boat, the bow angular velocity anti-disturbance dynamic controller is designed to output the control input torque of the defense unmanned boat. Based on the reference forward speed of the defense unmanned boat, the surge velocity anti-disturbance dynamic controller is designed to output the control input force of the defense unmanned boat. The interception control of the attacking unmanned boat by the defense unmanned boat is realized based on the defense unmanned boat control input force and the defense unmanned boat control input torque.

2. The method for planning and controlling the three-body pursuit and escape game of an unmanned boat according to claim 1 is characterized in that: The objective - defense of the unmanned boat team status constraints as follows: Where X = {x T ,y T ,ψ T ,x A ,y A ,ψ AW ,x D ,y D ,ψ DW ,R1,R2,θ1,θ2} is the target-defense unmanned boat team state; the derivative expression of X (x T ,y T ) is the target unmanned boat position information; ψ T is the target unmanned boat track angle information; R1 is the distance between the attacking unmanned boat and the defending unmanned boat; R2 is the distance between the attacking unmanned boat and the target unmanned boat; θ1 is the sight angle between the attacking unmanned boat and the defending unmanned boat; θ2 is the sight angle between the attacking unmanned boat and the target unmanned boat; the target-defense unmanned boat team cooperation strategy u={u Tf ,v Tf ,r Df }, namely the longitudinal and transverse velocity information of the target unmanned boat and the angular velocity information of the defense unmanned boat; f(·) is the derivative of the state of the target-defense unmanned boat team, (x A ,y A ) is the current position information of the attacking unmanned boat and ψ AW The current direction angle information of the unmanned boat; and: Among them, U T ,U A They represent the actual moving speeds of the target unmanned boat and the attacking unmanned boat respectively.

3. The unmanned boat three-body pursuit and escape game planning and control method according to claim 1 is characterized by: The target-defense unmanned boat team initial state constraint formula is as follows: X0={x 0T ,y 0T ,ψ 0T ,x 0A ,y 0A ,ψ 0AW ,x 0D ,y 0D ,ψ 0DW ,R 10 ,R 20 ,θ 10 ,θ 20 }; Among them, R 10 is the initial Euclidean distance between the attacking unmanned boat and the defending unmanned boat; R 20 is the initial Euclidean distance between the attacking unmanned boat and the target unmanned boat; θ 10 is the initial sight angle between the attacking unmanned boat and the defending unmanned boat; θ 20 is the initial sight angle between the attacking UAV and the target UAV; and The initial position of the target unmanned boat (x 0T ,y 0T ) and track angle information ψ 0T , initial position of the defense unmanned boat (x 0D ,y 0D ) and direction angle information ψ 0DW and the initial position of the attacking unmanned boat (x 0A ,y 0A ) and direction angle information ψ 0AW .

4. The method for planning and controlling the three-body pursuit and escape game of an unmanned boat according to claim 1 is characterized in that: The cost function J of the target-defense unmanned boat team is expressed as follows: Among them, τ h is the sampling time; is the threshold, that is, when the distance between the target unmanned boat and the attacking unmanned boat is less than e, the target unmanned boat starts to move.

5. The method for planning and controlling the three-body pursuit and escape game of an unmanned boat according to claim 1 is characterized in that: The target-defense unmanned boat team input constraint module formula is as follows: u∈[u min ,in max ](9) Among them, u is the target-defense unmanned boat team cooperation strategy; u min Goal - defense unmanned boat team cooperation strategy quantity lower bound constraint; u max Upper bound constraints on the target-defense unmanned boat teamwork strategy.

6. The unmanned boat three-body pursuit and escape game planning and control method according to claim 1 is characterized by: The target unmanned boat combined speed constraint output signal is the target unmanned boat combined speed constraint U T ; Among them, u Tf v is the target unmanned boat's longitudinal speed; Tf is the lateral swing speed of the target unmanned boat.

7. The unmanned boat three-body pursuit and escape game planning and control method according to claim 1 is characterized by: The target-defense unmanned boat team game strategy formula is as follows: constraint: X(0)=X0 (13) u∈[u min ,in max ](14) Among them, the target-defense unmanned boat team cooperation strategy u={u Tf ,v Tf ,r Df };u Tf ,v Tf ,r Df are the target unmanned boat longitudinal velocity information, the target unmanned boat transverse velocity information and the defensive unmanned boat angular velocity information; PC(t,t+τ h ) represents the time interval [t,t+τ h ] is the space of piecewise continuous functions defined in .

8. An unmanned boat three-body pursuit and escape game planning and control device, characterized by: include: Acquisition module: used to obtain the current position information and direction angle information of the target unmanned boat, the defense unmanned boat and the attacking unmanned boat; Target-defense unmanned boat team state constraint module: constructs the target-defense unmanned boat team state constraint based on the current position information and direction angle information of the target unmanned boat, defense unmanned boat and attack unmanned boat; Target-defense unmanned boat team initial state constraint module: Based on the initial position information and initial direction angle information of the target unmanned boat, the defense unmanned boat and the attacking unmanned boat, the target-defense unmanned boat team initial state constraint is constructed; Target-defense unmanned boat team cost function design module: used to design the target-defense unmanned boat team cost function; Target unmanned boat combined speed constraint module: used to determine the combined speed constraint of the target unmanned boat; Target-defense unmanned boat team input constraint module: used to determine the target-defense unmanned boat team input constraints; Target-defense unmanned boat team game strategy design module: used to construct the target-defense unmanned boat team game strategy for design based on the target-defense unmanned boat team input constraints, target unmanned boat combined speed constraints, target-defense unmanned boat team initial state constraints, target-defense unmanned boat team state constraints and target-defense unmanned boat team cost function, and output the target unmanned boat longitudinal speed information, target unmanned boat transverse speed information and defense unmanned boat angular velocity information; Heading ADRC dynamic controller design module: used to design a heading ADRC dynamic controller based on the target unmanned boat's longitudinal and transverse velocity information, output the target unmanned boat's control input torque, and achieve the target unmanned boat's escape control based on the target unmanned boat's control input torque; Bow angular velocity anti-disturbance dynamic controller module: used to design the bow angular velocity anti-disturbance dynamic controller based on the angular velocity information of the defense unmanned boat, output the control input torque of the defense unmanned boat, and output the control input torque of the defense unmanned boat based on the reference forward speed of the defense unmanned boat; Surge velocity anti-disturbance dynamics controller module: used to design a surge velocity anti-disturbance dynamics controller based on the reference forward velocity of the defense unmanned boat and output the control input force of the defense unmanned boat; The interception control of the attacking unmanned boat by the defense unmanned boat is realized based on the defense unmanned boat control input force and the defense unmanned boat control input torque.

Citation Information

Cited By

  • Unmanned ship cooperative tracking simulation method under speed disadvantage

    CN122595799A

  • An unmanned surface vehicle cooperative tracking simulation method under speed disadvantage

    CN122595799B