USPatent applicationPatented

Non-singular finite-time control method and system for dynamic positioning of unmanned boat with prescribed performance

Granted 10 Oct 2023 · no office action yet

Application· this page
18/324,168
filed 26 May 2023
Publication
Not published
not published
Patent
US 11,780,551
granted 10 Oct 2023

Life of the application

5 dated events
⤢ drag to zoom20242026202820302032203420362038204020422044ProsecutionOwnershipTerm & fees
ProsecutionOwnershipTerm & feeshover for detail · click to open

Abstract

Disclosed are a non-singular finite-time control method and system for prescribed performance dynamic positioning of unmanned boat, which belong to the field of automatic control of unmanned boats. The method includes obtaining a difference between the actual measured position and the desired position of the unmanned boat to obtain a position error of the unmanned boat; performing prescribed performance transformation on the unmanned boat position error; constructing a non-singular finite-time virtual velocity law as a reference velocity for unmanned boats; obtaining the difference between the reference speed and the actual measured speed to obtain the speed tracking error; calculating the fuzzy supervisory saturation compensated law and adaptive fuzzy approximation term; constructing a non-singular finite-time dynamical controller to output control commands; applying a force or moment to the unmanned boat to adjust the propeller speed of the unmanned boat, thereby realizing positioning of the unmanned boat.

Description

11 parts
›CROSS-REFERENCE TO RELATED APPLICATION

This application claims the priority benefit of Chinese application serial no. 202211336276.8, filed on Oct. 28, 2022. The entirety of the above-mentioned patent application is hereby incorporated by reference herein and made a part of this specification.

BACKGROUND
›TECHNICAL FIELD

The disclosure belongs to the field of automatic control of unmanned boats, and more specifically relates to a non-singular finite-time control method and system for prescribed performance dynamic positioning of unmanned boat.

›DESCRIPTION OF RELATED ART

In the past decades, a lot of developments related to ocean have been conducted, and unmanned boats have been widely adopted. When performing tasks such as oil drilling and laying submarine pipeline in deep sea areas, due to the restriction of length of the mooring cable, it is difficult to perform positioning tasks through the conventional anchoring method. The dynamic positioning technology that resists environmental disturbances through the self-propulsion system of the unmanned boat makes it possible to perform positioning tasks without mooring, thereby reducing the complicated anchoring process and it is possible to conduct tasks in water at a depth greater than 1000 meters. On the one hand, the positioning accuracy may be ensured, and on the other hand, the cost required for conventional mooring positioning may be saved.

In recent years, dynamic positioning control has been extensively studied by scholars worldwide. Based on nonlinear and intelligent control theories, various controllers have been proposed, but these controllers can only ensure that the positioning error is eventually and consistently bounded or asymptotically stable when the time is infinite. Although the finite-time control that has emerged in recent years is able to achieve the goal of control in a finite time, the integration of power terms may bring potential singularity, and it is difficult to precisely constrain the error state in the transient process. In the actual task of performing dynamic positioning of unmanned boat, considering that there are many uncertain factors in the surrounding environment of unmanned boat, it is very important to avoid singularity in the control process and ensure that the error converges within a finite time.

›SUMMARY · 1 of 2

To solve the defects of related art, the purpose of the present disclosure is to provide a non-singular finite-time control method and system for prescribed performance dynamic positioning of unmanned boat. The present disclosure aims to solve the problem of singularity phenomenon that occurs when the finite time converges in the case where positioning of unmanned boat is performed through the existing dynamic positioning control method.

In order to achieve the above purpose, on the one hand, the present disclosure provides a non-singular finite-time control method for prescribed performance dynamic positioning of unmanned boat, and the method includes the following steps: obtaining a difference between the actual measured position and the desired position of the unmanned boat to obtain a position error of the unmanned boat; performing prescribed performance transformation after decomposing the unmanned boat position error according to the longitudinal transformation position, lateral transformation position and heading transformation position to obtain prescribed performance error transformation variables; constructing a non-singular finite-time virtual velocity law as a reference velocity for unmanned boats based on prescribed performance error transformation variables and non-singular finite-time operators; obtaining the difference between the reference speed and the actual measured speed to obtain the speed tracking error; integrating the speed tracking error with the deviation between the control command and the saturation limit to calculate the fuzzy supervisory saturation compensated law by constructing fuzzy supervisory compensated; integrating the speed tracking error to construct a fuzzy logic system to calculate the adaptive fuzzy approximation term; calculating a robust term according to speed tracking error and an adaptive estimation term of compounded disturbances with unknown upper bound; introducing a kinematically non-singular finite-time control term and combining fuzzy supervisory saturation compensated law, adaptive fuzzy approximation term and robust term to construct a non-singular finite-time dynamical controller to output control commands; the control commands contain a force or a moment pre-applied on the unmanned boat; applying a force or moment to the unmanned boat to adjust the propeller speed of the unmanned boat, thereby realizing positioning of the unmanned boat.

