Straight-line path following for asymmetric unmanned platform with disturbance estimation

Yu-long Hua1 , Xiao-zhou Zheng2 , Bao-shan Chi3 , Wei Sun4

1, 2, 3, 4Department of Mechanical Engineering, Academy of Armored Forces Engineering, Beijing 100072, China

1Corresponding author

Journal of Measurements in Engineering, Vol. 4, Issue 3, 2016, p. 173-182. https://doi.org/10.21595/jme.2016.17743
Received 20 April 2016; received in revised form 19 September 2016; accepted 24 September 2016; published 30 September 2016

Copyright © 2016 JVE International Ltd.

Abstract.

The problem of straight-line path following for asymmetric unmanned platform exposed to unknown disturbances was addressed in this paper. The mathematical model of asymmetric unmanned platform was established and the inputs in sway and yaw directions were decoupled, which facilitated the establishment of control strategy of path following. The guidance law and the cross-track error were derived from the classical line-of-sight (LOS) guidance principle. And the equilibrium point of the cross-track error was proven to be uniformly semiglobally exponentially stable (USGES), which guaranteed the exponential convergence to zero. A new disturbance estimation law was developed by adding a linear item of the estimation error into the classical one, which improved the principle’s precision and sensitivity dramatically. The control strategy was developed based on the integrator backstepping technique and the new disturbance estimation law, which made the equilibrium system to be uniformly globally asymptotically stable (UGAS). Computer simulations were conducted to verify the effectiveness of the estimation and control laws during straight-line path following for asymmetric unmanned platform in the presence of unknown disturbances.

Keywords: asymmetric unmanned platform, disturbance estimation, integrator backstepping technique, line-of-sight guidance, path following.

1. Introduction

Unmanned platforms, as a kind of surface vessels, rely heavily on the guidance systems to accomplish path following scenarios [1], especially for asymmetric ones exposed to environmental disturbances such as wind, waves and currents. An overview of path following methods for unmanned surface vessels has been developed in [2, 3]. The path following methods for underactuated vehicles in the presence of large modeling parametric uncertainty using adaptive supervisory control that combines logic-based switching with Lyapunov-based techniques are discussed in [4]. An alternative model-based approach for robust adaptive path following is proposed in [5] and [6] on the basis of adaptive sliding mode control. The same problem was investigated in [7-9]. In [7, 9], the problem was formulated by a global diffeomorphism combined with backstepping technique, while in [8] was formulated by applying Serret-Frenet frame and model predictive control method. All the aforementioned references propose strategies under the assumption that the vessel is completely symmetric, which doesn’t really hold in practice. The path following for asymmetric vessels has also been discussed in [10-13]. [10, 11] decoupled the asymmetric system into two cascaded subsystems after two times diffeomorphism, and achieved the convergence of the tracking errors at the cost of the computation speed. [12, 13] proposed a simple-structure controller on the basis of line-of-sight (LOS) guidance principle and managed to steer an asymmetric vessel to follow the predefined path. But LOS is susceptible to environmental disturbances, and [12, 13] simply discussed the path following problem in the presence of constant ocean currents, it is necessary to continue studying methodologies that are robust to disturbances such as wind, waves and currents.

Motivated by [12, 13], based on an asymmetric unmanned platform this paper proposes a new simpler disturbance estimation law by adding a linear item of the estimation error into the classical one, then an adaptive path following controller is established based on the integrator backstepping technique, which makes the equilibrium system to be uniformly globally asymptotically stable (UGAS).

2. Mathematical model and problem statement

In this section, we will present the control objective and mathematical model of the platform considered in this paper.

2.1. Mathematical model

