CN114706298B - USV robust model-free track tracking controller design method based on preset performance - Google Patents

USV robust model-free track tracking controller design method based on preset performance Download PDF

Info

Publication number
CN114706298B
CN114706298B CN202111050109.2A CN202111050109A CN114706298B CN 114706298 B CN114706298 B CN 114706298B CN 202111050109 A CN202111050109 A CN 202111050109A CN 114706298 B CN114706298 B CN 114706298B
Authority
CN
China
Prior art keywords
error
model
dynamic
usv
kinematic
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202111050109.2A
Other languages
Chinese (zh)
Other versions
CN114706298A (en
Inventor
张磊
黄子玚
黄兵
张恩华
庄佳园
刘涛
沈海龙
苏玉民
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Harbin Engineering University
Original Assignee
Harbin Engineering University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Harbin Engineering University filed Critical Harbin Engineering University
Priority to CN202111050109.2A priority Critical patent/CN114706298B/en
Publication of CN114706298A publication Critical patent/CN114706298A/en
Application granted granted Critical
Publication of CN114706298B publication Critical patent/CN114706298B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • G05B13/042Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance

Landscapes

  • Engineering & Computer Science (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Evolutionary Computation (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Feedback Control In General (AREA)

Abstract

The invention discloses a design method of a USV robust model-free track tracking controller based on preset performance, and belongs to the field of automatic control of intelligent bodies. The method comprises the following steps: step one, establishing a kinematic and dynamic model of the unmanned surface vehicle; step two, defining kinematic and dynamic errors according to the kinematic and dynamic models of the unmanned surface vehicle and forming a tracking error dynamic model; step three, designing a conversion function; step four, selecting an error conversion formula; step five, based on the design of the step three and the step four, establishing an error matrix definition and an unconstrained dynamics system; and step six, designing a model-free controller. The invention can avoid the reduction of the required calculation load caused by the self-adaptive law calculation process in the existing research, ensures the transient and steady state behaviors of ideal tracking errors by adjusting the parameters of the preset performance matrix, and finally realizes the design of the USV track tracking controller.

Description

USV robust model-free track tracking controller design method based on preset performance
Technical Field
The invention relates to a design method of a USV robust model-free track tracking controller based on preset performance, and belongs to the field of automatic control of intelligent bodies.
Background
Over the past few decades, unmanned Surface Vessels (USV) have been attracting academic research interest due to their wide marine application prospects, such as inspection, surveillance, and marine research. For these application scenarios described above, although the mission scenario is set to a severe marine environment, it is generally desirable for the USV to perform satisfactory trajectory tracking control. Therefore, the problem of anti-interference track tracking control naturally becomes a research hot spot. To solve this problem, related researchers have used several advanced control design tools including Sliding Model Control (SMC), back-step control (BP) and model predictive control. Notably, model-dependent techniques account for a significant portion of the effort, and the requirements of accurate model parameters and complex control systems limit the practical application of these approaches.
To eliminate the dependency of the model parameters, approximator-based methods such as Neural Networks (NNs) and fuzzy control strategies are employed on the one hand. In particular, the combination of neural networks and fuzzy systems can improve the approximation accuracy of the system nonlinearity. With Minimum Learning Parameters (MLP), the computational burden of huge neural network weights can be reduced. Another similar control algorithm based on MLP neural networks has also been proposed to solve the problem of co-formation control. On the other hand, data-driven control schemes have also been a control method that affects profound. It is worth noting that continuous PID based controllers were successfully used for fully driven and underactuated marine unmanned aerial vehicles, respectively.
In addition to system uncertainty and ocean disturbances, preset control performance has recently attracted considerable research attention from the control community. While ensuring transient and steady state performance of the system output response is critical to safely completing offshore tasks. However, due to its engineering characteristics, it is difficult to theoretically build a formula for transient performance (i.e., convergence speed and overshoot) during the design of the relevant controller. In view of this challenge, bechlioulis and rovihake creatively visualize prescribed performance as tracking error constraints through prescribed performance functions, and then convert "constrained" systems to equivalent "unconstrained" systems through error conversion methods. Later, such control frames were widely used in various fields, such as spacecraft, drones and drones. A specified performance fault-tolerant control scheme is designed through a backstepping technology and an adaptive law of an area tracking task. Considering that input saturation may lead to serious degradation in control performance, researchers have introduced auxiliary dynamic systems into the study to address the impact of input amplitude and rate constraints. The stability of the member variables of the above scheme is theoretically guaranteed by applying infinite time. This means that the constraint state asymptotically converges to its equilibrium in an infinite time. With high real-time tasks, such convergence speeds may not be suitable. Therefore, a non-singular terminal sliding mode technique is employed to achieve limited time convergence with faster convergence speed. While the methods in the prior art all succeed in ensuring that a particular system signal evolves within a time-varying preselected region, prior confirmation of model parameters is required for deployment of these control schemes.
Based on the above discussion, a model-free parameter control algorithm meeting specified performance indicators is proposed to achieve the trajectory tracking task of the MSV.
Disclosure of Invention
The invention aims to provide a design method of a USV robust model-free track tracking controller based on preset performance, which can avoid the reduction of required calculation load caused by the self-adaptive law calculation process in the existing research, ensure the transient and steady state behaviors of ideal tracking errors by adjusting the parameters of a preset performance matrix, finally realize the design of the USV track tracking controller and solve the problem that external interference and parameter disturbance cannot be accurately modeled in the USV control theory research.
The design method of the USV robust model-free track tracking controller based on the preset performance comprises the following steps of:
step one, establishing a kinematic and dynamic model of the unmanned surface vehicle;
step two, defining kinematic and dynamic errors according to the kinematic and dynamic models of the unmanned surface vehicle and forming a tracking error dynamic model;
step three, designing a conversion function;
step four, selecting an error conversion formula;
step five, based on the design of the step three and the step four, establishing an error matrix definition and an unconstrained dynamics system;
and step six, designing a model-free controller.
Further, in the first step, specifically, a kinematic and dynamic model of the unmanned surface vessel is established, as follows:
wherein ,τ=τv Is the actual control vector;is an unknown nonlinear function consisting of hydrodynamic, model parameter perturbation, and the proposed control algorithm is completely model parameter independent, so the term M given in equation (2) will not be considered as a controller parameter, generating the desired trajectory as follows:
wherein ,ηd =[x d ,y dd ] T and υd =[u d ,v d ,r d ] T Is a desired kinematic and kinetic signal; f (f) d (t)=[f d,1 (t),f d,2 (t),f d,3 (t)] T Providing the required kinetic vector.
Further, in the second step, specifically,
kinematic errors are defined and expressed as:
η e =η-η d (4)
the kinetic error is expressed as:
υ e =J(ψ)υ-J(ψ dd (5)
thus, the tracking error dynamics model is derived as:
wherein j=j (ψ), J d =J(ψ d ),S=S(r),S d =S(r d ) The method is a simple writing method; λ=jsj T F= (λj) d -J d S dd -J d f d All are known nonlinear functions, and related variables are obtained from the on-board sensor; d=jm -1 f (t, v) is an unknown function representing the lumped uncertainty.
Further, in step three, specifically,
to give error eta e Conversion error μ= [ μ ] with a priori guaranteed evolution region 123 ] T Is designed as follows:
μ=diag -1 (ρ)η e (7)
wherein ρ= [ ρ ] 123 ] T Representing a preset performance function vector, and expressing elements in the vector as rho i =(ρ 0,i∞,i )exp(-κ i t)+ρ ∞,i I=1, 2,3, where ρ 0 Is the initial value of ρ (t); ρ The maximum allowable value of the tracking error is selected according to task requirements; kappa is the convergence rate of the preset performance function for a vector x= [ x ] 1 ,x 2 ,x 3 ] T In terms of this, the symbol diag (x) is defined as diag { x } 1 ,x 2 ,x 3 },
By selecting appropriate design parameters ρ 0,i∞,i and κi To characterize the tracking error eta of demand e In both transient and steady state conditions.
Further, in step four, specifically,
the following error conversion formula is designed to convert the constrained error into an equivalent unconstrained error:
wherein ,expressed as a compact vector of transformation functions, and more particularly,is composed of->Given.
Further, in step five, specifically,
based on the designs of step three and step four, an error matrix is defined as follows:
where k=diag { K 1 ,K 2 ,K 3 Is a matrix of design parameters in which the elements satisfy K i Differentiating the above expression and substituting the expression into the expression (8) to obtain a dynamic expression of the unconstrained error system, wherein the dynamic expression is larger than 0:
wherein, in the last step of the above formula, for convenience, the following symbols are defined: and λ ij ,F i ,D i ,(JM -1 ) ij τ υ,i Are elements of the ith row and the jth column of a given corresponding matrix,
the equivalent overwrite of formula (10) is as follows:
wherein ,
as long as eta e,i I=1, 2,3 is strictly in the region- ρ i (t)<η e,i <ρ i (t) inner evolution, thenEnd-to-end remains bounded and, furthermore, once ω i (t) at |eta e,i (0)|<ρ 0,i Is bounded on the premise that a conclusion is obtained:is composed of->Defined by the properties of (a) and, in addition, review ω i The limit of (t) is a direct result of the limit of s (t), and thus the control objective is expressed as a problem of stabilizing the error dynamic system formula (10).
Further, in step six, specifically,
in order to guarantee the stability of s (t), the following model-free controller is proposed:
where β is the strictly positive control gain; Θ=diag { θ 123 Is a user-defined matrix and has θ i >0,i=1,2,3,
By adjusting beta, K to adjust the control performance within a predetermined range,
the design parameters theta are selected to ensure that s (0) theta s (0) < 1 is true, is a sufficient condition for the stability of the resulting closed-loop control system,
thus, the architecture of the model-free trajectory tracking controller as shown in equation (12) is compact and is easy to implement because there are no model parameters, where the terms (1-s T Θs) -1 And Θs are used to ensure that the novel error system as shown in equation (11) is eventually consistent asymptotically stable in the presence of external disturbances,
itemsIs embedded in the formula (9), tracking error eta e,i The steering is predetermined to be ρ ∞,i Is near zero and has a predetermined minimum convergence rate exp (- κ) i t) exhibits a maximum preset overshoot ρ 0,i
The invention has the following beneficial effects:
1) By means of sliding mode technology, a robust non-parameter model control scheme is proposed. Since the calculation process of the adaptive law is not needed, compared with an algorithm based on online estimation, the control scheme provided by the invention has less calculation burden.
2) In other model-free control methods of USV, it is difficult to ensure that the transient and steady state behavior of the tracking error is ideal. In contrast, the control scheme proposed by the present invention is developed with a preset performance matrix, so that the desired transient and steady state performance can be obtained by adjusting the parameters.
3) The control scheme proposed by the present invention is very user/designer friendly due to its simple architecture and few parameters.
Drawings
Fig. 1 is a time response of a closed loop system signal at different K values, where β=400;
FIG. 2 is a time response of a closed loop system signal at different beta values, where K=diag ([ 1;1 ]);
FIG. 3 is a graph of USV track tracking position under different conditions;
FIG. 4 is a graph of USV longitudinal speed versus time for different conditions;
FIG. 5 is a graph of USV lateral velocity time response for different conditions;
FIG. 6 is a graph of USV yaw rate versus time for different conditions;
FIG. 7 is a graph of USV longitudinal position error time response for different conditions;
FIG. 8 is a graph of USV lateral position error time response for different conditions;
FIG. 9 is a graph of USV heading angle position error time response under different conditions;
FIG. 10 is a graph of USV longitudinal control signal time response for different conditions;
FIG. 11 is a graph showing the time response of the USV lateral control signal under different conditions;
FIG. 12 is a graph showing the time response of the USV yaw control signal under different conditions;
fig. 13 is a flowchart of a design method of a USV robust model-free trajectory tracking controller based on preset performance.
Detailed Description
The following description of the embodiments of the present invention will be made clearly and completely with reference to the accompanying drawings, in which it is apparent that the embodiments described are only some embodiments of the present invention, but not all embodiments. All other embodiments, which can be made by those skilled in the art based on the embodiments of the invention without making any inventive effort, are intended to be within the scope of the invention.
The invention aims to solve the problem that external interference and parameter disturbance cannot be accurately modeled in USV control theory research, provides a USV track tracking controller design method based on a preset performance control technology and a robust non-parameter model technology, can avoid the reduction of required calculation load caused by a self-adaptive law calculation process in the existing research, can ensure ideal transient and steady state behaviors of tracking errors by adjusting parameters of a preset performance matrix, and can finally realize the design of a USV track tracking controller.
Referring to fig. 13, the object of the present invention is achieved by:
the first step, a kinematic and dynamic model of the unmanned surface vessel is established, as follows:
wherein ,τ=τv Is the actual control vector;is an unknown nonlinear function and consists of fluid dynamics, model parameter perturbation and the like. Notably, the proposed control algorithm is entirely model parameter independent, and therefore the term M given in (2) will not be considered as a controller parameter, generating the required trajectory as follows:
wherein ,ηd =[x d ,y dd ] T and υd =[u d ,v d ,r d ] T Is a desired kinematic and kinetic signal; f (f) d (t)=[f d,1 (t),f d,2 (t),f d,3 (t)] T Providing the required kinetic vector.
A second step of defining kinematics, dynamics errors and forming a tracking error dynamics model,
kinematic errors are defined and expressed as:
η e =η-η d (4)
the kinetic error is expressed as:
υ e =J(ψ)υ-J(ψ dd (5)
thus, the tracking error dynamics model is derived as:
wherein j=j (ψ), J d =J(ψ d ),S=S(r),S d =S(r d ) The method is a simple writing method; λ=jsj T F= (λj) d -J d S dd -J d f d All are known nonlinear functions, and related variables can be obtained from the on-board sensor; d=jm -1 f (t, v) is an unknown function representing the lumped uncertainty.
Third step, design of conversion function
To give error eta e Conversion error μ= [ μ ] with a priori guaranteed evolution region 123 ] T Is designed as follows:
μ=diag -1 (ρ)η e (7)
wherein ρ= [ ρ ] 123 ] T Representing a preset performance function vector, and expressing elements in the vector as rho i =(ρ 0,i∞,i )exp(-κ i t)+ρ ∞,i I=1, 2,3, where ρ 0 Is the initial value of ρ (t); ρ For the maximum allowable value of the tracking error, the selection of the value is dependent on task requirements; kappa is the convergence rate of the preset performance function. For a vector x= [ x ] 1 ,x 2 ,x 3 ] T In terms of this, the symbol diag (x) is defined as diag { x } 1 ,x 2 ,x 3 }。
The design of the conversion error (7) is such that we can choose the appropriate design parameter ρ 0,i∞,i and κi To characterize the tracking error eta of demand e In both transient and steady state conditions.
Fourth, the error conversion formula is selected
For the design of the third step, mu is present for any t > 0 i Should be constrained to intervalsThe design of the transfer function therefore increases the difficulty of the controller design to some extent. The following error conversion formula is designed to convert the constrained error into an equivalent unconstrained error:
wherein ,expressed as a compact vector of transformation functions, and more particularly,is composed of->Given.
Fifth step, error matrix definition and unconstrained dynamic system establishment
Based on the designs of step three and step four, an error matrix is defined as follows:
where k=diag { K 1 ,K 2 ,K 3 Is a matrix of design parameters in which the elements satisfy K i Differentiating the above expression and substituting the expression into the expression (8) to obtain a dynamic expression of the unconstrained error system, wherein the dynamic expression is larger than 0:
wherein, in the last step of the above formula, for convenience, the following symbols are defined: and λ ij ,F i ,D i ,(JM -1 ) ij τ υ,i Are elements of the ith row and the jth column of a given corresponding matrix,
to facilitate the subsequent design of model-free controllers and the analysis of the stability of the resulting closed-loop system, (10) can be equivalently rewritten in a compact form as follows:
wherein ,
notably, as long as η e,i I=1, 2,3 is strictly in the region- ρ i (t)<η e,i <ρ i (t) inner evolution, thenShould remain bounded all the time. Furthermore, once ω i (t) at |eta e,i (0)|<ρ 0,i On the premise of being bounded, we can conclude that: />Is composed of->Defined by the properties of (a). And have a review of omega i The limit of (t) is a direct result of the limit of s (t), and thus, the control objective can be expressed as a problem of stabilizing the error dynamics system (10).
Sixth step, model-free controller design
In order to guarantee the stability of s (t), the present chapter proposes a model-free controller as follows:
where β is the strictly positive control gain; Θ=diag { θ 123 Is a user-defined matrix and has θ i >0,i=1,2,3。
It is noted that the control performance can be adjusted within a predetermined range by adjusting β, K as shown in fig. 1 and fig. 2.
The specific analysis is as follows: a larger K will result in a larger control input signal, a slower convergence speed and a higher control accuracy, while a larger β will result in a better performance of the closed loop control system, but at the same time a larger demand for control input. The design parameters Θ are chosen to ensure that s (0) Θs (0) < 1 holds, which is a sufficient condition for the stability of the resulting closed loop control system.
Based on the above description and analysis, it can be appreciated that the architecture of the model-free trajectory tracking controller as shown in equation (12) is compact and easy to implement because there are no model parameters. Wherein items (1-s T Θs) -1 And Θs are used to ensure that the new error system as shown in equation (11) is eventually consistent asymptotically stable in the presence of external disturbances.
In order for the proposed control scheme to have preset performance, the termIs embedded in equation (9), thus, tracking error η e,i The steering is predetermined to be ρ ∞,i Is near zero and has a predetermined minimum convergence rate exp (- κ) i t) exhibits a maximum preset overshoot ρ 0,i
The invention is described in further detail below with reference to the drawings and the detailed description.
The first step, a kinematic and dynamic model of the unmanned surface vessel is established, as follows:
wherein ,τ=τv Is the actual control vector;is an unknown nonlinear function and consists of fluid dynamics, model parameter perturbation and the like. It is worth noting that the proposed control algorithm is completely model parameter independent, and therefore the term M given in (2) will not be considered as a controller parameter. It is worth noting that the dynamic parameter settings of the USV are not available for the proposed control scheme of the present invention, since the proposed control scheme introduces a model-free parameter design approach.
The required trajectory is generated as follows:
wherein ,ηd =[0,0,0] T and υd =[1,0,0] T The kinetic vector is expressed as follows:
second, defining kinematics and dynamics error and forming tracking error dynamics model
Kinematic errors are defined and expressed as:
η e =η-η d (5)
the kinetic error is expressed as:
υ e =J(ψ)υ-J(ψ dd (6)
thus, the tracking error dynamics model is derived as:
wherein j=j (ψ), J d =J(ψ d ),S=S(r),S d =S(r d ) The method is a simple writing method; λ=jsj T F= (λj) d -J d S dd -J d f d All are known nonlinear functions, and related variables can be obtained from the on-board sensor; d=jm -1 f (t, v) is an unknown function representing the lumped uncertainty.
Third step, design of conversion function
To give error eta e Conversion error μ= [ μ ] with a priori guaranteed evolution region 123 ] T Is designed as follows:
μ=diag -1 (ρ)η e (8)
wherein ρ= [ ρ ] 123 ] T Representing a preset performance function vector, and expressing elements in the vector as rho 1 (t)=ρ 2 (t)=0.9exp(-0.15t)+0.1,ρ 3 (t)=0.26exp(-0.15t)+0.09。
The design of the conversion error (8) is such that we can choose the appropriate design parameter ρ 0,i∞,i and κi To characterize the tracking error eta of demand e In both transient and steady state conditions.
Fourth, the error conversion formula is selected
For the design of the third step, mu is present for any t > 0 i Should be constrained to intervalsThe design of the transfer function therefore increases the difficulty of the controller design to some extent. The following error conversion formula is designed to convert the constrained error into an equivalent unconstrained error:
wherein ,expressed as a compact vector of transformation functions, and more particularly,is composed of->Given.
Fifth step, error matrix definition and unconstrained dynamic system establishment
Based on the design of the third and fourth steps, an error matrix is defined as follows:
wherein K=diag {1.05,1.05,0.65} is a design parameter matrix, and the elements therein satisfy K i > 0. Differentiating the above formula and substituting the formula (9) to obtain a dynamic expression of the unconstrained error system:
wherein, in the last step of the above formula, for convenience, the following symbols are defined: and λ ij ,F i ,D i ,(JM -1 ) ij τ υ,i Are elements of the j-th column (i-th row) of the given corresponding matrix.
To facilitate the subsequent design of model-free controllers and the analysis of the stability of the resulting closed-loop system, (10) can be equivalently rewritten in a compact form as follows:
wherein ,
notably, as long as η e,i I=1, 2,3 is strictly in the region- ρ i (t)<η e,i <ρ i (t) inner evolution, thenShould remain bounded all the time. Furthermore, once ω i (t) at |eta e,i (0)|<ρ 0,i On the premise of being bounded, we can conclude that: />Is composed of->Defined by the properties of (a). And have a review of omega i The limit of (t) is a direct result of the limit of s (t), and thus, the control objective can be expressed as a problem of stabilizing the error dynamics system (10).
Sixth step, model-free controller design
In order to guarantee the stability of s (t), the present chapter proposes a model-free controller as follows:
where β=400 is a strictly positive control gain; Θ = diag {0.9,0.9,0.9}.
The initial conditions of USV were chosen to be η= [ -0.4, -0.5, pi/18] T And v= [0.8, -0.1,0.05 ]] T . Setting different external interference conditionsIn the case of a comparative test, two working conditions (Scenario I and Scenario II) are considered to prove the robustness of the controller proposed in this chapter to the model disturbance and external disturbance.
Scenario I (condition 1): model perturbation g and external disturbance are obtained by referring to the relevant literatureThe method comprises the following steps:
scenario II (condition 2): the perturbation of the model is the same as in Scenario I. To more actually simulate external disturbances, a second order Gaussian-Markov process is deployed as follows:
wherein A=diag {3, 3}, B=diag {1, 1} and C=diag {100,100,100} are positive definite matrices,is zero-mean gaussian white noise.
As can be seen from fig. 3 to 6, the controller designed by the present invention can successfully track the required track in terms of kinematics and dynamics, and has ideal control tracking performance.
Fig. 7 to 9 depict the position error and the corresponding performance envelope. Obviously, the proposed controller can guarantee the desired performance index and is further satisfactorily robust against disturbances and uncertainties.
Fig. 10 to 12 show the time response of the control input signal. As we see, the proposed control scheme generates different driving forces (torques) in response to different external disturbances.
Analysis in connection with fig. 3 to 12 makes it possible to conclude that the interference has less influence on the closed-loop system of the proposed controller of the base Yu Benzhang, which means that the interference cancellation effect of the proposed controller is satisfactory.
The above embodiments are only for aiding in understanding the method of the present invention and its core idea, and those skilled in the art can make several improvements and modifications in the specific embodiments and application scope according to the idea of the present invention, and these improvements and modifications should also be considered as the protection scope of the present invention.