Further preferably, the non-singular finite-time virtual velocity law is

In the formula, J(Ψ) is the rotation matrix that transforms the unmanned boat hull coordinate system into a fixed coordinate system; JΨ T is the transpose matrix of J(Ψ); Ψ represents the heading angle of the unmanned boat; G is the prescribed performance gain matrix; G −1 is the inverse matrix of G; δ 1 is a small positive definite parameter; Z 1 is the transformed position error vector; ᾰ is the intermediate control variable for calculating the non-singular finite-time virtual velocity law, and the calculation is performed by using a non-singular finite-time operator.

Further preferably, the adaptive fuzzy approximation term is

In the formula, ê is the speed tracking error;

θ τ = [ ϑ τ1 T 0 1 × l 0 1 × l 0 1 × l ϑ τ ⁢ 2 T 0 1 × l 0 1 × l 0 1 × l ϑ τ ⁢ 3 T ] T ,

{circumflex over (σ)} is the optimal estimated value of the two norm of the optimal weight matrix σ=||ω τ *|| 2 , {circumflex over (σ)}=diag({circumflex over (σ)} 1 , {circumflex over (σ)} 2 , {circumflex over (σ)} 3 ); ω τ * and δ τk are respectively the optimal weight and the Gaussian fuzzy basis function used to approximate the unknown model dependency term.

The fuzzy supervisory saturation compensated law is

In the formula, γ is the switching factor based on the saturation command deviation, when γ reaches the set threshold, γ=1, otherwise γ=0; θ Δτ T , is the transpose matrix of θ Δτ ; ê is the speed tracking error;

θ Δ ⁢ τ = [ ϑ Δ ⁢ τ ⁢ 1 T 0 1 × l 0 1 × l 0 1 × l ϑ Δ ⁢ τ ⁢ 2 T 0 1 × l 0 1 × l 0 1 × l ϑ Δ ⁢ τ ⁢ 3 T ] T ,

{circumflex over (ϕ)} is the optimal estimated value of the two norm of the optimal weight matrix ϕ=||ω Δγ *|| 2 ; ω Δγ * and δ 66 γk are respectively the optimal weight matrix and Gaussian fuzzy basis function for approximating the fuzzy logic system with unknown saturation deviation Δτ; Where k is 1, 2 or 3; l is a positive integer; T stands for transpose.

Further preferably, the non-singular finite-time dynamics controller is

In the formula, δ 2 is a normal number with a small value; τ̆ sat is the calculation of non-singular dynamics intermediate control variables; τ sat sat is the control command; ê is the speed tracking error.

The robust term is τ rob =−TANH(ê)Ê.

In the formula, Ê is the adaptive estimation term of the compounded disturbances with unknown upper bound; ê is the speed tracking error.

In another aspect, the present disclosure provides a non-singular finite-time control system for prescribed performance dynamic positioning of unmanned boat, and the system includes a sensor, a first subtractor, a prescribed performance mapping unit, a second subtractor, a virtual velocity law construction unit, a fuzzy supervisory compensated constructing unit, a fuzzy logic system constructing unit, a robust adaptive estimation constructing unit, and a non-singular finite-time dynamical controller constructing unit.

The output end of the sensor is connected to the input end of the first subtractor and the second subtractor. The output end of the first subtractor is connected to the input end of the prescribed performance mapping unit. The output end of the prescribed performance mapping unit is connected to the input end of the virtual velocity law constructing unit. The output end of the virtual velocity law constructing unit is connected to the second subtractor. The output end of the second subtractor is connected to the fuzzy supervisory compensated constructing unit, the fuzzy logic system constructing unit, the robust adaptive estimation constructing unit, and non-singular finite-time dynamical controller constructing unit.

›SUMMARY · 2 of 2

The sensor is provided to collect the actual measured speed and position of the unmanned boat in real time. The first subtractor is provided to obtain a difference between the actual measured position and the desired position of the unmanned boat to obtain the position error of the unmanned boat.