The unmanned platform is an approximately cubic port-starboard symmetric tank [14] with two nozzle-fixed but opening-adjustable waterjets located on both sides at a distance of 2l1, as is illustrated in Fig. 1, and a differential thrust steering scheme is therefore used. While there’s a difference in the openings of the left and right nozzle, i.e. βlβr, the yaw moment would produce. There are two reversing tunnels connected with the nozzles, where the extra water could squirt out to lateral anterior at an angle δ when the outlet of the nozzle is closing. l denotes the longitudinal distance from the center of the reversing tunnel outlet to point O, where O represents the center of gravity of the platform. For simplicity, we assume that the thrust force T produced by a single waterjet has a linear relationship with its nozzle opening [15], which is reasonable in practice. Consequently, applying the geometry yields:

(1)
X = 1 - t w T β r + β l - C T c o s δ 2 - β r + β l , Y = 1 + d Y C T s i n δ β r - β l , N = 1 + d N l 1 + C L ' T β r - β l ,

where L'=lsinδ+(Bcosδ)/2, L and B denote the overall length and beam of the platform; X and Y denote the surge and sway thrust forces, respectively, N denotes the yaw moment. C and tw denote the reversing thrust factor and the thrust deduction fraction, respectively; dY and dN denote the effect coefficients imposed on sway and yaw directions by the propellers.

Fig. 1. The structure sketch of unmanned amphibious platform

Obviously, it follows Eq. (1) that:

(2)
N = l τ Y ,

where lτ=1+dNl1+CL'/1+dYCsinδ.

Remark 1: Eq. (2) is nontrivial since the decreasement of control inputs would simplify the structure of path following controller.

In most cases, it is sufficient to consider a 3 degree-of-freedom (DOF) horizontal non-linear maneuvering model [16-18] which is shown that:

(3)
η ˙ = R ψ T υ ,           M υ ˙ + C υ υ + D υ = τ + τ w ,

where η=x,y,ψTR3 denotes earth-fixed position coordinates and heading angle, υ=u,v,rTR3 denotes the body-fixed velocities.

The matrices in Eq. (3) can be expressed as:

R ψ = c o s ψ s i n ψ 0 - s i n ψ c o s ψ 0 0 0 1 ,           M = M T = m 11 0 0 0 m 22 m 23 0 m 32 m 33 ,
C υ = 0 0 - m 22 v - m 23 r 0 0 m 11 u m 22 v + m 23 r - m 11 u 0 ,           D = D T = d 11 0 0 0 d 22 d 23 0 d 32 d 33 ,

where Rψ, M, Cυ and D are the rotation, inertia, Coriolis/centripetal and damping matrices, respectively.

The control inputs are: τ=τu,τv,τrT and all the forces and moments caused by wind, ocean current, second order wave loads, are collected in the vector: τw =τwu,τwv,τwrT . Since these disturbances are bounded and so slowly varying compared to the platform dynamics, it is reasonable to assume that τ˙w=0 and τwL in the controller synthesis.

2.2. Problem statement

The primary objective of this paper is to design a guidance and control system to steer the platform to converge to the predefined path C1 with the desired speed ud from any initial positions and orientations despite of the environmental disturbances.

3. LOS guidance system design

The LOS guidance law is a three-point guidance scheme for it involves a stationary reference point on the path in addition to the vessel and the desired position, mimicking a helmsman that commonly makes the vessel pursue the desired path through steering it towards a point located at a constant distance ahead of the vessel on the path [17, 18].

3.1. The desired heading angle

A C1 parameterized path (xpθ, ypθ), where θ 0 denotes the path variable, is assumed to go through a set of successive waypoints xi,yi for i= 1, 2, …, Np, as illustrated in Fig. 2. For any point (xpθ, ypθ) along the path, the path-tangential reference frame is rotated by an angle:

(4)
γ p θ = a r c t a n y p ' θ / x p ' θ ,

with respect to the North-East reference frame. Note that for a straight line γp(θ)=arctan((yi+1-yi)/(xi+1-xi)) is constant between the waypoints. For a platform located at the position (x, y) the LOS vector starts from (x, y) and ends up with the point (xlos, ylos), located on the path tangential at a distance > 0 ahead of the orthogonal projection of point (x, y). And the orientation of the LOS vector is donated as ψlos:

(5)
ψ l o s = γ p θ - a r c t a n d Δ ,

