Abstract

Aiming at the sway velocity and uncertainties such as wind, wave, and current, a state feedback H∞ control method is proposed to improve the dynamic and steady-state performance with line of sight (LOS) law for trajectory tracking of an unmanned surface vehicle (USV). First, a novel LOS is proposed for trajectory tracking with the position error to obtain the references of surge velocity and heading angle. Second, the LPV model is established with varying parameters of the sway velocity for the USV. Third, the closed-loop system for the LPV model is established by the state feedback H∞ control method to design the controller. Since the coupling term of system coefficients in the Lyapunov stability condition is difficult to solve directly, a novel variable is introduced to decouple the stability condition, which can be solved with MATLAB LMI tools for the controller parameters. Finally, the simulation result shows that the proposed method has super performance on the dynamic and steady-state indices.

1. Introduction

The trajectory tracking is a key technology to autonomously navigate to execute various tasks for an unmanned surface vehicle (USV) [1]. Since there are many disturbances in river or ocean, such as wind, wave, and current, an accurate mathematical model is too difficult to be established for the USV to obtain an excellent performance of trajectory tracking. In order to improve the performance of trajectory tracking, the novel control technologies are always explored and presented for the USV.

The trajectory tracking technology for the USV is classified into two strategies of the direct and indirect method. The indirect method includes the guidance law and the controller of the heading angle and velocity. For the guidance law, the line of sight (LOS) guidance law is a useful method in the path following and trajectory tracking fields [2]. A modified LOS is proposed for an adaptive sliding mode path following of the USV to suppress unknown constant current and other external disturbances [3]. An improved integral LOS with time-varying look-ahead distance is proposed for a path-following control system for USV [4]. The look-ahead distance is a function of USV’s cruising speed and cross tracking errors. In order to eliminate the tracking errors, the dynamic equation of the tracking error is established with the time-varying current in Serret–Frenet coordinate system, and LOS is modified by the adaptive law of three variables to replace the unmeasurable current and side slip angle [5]. These modified LOS laws focus on the heading angle to reduce the following errors with the disturbance for path following. For trajectory tracking, LOS should simultaneously produce the surge velocity reference and the heading angle reference [6]. Here, a novel LOS will be presented to design the control variable references of surge velocity and heading angle for trajectory tracking to converge to the desired trajectory. To improve the system performance, many research achievements on trajectory tracking technology have been obtained in the past decade [7]. Many advanced control technologies are proposed for the trajectory tracking of USV, for example, the PID algorithm [8], sliding mode control (SMC) [1, 9, 10], backstepping method [11], andneural network [12]. Since there are many disturbances in water way, such as wind and waves, a robust control technology is always a useful method to achieve an excellent trajectory tracking performance in complex environments. A μ-synthesis robust controller is designed to suppress the uncertainties of the Nomoto model of USV and the disturbances caused by waves [13]. Considering the influence of varying surge velocity on heading control, a state feedback H∞ heading control is proposed for the LPV model with surge velocity [14]. A linear parameter varying (LPV) model was presented with varied velocity parameters to adjust the course under different velocity conditions [15]. A robust H∞ heading control method based on convex hull is proposed to effectively suppress the adverse effect of system uncertainty [16]. A state feedback (SF) H∞ robust controller is proposed for the LPV model with variable mass parameters without considerations of USV sway velocity [17]. Due to the influence of wind and wave on the current surface, the roll speed of the USV almost exists in the process of steering, which results in an increment of the sway velocity [18]. So, it is very important for the design on SF H∞ controller with the consideration of the sway velocity to improve the system performance of trajectory tracking.

Here, the SF H∞ method is proposed for trajectory tracking of USV with considerations of sway velocities to suppress the uncertainties and disturbances, including the design on the LOS guidance law and the controller. First, the position error model of USV’s motion is established for trajectory tracking. Second, a novel LOS with the position errors is proposed to produce the heading angle reference and the surge velocity reference for trajectory tracking to guarantee that the USV converge to the desired trajectory quickly. Third, the LPV model is established with different sway velocities for the USV dynamic model, and the SF H∞ method is used to design the closed loop system of the LPV model with the Lyapunov function. Since the Lyapunov function has the coupling term of system parameter matrix parameters, it is decoupled with the novel variable to obtain the stability condition. Moreover, the stability condition is a linear matrix inequality to be solved by the MATLAB LMI toolbox for the controller parameters. Finally, the proposed SF control method for trajectory tracking is verified effective to suppress the influence of sway velocities and has a super dynamic and stable state system performance through the simulation comparisons.