The prescribed performance mapping unit is provided to perform prescribed performance transformation after decomposing the unmanned boat position error according to the longitudinal transformation position, lateral transformation position and heading transformation position to obtain prescribed performance error transformation variables.

The virtual speed law constructing unit is provided to construct a non-singular finite-time virtual speed law as the reference speed of the unmanned boat based on the prescribed performance error transformation variable and the non-singular finite-time operator.

The second subtractor is provided to obtain a difference between the reference speed and the actual measured speed to obtain a speed tracking error.

The fuzzy supervisory compensated constructing unit is provided to integrate the speed tracking error with the deviation between the control command and the saturation limit to calculate the fuzzy supervisory saturation compensated law by constructing fuzzy supervisory compensated.

The fuzzy logic system constructing unit is provided to integrate the speed tracking error to construct a fuzzy logic system to calculate the adaptive fuzzy approximation term.

The robust adaptive estimation constructing unit is provided to calculate a robust term according to speed tracking error and an adaptive estimation term of compounded disturbances with unknown upper bound.

The non-singular finite-time dynamical controller constructing unit is provided to introduce a kinematically non-singular finite-time control term and combine fuzzy supervisory saturation compensated law, adaptive fuzzy approximation term and robust term to construct a non-singular finite-time dynamical controller to output control commands; the control commands contain a force or a moment pre-applied on the unmanned boat; a force or moment is applied to the unmanned boat to adjust the propeller speed of the unmanned boat, thereby realizing positioning of the unmanned boat.

Further preferably, the non-singular finite-time virtual velocity law is

In the formula, J(Ψ) is the rotation matrix that transforms the unmanned boat hull coordinate system into a fixed coordinate system; J(Ψ) T is the transpose matrix of J(Ψ); Ψ represents the heading angle of the unmanned boat; G is the prescribed performance gain matrix; G −1 is the inverse matrix of G; δ 1 is a small positive definite parameter; Z 1 is the transformed position error vector; ᾰ is the intermediate control variable for calculating the non-singular finite-time virtual velocity law, and the calculation is performed by using a non-singular finite-time operator.

Further preferably, the adaptive fuzzy approximation term is

In the formula, ê is the speed tracking error;

θ τ = [ ϑ τ1 T 0 1 × l 0 1 × l 0 1 × l ϑ τ ⁢ 2 T 0 1 × l 0 1 × l 0 1 × l ϑ τ ⁢ 3 T ] T ,

{circumflex over (σ)} is the optimal estimated value of the two norm of the optimal weight matrix σ=||ω τ *|| 2 , σ=diag({circumflex over (σ)} 1 ,{circumflex over (σ)} 2 ,{circumflex over (σ)} 3 ); ω τ * and δ τk are respectively the optimal weight and the Gaussian fuzzy basis function used to approximate the unknown model dependency term.

The fuzzy supervisory saturation compensated law is

In the formula, γ is the switching factor based on the saturation command deviation, when γ reaches the set threshold, γ=1, otherwise γ=0; θΔτ T , is the transpose matrix of θΔτ, ê is the speed tracking error;

θ Δ ⁢ τ = [ ϑ Δ ⁢ τ ⁢ 1 T 0 1 × l 0 1 × l 0 1 × l ϑ Δ ⁢ τ ⁢ 2 T 0 1 × l 0 1 × l 0 1 × l ϑ Δ ⁢ τ ⁢ 3 T ] T ,

{circumflex over (γ)} is the optimal estimated value of the two norm of the optimal weight matrix ϕ=||ω 66 γ * || 2 ; ω 66 γ * and δ Δγk are respectively the optimal weight matrix and Gaussian fuzzy basis function for approximating the fuzzy logic system with unknown saturation deviation Δγ; where k is 1, 2 or 3; l is a positive integer; T stands for transpose.

Further preferably, the non-singular finite-time dynamics controller is

In the formula, δ 2 is a normal number with a small value; τ̆ sat is the calculation of non-singular dynamics intermediate control variables; τ sat is the control command; ê is the speed tracking error.

The robust term is τ rob =−Tanh (ê)Ê.

In the formula, Ê is the adaptive estimation term of the compounded disturbances with unknown upper bound; ê is the speed tracking error.

›BRIEF DESCRIPTION OF THE DRAWINGS

FIG. 1 is a block diagram of a non-singular finite-time control method for prescribed performance dynamic positioning of unmanned boat provided by an embodiment of the present disclosure.

FIG. 2 is a diagram showing dynamic positioning result of an unmanned boat at different initial positions provided by an embodiment of the present disclosure.

FIG. 3 is a control force curve diagram under different initial conditions provided by an embodiment of the present disclosure.

FIG. 4 is a curve diagram of dynamic positioning errors of an unmanned boat at different initial positions provided by an embodiment of the present disclosure.

›DESCRIPTION OF THE EMBODIMENTS · 1 of 3

In order to make the purpose, technical solution and advantages of the present disclosure more comprehensible, the present disclosure will be further described in detail below in conjunction with the accompanying drawings and embodiments. It should be understood that the specific embodiments described here are only used to explain the present disclosure, not to limit the present disclosure.

As shown in FIG. 1 , the present disclosure provides a non-singular finite-time control method and system for prescribed performance dynamic positioning of unmanned boat. The method aims to achieve error convergence in a finite time while avoiding potential singularity problems. Also, the accuracy of control and safety of unmanned boat are ensured in the process of dynamic positioning through prescribed performance. Firstly, a non-singular finite-time virtual velocity law is designed at the kinematic level to provide reference velocity input for the unmanned boat. Then the minimum parameter learning method is integrated to design a fuzzy supervisory saturation compensated law to deal with the input saturation phenomenon of the actuator. In the meantime, in order to ensure that the unmanned boat is able to accurately track to the reference speed when the model is unknown, an adaptive fuzzy approximation term for the unknown signal of the system is further designed based on the fuzzy logic system of the integrated minimum parameter learning method, so as to eliminate the need for accurate modeling needs. Meanwhile, it is possible to reduce the computational burden. Finally, a non-singular finite-time prescribed performance dynamics controller is designed, which avoids the singularity problem caused by the conventional finite-time power term, so that the tracking error is within the prescribed performance limit in the whole process, and convergence in finite time is achieved for dynamic positioning control of the unmanned boat.

As shown in FIG. 1 , a non-singular finite-time control method for prescribed performance dynamic positioning of unmanned boat provided by the present disclosure is specifically as follows:

Step 1 is obtaining a difference between the actual measured position and the desired position of the unmanned boat to obtain the position error of the unmanned boat.

Step 2 is performing prescribed performance transformation after decomposing the unmanned boat position error according to the longitudinal transformation position, lateral transformation position and heading transformation position to obtain prescribed performance error transformation variables.

Step 3 is designing a non-singular finite-time virtual velocity law at the kinematic level to provide reference velocity input for unmanned boats. Specifically:

The designed non-singular finite-time virtual velocity law is as follows

In the formula, J(Ψ) is the rotation matrix that transforms the unmanned boat hull coordinate system into a fixed coordinate system,

J ⁡ ( ψ ) = [ cos ⁢ ψ - s ⁢ in ⁢ ψ 0 sin ⁢ ψ cos ⁢ ψ 0 0 0 1 ] ,

J(Ψ) T is the transpose matrix of J(Ψ) , Ψ represents the heading angle of the unmanned boat; G is the prescribed performance gain matrix; G −1 is the inverse matrix of G ; δ 1 is a small positive definite parameter that is artificially selected to avoid singularity phenomena; Z 1 is the transformed position error vector and defined as follows: Z 1 =[Z 11 , Z 12 , Z 13 ] T =ξ−ξ d .

In the formula,

ξ = 1 2 ⁢ ln ⁡ ( χ ⁢ β u + β l ⁢ β u β l ⁢ β u - χ ⁢ β u ) ;

ξ is the prescribed performance transformation variable; β 1 and β u are the selected control parameters; X=η e | ρ; η e is the position error; ρ is the prescribed performance function; ξ d [0,0,0] T ; Z 11 ,Z 12 ,Z 13 are respectively the longitudinal transformation error, lateral transformation error and heading transformation error between the actual measured position and the desired position of the unmanned boat.

ᾰ is the intermediate control variable shown in the following formula:

ᾰ= K 1 Z 1 +ζ 1 (Z 1 )− GF.

In the formula, K 1 =diag (k 11 ,k 12 ,k 13 ) is the designed positive definite matrix; F=η e ρ|ρ; ζ 1 (Z 1 )=[ζ(Z 11 ), ζ(Z 12 ), ζ(Z 13 )] T is a piecewise function to avoid singularity, wherein ζ(Z 1i ) is a non-singular finite-time operator, and is specifically as follows

In the formula, 0<ζ 1 <1, γ=((2l−1)/(2l+1))(l>2,lϵN), ζ 1 , and l are all design parameters; N is a positive integer, β 1i and β 1i are used to ensure the differentiability of the piecewise function ζ(Z 1i ) at the point Z 1i =±ζ 1 , and the specifically value thereof is β 1i =S 1i ζ 1 2γ−2 (2−γ), β 1i =S 1i ζ 1 2γ−4 (γ=1) is a control parameter; ζ 1 2γ−2 (2−γ) and ζ 1 2γ−4 (γ−1) are functions provided to avoid singularity and ensure continuousness.

Step 4 is obtaining the difference between the reference speed and the actual measured speed to obtain the speed tracking error.

Step 5 is integrating the minimum parameter learning method to design a fuzzy supervisory saturation compensated law to deal with the input saturation phenomenon of the actuator. Specifically:

The fuzzy supervisory saturation compensated law is

In the formula, γ is the switching factor based on the saturation command deviation, when γ reaches the set threshold, γ=1, otherwise γ=0; θ Δτ T , is the transpose matrix of θ Δτ ; ê=v−Δ is the speed tracking error;

θ Δ ⁢ τ = [ ϑ Δ ⁢ τ ⁢ 1 T 0 1 × l 0 1 × l 0 1 × l ϑ Δ ⁢ τ ⁢ 2 T 0 1 × l 0 1 × l 0 1 × l ϑ Δ ⁢ τ ⁢ 3 T ] T ,

{circumflex over (ϕ)} is the optimal estimated value of the two norm of the optimal weight matrix ϕ=||ω Δτ *|| 2 and δ Δτk are respectively the optimal weight matrix and Gaussian fuzzy basis function for approximating the fuzzy logic system with unknown saturation deviation Δτ; k is 1, 2 or 3; l is a positive integer.

Δτ=ω Δτ *T δ Δτ +ξ Δτ

In the formula, Δτ is the deviation between the control command and the saturation limit caused by the input saturation constraint phenomenon, ω Δτ * is ω Δτ *T is the transpose matrix of ω Δτ *, δ Δτ =[δ Δτ1 ,δ Δτ2 ,δ Δτ3 ] is a fuzzy basis function, ξ Δτ is a bounded approximation error.

›DESCRIPTION OF THE EMBODIMENTS · 2 of 3

The designed fuzzy adaptive law is

In the formula, Γ 1 is an artificially set normal number; δ Δτ T is the transpose matrix of δ Δτ , and Proj(●) is the projection operator shown in the following formula.

In the formula,

p ⁡ ( ϕ ˆ ) =  ϕ ˆ  2 - r Ω 2 ϖ 2 + 2 ⁢ ϖ ⁢ r Ω ;

r Ω and ω are the normal constants of the design, and W is a variable in the projection operator.

Step 6 is designing an adaptive fuzzy approximation term for the unknown signal of the system based on the fuzzy logic system of the integrated minimum parameter learning method, so as to eliminate the need for accurate modeling and reduce the computational burden.

The designed adaptive fuzzy approximation term is

In the formula,

θ τ = [ ϑ τ ⁢ 1 T 0 1 × l 0 1 × l 0 1 × l ϑ τ ⁢ 2 T 0 1 × l 0 1 × l 0 1 × l ϑ τ ⁢ 3 T ] T ,

{circumflex over (σ)} is the optimal estimated value of the two-norm of the ideal weight σ=||ω τ *|| 2 , {circumflex over (σ)}=diag ({circumflex over (σ)} 1 ,{circumflex over (σ)} 2 , {circumflex over (σ)} 3 ) ; ω τ * and δ τk are respectively the ideal weight and the Gaussian fuzzy basis function used to approximate the unknown model dependency term as follows; where k is 1, 2 or 3; l is positive integer.

The unknown model is Dv+M{dot over (α)}=ω τ *T δ τ +ξ τ .

In the formula, D is the damping matrix, v is the velocity vector of the unmanned boat in the hull coordinate system, M is the inertia matrix, {dot over (Δ)} is the first derivative of the non-singular finite-time virtual velocity law Δ, ω τ *T is the transpose of the matrix ω τ *, ω τ * refers to the ideal weight matrix of the fuzzy logic system , δ τ is a fuzzy basis function, ξ τ represents a bounded estimation error; D and M are dependency terms.

The designed two-norm adaptive law of the fuzzy system is

In the formula, Γ 2 , are the set positive parameters.