Claims (3)

1. The USV robust model-free track tracking controller design method based on the preset performance is characterized by comprising the following steps of:
step one, establishing a kinematic and dynamic model of the unmanned surface vehicle;
step two, defining kinematic and dynamic errors according to the kinematic and dynamic models of the unmanned surface vehicle and forming a tracking error dynamic model;
step three, designing a conversion function;
step four, selecting an error conversion formula;
step five, based on the design of the step three and the step four, establishing an error matrix definition and an unconstrained dynamics system;
step six, designing a model-free controller,
in the third step, the first step, in particular,
to give error eta e Conversion error μ= [ μ ] with a priori guaranteed evolution region 123 ] T Is designed as follows:
μ=diag -1 (ρ)η e (7)
wherein ρ= [ ρ ] 123 ] T Representing a preset performance function vector, and expressing elements in the vector as rho i =(ρ 0,i∞,i )exp(-κ i t)+ρ ∞,i I=1, 2,3, where ρ 0 Is the initial value of ρ (t); ρ The maximum allowable value of the tracking error is selected according to task requirements; kappa is the convergence rate of the preset performance function for a vector x= [ x ] 1 ,x 2 ,x 3 ] T In terms of this, the symbol diag (x) is defined as diag { x } 1 ,x 2 ,x 3 },
By selecting appropriate design parameters ρ 0,i∞,i and κi To characterize the tracking error eta of demand e In transient and steady state conditions;
in step four, the process is performed, in particular,
the following error conversion formula is designed to convert the constrained error into an equivalent unconstrained error:
wherein ,expressed as a compact vector of transformation functions, and more particularly,is composed of->Is given;
in the fifth step, the first step, in particular,
based on the designs of step three and step four, an error matrix is defined as follows:
where k=diag { K 1 ,K 2 ,K 3 Is a matrix of design parameters in which the elements satisfy K i Differentiating the above expression and substituting the expression into the expression (8) to obtain a dynamic expression of the unconstrained error system, wherein the dynamic expression is larger than 0:
wherein, in the last step of the above formula, for convenience, the following symbols are defined: and λ ij ,F i ,D i ,(JM -1 ) ij τ υ,i Are elements of the ith row and the jth column of a given corresponding matrix,
the equivalent overwrite of formula (10) is as follows:
wherein ,
as long as eta e,i I=1, 2,3 is strictly in the region- ρ i (t)<η e,i <ρ i (t) inner evolution, thenEnd-to-end remains bounded and, furthermore, once ω i (t) at |eta e,i (0)|<ρ 0,i Is bounded on the premise that a conclusion is obtained:is composed of->Defined by the properties of (a) and, in addition, review ω i The limit of (t) is a direct result of the limit of s (t), and thus the control objective is expressed as a problem of stabilizing the error dynamic system formula (10);
in step six, the process is performed, in particular,
in order to guarantee the stability of s (t), the following model-free controller is proposed:
where β is the strictly positive control gain; Θ=diag { θ 123 Is a user-defined matrix and has θ i >0,i=1,2,3,
By adjusting beta, K to adjust the control performance within a predetermined range,
the design parameters theta are selected to ensure that s (0) theta s (0) < 1 is true, is a sufficient condition for the stability of the resulting closed-loop control system,
thus, the architecture of the model-free trajectory tracking controller as shown in equation (12) is compact and is easy to implement because there are no model parameters, where the terms (1-s T Θs) -1 And Θs are used to ensure that the novel error system as shown in equation (11) is eventually consistent asymptotically stable in the presence of external disturbances,
itemsIs embedded in the formula (9), tracking error eta e,i The steering is predetermined to be ρ ∞,i Is near zero and has a predetermined minimum convergence rate exp (- κ) i t) exhibits a maximum preset overshoot ρ 0,i
2. The method for designing the USV robust model-free trajectory tracking controller based on the preset performance according to claim 1, wherein in the first step, specifically, a kinematic and dynamic model of the unmanned surface vessel is built as follows:
wherein ,τ=τv Is the actual control vector;is an unknown nonlinear function consisting of hydrodynamic, model parameter perturbation, and the proposed control algorithm is completely model parameter independent, so the term M given in equation (2) will not be considered as a controller parameter, generating the desired trajectory as follows:
wherein ,ηd =[x d ,y dd ] T and υd =[u d ,v d ,r d ] T Is a desired kinematic and kinetic signal; f (f) d (t)=[f d,1 (t),f d,2 (t),f d,3 (t)] T Providing the required kinetic vector.
3. The method for designing a USV robust model-free trajectory tracking controller based on preset performance according to claim 2, wherein, in the second step, specifically,
kinematic errors are defined and expressed as:
η e =η-η d (4)
the kinetic error is expressed as:
υ e =J(ψ)υ-J(ψ dd (5)
thus, the tracking error dynamics model is derived as:
wherein j=j (ψ), J d =J(ψ d ),S=S(r),S d =S(r d ) The method is a simple writing method; λ=jsj T F= (λj) d -J d S dd -J d f d All are known nonlinear functions, and related variables are obtained from the on-board sensor; d=jm -1 f (t, v) is an unknown function representing the lumped uncertainty.
CN202111050109.2A 2021-09-08 2021-09-08 USV robust model-free track tracking controller design method based on preset performance Active CN114706298B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202111050109.2A CN114706298B (en) 2021-09-08 2021-09-08 USV robust model-free track tracking controller design method based on preset performance

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202111050109.2A CN114706298B (en) 2021-09-08 2021-09-08 USV robust model-free track tracking controller design method based on preset performance

Publications (2)

Publication Number Publication Date
CN114706298A CN114706298A (en) 2022-07-05
CN114706298B true CN114706298B (en) 2023-08-04

Family

ID=82166896

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202111050109.2A Active CN114706298B (en) 2021-09-08 2021-09-08 USV robust model-free track tracking controller design method based on preset performance

Country Status (1)

Country Link
CN (1) CN114706298B (en)

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2009086220A1 (en) * 2007-12-21 2009-07-09 University Of Florida Systems and methods for offset-free model predictive control
CN108008628A (en) * 2017-11-17 2018-05-08 华南理工大学 A kind of default capabilities control method of uncertain drive lacking unmanned boat system
CN108319138A (en) * 2018-01-29 2018-07-24 哈尔滨工程大学 A kind of sliding formwork of drive lacking unmanned boat-contragradience double loop Trajectory Tracking Control method
CN109839934A (en) * 2019-02-26 2019-06-04 华南理工大学 Unmanned water surface ship default capabilities tracking and controlling method based on RISE technology
CN110844122A (en) * 2019-11-20 2020-02-28 中山大学 Satellite attitude control method for restraining attitude tracking error
CN111650837A (en) * 2020-06-19 2020-09-11 哈尔滨理工大学 Second-order preset performance fault-tolerant control method for track tracking of surface ship during propeller failure

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US11178805B2 (en) * 2019-07-05 2021-11-23 Deere & Company Apparatus and methods for vehicle steering to follow a curved path

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2009086220A1 (en) * 2007-12-21 2009-07-09 University Of Florida Systems and methods for offset-free model predictive control
CN108008628A (en) * 2017-11-17 2018-05-08 华南理工大学 A kind of default capabilities control method of uncertain drive lacking unmanned boat system
CN108319138A (en) * 2018-01-29 2018-07-24 哈尔滨工程大学 A kind of sliding formwork of drive lacking unmanned boat-contragradience double loop Trajectory Tracking Control method
CN109839934A (en) * 2019-02-26 2019-06-04 华南理工大学 Unmanned water surface ship default capabilities tracking and controlling method based on RISE technology
CN110844122A (en) * 2019-11-20 2020-02-28 中山大学 Satellite attitude control method for restraining attitude tracking error
CN111650837A (en) * 2020-06-19 2020-09-11 哈尔滨理工大学 Second-order preset performance fault-tolerant control method for track tracking of surface ship during propeller failure

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
MIMO纯反馈受限系统无模型非线性比例反演控制;陈龙胜;王琦;;控制与决策(第04期);158-167 *

Also Published As

Publication number Publication date
CN114706298A (en) 2022-07-05

Similar Documents

Publication Publication Date Title
Yang et al. Adaptive neural prescribed performance tracking control for near space vehicles with input nonlinearity
CN109901403A (en) A kind of face autonomous underwater robot neural network S control method
CN112612209B (en) Full-drive ship track tracking control method and system based on instruction filtering neural network controller
CN105785762A (en) Bi-axis inertially-stabilized platform high-precision control method based on self-adaptive backstepping sliding mode
CN109189103B (en) Under-actuated AUV trajectory tracking control method with transient performance constraint
Shen et al. Dynamic surface control for tracking of unmanned surface vessel with prescribed performance and asymmetric time-varying full state constraints
Zhou et al. Three-dimensional trajectory tracking for underactuated AUVs with bio-inspired velocity regulation
CN107193210B (en) Adaptive learning preset performance control method of nonlinear system
CN109828467B (en) Data-driven unmanned ship reinforcement learning controller structure and design method
CN111273544B (en) Radar pitching motion control method based on prediction RBF feedforward compensation type fuzzy PID
Liu et al. Adaptive command filtered backstepping tracking control for AUVs considering model uncertainties and input saturation
Yang et al. A recurrent neural network based fuzzy sliding mode control for 4-DOF ROV movements
CN114047773A (en) Underwater ore collection robot backstepping sliding mode self-adaptive attitude control method based on extended state observer
CN115990888B (en) Mechanical arm control method with dead zone and time-varying constraint function
CN114089749A (en) Unmanned ship motion control anti-interference controller and method
CN117452827B (en) Under-actuated unmanned ship track tracking control method
CN105446136A (en) Ship course intelligence controller based on incomplete recursive branch-set dynamic neural network
CN114706298B (en) USV robust model-free track tracking controller design method based on preset performance
Li et al. Adaptive NN formation tracking control for the multiple underactuated USVs with prescribed performance and input saturations
Wang et al. Distributed optimal formation tracking control based on reinforcement learning for underactuated AUVs with asymmetric constraints
Shen et al. Nonlinear observer-based adaptive output feedback tracking control of underactuated ships with input saturation
CN115903820A (en) Multi-unmanned-boat pursuit and escape game control method
Zhao et al. Trajectory tracking control for unmanned surface vehicle subject to unmeasurable disturbance and input saturation
Yao et al. Research and comparison of automatic control algorithm for unmanned ship
Qin et al. Autonomous control of underwater offshore vehicles

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant