Sage Journals: Discover world-class research

Abstract

This article studies the trajectory tracking control of underactuated underwater vehicles using control moment gyros through a biologically inspired approach based on homeomorphism transformation and Lyapunov functions in the horizontal plane. First, a series of assumptions and simplifications need to be made to build the kinematic and dynamic equations of the underwater vehicle under a single-frame pyramid configuration structured with four control moment gyros. Second, the error dynamics analysis of the submarine based on the control moment gyros is derived from the equations, and a tracking control algorithm is proposed to demonstrate the feasibility and stabilization of this tracking control scheme from theoretical analysis. Finally, the numerical simulation results are given for verifying the effectiveness and feasibility of the rendered control law.

Keywords

Underwater vehicle control tracking control control moment gyros neural network nonlinear control

Introduction

There is no doubt that the development and protection of the ocean cannot be separated from research on marine engineering equipment. Study of underwater robots is an active field and may have a far-reaching impact on human beings.¹ As one kind of important underwater robots, autonomous underwater vehicles (AUVs) should be able to be moved freely and manipulated conveniently. As internal control actuator devices, control moment gyros (CMGs) have been widely used in spacecraft and satellites.^2,3 Despite their singularities and complicated nature, CMG systems can provide higher torque and large momentum to meet the typical requirements of the reactions of wheels.⁴ In particular, whether the speed of the vehicle is high or low, CMGs system can be appropriate for the attitude control, especially under zero momentum condition. In other words, the CMG-based underwater vehicle possesses a capability of zero-radius gyration under stationary state, so it can make a difference for maneuverability in narrow underwater space compared to the traditional underwater robots.⁵ Since Blair Thornton proposed Zero-G class AUVs using CMGs, a new class of research on AUVs that are able to accomplish attitude control unrestrictedly to some extent has been opened.^5,6 Using CMGs as a new type of underwater actuator can be used to develop a novel control scheme, with a zero-turning-radius circle manipulated on the surface of a sphere based on the internal momentum exchange principle. However, the author did not consider the issue of trajectory tracking and formation control for AUVs using the CMGs.

As a fact and also implied by Brockett’s theorem (Brockett 1983),⁷ any smooth or continuous time-invariant feedback control does not make the solution of underactuated vehicle dynamics asymptotically stable, the stabilization of planar motion and tracking control has gradually become an active field.⁸ Unlike traditional underwater actuators such as thrusters, fins, and rudders, the CMG-based underwater vehicle can preserve the hydrodynamic integrity of its hull and be free of erosion or damage caused by harsh underwater environments or small creatures. Based on this, it makes the response speed independent of the interaction between fluid and its attitude control actuator. The above properties will make the CMG-based underwater vehicle possess wider application fields such as marine rescues, military scouting, and special operations. Recently, finite-time state feedback and output feedback for stabilization have been studied from different perspectives.⁹ Moreover, since homogeneity, σ-transformation and backstepping, and other methods have gradually been introduced in the study of the stabilization control problem, such as in observer-based backstepping control^10,11 and neural networks,^12
–14 nonlinear model predictive control¹⁵ has begun to include state and input constraints, adaptive fuzzy logic systems,¹⁶ and sliding mode control.^17
–19 Sliding mode approach for path tracking of the unmanned agricultural tractor has been studied under restricted slipping effects and control saturation.²⁰ In addition, the finite-time trajectory tracking of an autonomous surface vehicle^21,22 has been achieved by adding a power integrator and a homogeneous-like controller in the research of Hong et al.,²³ therein achieving finite-time tracking using the homogeneous theory. It should be noted that for the trajectory-tracking problem of mobile robot, in his study Sun²⁴ utilizes a dynamic extension approach of the differential geometry control theory to fulfill the exact feedback linearization on the kinematic error equation. A distributed finite-time consensus tracking control for second-order multiagent systems has been developed based on a new class of observer-based control algorithms in the literature by He and Wang.²⁵ In order to reinforce the control of inexact model, a kernel-based regression learning method is applied, in the literature by Lou and Guo,²⁶ to estimate the inaccurate system parameters. In addition, incomplete symmetry underactuated USV tracking control²⁷ has been developed using a cascade system. Unfortunately, most underactuated systems are developed using a sufficiently simplified model, and chatting phenomena may not be mitigated by the proposed control strategy.

Motivated by the above results, this article addresses a biologically inspired model used in the construction of a Lyapunov function approach for underactuated multidimensional systems, describing underwater vehicles using CMGs for trajectory tracking on the horizontal plane. Accordingly, this vehicle, containing a propulsion propeller coupled with CMGs system, should have the ability to control the three-axis attitude and move forward. Predictably, its underwater trajectory tracking is an interesting problem worthy to be discussed and studied. The control law involved in the design and analysis is based on backstepping, Lyapunov functions, and shunting neurodynamics models inspired by Hodgkin and Huxley’s membrane equation,²⁸ therein using the biological neural system to replace the virtual control inputs to avoid differentiating the desired items. Nevertheless, it should be noted that the actual control strategies in the horizontal or vertical plane are not highly different.

The reminder of this article is organized as follows. In the “Preliminaries and problem formulation” section, we recall some assumptions on the models of the underactuated equation and use the homeomorphic transformation to modify the dynamical system. The “Trajectory tracking control law” section is devoted to designing a reasonable control scheme using the shunting model based on Lyapunov functions for this problem. In the “Simulation studies” section, the simulation results are presented to demonstrate the effectiveness and robustness of the proposed controller. Finally, conclusions and further considerations for the trajectory tracking control of this underwater vehicle using CMGs are provided in the “Conclusion” section.

Preliminaries and problem formulation

In this section, we consider the underwater vehicle using CMGs that is presented in Figure 1, where the square pyramid configuration is composed of the four-single gimbal control moment gyro (SGCMG) cluster and four CMGs located at the side-center position of a square pyramid, with gimbal axes perpendicular to the bottom face (Figure 2). It is important to note that Kurokawa studied the momentum envelope of the pyramid CMGs system by differential geometric theory and found that a third of its internal singular surface is passable.²⁹ The kinematic and dynamic models of the underwater vehicle using the CMGs moving in the horizontal plane are presented, and a homeomorphic transformation is used to achieve a better control design and objective.

Figure 1.

Small underwater vehicle using CMGs. CMG: control moment gyro.

Figure 2.

Four-CMG cluster in a pyramid configuration. CMG: control moment gyro.

Through the Newton–Euler formulation and laws of conservation of linear and angular momentum, a dynamic model describing underactuated underwater vehicles using CMGs can be built. Decoupling the complex nonlinear system, coinciding with the kinematics, we can obtain the dynamical system in the horizontal plane