Step 7 is designing a non-singular finite-time prescribed performance dynamics controller, which avoids the singularity problem caused by the conventional finite-time power term, so that the tracking error is within the prescribed performance limit in the whole process, and convergence in finite time is achieved for dynamic positioning control of the unmanned boat.

The non-singular finite-time dynamical controller is

In the formula, δ 2 is a normal number with a small value, which may be considered as a setting to avoid singular phenomena; τ̆ sat is an intermediate control variable of dynamics, and specifically as follows.

{circumflex over (τ)} sat = J (Ψ) T G T Z 1 +τ mod + K 2 ê+ζ 2 (ê)−τ sup −τ rob

In the formula, K 2 is a set positive parameter, τ sup is provided to deal with input saturation, τ rob is a robust term; ζ 2 (e)=[ζ(ê 1 ),ζ(ê 2 ),ζ(ê 3 )] T is a dynamic non-singular finite-time control term; where ζ(ê i ) is:

In the formula, S 2i is the control parameter, β 2i and β 2i are provided to ensure the differentiability of the piecewise function ζ(ê i ) at point ê i =±ζ 2 , and its specific value is β 2i =S 2i ζ 2 2γ−2 (2−γ), β 2i =S 2i ζ 2 2γ−4 (γ−1).

In order to ensure the robustness of the closed-loop system under complex disturbances, the robust term is designed as:

τ rob =−Tanh (ê)Ê

In the formula, Tanh(ê)=diag(tanh(ê 1 /Δ),tanh(ê 2 /Δ),tanh(ê 3 /Δ)), and tanh(*)=(e*−e −* )/(e*+e −* ), where e represents a natural constant, Δ is an artificially set normal number; Ê is a adaptive estimation term of the compounded disturbances with an unknown upper bound, and its adaptive law is:

In the formula, Γ 3 and λ 3 both are set normal constants.

Step 8 is programming the above control method using C language, and analyzing the information returned by the navigation information determining unit according to the communication protocol, and the navigation information includes, for example, the position and attitude of the unmanned boat. Then, the navigation information obtained by the sensor is calculated to obtain the control output command according to the on-board controller unit. Finally, the control signal is transformed into a signal such as a speed, and the calculated propeller speed command is provided to realize precise dynamic positioning under external environment interference.

The present disclosure provides a non-singular finite-time control system for prescribed performance dynamic positioning of unmanned boat, and the system includes a sensor, a first subtractor, a prescribed performance mapping unit, a second subtractor, a virtual velocity law constructing unit, a fuzzy supervisory compensated constructing unit, a fuzzy logic system constructing unit, a robust adaptive estimation constructing unit, and a non-singular finite-time dynamical controller constructing unit.

The output end of the sensor is connected to the input end of the first subtractor and the second subtractor. The output end of the first subtractor is connected to the input end of the prescribed performance mapping unit. The output end of the prescribed performance mapping unit is connected to the input end of the virtual velocity law constructing unit. The output end of the virtual velocity law constructing unit is connected to the second subtractor. The output end of the second subtractor is connected to the fuzzy supervisory compensated constructing unit, the fuzzy logic system constructing unit, the robust adaptive estimation constructing unit and non-singular finite-time dynamical controller constructing unit.

The sensor is configured to collect the actual measured speed and position of the unmanned boat in real time. The first subtractor is configured to obtain a difference between the actual measured position and the desired position of the unmanned boat to obtain the position error of the unmanned boat.

The prescribed performance mapping unit is configured to perform prescribed performance transformation after decomposing the unmanned boat position error according to the longitudinal transformation position, lateral transformation position and heading transformation position to obtain prescribed performance error transformation variables.

›DESCRIPTION OF THE EMBODIMENTS · 3 of 3

The virtual velocity law constructing unit is configured to construct a non-singular finite-time virtual velocity law as a reference velocity for unmanned boats based on prescribed performance error transformation variables and non-singular finite-time operators.

The second subtractor is configured to obtain the difference between the reference speed and the actual measured speed to obtain the speed tracking error.

The fuzzy supervisory compensated constructing unit is configured to integrate the speed tracking error with the deviation between the control command and the saturation limit to calculate the fuzzy supervisory saturation compensated law by constructing fuzzy supervisory compensated.

The fuzzy logic system constructing unit is configured to integrate the speed tracking error to construct a fuzzy logic system to calculate the adaptive fuzzy approximation term.