This paper is organized as follows. In Section 2, the USV motion error model is established. In Section 3, an error correction is introduced to design the LOS guidance law. In Section 4, SF controller is designed to obtain the lateral torque control law and longitudinal thrust control law. Finally, the simulation result is discussed in Section 5.

2. Position Error Model of USV Motion

2.1. Kinematics Model

Since the earth is supposed as a plane, Figure 1 shows the motion diagram of USV. (x, y) is the center position of USV’s mass in the earth coordinate, (xd, yd) is the position to be tracked, ψd is the desired heading angle, ψ is the heading angle, , , and r are the surge velocity, sway velocity, and yaw velocity of USV, respectively.

The kinematics mathematical motion model is as follows [19]:

Usually, USV is assumed as symmetry both from front to rear and from left to right, and the mass center is located in the hull center. With the system parameter uncertainties, the dynamic model is as follows [19]:where, d11, d22, d33, m11, m22, and m33 are the hydrodynamic damping coefficients and the inertial parameters including the additional mass. τu and τr are the longitudinal thrust and lateral steering torque, respectively; τuw, τvw, and τrw are the interference forces and torques of the USV generated by external wind, waves, and currents, respectively.

2.2. Position Error Model of Trajectory Tracking

In Figure 1, along the tangent and centripetal direction through the point (xd, yd), the position tracking errors of tangent error xe and centripetal error ye are defined as follows:where ψd ∈ [-π, π], and ψd is as follows:where atan2 is the arctangent function.

In Figure 1, the speed Ud on desired trajectory is as follows [6]:

With equations (1) and (5), the derivative of equation (3) is as follows:where is the combined speed of USV, and β = atan2() ∈ [−π, π] is the sideslip angle, produced by the sway velocity . Equations (6) and (7) are the dynamic models with position error for USV trajectory tracking.

3. LOS with Position Errors for Trajectory Tracking

For trajectory tracking, LOS should produce both the reference of heading angle and the reference of surge velocity.

3.1. LOS for the Heading Angle

The Lyapunov function V is defined as follows:

The derivative of equation (8) is as follows:

In Figure 1, (xΔ, yΔ) is the position in the tangential direction and Δ is the distance between (xd, yd) and (xΔ, yΔ). In order to regulate the USV’s heading angle to (xΔ, yΔ), LOS for the heading angle is designed as follows:where ψr is the reference heading angle by LOS.

3.2. LOS for Surge Velocity

If the control system of the heading angle has an excellent performance, which is supposed as ψ = ψr, equation (9) is as follows:The reference speed Ur of USV is designed as follows:where k > 0.

If U = Ur, equation (11) is as follows:

Since U and k > 0, always holds for any xe and ye. In order to assure xe and ye converge to zero to track the desired trajectory for USV, the longitudinal thrust control law and the lateral torque control law should be designed for U and ψ to converge to Ur and ψr.

Since USV is an underactuated system without lateral driving force, the lateral torque is usually small to prevent accidents. If the sway velocity is assumed to be small, the reference surge velocity ur is equal to Ur in equation (12), i.e.,where ur is the surge velocity by LOS.

When the actual heading angle ψ and the surge velocity u of USV can track ψr and ur, xe and ye can converge to zero, which means the USV can track the desired trajectory. So, it is important to design longitudinal thrust controller and the lateral torque controller to ensure U and ψ converge to Ur and ψr quickly.

4. SF Control for the LPV System

4.1. LPV System with Sway Velocity

The heading angle error ψe is defined as follows:where ψr is assumed to be constant in a sampling cycle, the derivative of equation (15) is as follows:

Surge velocity error ue is defined as follows:where is also assumed to be constant in a sampling cycle. With equation (17), equation (2) is as follows:

The novel variables are designed as follows:

The state variable is ξ = [ue, r, ψe]T, and the system measurement output y is the heading angle error ψe. The system state equations with equation (16) and (18) are as follows:where z is the modulated output and A() is the system coefficient matrix with the relation of the sway velocity , i.e.,where are the system constant coefficients, τ is the torque control variable, and is the disturbance vector. Equation (20) is the LPV system with sway velocity and the uncertainty for USV.

4.2. SF H∞ Controller Design

The SF H∞ control method is proposed for the LPV system of equation (20). The control variable τ is as follows:where K is the controller parameter to be solved. With the control variable τ, the closed-loop system satisfies the following properties [20]: (1) the closed-loop system is internal stable, which means all the eigenvalues of the state matrix in the closed-loop system are in the left half open complex plane and (2) the H∞ norm of the closed-loop transfer function Twz(s) from the disturbance to the output z is less than γ, i.e, ||Twz(s)|| < γ. The H∞ constraint condition J is as follows:

With equation (22), the closed-loop system from equation (20) is as follows:where Acl is coefficient matrix, Acl = A + B2K.

Theorem 1. For equation (24), there exist symmetric positive definite matrices X and matrices S, Y. If the matrix Π satisfieswhere K = YS−1, L = X − S − λ(AS + B2Y)T, the given scalars are γ > 0, λ < 0, and he is the equation he(X) = X + XT, and the closed-loop system of equation (24) is asymptotically stable and satisfies the H∞ constraint condition of equation (23).

Proof. The Lyapunov function is constructed as follows:where P is a symmetric positive definite matrix.
For the constant matrix Tj(j = 1, 2) with appropriate dimension, it can be obtained from equation (23) as follows [21]:With equation (20), the derivation of the Lyapunov function in equation (27) is as follows:where J = P + T1T − (T2TAcl)T.
With equation (27), equation (23) is as follows:where , andwhere I is the unit matrix.
Since V(x) > 0, equation (30) is true when Λ < 0. According to Schur lemma [20], Λ < 0 can be equivalent to the matrix, i.e.,In fact, Φ < 0 can satisfy the bounded real lemma [21]. That is,The matrix is selected such that , and it followsSo, ΞTΦΞ < 0 is equivalent to Φ < 0. In fact, it can be seen that equation (33) is a submatrix of equation (34). Obviously, if ΞTΦΞ < 0 has a feasible solution, this solution must be the feasible solution of equation (33). So, equation (34) can satisfy the bounded real lemma.
In order to satisfy the Inequality 31, T2 is selected a negative definite matrix, T = −T1, and λT = T2 < 0. Inequality 31 is as follows:With Acl = A + B2K, equation (35) is as follows:where .
The variables are selected such that S = T−1, , and it followswhere .
When the variables are selected, Y = KS and , Inequality 36 is as follows:Inequality 37 is equal to equation (25). For the LPV system of equation (20), the Lyapunov stability condition of the SF H∞ system is equation (25). The proof is over.

5. Simulation Analysis

A small USV is used as the analysis object with the parameters [22] m11 = 1.956, m22 = 2.405, m33 = 0.043, d11 = 2.436, d22 = 12.992, and d33 = 0.0564. The external disturbance is τuw = τrw = rand(). Figure 2 is the control block diagram of the USV. The LOS law consists of equations (10) and (12) to produce the reference ψr and ur, respectively. Equation (22) is the SF H∞ controller to produce τu and τr. The parameter K of the SF H∞ controller in equation (22) can be obtained by the LMI toolbox for the solution of Inequality 25 and Inequality 26.

To keep smooth sailing for the USV, the reference surge velocity ur should be limited as follows:

The variable de is the trajectory error defined as de = ((xd)2 + (yd)2)0.5 − (x2 + y2)0.5. In order to verify the SF H∞ control system performance, the ESO method [6] was used to control trajectory tracking for the USV by replacing with equation (22).

5.1. Circular Trajectory Tracking

The given reference trajectory is a circle with the function of xd(t) = 10sin(0. 1t) and yd(t) = 10cos(0. 1t). The reference trajectory is a circle with the radius of 10m, the reference speed of 1 m/s, and the initial reference input (xd(0), yd(0)) = (0, 10). The initial position and heading angle of the USV are x(0) = 0 m, y(0) = 1.5 m, and ψ(0) = 0 rad; the initial velocities of the USV are set as (0) = 0 m/s and r(0) = 0 rad/s. To demonstrate the suppression of sway velocity by the SF H∞ method, the sway velocity is 0.2 m/s, 0.5 m/s, and 1.0 m/s for simulations.

Figure 3 shows the circular trajectory tracking with  = 0.5 m/s. The two curves are the trajectories by the SF H∞ control method and the ESO method, respectively. The SF method has not overshoots and can track circular trajectories more smoothly. Moreover, it has a smaller tracking error than the ESO method in the steady state.

Figures 46 are circular trajectory response of de, , and ψe with different values of . When  = 0.2 m/s, 0.5 m/s, and 1.0 m/s, the errors de of the SF H∞ method have no overshoots but those of the ESO method have overshoots of 3.4%, 7.1%, and 9.9%, as shown in Figure 4. System response of the surge velocity u by the SF H∞ method has overshoots of 3.4%, 7.1%, and 9.9% but those by the ESO method have overshoots of 17.4%, 18.9%, and 28.8%, as shown in Figure 5. In Figure 6, system response ψe by the SF H∞ method has overshoots of 16.2%, 24.2%, and 30.3% but those by the ESO method have 56.1%, 64.4%, and 83.3%, respectively. Moreover, the steady-state error between the surge velocity u and the reference ur increases when increases, but the error increment by the SF H∞ method is smaller than the ESO method, as shown in Figure 5. So, whatever the value of , thr SF H∞ method has the better performance on dynamic and stable indices than those by the ESO method in circular trajectory.

