Under-actuated unmanned ship distributed formation tracking control method with input and state quantification
By introducing distributed ESO and layered design in the distributed formation of unmanned ships, the stability problem of unmanned ship formation tracking control under the restricted bandwidth of maritime communication is solved, and the stable tracking of the system is realized and the communication burden is reduced, which is in line with navigation. Engineering requirements.
Patent Information
- Application Number
- CN202411121721.8
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-15
- Publication Date
- 2024-11-29
- Estimated Expiration
- Not applicable · inactive patent
AI Technical Summary
In the case of limited offshore communication bandwidth, a single unmanned ship is difficult to effectively track complex tasks, and the prior art is difficult to achieve stable coordinated control of the distributed formation of unmanned ships with input and state quantization.
By introducing a distributed expansion state observer (ESO), the position information of the virtual leader is observed, and the control system is divided into two parts: kinematics and dynamics for layered design, designing kinematic guidance law and dynamics quantitative tracking control law. , using input to state stability theory to prove system stability.
It realizes stable tracking control of the distributed formation of unmanned ships with input and state quantization, reduces the execution frequency of the actuator, reduces the burden of maritime communication signal transmission, and is in line with navigation engineering practice.
Smart Images

Figure CN119045478A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of artificial intelligence technology, and in particular to a distributed formation tracking control method for underactuated unmanned ships with input and state quantization. Background Art
[0002] In recent years, the emergence and rapid development of unmanned surface vehicles (USVs) are profoundly changing the way we explore and use the ocean. As an advanced navigation tool that integrates intelligent navigation, autonomous decision-making, remote control and other technologies, USVs can not only greatly improve the efficiency of ocean data collection and processing, but also perform various difficult tasks in complex and changeable marine environments, such as environmental monitoring, maritime rescue, and cargo transportation. However, with the continuous expansion of USV application scenarios, a single USV can no longer meet the needs of complex tasks, and USV formations have gradually become a research hotspot. USV formations can not only improve the efficiency and quality of overall mission execution through multi-ship collaborative operations, but also achieve a higher level of navigation control and autonomous decision-making through mutual cooperation within the formation. Therefore, USV formation tracking and control technology is the key to achieving efficient and safe operation of USV formations.
[0003] In navigation practice, control signals need to be transmitted through communication channels, and information must be quantized and encoded during the channel transmission process. Quantization is the process of converting a continuous signal into a set of discrete symbols or integer values. Considering the limited bandwidth of maritime communications, in order to ensure the normal operation of the system within a given bandwidth, considering USV formation tracking control with input and state quantization is more meaningful for navigation practice. Summary of the invention
[0004] The present invention studies the tracking control problem of a USV distributed formation under the control condition that both the control input and the state variables are quantized. The position information of the virtual leader is observed by introducing a distributed ESO, and the influence of the quantized state variables and the model uncertainty on the USVs is solved by the ESO technology. Based on the observation results of the ESO, the control system is divided into two parts, kinematics and dynamics, for hierarchical design, and the USV formation tracking guidance law is designed in the kinematic subsystem. In the dynamics subsystem, a more comprehensive method for describing the input quantization is proposed, so that the designed USV formation tracking controller does not require prior information of the quantized parameters. At the same time, the underlying control law of the USV formation is designed to achieve tracking of the guidance signal. In the stability analysis, it is proved that the USV distributed formation tracking control system with both input and state quantization is stable according to the input-to-state stability theory.
[0005] The technical means adopted by the present invention are as follows:
[0006] The present invention provides a distributed formation tracking control method for underactuated unmanned ships with input and state quantization, comprising:
[0007] S1. Obtain the sea condition information of the surrounding environment and other ships around, establish the trajectory control mathematical model of the distributed formation of underactuated unmanned ships, and use a uniform quantizer to quantize the control input and state variables in the control system;
[0008] S2. Design a distributed ESO to observe the position information of the virtual leader and use the ESO technology to estimate the quantitative state information of each USV and the uncertainties in the model;
[0009] S3. Use the hierarchical design method to design the kinematic guidance law and dynamic quantitative tracking control law;
[0010] S4. Using the input-to-state stability theory, the stability of the USV distributed formation tracking control system with input and state quantization is proved.
[0011] Furthermore, step S1 specifically includes:
[0012] S11. Given an underactuated USV formation, construct the kinematic model of the motion of the i-th unmanned ship in the USV formation system as follows:
[0013]
[0014] In the formula, x i ,y i Indicates the coordinates of the ship's center of mass described in the geodetic coordinate system; Indicates the ship's heading angle; u i 、v i and r i They represent the surge speed, sway speed and rotation speed of the ship respectively;
[0015] S12. Construct a nonlinear dynamic mathematical model of the underactuated unmanned ship as follows:
[0016]
[0017] In the formula, Respectively represent the mass of USV; Represent the hydrodynamic derivative terms respectively; I z represents the moment of inertia around the z-axis; function f iu (·),f iv (·),f ir (·) represent the fluid dynamic damping and centripetal force nonlinear uncertainties respectively; τ iuw ,τ ivw ,τ irwrepresent the disturbances caused by unknown ocean factors; Q(τ iu ) and Q(τ ir ) represent the system control input τ iu and τ ir The quantitative value of
[0018] S13, using a uniform quantizer to quantize the state variables and control inputs in the system, the specific quantization process is as follows:
[0019]
[0020] In the formula, ι = x i ,y i , u i ,v i ,r i and μ>0 indicates the quantization step size, H1=μ and H i+1 =H i +μ; therefore, the quantization error of the uniform quantizer is bounded and is expressed as:
[0021] S14, define the ideal parameter trajectory as Where P0(t) represents the continuous and differentiable ideal parameter trajectory;
[0022] S15. Use a graph of Ξ={Γ,Θ} to represent the relationship between N USVs and the virtual leader; where Θ=(i,j)∈Γ×Γ represents the set of edges, Γ=n0,n1,...,n N Represents a set of points; the adjacency matrix of the leader is defined as Υ0=diag{a i0}, and described as follows:
[0023] Ω=Ψ+Υ0
[0024] Where Ψ=Λ-Υ represents the Laplace matrix, Λ=diag{Λ i} represents the in-degree matrix,
[0025] S16. The control objective is to enable each USV in the ship formation system to track the ideal trajectory of the upper time-varying under the condition of communication bandwidth constraints, that is:
[0026]
[0027] Where P i (t) = [x i ,y i ] T Indicates the actual position of each USV in the formation; P 0id(t) represents the position deviation of each USV relative to the virtual leader parameter trajectory; ∈ d Represents a constant greater than zero.
[0028] Furthermore, step S2 specifically includes:
[0029] S21, introduce event-triggered ESO system to observe the location information of virtual leaders;
[0030] S22. ESO is introduced to estimate the state variables quantified by USV and the uncertainties in the system model.
[0031] Furthermore, step S21 specifically includes:
[0032] S211. In the inertial coordinate system, define and are the observation values of the position and heading angle of the virtual leader by the i-th USV, and The distributed ESO is designed based on the observed values of the speed and the turning angular velocity of the virtual leader by the i-th USV as follows:
[0033]
[0034] In the formula, β d represents the distributed ESO gain; ρ1, ρ2, ρ3, ρ4, ρ5, ρ6 are constants greater than 0; the state vector represents the state estimate of the i-th reference USV;
[0035] S212. Definition Then we have:
[0036]
[0037] S213, assuming that G = [G1, G2, ..., G N ] T =F -1 I N , C = diag{1 / G i}(i=1,2,...,N) and T=CF+F T C, then C and T are both positive definite matrices; define Then we have:
[0038]
[0039] Where A=diag{A1,A2,...,A N}, B = diag{B1, B2, ..., BN}, D = diag{D1, D2, ..., D N}, K=diag{K1,K2,...,K N}, and D N =[1,0,0,0,0,0], B N =[ρ1,ρ4,ρ2,ρ5,ρ3,ρ6] T ,
[0040] S214. Given two positive definite matrices X and Y, and satisfying A T X+XA-XD T DX+Y≤0; introduce the designed distributed event trigger ESO, let B=XD T ,β d >1 / (min i=1,...,N {Y i T i}), then Indicates that the input is stable;
[0041] S215. Define the Lyapunov function as:
[0042]
[0043] And take the derivative of the defined Lyapunov function, we get:
[0044]
[0045] S216, using state transition: and The derived Lyapunov function is rewritten as follows:
[0046]
[0047] S217, Order Then we have:
[0048]
[0049] In the formula, 0<o d <1;
[0050] S218. According to the above steps, the designed distributed event-triggered ESO system is stable in input state and satisfies:
[0051]
[0052] In the formula, express Function and:
[0053]
[0054] Further, step S22 specifically includes:
[0055] S221. In order to solve the influence of quantization error on the stability of distributed formation tracking control system and ensure that USVs in the formation can quickly and effectively track the desired trajectory, ESO is introduced to observe the quantized state variables in USVs.
[0056] S222: According to step S11 and step S12, the mathematical model of the i-th USV is rewritten as:
[0057]
[0058] In the formula, ν i =[u i ,v i ,r i ] T , is a rotation matrix that satisfies:
[0059] S223, design ESO as follows:
[0060]
[0061]
[0062] In the formula, σ i is a constant greater than 0, represents the observer state, and Represent the quantized state variables and Q(ν i )=[Q(u i ),Q(v i ),Q(r i )] T Observed value of Represents the uncertainty term of the system The observed value of Represents a rotation matrix based on state quantization and satisfies:
[0063]
[0064] S224. Definition And satisfy:
[0065]
[0066]
[0067]
[0068]
[0069] S225, due to This means there is a constant greater than 0 and Make
[0070] S226. Define the dynamic error of ESO as follows:
[0071]
[0072] In the formula,
[0073] S227、For the designed ESO, there exists a positive definite matrix Satisfy the given conditions so that the ESO error subsystem is input to the state stable, let in right Taking the derivative, we get:
[0074]
[0075] In the formula, And there is
[0076] S228, according to There is a constant greater than 0 satisfy In order to analyze the stability of the ESO error system, the following two inequalities are given:
[0077]
[0078] In the formula, ∈ i >0, is the yaw angular velocity r i The upper bound of
[0079] S229. Design the Lyapunov function as follows:
[0080]
[0081] In the formula, Is a positive definite matrix, and the designed Lyapunov function is derived as follows:
[0082]
[0083] S2210, when satisfied Then we get Where 0<o i <1, and satisfies:
[0084]
[0085] In the formula, and Respectively represent matrices The maximum and minimum eigenvalues of ;
[0086] S2211, due to Then we get:
[0087]
[0088] Therefore, the error subsystem of the ESO is input-to-state stable;
[0089] Furthermore, step S3 specifically includes:
[0090] S31. In the kinematic subsystem, design the guidance law to achieve tracking of the ideal trajectory of the distributed formation of unmanned ships;
[0091] S32. In the dynamic subsystem, a linear analytical model is used to describe the input quantization process, and the system control law and adaptive law are designed based on the sliding mode control strategy.
[0092] Furthermore, step S31 specifically includes:
[0093] S311. Define the distributed formation tracking error as follows:
[0094]
[0095] In the formula, represents the estimated value of the actual position of the USVs in the formation, represents an estimate of the actual position of the virtual leader; represents a rotation matrix and satisfies
[0096] S312, deriving the distributed formation tracking error defined in step S311, and obtaining:
[0097]
[0098] In the formula,
[0099] S313. In order to eliminate the influence of under-actuation on the USV formation control system, the error is transformed as follows:
[0100]
[0101] In the formula, is a constant greater than 0, and combined with step S312, we obtain:
[0102]
[0103] In the formula,
[0104] S314. From step S2, it can be seen that the designed distributed event-triggered ESO and ESO are both stable, and the observation error can converge to a smaller residual set. Therefore, there must be a small constant ζ u and r satisfy Then we get:
[0105]
[0106] S315. Design the kinematic guidance law of ESO as follows:
[0107]
[0108] In the formula, And i is a constant greater than 0,
[0109] and are all constants greater than 0, and the kinematic error is expressed as
[0110] Further, step S32 specifically includes:
[0111] S321. Trigger the ESO system according to the designed distributed event, and obtain:
[0112]
[0113] Since the designed ESO is stable, the observation error of ESO can converge to a smaller residual set. Therefore, let and and are all bounded, then the above formula is simplified as follows:
[0114]
[0115] S322, let Q(τ iu )=q 1iu (t)τ iu +q 2iu (t), Q(τ ir )=q1ir (t)τ ir +q 2ir (t), and let:
[0116]
[0117] In the formula, q 1iu (t) and q 1ir (t) is an unknown parameter. Since the sign remains unchanged during the entire quantization process, it can be seen from the above formula that q 1iu (t)>0,q 1ir (t)>0; In addition, if and Considering Q(τ iu (t)) and Q(τ ir (t)) is bounded, then q 2iu (t) and q 2ir (t) is also bounded and satisfies
[0118] S323. Set the control target of the dynamics subsystem as follows:
[0119]
[0120] Wherein, Ξ1, Ξ2 are small positive integers;
[0121] S324. Define the integral sliding film surface as follows:
[0122]
[0123] Where b iu >0 and b ir > 0, taking the derivative of the defined integral sliding film surface, we get:
[0124]
[0125]
[0126]
[0127]
[0128] In the formula, l iu ,δ iu ,l ir ,δ ir is a constant greater than 0, δ iu ≥ψ+δ ud ,δ ir ≥ψ+δ rd And δ ud >0,δ rd>0;
[0129] S325, Definition
[0130]
[0131]
[0132] S326. Define time-varying gain κ iu =1 / q 1iu (t) min and κ ir =1 / q 1ir (t) min , where q 1iu (t) min and q 1ir (t) min They are
[0133] q 1iu (t) and q 1ir The lower bound of (t) is obtained, and the USV distributed formation tracking control law is designed as follows:
[0134]
[0135]
[0136] In the formula, γ1,γ2,c iu ,c ir ,λ iu and λ ir is a constant greater than 0;
[0137] S327, based on s iu ,s ir , Design the kinematic and dynamic error systems as follows:
[0138]
[0139] Further, step S4 specifically includes:
[0140] S41. Define the Lyapunov function as follows:
[0141]
[0142] Derivative the defined Lyapunov function, we get:
[0143]
[0144] S42, combining step S325 and step S41, obtain:
[0145]
[0146] S43. Combining the designed control law and adaptive law, we get:
[0147]
[0148] In the formula, is a constant greater than 0 and
[0149] S44. Due to Then there is make Then we get:
[0150]
[0151] S45, taking into account q 1iu ≥q 1iumin =1 / κ iu >0 and q 1ir ≥q 1irmin =1 / κ ir >0, then:
[0152]
[0153]
[0154] S46. Due to Then we have:
[0155]
[0156]
[0157] S47, Order Then we get:
[0158]
[0159] S48, combining the designed ESO kinematic guidance law and step S47, obtain:
[0160]
[0161] S49. Definitions u =[s 1u ,s 2u ,...,s Nu ] T ,s r =[s 1r ,s 2r ,...,s Nr ]T ,
[0162] Then we have:
[0163]
[0164]
[0165]
[0166] Where, 0<υ<1, therefore, the designed error subsystem with input and state quantization is input-to-state stable and satisfies:
[0167]
[0168] In the formula, And P c =diag{1,1 / 2γ1κ 1u ,...,1 / 2γ1κ Nu ,1 / 2γ2κ 1r ,...,1 / 2γ2κ Nr};
[0169] S410, due to s iu ,s ir is bounded, so is bounded. According to the designed ESO kinematic guidance law, the kinematic guidance signal u ic and r ic are all bounded, so it can be proved that u i and r i is bounded; from step S21 and step S22, it can be seen that both the distributed ESO and the ESO are stable when input to the state; according to the cascade system stability theory, combined with step S2211 and step S48, it is proved that ||W(t)|| is bounded and satisfies:
[0170]
[0171] Compared with the prior art, the present invention has the following advantages:
[0172] 1. The present invention provides a tracking control method for a distributed formation of under-actuated unmanned ships with input and state quantization, which quantizes the control input and state variables in the control system, solves the problem of collaborative tracking control of a distributed formation of unmanned ships under the condition of limited maritime communication bandwidth, reduces the execution frequency of the actuator while ensuring effective tracking, alleviates the burden of maritime communication signal transmission, and is more in line with navigation engineering practice.
[0173] 2. The present invention provides a distributed formation tracking control method for underactuated unmanned ships with input and state quantization, which introduces a distributed extended state observer to solve the influence of uncertainties in the quantized state variables and system models on the control system.
[0174] 3. The present invention provides a distributed formation tracking control method for underactuated unmanned ships with input and state quantization, which adopts a linear analysis model to describe the input quantization process, that is, the designed adaptive quantization tracking controller does not require prior information of quantization parameters.
[0175] 4. Based on the Matlab platform, the present invention conducted a comparative experiment of the unmanned ship formation control system before and after quantization. At the same time, an adaptive quantized tracking controller was designed to track the trajectory of the unmanned ship formation. After considering the input and state quantization, the execution frequency of the actuator was reduced, the control amplitude was reduced, and the system control input curve was more in line with the practice of navigation engineering. This further verified the effectiveness and rationality of the distributed formation tracking control method of underactuated unmanned ships with input and state quantization proposed by the present invention.
[0176] Based on the above reasons, the present invention can be widely promoted in fields such as artificial intelligence. BRIEF DESCRIPTION OF THE DRAWINGS
[0177] 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.
[0178] Figure 1 The figure is a flow chart of the method of the present invention.
[0179] Figure 2 This is a diagram of the distributed formation tracking control results of unmanned ships provided in an embodiment of the present invention.
[0180] Figure 3 This is a lateral speed tracking diagram of five unmanned ships provided in an embodiment of the present invention.
[0181] Figure 4 This is a tracking diagram of the bow angular velocity of five unmanned ships provided in an embodiment of the present invention.
[0182] Figure 5 This is a diagram of the lateral tracking errors of five unmanned ships provided in an embodiment of the present invention.
[0183] Figure 6 This is a longitudinal tracking error diagram of five unmanned ships provided in an embodiment of the present invention.
[0184] Figure 7 This is a control input diagram of five unmanned ships in different communication environments provided by an embodiment of the present invention.
[0185] Figure 8 This is a control input diagram of five unmanned ships in different communication environments provided by an embodiment of the present invention. DETAILED DESCRIPTION
[0186] It should be noted that, in the absence of conflict, the embodiments of the present invention and the features in the embodiments can 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.
[0187] 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.
[0188] It should be noted that the terms used herein are only for describing specific embodiments and are not intended to limit exemplary embodiments according to the present invention. As used herein, unless the context clearly indicates otherwise, the singular form is also intended to include the plural form. In addition, it should be understood that when the terms "comprising" and / or "including" are used in this specification, it indicates the presence of features, steps, operations, devices, components and / or combinations thereof.
[0189] Unless otherwise specifically stated, the relative arrangement of the parts and steps described in these embodiments, the numerical expressions and numerical values do not limit the scope of the present invention. At the same time, it should be clear that, for ease of description, the sizes of the various parts shown in the drawings are not drawn according to the actual proportional relationship. The technology, methods and equipment known to ordinary technicians in the relevant field may not be discussed in detail, but in appropriate cases, the technology, methods and equipment should be regarded as part of the authorization specification. In all examples shown and discussed here, any specific value should be interpreted as merely exemplary, rather than as a limitation. Therefore, other examples of exemplary embodiments may have different values. It should be noted that similar numbers and letters represent similar items in the following drawings, so once an item is defined in one drawing, it does not need to be further discussed in subsequent drawings.
[0190] In the description of the present invention, it is necessary to understand that the directions or positional relationships indicated by directional words such as "front, back, up, down, left, right", "lateral, vertical, perpendicular, horizontal" and "top, bottom" are usually based on the directions or positional relationships shown in the drawings. They are only for the convenience of describing the present invention and simplifying the description. Unless otherwise specified, these directional words do not indicate or imply that the device or element referred to must have a specific direction or be constructed and operated in a specific direction. Therefore, they cannot be understood as limiting the scope of protection of the present invention: the directional words "inside and outside" refer to the inside and outside relative to the contours of each component itself.
[0191] For ease of description, spatially relative terms such as "above", "above", "on the upper surface of", "above", etc. may be used here to describe the spatial positional relationship between a device or feature and other devices or features as shown in the figure. It should be understood that spatially relative terms are intended to include different orientations of the device in use or operation in addition to the orientation described in the figure. For example, if the device in the accompanying drawings is inverted, the device described as "above other devices or structures" or "above other devices or structures" will be positioned as "below other devices or structures" or "below their position devices or structures". Thus, the exemplary term "above" can include both "above" and "below". The device can also be positioned in other different ways (rotated 90 degrees or in other orientations), and the spatially relative descriptions used here are interpreted accordingly.
[0192] In addition, it should be noted that the use of terms such as "first" and "second" to limit components is only for the convenience of distinguishing the corresponding components. If not otherwise stated, the above terms have no special meaning and therefore cannot be understood as limiting the scope of protection of the present invention.
[0193] like Figure 1 As shown, the present invention provides a distributed formation tracking control method for underactuated unmanned ships with input and state quantization, comprising:
[0194] S1. Obtain the sea condition information of the surrounding environment and other ships around, establish the trajectory control mathematical model of the distributed formation of underactuated unmanned ships, and use a uniform quantizer to quantize the control input and state variables in the control system;
[0195] S2. Design a distributed ESO to observe the position information of the virtual leader and use the ESO technology to estimate the quantitative state information of each USV and the uncertainties in the model;
[0196] S3. A hierarchical design method is used to solve the under-actuation problem of USV, and the kinematic guidance law and dynamic quantized tracking control law are designed. In addition, a linear model is introduced to describe the input quantization process, so that the designed controller no longer requires prior information on the quantization parameters.
[0197] S4. Using the input-to-state stability theory, the stability of the USV distributed formation tracking control system with input and state quantization is proved.
[0198] In specific implementation, as a preferred embodiment of the present invention, step S1 specifically includes:
[0199] S11. Given an underactuated USV formation, construct the kinematic model of the motion of the i-th unmanned ship in the USV formation system as follows:
[0200]
[0201] In the formula, x i ,y i Indicates the coordinates of the ship's center of mass described in the geodetic coordinate system; Indicates the ship's heading angle; u i 、v i and r i They represent the surge speed, sway speed and rotational speed (ROT) of the ship respectively;
[0202] S12. Construct a nonlinear dynamic mathematical model of the underactuated unmanned ship as follows:
[0203]
[0204] In the formula, Respectively represent the mass of USV; Represent the hydrodynamic derivative terms respectively; I z represents the moment of inertia around the z-axis; function f iu (·),f iv (·),f ir (·) represent the fluid dynamic damping and centripetal force nonlinear uncertainties respectively; τ iuw ,τ ivw ,τ irw represent the disturbances caused by unknown ocean factors; Q(τ iu ) and Q(τ ir ) represent the system control input τ iu and τ ir The quantitative value of
[0205] S13, using a uniform quantizer to quantize the state variables and control inputs in the system, the specific quantization process is as follows:
[0206]
[0207] In the formula, ι = x i ,y i , u i ,v i ,r i and μ>0 indicates the quantization step size, H1=μ and H i+1 =H i +μ; therefore, the quantization error of the uniform quantizer is bounded and is expressed as:
[0208] S14, define the ideal parameter trajectory as Among them, P0(t) represents the ideal parameter trajectory that is continuously differentiable; the ideal parameter trajectory P0(t) is differentiable, and its first-order derivative and second-order derivative are bounded; this indicates that the ideal parameter trajectory is smooth and stable over time. That is, there is a constant P m satisfy
[0209] S15. Use a graph of Ξ={Γ,Θ} to represent the relationship between N USVs and the virtual leader; where Θ=(i,j)∈Γ×Γ represents the set of edges, Γ=n0,n1,...,n N represents a set of points; in this case, n i ,n j represents the communication flow from node j to node i. The adjacency matrix can be expressed as Specifically, if there is an edge (n j ,n i )∈Θ, then a ij =1; otherwise, a ij = 0. Define the leader's adjacency matrix as Υ0 = diag{a i0}, and described as follows:
[0210] Ω=Ψ+Υ0
[0211] Where Ψ=Λ-Υ represents the Laplace matrix, Λ=diag{Λ i} represents the in-degree matrix,
[0212] S16. The control objective is to enable each USV in the ship formation system to track the ideal trajectory of the upper time-varying under the condition of communication bandwidth constraints, that is:
[0213]
[0214] Where P i (t) = [x i ,yi ] T Indicates the actual position of each USV in the formation; P 0id (t) represents the position deviation of each USV relative to the virtual leader parameter trajectory; ∈ d Represents a constant greater than zero.
[0215] In specific implementation, as a preferred embodiment of the present invention, step S2 specifically includes:
[0216] S21, introduce event-triggered ESO system to observe the location information of virtual leaders;
[0217] S22. ESO is introduced to estimate the state variables quantified by USV and the uncertainties in the system model.
[0218] In specific implementation, as a preferred embodiment of the present invention, step S21 specifically includes:
[0219] S211. In the inertial coordinate system, define and are the observation values of the position and heading angle of the virtual leader by the i-th USV, and The distributed ESO is designed based on the observed values of the speed and the turning angular velocity of the virtual leader by the i-th USV as follows:
[0220]
[0221] In the formula, β d represents the distributed ESO gain; ρ1, ρ2, ρ3, ρ4, ρ5, ρ6 are constants greater than 0; the state vector represents the state estimate of the i-th reference USV;
[0222] S212. Definition Then we have:
[0223]
[0224] S213, assuming that G = [G1, G2, ..., G N ] T =F -1 I N , C = diag{1 / G i}(i=1,2,...,N) and T=CF+F T C, then C and T are both positive definite matrices; define Then we have:
[0225]
[0226] Where A=diag{A1,A2,...,A N}, B = diag{B1, B2, ..., B N}, D = diag{D1, D2, ..., D N}, K=diag{K1,K2,...,K N}, and D N =[1,0,0,0,0,0], B N =[ρ1,ρ4,ρ2,ρ5,ρ3,ρ6] T ,
[0227] S214. Given two positive definite matrices X and Y, and satisfying A T X+XA-XD T DX+Y≤0; introduce the designed distributed event trigger ESO, let B=XD T ,β d >1 / (min i=1,...,N {Y i T i}), then Indicates that the input is stable;
[0228] S215. Define the Lyapunov function as:
[0229]
[0230] And take the derivative of the defined Lyapunov function, we get:
[0231]
[0232] S216, using state transition: and The derived Lyapunov function is rewritten as follows:
[0233]
[0234] S217, Order Then we have:
[0235]
[0236] In the formula, 0<o d <1;
[0237] S218. According to the above steps, the designed distributed event-triggered ESO system is stable in input state and satisfies:
[0238]
[0239] In the formula, express Function and:
[0240]
[0241] In specific implementation, as a preferred embodiment of the present invention, step S22 specifically includes:
[0242] S221. After passing through the quantizer, the quantized variables in the control system will produce quantization errors, which is equivalent to losing some control information, which will lead to the degradation of control system performance. In order to solve the impact of quantization errors on the stability of the distributed formation tracking control system and ensure that the USVs in the formation can quickly and effectively track the desired trajectory, ESO is introduced to observe the quantized state variables in the USVs;
[0243] S222: According to step S11 and step S12, the mathematical model of the i-th USV is rewritten as:
[0244]
[0245] In the formula, ν i =[u i ,v i ,r i ]T, is a rotation matrix that satisfies:
[0246]
[0247] S223, design ESO as follows:
[0248]
[0249] In the formula, σ i is a constant greater than 0, and represents the observer state, and Represent the quantized state variables and Q(ν i )=[Q(u i ),Q(v i ),Q(r i )] T Observed value of Represents the uncertainty term of the system The observed value of Represents a rotation matrix based on state quantization and satisfies:
[0250]
[0251] S224. Definition
[0252] And satisfy:
[0253]
[0254]
[0255]
[0256]
[0257] S225, due to This means there is a constant greater than 0 and Make
[0258] S226. Define the dynamic error of ESO as follows:
[0259]
[0260] In the formula,
[0261] S227、For the designed ESO, there exists a positive definite matrix Satisfy the given conditions so that the ESO error subsystem is input to the state stable, let in right Taking the derivative, we get:
[0262]
[0263] In the formula, And there is
[0264] S228, according to There is a constant greater than 0 satisfy In order to analyze the stability of the ESO error system, the following two inequalities are given:
[0265]
[0266] In the formula, ∈ i >0, is the yaw angular velocity r i The upper bound of
[0267] S229. Design the Lyapunov function as follows:
[0268]
[0269] In the formula, Is a positive definite matrix, and the designed Lyapunov function is derived as follows:
[0270]
[0271] S2210, when satisfied Then we get Where 0<o i <1, and satisfies:
[0272]
[0273] In the formula, Respectively represent matrices The maximum and minimum eigenvalues of ;
[0274] S2211, due to Then we get:
[0275]
[0276] Therefore, the error subsystem of the ESO is input-state stable.
[0277] In this embodiment, the introduction of ESO in the control system has two main purposes. First, it helps to obtain the state information of the USV in a quantitative environment and estimate the inherent uncertainties in the ship model. In addition, ESO also plays a role in filtering and smoothing the quantization curve, ensuring that the quantized state variables can be used as continuous differentiable variables, enhancing its applicability and feasibility in controller design.
[0278] In specific implementation, as a preferred embodiment of the present invention, step S3 specifically includes:
[0279] S31. In the kinematic subsystem, design the guidance law to achieve tracking of the ideal trajectory of the distributed formation of unmanned ships;
[0280] S32. In the dynamic subsystem, a linear analytical model is used to describe the input quantization process, and the system control law and adaptive law are designed based on the sliding mode control strategy.
[0281] In specific implementation, as a preferred embodiment of the present invention, step S31 specifically includes:
[0282] S311. Define the distributed formation tracking error as follows:
[0283]
[0284] In the formula, represents the estimated value of the actual position of the USVs in the formation, represents an estimate of the actual position of the virtual leader; represents a rotation matrix and satisfies
[0285] S312, deriving the distributed formation tracking error defined in step S311, and obtaining:
[0286]
[0287] In the formula,
[0288] S313. In order to eliminate the influence of under-actuation on the USV formation control system, the error is transformed as follows:
[0289]
[0290] In the formula, is a constant greater than 0, and combined with step S312, we obtain:
[0291]
[0292] In the formula,
[0293] S314. From step S2, it can be seen that the designed distributed event-triggered ESO and ESO are both stable, and the observation error can converge to a smaller residual set. Therefore, there must be a small constant ζ u and r satisfy Then we get:
[0294]
[0295] S315. Design the kinematic guidance law of ESO as follows:
[0296]
[0297] In the formula, And i is a constant greater than 0, and are all constants greater than 0, and the kinematic error is expressed as
[0298] In specific implementation, as a preferred embodiment of the present invention, step S32 specifically includes:
[0299] S321. Trigger the ESO system according to the designed distributed event, and obtain:
[0300]
[0301] Since the designed ESO is stable, the observation error of ESO can converge to a smaller residual set. Therefore, let and and are all bounded, then the above formula is simplified as follows:
[0302]
[0303] S322, let Q(τ iu )=q 1iu (t)τ iu +q 2iu (t), Q(τ ir )=q 1ir (t)τ ir +q 2ir (t), and let:
[0304]
[0305] In the formula, q 1iu (t) and q 1ir (t) is an unknown parameter. Since the sign remains unchanged during the entire quantization process, it can be seen from the above formula that q 1iu (t)>0,q 1ir (t)>0; In addition, if and Considering Q(τ iu (t)) and Q(τ ir (t)) is bounded, then q 2iu (t) and q 2ir (t) is also bounded and satisfies
[0306] S323. Set the control target of the dynamics subsystem as follows:
[0307]
[0308] Wherein, Ξ1, Ξ2 are small positive integers;
[0309] S324. Define the integral sliding film surface as follows:
[0310]
[0311] Where b iu >0 and b ir > 0, taking the derivative of the defined integral sliding film surface, we get:
[0312]
[0313]
[0314]
[0315]
[0316] In the formula, l iu ,δ iu ,l ir ,δ ir is a constant greater than 0, δ iu ≥ψ+δ ud ,δ ir ≥ψ+δ rd And δ ud >0,δ rd >0;
[0317] S325, Definition Then we have:
[0318]
[0319]
[0320] S326, due to q 1iu (t) and q 1ir (t) is unknown and time-varying, so an adaptive method is used to estimate its boundary. In order to prevent the singular problem that may occur when the estimated value tends to zero, q 1iu (t) and q 1ir The lower bound of (t) is estimated. Define the time-varying gain κ iu =1 / q 1iu (t) min and κ ir =1 / q 1ir (t) min , where q 1iu (t) min and q 1ir (t) min They are q 1iu (t) and q 1ir The lower bound of (t) is obtained, and the USV distributed formation tracking control law is designed as follows:
[0321]
[0322]
[0323] In the formula, γ1,γ2,c iu ,c ir ,λ iu and λir is a constant greater than 0;
[0324] S327, based on s iu ,s ir , Design the kinematic and dynamic error systems as follows:
[0325]
[0326] In specific implementation, as a preferred embodiment of the present invention, step S4 specifically includes:
[0327] S41. Define the Lyapunov function as follows:
[0328]
[0329] Derivative the defined Lyapunov function, we get:
[0330]
[0331] S42, combining step S325 and step S41, obtain:
[0332]
[0333] S43. Combining the designed control law and adaptive law, we get:
[0334]
[0335] In the formula, is a constant greater than 0 and
[0336] S44. Due to Then there is make Then we get:
[0337]
[0338] S45, taking into account q 1iu ≥q 1iumin =1 / κ iu >0 and q 1ir ≥q 1irmin =1 / κ ir >0, then:
[0339]
[0340]
[0341] S46. Due to Then we have:
[0342]
[0343]
[0344] S47, Order Then we get:
[0345]
[0346] S48, combining the designed ESO kinematic guidance law and step S47, obtain:
[0347]
[0348] S49. Definitions u =[s 1u ,s 2u ,...,s Nu ] T ,s r =[s 1r ,s 2r ,...,s Nr ] T ,
[0349] Then we have:
[0350]
[0351]
[0352]
[0353] Where, 0<υ<1, therefore, the designed error subsystem with input and state quantization is input-to-state stable and satisfies:
[0354]
[0355] In the formula, And P c =diag{1,1 / 2γ1κ 1u ,...,1 / 2γ1κ Nu ,1 / 2γ2κ 1r ,...,1 / 2γ2κ Nr};
[0356] S410, due to s iu ,s ir is bounded, so is bounded. According to the designed ESO kinematic guidance law, the kinematic guidance signal u ic and r ic are all bounded, so it can be proved that u i and r i is bounded; from step S21 and step S22, it can be seen that both the distributed ESO and the ESO are stable when input to the state; according to the cascade system stability theory, combined with step S2211 and step S48, it is proved that ||W(t)|| is bounded and satisfies:
[0357]
[0358] In this embodiment, a USV distributed formation tracking control system with input and state quantization is considered, combined with the designed distributed ESO, ESO, kinematic guidance rate, dynamic control rate and adaptive law, with state s iu ,s ir , and input Ω iu ,Ω ir The distributed formation tracking control system is input-state stable, the tracking error can converge to a smaller residual set, and all signals in the designed control system are consistently and ultimately bounded.
[0359] Example
[0360] In order to verify the effectiveness of the distributed formation tracking control method and system of underactuated unmanned ships with input and state quantization proposed in the present invention, this embodiment uses MATLAB / Simulink for computer simulation research. The parameters are set as follows:
[0361] The simulation object is the "Lanxin" unmanned surface ship of Dalian Maritime University. The parameters of the unmanned ship are: length 7.02m, width 2.6m, speed 35kn, full load draft 0.32m, full load displacement 2.73m3, and square coefficient 0.6976. Other model parameters are selected as follows: m u =25.8kg, m v =33.8kg, m r =2.76kg·m 2 , f v (·)=-36.5|v|v-0.8896v-0.805v|r|-m u u i r, f r (·)=-0.75|r|r-1.90r+0.08|v|r+(m u -m v ) i v-1.0948ui r.
[0362] The time-varying parameter trajectory of the virtual leader is designed as P0(t)=[0.8t,2sin(0.1t)] T The initial state of the five USVs in the formation is designed to be P1 = [0,0] T , P2=[-7,7] T , P3=[7,-7] T , P4=[-14,14] T and P5 = [14, -14] T The ideal initial position of the formation is designed as P 1d =[0,0] T ,P 2d =[-7,7] T ,P 3d =[7,-7] T , P 4d =[-14,14] T and P 5d =[14,-14] T The controller design parameters are b iu =b ir =10, δ iu =δ ir =2, c iu =c ir =0.02,λ iu =λ ir =0.15, γ1=γ2=3. The design parameters of distributed ESO are selected as β d =1, ρ1=ρ2=ρ3=10, ρ4=ρ5=ρ6=25, The design parameter of ESO is selected as σ=0.01, and the quantization parameter of uniform quantizer is selected as δ=0.1.
[0363] Figure 2-Figure 8 Simulation results of the designed USV distributed formation tracking control strategy. Figure 2 The tracking results of the time-varying ideal trajectory by five underactuated USVs are shown in Figure 2. It can be seen that all USVs can track the ideal trajectory from the starting position in a short time. At the same time, after considering the input and state quantization, the designed USV distributed formation tracking controller can still show good control performance. Figure 3 and Figure 4 The following are the tracking results of lateral velocity and angular velocity of 5 USVs. It can be seen that the USV can synchronize the velocity in a short time, and the velocity tracking error is convergent. Figure 5 and Figure 6The lateral and longitudinal tracking errors of the five USVs are given respectively. It can be seen from the figure that although considering the input and state quantization in the control system will lead to the loss of some control information, the control quality is not significantly sacrificed, and the lateral and longitudinal tracking errors of the five USVs can converge to a small neighborhood near 0. Figure 7 and Figure 8 The unquantized and quantized USV control inputs are represented. It can be seen that after considering the input and state quantization, the number of controller executions is significantly reduced, which is more in line with the marine environment with limited communication bandwidth. The simulation results show that the simulation results of the tracking control strategy designed by the present invention are relatively ideal, the controller can well realize the USV distributed formation trajectory tracking, and the tracking error can quickly converge to a smaller residual set. After considering the input and state quantization, the execution frequency of the actuator is reduced, the control amplitude is reduced, and the system control input curve is more in line with the practice of navigation engineering. It further verifies the effectiveness and rationality of the distributed formation tracking control method of under-actuated unmanned ships with input and state quantization proposed in the present invention.
[0364] 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 distributed formation tracking control method for underactuated unmanned ships with input and state quantization, characterized in that: include: S1. Obtain the sea condition information of the surrounding environment and other ships, establish the trajectory control mathematical model of the distributed formation of underactuated unmanned ships, and use a uniform quantizer to quantize the control input and state variables in the control system; S2. Design a distributed ESO to observe the position information of the virtual leader and use the ESO technology to estimate the quantitative state information of each USV and the uncertainties in the model; S3. Use the hierarchical design method to design the kinematic guidance law and dynamic quantitative tracking control law; S4. Using the input-to-state stability theory, the stability of the USV distributed formation tracking control system with input and state quantization is proved.
2. A distributed formation tracking control method for underactuated unmanned ships with input and state quantization according to claim 1, characterized in that: Step S1 specifically includes: S11. Given an underactuated USV formation, construct the kinematic model of the motion of the i-th unmanned ship in the USV formation system as follows: In the formula, x i ,y i Indicates the coordinates of the ship's center of mass described in the geodetic coordinate system; Indicates the ship's heading angle; u i 、v i and r i They represent the surge speed, sway speed and rotation speed of the ship respectively; S12. Construct a nonlinear dynamic mathematical model of the underactuated unmanned ship as follows: In the formula, Respectively represent the mass of USV; Represent the hydrodynamic derivative terms respectively; I z Represents the moment of inertia around the z-axis; function f iu (·),f iv (·),f ir (·) represent the fluid dynamic damping and centripetal force nonlinear uncertainties respectively; τ iuw ,τ ivw ,τ irw represent the disturbances caused by unknown ocean factors; Q(τ iu ) and Q(τ ir ) represent the system control input τ iu and τ ir The quantitative value of S13, using a uniform quantizer to quantize the state variables and control inputs in the system, the specific quantization process is as follows: In the formula, ι = x i ,y i , u i ,v i ,r i and μ>0 indicates the quantization step size, H1=μ and H i+1 =H i +μ; therefore, the quantization error of the uniform quantizer is bounded and is expressed as: S14, define the ideal parameter trajectory as Where P0(t) represents the continuous and differentiable ideal parameter trajectory; S15. Use a graph of Ξ={Γ,Θ} to represent the relationship between N USVs and the virtual leader; where Θ=(i,j)∈Γ×Γ represents the set of edges, Γ=n0,n1,...,n N Represents a set of points; the adjacency matrix of the leader is defined as Υ0=diag{a i0 }, and described as follows: Ω=Ψ+Υ0 Where Ψ=Λ-Υ represents the Laplace matrix, Λ=diag{Λ i } represents the in-degree matrix, S16. Set the control target to enable each USV in the ship formation system to track the ideal trajectory of the time-varying under the condition of communication bandwidth constraints, that is: Where P i (t) = [x i ,y i ] T Indicates the actual position of each USV in the formation; P 0id (t) represents the position deviation of each USV relative to the virtual leader parameter trajectory; ∈ d Represents a constant greater than zero.
3. The distributed formation tracking control method of underactuated unmanned ships with input and state quantization according to claim 1 is characterized in that: Step S2 specifically includes: S21, introduce event-triggered ESO system to observe the location information of virtual leaders; S22. ESO is introduced to estimate the state variables quantified by USV and the uncertainties in the system model.
4. The distributed formation tracking control method of underactuated unmanned ships with input and state quantization according to claim 3 is characterized in that: Step S21 specifically includes: S211. In the inertial coordinate system, define and are the observation values of the virtual leader’s position and heading angle by the i-th USV, and The distributed ESO is designed based on the observed values of the speed and the turning angular velocity of the virtual leader by the i-th USV as follows: In the formula, β d represents the distributed ESO gain; ρ1, ρ2, ρ3, ρ4, ρ5, ρ6 are constants greater than 0; the state vector represents the state estimate of the i-th reference USV; S212. Definition Then we have: S213, assuming that G = [G1, G2, ..., G N ] T =F -1 I N , C = diag{1 / G i }(i=1,2,...,N) and T=CF+F T C, then C and T are both positive definite matrices; define Then we have: If,A,diag{A1,A2,...,A N },B,diag{B1,B2,...,B N },D,diag{D1,D2,...,D N },K6diag{K1,K2,...,K N },oneD N [1,0,0,0,0,0 S214. Given two positive definite matrices X and Y, and satisfying A T X+XA-XD T DX+Y≤0; introduce the designed distributed event trigger ESO, let B=XD T ,β d >1 / (min i=1,...,N {Y i T i }), then Indicates that the input is stable; S215. Define the Lyapunov function as: And take the derivative of the defined Lyapunov function, we get: S216, using state transition: and The derived Lyapunov function is rewritten as follows: S217, Order Then we have: In the formula, 0<o d <1; S218. According to the above steps, the designed distributed event-triggered ESO system is stable in input state and satisfies: In the formula, express Function and:
5. The distributed formation tracking control method of underactuated unmanned ships with input and state quantization according to claim 3 is characterized in that: Step S22 specifically includes: S221. In order to solve the influence of quantization error on the stability of distributed formation tracking control system and ensure that USVs in the formation can quickly and effectively track the desired trajectory, ESO is introduced to observe the quantized state variables in USVs. S222. According to step S11 and step S12, the mathematical model of the i-th USV is rewritten as: In the formula, ν i =[u i ,v i ,r i ] T , is a rotation matrix that satisfies: S223, design ESO as follows: In the formula, σ i is a constant greater than 0, and represents the observer state, and Represent the quantized state variables and Q(ν i )=[Q(u i ),Q(v i ),Q(r i )] T Observed value of Represents the uncertainty term of the system The observed value of Represents a rotation matrix based on state quantization and satisfies: S224. Definition And satisfy: S225, due to This means there is a constant greater than 0 and Make S226. Define the dynamic error of ESO as follows: In the formula, S227、For the designed ESO, there exists a positive definite matrix Satisfy the given conditions so that the ESO error subsystem is input to the state stable, let in right Taking the derivative, we get: In the formula, And there is S228, according to There is a constant greater than 0 satisfy In order to analyze the stability of the ESO error system, the following two inequalities are given: In the formula, ∈ i >0, is the yaw angular velocity r i The upper bound of S229. Design the Lyapunov function as follows: In the formula, Is a positive definite matrix, and the designed Lyapunov function is derived as follows: S2210, when satisfied Then we get Where 0<o i <1, and satisfies: In the formula, and Respectively represent matrices The maximum and minimum eigenvalues of ; S2211, due to Then we get: Therefore, the error subsystem of the ESO is input-state stable.
6. The distributed formation tracking control method of underactuated unmanned ships with input and state quantization according to claim 1, characterized in that: Step S3 specifically includes: S31. In the kinematic subsystem, design the guidance law to achieve tracking of the ideal trajectory of the distributed formation of unmanned ships; S32. In the dynamic subsystem, a linear analytical model is used to describe the input quantization process, and the system control law and adaptive law are designed based on the sliding mode control strategy.
7. The distributed formation tracking control method of underactuated unmanned ships with input and state quantization according to claim 6 is characterized in that: Step S31 specifically includes: S311. Define the distributed formation tracking error as follows: In the formula, represents the estimated value of the actual position of the USVs in the formation, represents an estimate of the actual position of the virtual leader; represents a rotation matrix and satisfies S312, deriving the distributed formation tracking error defined in step S311, and obtaining: In the formula, S313. In order to eliminate the influence of under-actuation on the USV formation control system, the error is transformed as follows: In the formula, is a constant greater than 0, and combined with step S312, we obtain: In the formula, S314. From step S2, it can be seen that the designed distributed event-triggered ESO and ESO are both stable, and the observation error can converge to a smaller residual set. Therefore, there must be a small constant ζ u and r satisfy Then we get: S315. Design the kinematic guidance law of ESO as follows: In the formula, And i is a constant greater than 0, And are all constants greater than 0, and the kinematic error is expressed as 8. The distributed formation tracking control method of underactuated unmanned ships with input and state quantization according to claim 6, characterized in that: Step S32 specifically includes: S321. According to the designed ESO, we get: Since the designed ESO is stable, the observation error of ESO can converge to a smaller residual set. Therefore, let and and are all bounded, then the above formula is simplified as follows: S322. Let Q(τ iu ) = q 1iu (t)τ iu + q 2iu (t), Q(τ ir ) = q 1ir (t)τ ir + q 2ir (t), and let: In the formula, q 1iu (t) and q 1ir (t) is an unknown parameter. Since the sign remains unchanged during the entire quantization process, it can be seen from the above formula that q 1iu (t)>0,q 1ir (t)>0; In addition, if and Considering Q(τ iu (t)) and Q(τ ir (t)) is bounded, then q 2iu (t) and q 2ir (t) is also bounded and satisfies S323. Set the control target of the dynamics subsystem as follows: Wherein, Ξ1, Ξ2 are small positive integers; S324. Define the integral sliding film surface as follows: Where b iu >0 and b ir > 0, taking the derivative of the defined integral sliding film surface, we get: In the formula, l iu ,δ iu ,l ir ,δ ir is a constant greater than 0, δ iu ≥ψ+δ ud ,δ ir ≥ψ+δ rd And δ ud >0,δ rd >0; S325, Definition Then we have: S326. Define time-varying gain κ iu =1 / q 1iu (t) min and κ ir =1 / q 1ir (t) min , where q 1iu (t) min and q 1ir (t) min They are q 1iu (t) and q 1ir The lower bound of (t) is obtained, and the USV distributed formation tracking control law is designed as follows: In the formula, γ1,γ2,c iu ,c ir ,λ iu and λ ir is a constant greater than 0; S327, based on s iu ,s ir , Design the kinematic and dynamic error systems as follows:
9. The distributed formation tracking control method of underactuated unmanned ships with input and state quantization according to claim 1, characterized in that: Step S4 specifically includes: S41. Define the Lyapunov function as follows: Derivative the defined Lyapunov function, we get: S42, combining step S325 and step S41, obtain: S43. Combining the designed control law and adaptive law, we get: In the formula, is a constant greater than 0 and S44. Due to Then there is make Then we get: S45, taking into account q 1iu ≥q 1iumin =1 / κ iu >0 and q 1ir ≥q 1irmin =1 / κ ir >0, then: S46. Due to Then we have: S47, Order Then we get: S48, combining the designed ESO kinematic guidance law and step S47, obtain: S49. Definitions u =[s 1u ,s 2u ,...,s Nu ] T ,s r =[s 1r ,s 2r ,...,s Nr ] T , Then we have: Where, 0<υ<1, therefore, the designed error subsystem with input and state quantization is input-to-state stable and satisfies: In the formula, and P c = diag{1, 1 / 2γ1κ 1u ,..., 1 / 2γ1κ Nu , 1 / 2γ2κ 1r ,..., 1 / 2γ2κ Nr}; S410, due to s iu ,s ir is bounded, so is bounded. According to the designed ESO kinematic guidance law, the kinematic guidance signal u ic and r ic are all bounded, so it can be proved that u i and r i is bounded; from step S21 and step S22, it can be seen that both the distributed ESO and the ESO are stable when input to the state; according to the cascade system stability theory, combined with step S2211 and step S48, it is proved that ||W(t)|| is bounded and satisfies:
Citation Information
Patent Citations
Distributed multi-unmanned ship adaptive neural network formation control method considering input quantization
CN113835434A
USV path planning and fuzzy adaptive tracking control method with input quantization
CN115437251A
Unmanned ship track tracking control method with input / state quantification
CN117055566A
Under-actuated unmanned ship path tracking control method based on event triggering mechanism and input quantization
CN117193298A
Under-actuated unmanned ship trajectory tracking control method with event triggering mechanism and state / input quantization
CN117434843A
Cited By
Multi-unmanned ship formation hunting control method based on reinforcement learning
CN119440101A
A multi-unmanned ship formation capture control method based on reinforcement learning
CN119440101B