The robust adaptive estimation constructing unit is configured to calculate a robust term according to speed tracking error and an adaptive estimation term of compounded disturbances with unknown upper bound.

The non-singular finite-time dynamical controller constructing unit is configured to introduce a kinematically non-singular finite-time control term and combining fuzzy supervisory saturation compensated law, adaptive fuzzy approximation term and robust term to construct a non-singular finite-time dynamical controller to output control commands; the control commands contain a force or a moment pre-applied on the unmanned boat; a force or moment is applied to the unmanned boat to adjust the propeller speed of the unmanned boat, thereby realizing positioning of the unmanned boat.

Further preferably, the non-singular finite-time virtual velocity law is

In the formula, J(Ψ) is the rotation matrix that transforms the unmanned boat hull coordinate system into a fixed coordinate system; J(Ψ) T is the transpose matrix of J(Ψ) Ψ represents the heading angle of the unmanned boat; G is the prescribed performance gain matrix; G −1 is the inverse matrix of G; δ 1 is a small positive definite parameter; Z 1 is the transformed position error vector; ᾰ is the intermediate control variable for calculating the non-singular finite-time virtual velocity law, and the calculation is performed by using a non-singular finite-time operator.

Further preferably, the adaptive fuzzy approximation term is

In the formula, ê is the speed tracking error;

θ τ = [ ϑ τl T 0 1 × l 0 1 × l 0 1 × l ϑ τ ⁢ 2 T 0 1 × l 0 1 × l 0 1 × l ϑ τ ⁢ 3 T ] T ,

{circumflex over (σ)} is the optimal estimated value of the two norm of the optimal weight matrix σ=||ω τ *|| 2 , {circumflex over (σ)}=diag({circumflex over (σ)} 1 ,{circumflex over (σ)} 2 ,{circumflex over (σ)} 3 ); ω τ * and δ τk are respectively the optimal weight and the Gaussian fuzzy basis function used to approximate the unknown model dependency term.

Dv+Mα=ω τ *T δ 96 +ξ τ

In the formula, D is the damping matrix, v is the velocity vector of the unmanned boat in the hull coordinate system, M is the inertia matrix, {dot over (α)} is the first derivative of the non-singular finite-time virtual velocity law α, ω 96 *T is the transpose of the matrix ω τ *, ω τ * refers to the ideal weight matrix of the fuzzy logic system , δ 96 is a fuzzy basis function, ξ τ represents a bounded estimation error.

The fuzzy supervisory saturation compensated law is

In the formula, γ is the switching factor based on the saturation command deviation, when γ reaches the set threshold, γ=1, otherwise γ=0; θ Δτ T is the transpose matrix of θ Δτ ; ê is the speed tracking error;

θ Δ ⁢ τ = [ ϑ Δ ⁢ τ ⁢ 1 T 0 1 × l 0 1 × l 0 1 × l ϑ Δ ⁢ τ ⁢ 2 T 0 1 × l 0 1 × l 0 1 × l ϑ Δ ⁢ τ ⁢ 3 T ] T ,

{circumflex over (ϕ)} is the optimal estimated value of the two norm of the optimal weight matrix are respectively the optimal weight matrix and Gaussian fuzzy basis function for approximating the fuzzy logic system with unknown saturation deviation Δτ.

Δτ=ω Δτ *T δ Δτ +ξ Δτ

In the formula, Δτ is the deviation between the control command and the saturation limit caused by the input saturation constraint phenomenon, ω Δτ * is the optimal weight matrix, ω Δτ *T is the transpose matrix of ω Δτ * , δ Δτ =[δ Δτ1 , δ Δτ2 ,δ Δτ3 ] is a fuzzy basis function, ξ Δτ is a bounded approximation error.

Further preferably, the non-singular finite-time dynamical controller is

In the formula, δ 2 is a normal number with a small value; τ̆ sat sat is the calculation of non-singular dynamics intermediate control variables; τ sat is the control command; ê is the speed tracking error.

The robust term is τ rob =−Tanh(ê)Ê.

In the formula, Ê is the adaptive estimation term of the compounded disturbances with the unknown upper bound; ê is the speed tracking error.

›Example

In order to verify the effect of the dynamic positioning control method in the present disclosure, a certain unmanned boat was adopted as the simulation object to carry out the following simulation experiments. In order to fully verify the effectiveness of the designed control algorithm, the unmanned boat was set out from two different initial positions in the simulation, and the position 1: [5m,5m,10 o ] T , position 2: [−5 m,−5 m,−10 o ] T .