where d is the cross-track error, and is the lookahead distance.

Fig. 2. LOS guidance geometry

In LOS guidance system, the moving point (xlos, ylos) and the orientation angle ψlos are the desired point and angle that the platform is chasing for at each time instant. Consequently, the corresponding LOS guidance law is given by:

χ d = ψ l o s .

Commonly, a vehicle exposed to disturbances (such as wind, waves and ocean currents, etc.) exhibits variations in the velocities u, v and r. The response can be observed as a non-zero sideslip angle β during path following. This is also observed as a difference in heading angle ψ and course angle χ according to:

(6)
χ = ψ + β ,

where β=arctan(v/u).

This suggests that the LOS guidance law is chosen as:

(7)
ψ d = γ p θ - a r c t a n d Δ - β ,

where 0minmax.

3.2. The cross-track error

The cross-track error is computed as the orthogonal distance to the path-tangential reference frame defined by the point (xpθ, ypθ). Hence:

(8)
0 d = c o s γ p θ s i n γ p θ - s i n γ p θ c o s γ p θ R γ p θ x - x p θ y - y p θ ,

where RγpθSO2.

Expanding Eq. (8) gives the cross-track error:

(9)
d = - x - x p θ s i n γ p θ + y - y p θ c o s γ p θ ,

where θ propagates [13] according to Eq. (10):

(10)
θ ˙ = U x p ' θ 2 + y p ' θ 2 > 0 .

Differentiating Eq. (9) yields:

(11)
d ˙ = - s i n γ p θ x ˙ + c o s γ p θ y ˙ + s i n γ p θ x ˙ p θ - c o s γ p θ y ˙ p θ
            - c o s γ p θ x - x p θ + s i n γ p θ y - y p θ γ ˙ p .

The last bracket in Eq. (11) is zero because of the first line of Eq. (8). From Eq. (4) it follows that x˙pθsinγpθ-y˙pθcosγpθ=0. Consequently, Combine Eq. (3) and (11) yield:

(12)
d ˙ = u s i n ψ - γ p θ + v c o s ψ - γ p θ = U s i n ψ - γ p θ + β ,

where U=u2+v2.

In this paper we consider the special case where γpθ=γp is constant, that is straight-line paths such that:

(13)
d ˙ = U s i n ψ - γ p + β .

Theorem 1: The LOS guidance law Eq. (7) applied to the cross-track error dynamics Eq. (13) renders the equilibrium point d= 0 USGES if the lookahead distance and speed satisfy 0min  max and 0UminUUmax, respectively.

Proof. Inserting Eq. (7) into Eq. (13) gives:

(14)
d ˙ = - U Δ 2 + d 2 d .

Since U and is time varying the system Eq. (14) is nonautonomous. Consider the Lyapunov function candidate: Vt,d=d2/2> 0 when d 0. Hence:

V ˙ t ,   d = - U Δ 2 + d 2 d 2 0 .

Since Vt, d>0 and V˙t, d0 it follows that:

(15)
d t d t 0 ,         t t 0 .

Therefore, according to [19, 20] the origin d= 0 is uniformly stable.

Next, we define:

ϕ t ,   d U Δ 2 + d 2 .

For each r> 0 and all dtr, we have:

ϕ t ,   d U m i n Δ m a x 2 + r 2 c r .

Consequently:

V ˙ t ,   d = - 2 ϕ t ,   d V t ,   d - 2 c r V t ,   d ,           d t r .

In view of Eq. (15), the above holds for all trajectories generated by the initial conditions d(t0). Consequently, we have:

d t e - c r t - t 0 d t 0 ,

for all tt0, dt0r and r> 0.

Hence, we can conclude that the equilibrium point d= 0 is USGES.

4. Control system design

In this section, a model-based control method is performed by utilizing the integrator backstepping technique for the nonlinear maneuvering system Eq. (3) to design a uniformly globally asymptotically stable (UGAS) controller. And the design is divided into two coherent steps.

The overall design is conducted under the assumptions that all the reference signals are bounded and high order differentiable.

The heading angle and the velocity error dynamics are defined as:

(16)
ψ ~ ψ - ψ d = h T η - ψ d ,
(17)
z z 1 , z 2 , z 3 T = υ - α ,

where h0,0,1T, and αα1,α2,α3TR3 is a vector of stabilizing functions to be specified later.

Step 1. Define the first Lyapunov function candidate as: V1t,  ψ~=ψ~2/2>0 when ψ~0. Hence:

V ˙ 1 t ,   ψ ~ = h T υ - ψ ˙ d ψ ~ = ψ ~ h T z + ψ ~ α 3 - ψ ˙ d .

Choosing:

(18)
α 3 ψ ~ = - k 0 ψ ~ + ψ ˙ d ,

where k0> 0, gives:

V ˙ 1 = - k 0 ψ ~ 2 + ψ ~ h T z .

This concludes Step 1.

Step 2. Combine Eq. (3) and differentiate Eq. (17) yields:

(19)
M z ˙ = M υ ˙ - α ˙ = τ + τ w - C υ υ - D υ - M α ˙ .

Next, we need to expand the first Lyapunov function V1 as:

V 2 = V 1 + 1 2 z T M z + 1 2 τ ~ w T Γ - 1 τ ~ w ,

where τ~w=τw-τ^w and Γ=ΓT> 0 is the estimation error and gain matrices, respectively. τ^w is the estimation of the environmental disturbance vector τw. It should be noted that τw is slow varying and bounded, therefore, τ~˙w=-τ^˙w. Differentiating V2 along the trajectories of ψ~, z, τ~w gives:

V ˙ 2 = - k 0 ψ ~ 2 + ψ ~ h T z + z T M z ˙ + τ ~ w T Γ - 1 τ ~ ˙ w
            = - k 0 ψ ~ 2 + τ ~ w T Γ - 1 Γ z - τ ^ ˙ w + z T ψ ~ h + τ + τ ^ w - C + D α + z - M α ˙ .

Choosing the control input τ and the disturbance estimation law:

(20)
τ = M α ˙ + C + D α - τ ^ w - ψ ~ h - K z ,
(21)
τ ^ ˙ w = Γ z + Q τ ~ w ,

where K=diagk1,k2,k3 and Q=diagq1,q2,q3 are positive matrices to be specified, gives:

V ˙ 2 = - k 0 ψ ~ 2 - z T C + D + K z - τ ~ w T Γ - 1 Q τ ~ w 0 .

It follows from the theorems proposed by [17, 20] that ψ~, z, τ~w is uniformly stable.

Remark 2: Compared with the law developed by [17], Eq. (21) contains an additional item Qτ~w, which realizes the negative feedback regulation of τ~w, and when z approaches to its equilibrium point the estimation error τ~w will converge to zero exponentially.

Because of the uniform stability of z we have limtu=α1. Considering the control objective is to steer the platform travelling at the desired speed ud, it is reasonable to choose α1=ud.

Combining Eq. (2) and (20) gives:

(22)
m - 22 α ˙ 2 = d - 22 α 2 + g α 1 ,   α 3 ,   α ˙ 3 ,   τ ^ w ,   ψ ~ ,   z ,

where:

m - 22 = l τ m 22 - m 23 ,           m - 33 = m 33 - l τ m 23 ,        
  d - 22 = d 32 + c 32 - l τ d 22 ,           d - 33 = d 33 - l τ d 23 - l τ c 23 ,
g α ,   α ˙ 3 ,   τ ^ w ,   ψ ~ ,   z = m - 33 α ˙ 3 + c 31 α 1 + d - 33 α 3 - τ ^ w r + l τ τ ^ w v - ψ ~ + l τ k 2 z 2 - k 3 z 3 .

Theorem 2: The platform dynamics Eq. (3) with guidance, control and estimation laws Eqs. (7, 20, 21) renders the origin of the error system Eqs. (13), (16), (17) UGAS.

Proof. We can prove the Theorem 2 based on the control design and stability analysis above.