{\begin{array}{l} \dot{η} = R (ψ) ν \\ M \dot{ν} + C (ν) ν + D (ν) ν + τ_{dis} = τ \end{array}

where $η = [x, y, ψ]^{T} \in ℝ^{3}$ and $ν = [u, v, r]^{T} \in ℝ^{3}$ , and $τ = [τ_{1},0, τ_{3}]^{T} \in ℝ^{3}$ is the control input and R(ψ) is a rotation matrix given by

R (ψ) = [\begin{matrix} cos ψ & - sin ψ & 0 \\ sin ψ & cos ψ & 0 \\ 0 & 0 & 1 \end{matrix}]

with the following properties: $R^{T} (ψ) R (ψ) =$ I, $∥ R (ψ) ∥ = 1$ , and $\dot{R} (ψ) = R (ψ) S (r)$ . Here,

S (r) = [\begin{matrix} 0 & - r & 0 \\ r & 0 & 0 \\ 0 & 0 & 0 \end{matrix}]

Take P = [x, y]^T as the vertical position in the inertial frame and ψ as the heading angle measured from the inertial axes. u, v, and r describe the surge, sway, and yaw velocities in the body-fixed frame, respectively; M and C(ν) are, respectively, the inertia matrix and the Coriolis and centripetal matrix (including the added mass); D(ν) is the drag matrix; and τ _dis is the disturbance vector. Notice that τ ₁ is the control input actuated by the propeller, and τ ₃ is the yaw moment provided by the CMGs. The following assumptions are made for the underwater vehicle to simplify the dynamical system and support the control scheme; in addition, some work must be performed beforehand to design the controller.

Assumption 1

The disturbance vector τ _dis is ignored, namely, τ _dis = 0.

Then, the simplified dynamical system (equation (1)), based on the above assumption and studies,^4,6 can be written as

\dot{u} = \frac{1}{m_{11}} (X_{u | u |} u | u | + X_{v r} v r + X_{r r} r^{2}) + \frac{1}{m_{11}} τ_{1}

\dot{v} = \frac{m_{33}}{Δ} f (v) - \frac{m_{23}}{Δ} f (r) - \frac{m_{23}}{Δ} τ_{3}

\dot{r} = \frac{m_{22}}{Δ} f (r) - \frac{m_{32}}{Δ} f (v) + \frac{m_{22}}{Δ} τ_{3}

where $Δ = m_{22} m_{33} - m_{23} m_{32}$ and $f (v) = Y_{v | v |} v | v | + Y_{r | r |} r | r | + Y_{u r} u r + Y_{u v} u v$ , $f (r) = N_{v | v |} v | v | + N_{r | r |} r | r | + N_{u r} u r + N_{u v} u v$ . Here, $m_{11} = m - X_{\dot{u}}$ , $m_{22} = m - Y_{\dot{v}}$ , $m_{23} = - Y_{\dot{r}}$ , $m_{32} = - N_{\dot{v}}$ , $m_{33} = I_{z} - N_{\dot{r}}$ , $τ_{3} = - h sin β {\dot{δ}}_{4} cos δ_{4}$ , m is the mass of the vehicle, I_z is the moment of inertia about the yaw rotation, β = 54.73^° denotes the pyramid skew angle,³⁰ h = 20 Nms is the magnitude of the angular momentum of each gyro rotor, and δ ₄ is the fourth CMG rotation angle about the axle h ₄ (see Figure 1).

Assumption 2

Similar to Behal et al. (2001)³¹, there exist bounded constraints, such as $| τ_{1} | \leq {\bar{τ}}_{1}$ , $| τ_{3} | \leq {\bar{τ}}_{3}$ , $| u | \leq \bar{u}$ , $| v | \leq \bar{v}$ , $| r | \leq \bar{r}$ , and heading angle ψ ∈ [0, 2π], for the control inputs and velocities to ensure an effective control strategy. Here, ${\bar{τ}}_{1}$ , ${\bar{τ}}_{3}$ , $\bar{u}$ , $\bar{v}$ , and $\bar{r}$ are positive constants.

Consider a desired sufficiently smooth trajectory path $P_{d} = [x_{d}, y_{d}]^{T}$ and the tracking errors ${[x_{e}, y_{e}]}^{T} = [x - x_{d}, y - y_{d}]^{T}$ , $ψ_{e} = ψ - ψ_{d}$ . In addition, define $φ_{e} = ψ - ϕ_{d}$ , where $ϕ_{d} = arctan (\frac{{\dot{y}}_{d}}{{\dot{x}}_{d}})$ , and from the relationship between the inertial and body-fixed frames, there exists the following coordinate transformation

[\begin{matrix} e_{x} \\ e_{y} \end{matrix}] = [\begin{matrix} cos ψ & sin ψ \\ - sin ψ & cos ψ \end{matrix}] [\begin{matrix} x_{e} \\ y_{e} \end{matrix}]

Use the properties above equation (3) to take the time derivative of equation (7) and considering the kinematical systems, we can obtain

[\begin{matrix} {\dot{e}}_{x} \\ {\dot{e}}_{y} \end{matrix}] = [\begin{matrix} u + r e_{y} - v_{p} cos φ_{e} \\ v - r e_{x} + v_{p} sin φ_{e} \end{matrix}]

Here, we have the following equivalence relations

{\begin{matrix} v_{p} cos φ_{e} = u_{d} cos ψ_{e} + v_{d} sin ψ_{e} \\ v_{p} sin φ_{e} = u_{d} sin ψ_{e} - v_{d} cos ψ_{e} \end{matrix}

Therefore, the tracking error vector ${[x_{e}, y_{e}]}^{T} = 0$ under the inertial frame is equivalent to the error vector under the body-fixed frame ${[e_{x}, e_{y}]}^{T} = 0$ . For the sake of designing a control scheme to make the vector become zero, similar to Pan et al.,¹³ an assumption about the desired path needs to be made.

Assumption 3

The desired path $P_{d} : [0, \infty] \to ℝ^{2}$ is sufficiently smooth, and its time derivatives are bounded.

For the complex system in equations (4) to (6), notice that the control inputs τ ₁ and τ ₃ are contained in the three equations. When considering the dynamical error analysis, this may cause numerous issues. Consider the following homeomorphic transformation

{\begin{array}{l} z_{1} = x + α (cos ψ - 1) \\ z_{2} = y + α sin ψ \\ z_{3} = ψ \\ z_{4} = u \\ z_{5} = v + α r \\ z_{6} = r \end{array}

where $α = \frac{m_{23}}{m_{22}}$ , and the control inputs and the variation in the sway velocity are as follows:

{\begin{array}{l} f_{1} = \frac{1}{m_{11}} (\bar{f} (u) + τ_{1}) \\ f_{2} = \frac{1}{m_{22}} \bar{f} (v) \\ f_{3} = \frac{m_{22}}{Δ} \bar{f} (r) - \frac{m_{32}}{Δ} \bar{f} (v) + \frac{m_{22}}{Δ} τ_{3} \end{array}

where

\bar{f} (u) = X_{u | u |} u | u | + X_{v r} (v - α r) r + X_{r r} r^{2}

\bar{f} (v) = Y_{v | v |} (v - α r) | v - α r | + Y_{r | r |} r | r | + Y_{u r} u r + Y_{u v} u (v - α r)

\bar{f} (r) = N_{v | v |} (v - α r) | v - α r | + N_{r | r |} r | r | + N_{u r} u r + N_{u v} u (v - α r)

For convenience and consistency, we use the previous notation. Then, the system equation (1) becomes

{\begin{array}{l} \dot{x} = u cos ψ - v sin ψ, \\ \dot{y} = u sin ψ + v cos ψ, \\ \dot{ψ} = r, \\ \dot{u} = f_{1}, \\ \dot{v} = f_{2}, \\ \dot{r} = f_{3} \end{array}

Trajectory tracking control law

To continue the following discussion, we shall investigate the model of shunting neural dynamics proposed by Hodgkin and Huxley²⁸, which is recommended by Grossberg to understand real time adaptive behaviors and is applied in biological and machine vision, sensor motor control, and other areas.^13,32,33 A typical shunting model can be written as

{\dot{ξ}}_{i} = - (A + B S_{i}^{+} (t) + C S_{i}^{-} (t)) ξ_{i} + B S_{i}^{+} (t) - C S_{i}^{-} (t)

where ξ_i is the membrane potential of the ith neuron. The nonnegative constants A, B, and C represent the passive decay rate, and the variables $S_{i}^{+} (t)$ and $S_{i}^{-} (t)$ are called the excitatory input and the inhibitory input, respectively. This article combines the shunting model (13) with the backstepping method to design a reasonable control scheme for the new system (12).

Virtual controller design for the kinematics

The major change in the system equations (1) and (12) is that the control input τ ₃ is no longer in the differential equation concerning the sway velocity v, and the control objectives, namely, the surge and yaw velocities u and r, are tightly coupled with the sway velocity; therefore, the main goal is to converge the tracking error vector ${[e_{x}, e_{y}]}^{T}$ and φ_e to a small neighborhood of the origin.

First, consider the body-fixed tracking error vectors e_x and e_y , that is, making the actual path P track the desired path P_d ; then, a positive-definite Lyapunov function is defined as

V_{1} = \frac{1}{2} (e_{x}^{2} + e_{y}^{2})

Consider equation (8) and obtain the time derivative ${\dot{V}}_{1}$

\begin{matrix} {\dot{V}}_{1} = e_{x} (u + r e_{y} - v_{p} cos φ_{e}) + e_{y} (v - r e_{x} + v_{p} sin φ_{e}) \\ = e_{x} (u - v_{p} cos φ_{e}) + e_{y} (v + v_{p} sin φ_{e}) \end{matrix}

To make the Lyapunov function V ₁ be negative, set w = v_p sinφ_e , and the virtual control inputs are assumed to be u and w. Then, the desired virtual control w_d and ${\tilde{u}}_{d}$ are designed as follows:

{\begin{array}{l} {\tilde{u}}_{d} = - l_{1} e_{x} + v_{p} cos φ_{e} \\ w_{d} = - l_{2} e_{y} - v \end{array}

where l ₁ and l ₂ are positive constants to be selected. Then, based on the shunting model equation (13), we obtain a new control w_f to avoid differentiating w_d

{\dot{w}}_{f} = - (A_{1} + B_{1} f (w_{d}) + C_{1} g (w_{d})) w_{f} + B_{1} f (w_{d}) - C_{1} g (w_{d})

where A ₁ is a nonnegative constant and B ₁ and C ₁ are the upper and lower bounds of w_f , respectively. The functions f(x) and g(x) are defined as f(x) = max{x, 0} and g(x) = max{−x, 0}. Then, we obtain new error variables δ_w and ε_w :

δ_{w} = w_{f} - w_{d}, ε_{w} = w - w_{f}

Substituting w = w_d + (δ_w + ε_w ) into equation (15) yields

{\dot{V}}_{1} = - l_{1} e_{x}^{2} - l_{2} e_{y}^{2} + δ_{w} e_{y} + ε_{w} e_{y}

Second, consider the orientation error φ_e and the virtual input error δ_w . Regard the yaw velocity r as a new virtual control input and take the time derivative of ε_w . We obtain

\begin{matrix} {\dot{ε}}_{w} = \dot{w} - {\dot{w}}_{f} \\ = {\dot{v}}_{p} sin φ_{e} + v_{p} (r - {\dot{ϕ}}_{d}) cos φ_{e} - {\dot{w}}_{f} \end{matrix}

Then, we define the second Lyapunov function V ₂ as

V_{2} = V_{1} + \frac{1}{2} (ε_{w}^{2} + φ_{e}^{2})

Differentiating the function V ₂ yields

\begin{matrix} {\dot{V}}_{2} = {\dot{V}}_{1} + ε_{w} {\dot{ε}}_{w} + φ_{e} {\dot{φ}}_{e} \\ = - l_{1} e_{x}^{2} - l_{2} e_{y}^{2} + δ_{w} e_{y} + ε_{w} (e_{y} + {\dot{v}}_{p} sin φ_{e} - {\dot{w}}_{f}) + (r - {\dot{ϕ}}_{d}) (φ_{e} + ε_{w} v_{p} cos φ_{e}) . \end{matrix}

Introduce the virtual control yaw velocity r, and assume its desired control input as

{\tilde{r}}_{d} = - l_{3} (φ_{e} + ε_{w} v_{p} cos φ_{e}) + {\dot{ϕ}}_{d}

${\dot{V}}_{2}$ becomes

{\dot{V}}_{2} = - l_{1} e_{x}^{2} - l_{2} e_{y}^{2} - l_{3} {(φ_{e} + ε_{w} v_{p} cos φ_{e})}^{2} + δ_{w} e_{y} + ε_{w} (e_{y} + {\dot{v}}_{p} sin φ_{e} - {\dot{w}}_{f})

Then, the virtual kinematical control inputs ${\tilde{u}}_{d}$ in (16) and ${\tilde{r}}_{d}$ in (22) are used in the following actual dynamical control scheme.

Virtual controller design for dynamics

Based on the virtual controllers u and r, the following section will discuss the actual control inputs τ ₁ and τ ₃ in the dynamics and will realize the design of the trajectory tracking control.

Similar to the control w using the shunting model (17), we obtain new controls u_f and r_f , and the shunting models are

\begin{array}{l} {\dot{u}}_{f} = - (A_{2} + B_{2} f ({\tilde{u}}_{d}) + C_{2} g ({\tilde{u}}_{d})) u_{f} + B_{2} f ({\tilde{u}}_{d}) - C_{2} g ({\tilde{u}}_{d}) \\ {\dot{r}}_{f} = - (A_{3} + B_{3} f ({\tilde{r}}_{d}) + C_{3} g ({\tilde{r}}_{d})) r_{f} + B_{3} f ({\tilde{r}}_{d}) - C_{3} g ({\tilde{r}}_{d}) \end{array}

The new error variables are

{\begin{matrix} δ_{u} = u_{f} - {\tilde{u}}_{d}, ε_{u} = u - u_{f} \\ δ_{r} = r_{f} - {\tilde{r}}_{d}, ε_{r} = r - r_{f} \end{matrix}

where the definitions of the constraints A_i , B_i , and C_i (i = 2, 3) are the same as in equation (17). Then, consider the errors above and substitute $u = {\tilde{u}}_{d} + (δ_{u} + ε_{u})$ and $r = {\tilde{r}}_{d} + (δ_{r} + ε_{r})$ into equations (15) and (21). The derivative of the function V ₂ becomes

\begin{matrix} {\dot{V}}_{2} = - l_{1} e_{x}^{2} - l_{2} e_{y}^{2} - l_{3} {(φ_{e} + ε_{w} v_{p} cos φ_{e})}^{2} + δ_{w} e_{y} + e_{x} (δ_{u} + ε_{u}) \\ + ε_{w} (e_{y} + {\dot{v}}_{p} sin φ_{e} - {\dot{w}}_{f}) + (δ_{r} + ε_{r}) (φ_{e} + ε_{w} v_{p} cos φ_{e}) \end{matrix}

Noting the dynamic equation (12) and differentiating the error variables in (25) yield

{\begin{array}{l} {\dot{ε}}_{u} = f_{1} - {\dot{u}}_{f} \\ {\dot{ε}}_{r} = f_{3} - {\dot{r}}_{f} \end{array}

Finally, take the error variables ε_u and ε_r into account and define a new Lyapunov function as follows

V_{3} = V_{2} + \frac{m_{11}}{2} ε_{u}^{2} + \frac{Δ}{2 m_{22}} ε_{r}^{2}

where f ₁, f ₂, and Δ are defined in equation (11). Differentiating V ₃ with respect to time yields

\begin{matrix} {\dot{V}}_{3} = {\dot{V}}_{2} + m_{11} ε_{u} {\dot{ε}}_{u} + \frac{Δ}{m_{22}} ε_{r} {\dot{ε}}_{r} \\ = - l_{1} e_{x}^{2} - l_{2} e_{y}^{2} - l_{3} {(φ_{e} + ε_{w} v_{p} cos φ_{e})}^{2} + ε_{u} (τ_{1} + e_{x} + \bar{f} (u) - m_{11} {\dot{u}}_{f}) \\ + ε_{r} (τ_{3} + φ_{e} + ε_{w} v_{p} cos φ_{e} + \bar{f} (r) - \frac{m_{32}}{m_{22}} \bar{f} (v) - \frac{Δ}{m_{22}} {\dot{r}}_{f}) + Θ \end{matrix}

where

Θ = δ_{w} e_{y} + δ_{u} e_{x} + δ_{w} (e_{y} + {\dot{v}}_{p} sin φ_{e} - {\dot{w}}_{f}) + δ_{r} (φ_{e} + ε_{w} v_{p} cos φ_{e})

and $\bar{f} (u), \bar{f} (v), and \bar{f} (r)$ are also defined in equation (11). Then, the control inputs τ ₁ and τ ₃ are chosen as

τ_{1} = - l_{4} ε_{u} - e_{x} - \bar{f} (u) + m_{11} {\dot{u}}_{f}

τ_{3} = - l_{5} ε_{r} - φ_{e} - ε_{w} v_{p} cos φ_{e} - \bar{f} (r) + \frac{m_{32}}{m_{22}} \bar{f} (v) + \frac{Δ}{m_{22}} {\dot{r}}_{f}

where the parameters l ₄ and l ₅ are positive constants. Then, equation (29) can be rewritten as

{\dot{V}}_{3} = - l_{1} e_{x}^{2} - l_{2} e_{y}^{2} - l_{3} {(φ_{e} + ε_{w} v_{p} cos φ_{e})}^{2} - l_{4} ε_{u}^{2} - l_{5} ε_{r}^{2} + Θ

Remark 1

If the proposed controllers in equation (31) and (32) are used in the transformed system (12), the trajectory tracking errors will convergent quickly to a small neighborhood of the origin, and its theoretical verification can be performed based on theorem 1¹³; that is the coupled and transformed system can be tracked by the proposed control theoretically. As a main limitation, the resulting controller relies on the improved knowledge of the dynamical system.

Simulation studies

To demonstrate the effectiveness of the designed controller for the tracking control of underwater vehicles in the horizontal plane, simulation studies are conducted on the vehicle using the pyramid configuration CMGs, where the parameters are mainly from Yang et al.,³⁴ as listed in Table 1.

Table 1.

Main parameters of the underwater vehicle.

m	31.4 kg	I_z	3.45 kg m²	$X_{\dot{u}}$	−0.93 kg
$Y_{\dot{v}}$	−35.5 kg	$Y_{\dot{r}}$	1.93 kg m rad⁻²	$N_{\dot{v}}$	1.93 kg m
$N_{\dot{r}}$	−4.88 kg m² rad⁻¹	X _u\|u\|	−1.62 kg m⁻¹	X_vr	35.5 kg rad⁻¹
X_rr	−1.93 kg m rad⁻¹	Y _v\|v\|	−1310 kg m⁻¹	Y _r\|r\|	$- 6.32 kg m {rad}^{- 2^{2}}$
Y_ur	5.22 kg rad⁻¹	Y_uv	−28.6 kg m⁻¹	N _v\|v\|	−3.18 kg
N _r\|r\|	−94 kg m² rad⁻²	N_ur	−2 kg m rad⁻¹	N_uv	−24 kg

Our actual control objective is to track the desired trajectory [η_d , ν_d ]^T given by

{\begin{array}{l} {\dot{η}}_{d} = R (ψ_{d}) ν_{d} \\ M {\dot{ν}}_{d} + C (ν_{d}) ν_{d} + D (ν_{d}) ν_{d} = τ_{d} \end{array}

where $τ_{d} = [10, 0, \frac{π t}{2}]^{T}$ , the disturbance vector τ _dis = 0, and the initial conditions of the underwater vehicle are set as $η_{d} (0) = [3, 2, \frac{π}{4}]^{T}$ , $ν_{d} {= [1, 2, 0]}^{T}$ , $η (0) = [2, 1, \frac{π}{2}]^{T}$ , and $ν {(0) = [0, 0, 0]}^{T}$ . Correspondingly, the controller parameters are chosen as l ₁ = 2.3, l ₂ = 1, l ₃ = 12, l ₄ = l ₅ = 0.01, A ₁ = A ₂ = A ₃ = 5, B ₁ = B ₂ = B ₃ = 6, and C_i = B_i , (i =1, 2, 3). Considering the actual error dynamics and the equivalent relation in equation (9), the error yaw angle ψ_e replaces φ_e in the simulation to avoid oscillations resulting from the inverse operation of the trigonometric functions. Then, from Figure 3, which plots the desired and actual trajectories, we can observe that the proposed control scheme is computationally efficient. The scheme also presents a high convergence rate and state performance in Figure 4, and in Figure 5 some oscillations appear in the initial stage. The actual system states η and ν and their desired targets η_d and ν_d are shown in the image, which shows that the designed controller achieves a good performance for the tracking control of positions and velocities simultaneously. The corresponding control force τ ₁ and torque τ ₃ are shown in Figure 6, which demonstrates that chattering is found in the control action. In addition, from the value of the torque input τ ₃, we can calculate the desired fourth angle δ ₄ of the gyro rotor; then, the actual control input can be realized.

Figure 3.

Desired and actual trajectories in the xy plane within 20 s.

Figure 4.

Desired and actual states x, y, and ψ.

Figure 5.

Desired and actual states u, v, and r.

Figure 6.

Control force τ ₁ and torque τ ₃.

Conclusion

In this article, a controller based on a biologically inspired model and Lyapunov functions acting on a transformed nominal underactuated system is proposed. The state of the underwater vehicle in the horizontal plane can be estimated by the designed state observer. Moreover, if the system is further modified or simplified, we can design a more intelligent learning algorithm using neural networks to achieve a better performance of the unknown or uncertain variables of the dynamics. It should also be noted that this control scheme can be transplanted in parallel to tracking for the vertical plane. In addition, this trajectory tracking control law is proposed to obtain the control signal of the thruster directly and the torque input to calculate the expected angle input of the fourth gyro rotor. The stability can be guaranteed by Lyapunov’s stability theory. Because of the fact that the virtual kinematic inputs are composed of the tracking guidance laws, and because the actual boundedness of the inputs is needed, the simulation results demonstrate reasonable robustness against parameter perturbation. Furthermore, if the trajectory tracking control for six--degree-of-freedom motion is considered, then more simplifications may be needed for the coupled non-affine nonlinear dynamical system, and other measures need to be taken to address both the unknown current or disturbance and the problem of how to design finite-time state feedback tracking controllers.

Footnotes

Declaration of conflicting interests

The author(s) declared no potential conflicts of interest with respect to the research, authorship, and/or publication of this article.

Funding

The author(s) disclosed receipt of the following financial support for the research, authorship, and/or publication of this article: This work was supported by the Natural Science Foundation of Hubei Province (no. 2013CFB154), the Open Foundation of the State Key Laboratory of Ocean Engineering, Shanghai Jiao Tong University (no. 1304), the Innovation Foundation of Maritime Defense Technologies Innovation Center, and the HUST Interdisciplinary Innovation Team Project.

References

Shi

Guo

Mao

. Development of a lobster-inspired underwater microrobot. Int J Adv Robot Syst 2013; 10(44): 1–15.

The Bendix Corp. Control moment gyroscope gimbal actuator study. South Bend, IN: The Bendix Corp, 1966, p. 210.

Branets

Weinberg

Verestchagin

. Development experience of the attitude control system using single-axis control moment gyros for long-term orbiting space stations. In: Proceedings of 38th congress international astronautical federation, Acta Astronautica, 1988, pp. 91–98.

Mony

Hablani

HB,

Sukumar

. Steering laws of single gimbal control moment gyros applied to spacecraft manoeuvres and tracking-a comparison. In: Control conference (ICC), 2016 Indiana, Hyderabad, India, 4–6 January 2016. DOI: 10.1109/INDIANCC.2016.7441144.

Thornton

Ura

Nose

. Zero-G class underwater robots and unrestricted attitude control using control moment gyros. Oceans 2007; 32(3): 1–5. DOI: 10.1109/OCEANSAP.2006.4393842.

Thornton

Ura

Nose

. Internal actuation of underwater robots using control moment gyros. Oceans 2005; 1: 591–598. DOI: 10.1109/OCEANSE.2005.1511781.

Brockett

. Asymptotic stability andfeedback stabilization. In: Differential geometry control theory. Boston: Birkhauser, 1983, pp. 181–208.

Yan

Zhang

. Globally finite-time stable tracking control of underactuated UUVs. Ocean Eng 2015; 107: 132–146.

Amato

Ariola

Cosentino

. Finite-time stabilization via dynamic output feedback. Automatica 2006; 42(2): 337–342.

10.

Santhakumar

. Proportional-derivative observer-based backstepping control for an underwater manipulator. Math Prob Eng 2011; 2011(4): 18.

11.

Yang

Bai

Wang

. Trajectory tracking control of omnidirectional wheeled robot for lower limbs rehabilitative training. Robots 2011; 33(3): 314–318.

12.

Zhang

Chu

. Adaptive sliding mode control based on local recurrent neural networks for underwater robot. Ocean Eng 2012; 45(2): 56–62.

13.

Pan

Lai

Yang

. A biologically inspired approach to tracking control of underactuated surface vessels subject to unknown dynamics. Exp Syst Appl 2015; 42(4): 2153–2161.

14.

Zhu

Yan

. The path planning of AUV based on D-S information fusion map building and bio-inspired neural network in unknown dynamic environment. Int J Adv Robot Syst 2014; 11(1): 1–14. DOI: 10.5772/56346.

15.

Guerreiro

Silvestre

Cunha

R, et al

. Trajectory tracking nonlinear model predictive control for autonomous surface craft. In: European control conference, Budapest, Hungary, 23–26 August 2009.

16.

Nag

Patel

SS,

Akbar

. Fuzzy logic based depth control of an autonomous underwater vehicle. In: Int Multi-Conf Autom, Kottayam, India, 22–23 March 2013, pp. 117–123.

17.

Pezeshki

Ghiasi

AR,

Badamchizadeh

. Adaptive robust control of autonomous underwater vehicle. J Control Autom Elect Syst 2016; 27(3): 250–262.

18.

Hwang

. Trajectory tracking of a mobile robot with frictions and uncertainties using hierarchical sliding-mode under-actuated control. IET Control Theory Appl 2013; 7(7): 952–965.

19.

Wang

Qian

Sun

. Adaptive robust finite-time trajectory tracking control of fully actuated marine surface vehicles. IEEE Trans Control Syst Technol 24(4): 1454–1462. DOI: 10.1109/TCST.2015.2496585.

20.

Matveev

Hoy

Katupitiya

. Nonlinear sliding mode control of an unmanned agricultural tractor in the presence of sliding and control saturation. Robot Auton Syst 2013; 61(9): 973–987.

21.

Ashrafiuon

Muske

Mcninch

. Sliding-mode tracking control of surface vessels. IEEE Trans Indus Elect 2008; 55(11): 556–561.

22.

Wang

Liang

. Global finite-time trajectory tracking control of autonomous of autonomous surface vehicles. In: 12th World congress on intelligent control and automation (WCICA), Guilin, China, 12–15 June 2016, DOI: 10.1109/WCICA.2016.7578456.

23.

Hong

YS,

Jie

. Finite-time control for robot manipulators. Syst Control Lett 2002; 46: 243–253.

24.

Sun

. Designing approach on trajectory-tracking control of mobile robot. Robot Computer Int Manuf 2005; 21(1): 81–85.

25.

Wang

. Distributed finite-time consensus tracking control for second-order nonlinear multi-agent systems. In: Control Conf, Hangzhou, China, 28–30 July 2015, pp. 509–521.

26.

Lou

Guo

. Adaptive trajectory tracking control using reinforcement learning for quadrotor J/OL. Int J Adv Robot Syst 2016; 13(38): 1–10.

27.

Wan

Dong

Yue-Ming

. Trajectory tracking control of incomplete symmetry underactuated USV at high speed. Dianji Yu Kongzhi Xuebao Elect Mach Control 2014; 18(10): 1–9.

28.

Hodgkin

Huxley

. A quantitative description of membrane current and its application to conduction and excitation in nerve. J Physiol 1952; 117: 500–554.

29.

Kurokawa

. A Geometric study of single gimbal control moment gyros. Tokyo: University of Tokyo, 1998.

30.

Wie

Space vehicle dynamics and control , AIAA Education Series , ch. 11, 2008. American Institute of Aeronautics & Ast.

31.

Behal

Dawson

Xian

. Adaptive tracking control of underactuated surface vessels. In: Proceedings of the 2001 IEEE international conference on control applications, Mexico City, Mexico, 7–7 September 2001, pp. 645–650.

32.

Yang

Meng

. Neural network approaches to dynamic collision-free trajectory generation. IEEE Trans Syst Man Cybern 2001; 31(3): 302–318.

33.

Yang

Zhu

Yuan

. A bioinspired neurodynamics-based approach to tracking control of mobile robots. IEEE Trans Industr Elect 2012; 59(8): 3211–3220.

34.

Prestero

. Verification of a six-degree of freedom simulation model for the REMUS autonomous underwater vehicle, REMUS (autonomous underwater vehicle). Master’s thesis, Massachusetts Institute of Technology and Woods Hole Oceanographic Institution, September 2001. DOI: 10.1575/1912/3040.

Underactuated tracking control of underwater vehicles using control moment gyros

Abstract

Keywords

Introduction

Preliminaries and problem formulation

Assumption 1

Assumption 2

Assumption 3

Trajectory tracking control law

Virtual controller design for the kinematics

Virtual controller design for dynamics

Remark 1

Simulation studies

Conclusion

Footnotes

Declaration of conflicting interests

Funding

References