The simulation results are shown in FIG. 2 to FIG. 4 . FIG. 2 is a diagram showing dynamic positioning result of an unmanned boat at different initial positions under the action of non-singular finite-time prescribed performance dynamics controller. FIG. 3 is a control force curve diagram of unmanned boat under different initial conditions. FIG. 4 is a curve diagram of dynamic positioning errors of an unmanned boat at different initial positions. It can be seen that although the unmanned boat starts from different initial conditions, the position of the unmanned boat will gradually converge to the desired position as time goes by, and in the whole process, the lateral, longitudinal and heading errors of the unmanned boat are all within the preset limits that are set in advance, so the safety of the whole process of unmanned boat dynamic positioning is ensured.

Generally speaking, compared with the related art, the above technical solution conceived by the present disclosure has the following advantageous effects.

The non-singular finite-time control method and system for prescribed performance dynamic positioning of unmanned boat provided by the present disclosure adopt the prescribed performance technology

( ξ = 1 2 ⁢ ln ⁡ ( χβ u + β l ⁢ β u β l ⁢ β u - χβ u ) )

to constrain the dynamic top position error, and improve the operation accuracy of unmanned boat. In the meantime, the fuzzy logic system integrated with the minimum parameter learning method estimates the dependency term and 10 saturation deviation of the unmanned boat model parameter matrix (D and M), offsetting the input saturation and unmanned boat model uncertainty while reducing the computational burden. In the design of virtual control law and dynamic controller, the advantage of smooth sign function is adopted for reference, and the intermediate control variable τ̆ sat is used to perform bounded smoothing to obtain

τ s ⁢ a ⁢ t = - τ ⌣ s ⁢ a ⁢ t ⁢ τ ⌣ s ⁢ a ⁢ t T ⁢ e ^ e ^ T ⁢ τ ⌣ s ⁢ a ⁢ t ⁢ τ ⌣ s ⁢ a ⁢ t T ⁢ e ^ + δ 2 2 .

Meanwhile, considering that the power term in conventional finite-time control may have singular when the error is zero, a non-singular finite-time term that is switched along with the tracking velocity error is designed in the virtual control law and dynamic controller. By properly constructing the switching function, the continuity of the algorithm at the switching point is ensured while ensuring convergence at finite time. In summary, the present disclosure ensures the non-singular finite-time prescribed performance dynamic positioning control of the unmanned boat in the presence of model uncertainty and input saturation constraints.

It is obvious for those skilled in the art that the above descriptions are only preferred embodiments of the present disclosure, and are not intended to limit the present disclosure. Any modifications, equivalent replacements and improvements made within the spirit and principles of the present disclosure should all be included within the protection scope of the present disclosure.

›Tables in the description — 1
Pro⁢
j⁡(
w,
ϕˆ
)
=
{
w,
p⁡(
ϕˆ
)
<0
w,
p⁡(ϕˆ)
≥0
,
∂pT∂ϕˆ⁢w
≤0
w⁢
p⁡(ϕˆ)⁢∂p∂ϕˆ⁢∂pT∂ϕˆ∂p∂ϕˆ2
⁢w
,
other

Claims as granted

8 claims

Log in to read the claims of this application.

Log in to unlock

Classifications

2 codes
IPC · International Patent Classification
Section B — Performing operations; transporting
  • B63H25/04
Section G — Physics
  • G05D1/02

Claim changes

Soon
Coming soonHow the claims changed between publication and grant

See which claims were amended, added or cancelled during examination, with every added and removed word marked.

AmendedAddedCancelledUnchanged

The published claims of this application are not paired with the granted ones in what we hold.

File wrapper

⤢ drag to zoomAprMayJunJulAugSepOctNovDecUSPTOApplicantNotice of allowance
USPTOApplicanthover for detail · click to open
Pendency
0.4 y
137 days filing → grant
Office actions
0
none on record
Examiner
Mcdieunel Marc
art unit 3664 · TC 3600
Citations: 16 back · 0 forward

See the full prosecution history — every USPTO and applicant action on this file, in order.

Log in to unlock

Documents

Log in to open the documents of this file: the application as filed, every office action and response, the notice of allowance.

Log in to unlock

Chain of title

⤢ drag to zoom20242026202820302032203420362038204020422044Owner 1
Titlehover for detail · click to open

See the full assignment history — every owner this patent has passed through, with recordation dates and reel/frame numbers.

Log in to unlock