5. Simulations

In this section results from numerical simulations are presented. The developed control strategy is applied to an asymmetric unmanned platform. The vehicle has a 10 kN of maximum thrust for every waterjet, and other parameters are shown as follows [14]:

M = 28019 0 0 0 28020 3000 0 3000 387330 ,           D = 447 0 0 0 13121 4000 0 1600 42632 .

The objective is to make the platform follow the predefined path C1 with a desired surge speed ud= 3 m/s. The path C1 is chosen as a straight-line passing through point (5 m, 12 m) with a slope angle γp=π/6. The environmental disturbances presenting on the platform is bounded and slow variable, without loss of any generality, we here assume that the disturbances are generated as in Eq. (23).

(23)
τ w = 1000 - 5 4 1 + 100 s i n 0.2 t c o s 0.1 t 0.1 c o s 0.1 t .

To make the controllers Eq. (20-21) follow the desired references smoothly and estimate the disturbances precisely, the following gains are implemented: k0= 5,  = 30, K= diag{3000, 1.5, 0.5}, Γ= diag{1, 1, 2}, Q= diag{0.8, 0.5, 0.3}, lτ= 14.94. The platform is given an initial state of (20 m, 0 m, 0 rad/s, 1 m/s, 0 m/s, 0 rad/s).

Fig. 3. Straight-line path following of the platform

Fig. 4. Time evolution of the platform’s states

a) State of v

b) State of z

Fig. 3 shows how the path following is successfully achieved under control and estimation laws Eqs. (20-21). Fig. 4 shows all the platform’s states converge to equilibriums smoothly, and Fig. 5 shows a graceful time evolution of control inputs without saturation. Fig. 6 is a comparison between the estimation law Eq. (21) and that of [17] (denote the estimation law Eq. (21) as M1 and that proposed in [17] as M2 for simplicity). Fig. 6 is the time evolution of disturbance estimation errors, and Fig. 6(a) is the result of M1 and Fig. 6(b) of M2 with Γ= diag{200, 200, 400}. As is shown in Fig. 6(a), the disturbance estimation error converges exponentially to zero and stays at that equilibrium point afterthen, which coinsides well with our previous analysis. On the contrary, Fig. 6(b) shows the maximum of estimation error is nearly 20 kN, which might lead to saturation for control inputs. As a result, it is obvious to conclude the better performance of M1than that of M2.

Fig. 5. Time evolution of control inputs

Fig. 6. Time evolution of the disturbance estimation errors

a)M1

b)M2

6. Conclusions

A nonlinear adaptive path following strategy for estimation and compensation of the disturbances has been presented on the basis of integrator backstepping technique. The guidance law is derived from the classical LOS principle and the equilibrium points of the cross-track error is shown to be USGES, which guarantees the exponential convergence to zero. A new estimation law for disturbances is developed by adding a linear item of the estimation error into the classical one, which improves the estimation precision and sensitivity dramatically. The control strategy is developed based on the integrator back- stepping technique and the new disturbance estimation law, which makes the equilibrium system to be UGAS. In the end, computer simulations are conducted to verify the effectiveness of the control and estimation laws during straight-line path following for asymmetric unmanned platform in the presence of unknown disturbances.