5.2. Straight Trajectory Tracking

The reference input is a straight trajectory of and with the initial position (xd(0), yd(0)) = (0, 0). The initial position and heading angle of the USV are set as follows: x(0) = 0 m, y(0) = 1.5 m, and ψ(0) = 0 rad; USV initial velocities are set as follows: u(0) = 0 m/s and r(0) = 0 rad/s. To demonstrate the suppression of the sway velocity by the SF H∞ method, are set as  = 0.2 m/s, 0.5 m/s, and 1.0 m/s in simulations.

Figure 7 is straight trajectory tracking by the SF H∞ method and the ESO method with  = 0.5 m/s. The SF H∞ method can track straight trajectory earlier and faster than the ESO method, which is also reflected with the trajectory error de in Figure 8. Moreover, de overshoots by the SF H∞ method are 0.0%, 5.1%, and 21.3% while for the ESO method are 3.9%, 13.5% ,and 38.7% with  = 0.2 m/s, 0.5 m/s, and 1.0 m/s. The overshoot de increases when increases, but the corresponding overshoot by the SF H∞ method is smaller than that by the ESO method. Figures 9(a) and 10 are the system responses u and ψ. When increases, the adjust time for and ψ increases, especially for the ESO method. When  = 0.2 m/s, 0.5 m/s, and 1.0 m/s, the system response by the SF H∞ method has overshoots of 0.4%, 5.8%, and 31.7% while the ESO method has overshoots of 4.1%, 17.6%, and 55.3%. The system response ψ by the SF H∞ method has overshoots of 0.0%, 3.8% and 18.2% while the ESO method has overshoots of 4.8%, 12.7% and 30.3%, respectively. Moreover, the steady-state error of ψ is larger when increases. So, the SF H∞ method has the better performance on dynamic and stable indices than those by the ESO method for straight trajectory tracking.

5.3. Robustness Analysis

In order to analyze the system robustness, the uncertainties are imposed as τuw = τrw = κ(rand()) with κ = 1, 2, and 4, respectively. The larger the κ, the larger the uncertainties are. The steady-state errors and ψe are used to evaluate the system robustness to suppress the uncertainties with the different κ. Figures 11 and 12 are the steady-state errors ue and ψe with κ = 2. When κ = 1, 2, and 4, the ranges of the steady-state error ue are ±0.008 m/s, ±0.012 m/s, and ±0.015 m/s by the SF H∞ method and ±0.012 m/s, ±0.016 m/s, and ±0.022 m/s by the ESO method. The ranges of the steady-state error ψe are ±0.021 rad, ±0.032 rad, and ±0.044 rad by the SF H∞ method and ±0.028 rad, ±0.037 rad, and ±0.051 rad by the ESO method. Moreover, the steady-state errors and ψe of the SF H∞ control system have smaller increment than the ESO system, which indicates the SF H∞ control system has the stronger robustness than the ESO system.

6. Conclusions

With consideration of the sway velocity and the uncertainties and the disturbance of wind, wave, and currentW the SF H∞ control method is proposed for trajectory tracking of the USV to improve the system performance. First, the position error mode of trajectory tracking is established to design the LOS law to produce the reference heading angle and surge velocity. Second, the LPV system with sway velocity is established to design the SF H∞ controller for the heading angle and the surge velocity. The Lyapunov function is constructed to obtain the asymptotical stability for the LPV since the asymptotical stability has coupling terms of the variable parameter and can be directly solved by the novel variable replacement method. Moreover, the parameters of the SF H∞ controller are obtained by the LMI tool. Finally, the simulation results show that (1) the LOS guidance law can produce the reference heading angle and the reference surge velocity for trajectory tracking and (2) the SF H∞ method has the better system performance on dynamic, steady-state indices for circular and straight trajectory tracking than the ESO method to suppress the sway velocity and also on system robustness. In this work, the proposed method does not consider the convergence of LOS.

Data Availability

The data used to support the findings of this study are included within the supplementary file.

Conflicts of Interest

The authors declare that there are no conflicts of interest regarding the publication of this paper.

Acknowledgments

This research was funded by the Natural Science Foundation of Fujian under project 2019H0007, Fujian Young and Middle-Aged Teachers Science and Technology Research Project JAT220564.