References

  1. Breivik M., Hovstein V. E., Fossen T. I. Straight-line target tracking for unmanned surface vehicles. International Journal of Modelling, Identification and Control, Vol. 29, Issue 4, 2008, p. 131-149.
  2. Liao Yu Lei, Zhang Ming Jun, Dong Zao Peng, et al. Methods of motion control for unmanned surface vehicle: state of the art and perspective. Shipbuilding of China, Vol. 55, Issue 4, 2014, p. 206-216.
  3. Liu Chen Guang, Chu Xiu Xin, Wu Qing, et al. A review and prospect of USV research. Ship Building of China, Vol. 55, Issue 4, 2014, p. 194-205.
  4. Aguiar A. Pedro, Hespanha Joao P. Trajectory-tracking and path-following of underactuated autonomous vehicles with parametric modeling uncertainty. IEEE Transactions On Automatic Control, Vol. 52, Issue 8, 2007, p. 1362-1379.
  5. Liao Yu Lei, Zhang Ming Jun, Wan Lei Serret-Frenet frame based on path following control for underactuated unmanned surface vehicles with dynamic uncertainties. Journal of Central South University, Vol. 22, Issue 1, 2015, p. 214-223.
  6. Cheng Liu, Jian Zou Zao, Shan Li Tie Adaptive robust sliding mode control for ship straight-line tracking in random waves. Journal of Shanghai Jiaotong University (Science), Vol. 18, Issue 5, 2013, p. 549-553.
  7. Ghommam J., Mnif F., Derbel N. Global stabilization and tracking control of underactuated surface vessels. IET Control Theory and Applications, Vol. 4, Issue 1, 2010, p. 71-88.
  8. Wang Xiao Fei, Zou Zao Jian, Li Tie Shan, et al. Adaptive path following controller of underactuated ships using Serret-Frenet. Journal of Shanghai Jiaotong University (Science), Vol. 15, Issue 3, 2010, p. 334-339.
  9. Wang Yao Lu, Guo Chen Path flowing adaptive control for underactuated surface vessels based on RBF neural network. Journal of Dalian Maritime University, Vol. 41, Issue 1, 2015, p. 1-5.
  10. Wan Lei, Dong Zao-Peng, Li Yue-Ming, et al. Global asymptotic stabilization control of incomplete symmetry underactuated USV. Journal of Huazhong University of Science and Technology (Natural Science Edition), Vol. 42, Issue 8, 2014, p. 48-53.
  11. Zhang Zhong Cai, Wu Yu Qiang Switching-based asymptotic stabilization of underactuated ships with non-diagonal terms in their system matrices. IET Control Theory and Applications, Vol. 9, Issue 6, 2015, p. 972-980.
  12. Caharija Walter, Candeloro Mauro, Pettersen Kristin Y., et al. Relative velocity control and integral LOS for path following of underactuated surface vessels. 9th IFAC Conference on Manoeuvring and Control of Marine Craft. Arenzano, Italy: 2012.
  13. Fossen Thor I., Pettersen Kristin Y., Galeazzi Roberto Line-of-sight path following for Dubins paths with adaptive sideslip compensation of drift forces. IEEE Transactions On Control Systems Technology, Vol. 23, Issue 2, 2015, p. 820-827.
  14. Ju Nai Jun Hydrodynamics Analysis and Simulation for Amphibious Vehicle. Weapon Industry Press, Beijing, 2005.
  15. Hua Yu Long, Chi Bao Shan, Sun Wei, et al. Study on motion model of twin-propeller unmanned amphibious platform. Machinery Design and Manufacture. Vol. 9, 2015, p. 37-40.
  16. Breivik M., Fossen Thor I. Guidance-based path following for autonomous underwater vehicles. Proceedings of OCEANS 2005 MTS/IEEE, Washington, D.C., 2005, p. 2807-2814.
  17. Wang Hao Duo, Wang Qin Ruo, Wu Xiao Ze Uniformly globally asymptotically stable path following with integral gain-variable guidance law for ships. Control Theory and Applications, Vol. 32, Issue 6, 2015, p. 849-856.
  18. Fossen Thor I. Models for Ships, Offshore Structures and Underwater Vehicles. Handbook of Marine Craft Hydrodynamics and Motion Control, John Wiley and Sons Ltd., Chichester, UK, 2011.
  19. El-Sayed A. M. A., Nasr M. E. Existence of uniformly stable solutions of nonautonomous discontinuous dynamical systems. Journal of the Egyptian Mathematical Society, Vol. 19, 2011, p. 91-94.
  20. Fossen Thor I., Pettersen Kristin Y. On uniform semiglobal exponential stability (USGES) of proportional line-of-sight guidance laws. Automatica, Vol. 50, Issue 11, 2014, p. 2912-2917.