# Finite Time Controller for Point Stabilization of a Spherical Underwater Roving Robot

Authors: Zhimin Liu; Hanxu Sun; Yansheng Li; Qingxuan Jia; Ming Chu
Journal: Mathematical Problems in Engineering
 (2016)

---

## Abstract

The finite time controller is proposed to solve the point stabilization problem for a novel underwater spherical roving robot (BYSQ-3) in two-dimensional space. The finite time design scheme is a new method; the main advantage of this control scheme is that it can steer the robot to the origin in fast converging times without excessive control effort. Firstly, the physical prototype of BYSQ-3 is introduced and the equations describing the kinematics and dynamics of BYSQ-3 are established. Secondly, the finite time controller is constructed based on the backstepping method; the explicit form of the finite time controller is more concise compared with the other finite time controllers; there is no virtual input in the design process and the stability analysis is simple; the designed controller is easy for engineering implementation. Thirdly, the hydrodynamic characteristics is analyzed by CFD simulation; the simulation and experiment results are presented to validate the shorter convergence time and better stability character of the controller.


---

## Body

## 1. Introduction

Over the last two decades, the underwater autonomous vehicles (UAVs) have become a necessity for investigating and exploring the ocean resources. At the same time, the UAVs can undertake surveillance missions or mine laying and disposal operations with low cost [1].The UAV under consideration in this paper is BYSQ-3, a roving UAV developed at Beijing University of Posts and Telecommunications (BUPT) (see Figure1). A spherical hull is adopted due to its outstanding water pressure resistance and flexibility. The primary roles of the BYSQ-3 are deep-sea detection or operation tasks. To carry out the tasks, it is necessary to stabilize the robot at a final target point with a desired attitude, that is, point stabilization problems. The point stabilization control plays a very significant role for UAVs to implement abroad range of applications [2]. Generally, the UAVs are underactuated systems equipped with fewer actuators than degrees of freedom; it is difficult to command accelerations in all DOF simultaneously [3]. Furthermore, due to the strongly coupled and intrinsic nonlinear nature of the UAVs’ dynamical equations, the control of UAVs has become a great challenge attracting more attention from both marine technology and control engineering communities [4].Figure 1
Three-dimensional structure chart.Because of the limitations of Brockett’s theory [5], there is no pure state feedbacks that can stabilize the underactuated UAVs at a fixed-point asymptotically. Thus, the discontinuous feedback laws or time-varying continuous feedback laws are usually used to solve the point stabilization problems. In [6], the switching time-invariant control scheme was proposed for underactuated surface vehicles which can steer the vehicles to the desired target point which is asymptotically stable. In [7], discontinuous two-stage control laws based on the terminal sliding mode were proposed to solve the point stabilization problems. In [8], it was shown that the underactuated autonomous vehicles dynamical systems were small-time locally controllable and strongly accessible at origin and then the time-invariant discontinuous control laws were constructed to stabilize the system to the origin asymptotically. In [9], by using the coordinate transformations, the whole dynamical system could be transformed into a cascade system and then it was reduced to a third-order chained form; the controller was constructed based on the backstepping approach. In [10], a set-point controller was proposed for UAVs in transformed equations of motion, the system was decoupled and each quasi-velocity could be regulated separately. In [11, 12], a logic-based feedback hybrid controller was proposed which exhibited a simple structure and ensured that the system converges to an arbitrarily small neighborhood of the origin asymptotically. There are several other control schemes proposed for the point stabilization problems; see [13–16].However, the control schemes proposed in the aforementioned literature have at best exponential convergence rate to an equilibrium; in other words, to steer the vehicles to a final target point with a desired orientation in finite time is difficult. In fact, there are many time sensitive tasks, for example, rendezvous missions for mobile agents, underwater search and rescue, and surveillance and detection. It is desirable that the underwater tasks can be accomplished quickly in finite time rather than merely over the infinite horizon. The finite time control laws have the good performance such as higher accuracies, faster convergence rate, and better disturbance rejection properties. Therefore, the design of finite time control laws for nonlinear underactuated systems have attracted considerable attention from the control field. For example, in [17], the point stabilization problem of the underwater robot was solved by using a sequential series of switched control laws, each of which can achieve a certain objective; finally the system can be steered to the origin in finite time. In [18], the trajectory tracking control problem for underactuated UAVs was addressed, the finite time tracking control laws were developed, and the tracking errors converged to the origin in finite time but the yaw angular r was BIBO stabilization. In [19], the underactuated nonholonomic systems with chained form were investigated by output feedback control law; the designed controller rendered the state variables to zero within finite time. In [20], a class of high-order nonlinear systems’ point stabilization problem was investigated; by combining the sign function with adaptive technique, the convergent time can be adjusted by preassigning the design parameter. The other results associated with this field; see [21–24].The adding-a-power-integrator technique has been used in many literatures. By using the adding-a-power-integrator technique, combining with other techniques, for example, the related adaptive technique in [25], a scaling gain and appropriate Lyapunov-Krasovskii functional in [26, 27], the homogeneous domination approach in [28], and the sign functions in [29], a class of uncertain high-order nonlinear systems with time-varying delay system can be rendered globally asymptotically stable; however, the aforementioned results are merely asymptotic. In [30], a class of nonholonomic systems in chained form which can model mobile robots and wheeled vehicles was studied, the finite time state feedback controller was addressed; however, the method requires the sway velocity satisfying the first-order nonholonomic constraints (the sway velocity must be zero); it cannot be applied to the control of UAVs.Motivated by [25–31], the finite time controller is constructed based on the adding a power integrator technique and backstepping method; the explicit form of the finite time controller is more concise compared with the finite time controller proposed in [30, 32, 33]; the coordinate transformations are introduced and the system is decoupled and then the designed controller can steer the state variables to zero fast. Compared with the other traditional approaches, the proposed approaches have shorter convergence time and it is the energy saving control strategy.The paper is organized as follows. Section2 introduces the preliminaries and problem formulation. Section 3 presents the process of the controller design. Section 4 contains the simulation results of the proposed control strategy and the comparison results by the designed controller and the controller in [17]. Section 5 depicts and analyzes the experiment results. Section 6 provides the conclusions.


## 2. Preliminaries and Problem Formulation

### 2.1. Preliminaries

Definition 1 (see [34]).
Consider the system given by(1)x˙t=fxt=f1x,f2x,…,fnxT,where xt∈D∁Rn, t∈t0,T,T≤∞ is the state vector, f0=0, D is an open set, 0∈D, and fxt is continuous on D. Let the origin x(t)=0 be an equilibrium point of system (1); then the origin is said to be finite time stable if an open neighborhood U∈D of the origin exists.(i)
Finite Time Convergence. That is, for every x∈U∖{0}, a settling-time function T:U∖{0}→R+ exists such that, for all x∈U∖{0}, s(x,t)∈U∖{0} is defined on [0,Tx), nonzero, and satisfies limt→T(x)⁡st,x=0 for all t∈[0,Tx); if U=Rn, the zero solution xt=0 of system (1) is said to be globally finite time stable.(ii)
Stability in the Sense of Lyapunov. That is, for all t∈[0,Tx) and for any ε>0, δt,ε>0 exists such that, for every x<δ, s(t,x)<ε.Definition 2 (see [34]).
Consider the nonlinear dynamical system (1); assume that the origin x(t)=0 be an equilibrium point, if there exists a continuously differentiable function V(x), and the following statements are satisfied:
(i)V(x) is positive definite.
(ii) Two real numbersc>0, 0<α<1 and an open neighborhood U0∈D of the origin exist such that(2)V˙x+cVxα≤0;then the origin x(t)=0 is said to be a finite time stable equilibrium of (1) and the settling-time (3)Tx≤1c1-αVx1-α.Lemma 3 (see [32]).
For any real numbersx and y, let c, d be two positive real numbers, 0<q=q1/q2<1, and q1, q2 are two coprime positive odds; the following inequality holds:(4)xcyd≤cxc+dc+d+dyc+dc+d,xq-yq≤21-qx-yq.Throughout this paper, the above definitions and lemma are used to help us to design and analyze the finite time stability controller for the point stabilization problems of BYSQ-3.


### 2.2. Inner Structure and Dynamics of BYSQ-3

BYSQ-3 is the third generation underwater robot of BUPT; it adopts spherical hull; the general structure of BYSQ-3 mainly consists of a single propeller, the heavy pendulums, and a flywheel (see Figures1 and 8). The catheter is fixed to the spherical shell and the propeller is mounted in the middle of the catheter; the sleeve (or long axis) is mounted on the outer wall of the catheter and it can rotate around the catheter; the short axis mechanism and the flywheel rotation axis are fixed to sleeve and perpendicular to the sleeve. The robot adjusted its attitude by using the heavy pendulums and the flywheel. The heavy pendulums can rotate around the long or short axis; thus, the robot’s roll or pitch angle can change. Driving the flywheel motor, the robot’s yaw angle can change. The single propeller provides the thrust to make the robot move forward. The driving motors and control module are sealed inside the spherical shell. The three-dimensional structure of BYSQ-3 is shown in Figure 1. The BYSQ-3 is equipped with propeller and flywheel for surge and yaw motion and there is no direct actuators for sway motion, so it is said to be underactuated.In this paper, we consider BYSQ-3 as a rigid body; the inertial reference and the body-fixed reference are depicted in Figure2. The equations describing the kinematics and dynamics of BYSQ-3 can be written as follows (see [6]):(5)x˙=ucos⁡φ-vsin⁡φ,y˙=usin⁡φ+vcos⁡φ,φ˙=r,u˙=m22vr-d11u+τ1m22,v˙=-m11ur+d22vm22,r˙=m11-m22uv-d33r+τ3m33,where x, y represent the positions and φ is the yaw angle representing the orientation of BYSQ-3 in the inertial frame; u, v represent linear velocities and r represents angular velocity of BYSQ-3 in the body-fixed frame; mii, i=1,2,3, represent the inertia including added masses, dii, i=1,2,3, represent the drag coefficients of BYSQ-3; τ1, τ3 are the forces of the thruster and torque generated by flywheel motor. No motors are aligned in the sway direction. The 3 DOFs’ horizontal motion must be controlled by the forward thrust control τ1 and the rotating torque τ3. So, (5) is an underactuated control system.Figure 2
The inertial and the body-fixed reference frames.Assumption 4.
(i) The center of gravity coincides with the center of buoyancy. (ii) The spherical shell is perfectly spherical and the mass distribution of BYSQ-3 is homogeneous. (iii) The heave, pitch, and roll movements are neglected and the effects of wave, wind, and current are ignored.


### 2.3. Control Objectives

The control objective is to move the BYSQ-3 from one initial motion state to another desired motion state. Without loss of generality, we describe the problem as the stabilization of a nonlinear underactuated system to the origin from a nonzero initial configuration.


## 2.1. Preliminaries

Definition 1 (see [34]).
Consider the system given by(1)x˙t=fxt=f1x,f2x,…,fnxT,where xt∈D∁Rn, t∈t0,T,T≤∞ is the state vector, f0=0, D is an open set, 0∈D, and fxt is continuous on D. Let the origin x(t)=0 be an equilibrium point of system (1); then the origin is said to be finite time stable if an open neighborhood U∈D of the origin exists.(i)
Finite Time Convergence. That is, for every x∈U∖{0}, a settling-time function T:U∖{0}→R+ exists such that, for all x∈U∖{0}, s(x,t)∈U∖{0} is defined on [0,Tx), nonzero, and satisfies limt→T(x)⁡st,x=0 for all t∈[0,Tx); if U=Rn, the zero solution xt=0 of system (1) is said to be globally finite time stable.(ii)
Stability in the Sense of Lyapunov. That is, for all t∈[0,Tx) and for any ε>0, δt,ε>0 exists such that, for every x<δ, s(t,x)<ε.Definition 2 (see [34]).
Consider the nonlinear dynamical system (1); assume that the origin x(t)=0 be an equilibrium point, if there exists a continuously differentiable function V(x), and the following statements are satisfied:
(i)V(x) is positive definite.
(ii) Two real numbersc>0, 0<α<1 and an open neighborhood U0∈D of the origin exist such that(2)V˙x+cVxα≤0;then the origin x(t)=0 is said to be a finite time stable equilibrium of (1) and the settling-time (3)Tx≤1c1-αVx1-α.Lemma 3 (see [32]).
For any real numbersx and y, let c, d be two positive real numbers, 0<q=q1/q2<1, and q1, q2 are two coprime positive odds; the following inequality holds:(4)xcyd≤cxc+dc+d+dyc+dc+d,xq-yq≤21-qx-yq.Throughout this paper, the above definitions and lemma are used to help us to design and analyze the finite time stability controller for the point stabilization problems of BYSQ-3.


## 2.2. Inner Structure and Dynamics of BYSQ-3

BYSQ-3 is the third generation underwater robot of BUPT; it adopts spherical hull; the general structure of BYSQ-3 mainly consists of a single propeller, the heavy pendulums, and a flywheel (see Figures1 and 8). The catheter is fixed to the spherical shell and the propeller is mounted in the middle of the catheter; the sleeve (or long axis) is mounted on the outer wall of the catheter and it can rotate around the catheter; the short axis mechanism and the flywheel rotation axis are fixed to sleeve and perpendicular to the sleeve. The robot adjusted its attitude by using the heavy pendulums and the flywheel. The heavy pendulums can rotate around the long or short axis; thus, the robot’s roll or pitch angle can change. Driving the flywheel motor, the robot’s yaw angle can change. The single propeller provides the thrust to make the robot move forward. The driving motors and control module are sealed inside the spherical shell. The three-dimensional structure of BYSQ-3 is shown in Figure 1. The BYSQ-3 is equipped with propeller and flywheel for surge and yaw motion and there is no direct actuators for sway motion, so it is said to be underactuated.In this paper, we consider BYSQ-3 as a rigid body; the inertial reference and the body-fixed reference are depicted in Figure2. The equations describing the kinematics and dynamics of BYSQ-3 can be written as follows (see [6]):(5)x˙=ucos⁡φ-vsin⁡φ,y˙=usin⁡φ+vcos⁡φ,φ˙=r,u˙=m22vr-d11u+τ1m22,v˙=-m11ur+d22vm22,r˙=m11-m22uv-d33r+τ3m33,where x, y represent the positions and φ is the yaw angle representing the orientation of BYSQ-3 in the inertial frame; u, v represent linear velocities and r represents angular velocity of BYSQ-3 in the body-fixed frame; mii, i=1,2,3, represent the inertia including added masses, dii, i=1,2,3, represent the drag coefficients of BYSQ-3; τ1, τ3 are the forces of the thruster and torque generated by flywheel motor. No motors are aligned in the sway direction. The 3 DOFs’ horizontal motion must be controlled by the forward thrust control τ1 and the rotating torque τ3. So, (5) is an underactuated control system.Figure 2
The inertial and the body-fixed reference frames.Assumption 4.
(i) The center of gravity coincides with the center of buoyancy. (ii) The spherical shell is perfectly spherical and the mass distribution of BYSQ-3 is homogeneous. (iii) The heave, pitch, and roll movements are neglected and the effects of wave, wind, and current are ignored.


## 2.3. Control Objectives

The control objective is to move the BYSQ-3 from one initial motion state to another desired motion state. Without loss of generality, we describe the problem as the stabilization of a nonlinear underactuated system to the origin from a nonzero initial configuration.


## 3. Design of the Control System

To facilitate the design of the control laws, we will convert system (5) to the following suitable form by using the coordinate and input transformations, which have been used in [6]:(6)
z
1
z
2
z
3
z
4
z
5
z
6
=
cos
⁡
φ
sin
⁡
φ
0
0
0
0
-
sin
⁡
φ
cos
⁡
φ
0
0
m
22
d
22
0
0
0
1
0
0
0
-
cos
⁡
φ
-
sin
⁡
φ
0
-
m
11
d
22
0
0
0
0
0
0
1
0
0
0
0
0
0
1
x
y
φ
u
v
r
,
F
1
=
d
11
-
d
22
u
-
d
22
z
2
z
6
-
τ
1
d
22
,
F
2
=
m
11
-
m
22
u
v
-
d
33
r
+
τ
3
m
33
;it is easy to see that the coordinate transformations are invertible, and F1, F2 can be seen as the new control inputs; then, system (5) is converted to the following form:(7)z˙1=-az1+z2z6-az4-bz5z6,z˙5=cz1+z4z6-cz5,(8)z˙2=z4z6,z˙3=z6,z˙4=F1z˙6=F2,where (9)a=d22m11,b=m22d22,c=d22m22.It had been proved in [6] that system (7) is globally uniformly asymptotically stabilized, if system (8) can be globally uniformly asymptotically stabilized by any control law.Given that the initial value ofz6 satisfies z60≠0, the design of the control laws can be divided into three stages.Stage 1.
By using the following control laws, we can regulate the state variablesz2, z4 to the origin in finite time T1. To realize the objective, we set F2=0.Theorem 5.
The nonlinear subsystem of (8),(10)z˙2=z4z6,z˙4=F1,can be stabilized by the following finite time control laws:(11)F1=-a1z4z6p1+c1p1z21-δ1/p1z6,F2=0,where a1≥2p1-1/p1c11+p1(21-1/p1+22-2/p1/c1+ε1),(12)c1=2p1-1/p1+ε1,ε1>0,0<δ1<1,p1=1+δ1,δ1=w1w2,where w1 is a positive and even number and w2 is a positive and odd number.Proof.
Letx1=z2, x2=z4z6, F1=u/z6; then system (11) can be converted to11∗x˙1=x2,x˙2=z6F1=u.Remark 6.
If the statesx1, x2 can be stabilized in finite time, from x1=z2, x2=z4z6 (z6≠0), we know that the states z2,z4 can be stabilized in finite time. In this stage, F2=0, z˙6=F2; hence, z6t=z6(0)≠0.
By using Definitions1 and 2, we describe that system 11∗ can be stabilized in finite time by(13)u=-a1x2p1+bp1x11-δ1/p1,where(14)a1≥2p1-1p1c11+p121-1/p1+22-2/p1c1+ε1,c1=2p1-1/p1+ε1,ε1>0,0<δ1<1,p1=1+δ1,δ1=w1w2.Define the candidate Lyapunov function:(15)V1x1=x122.Its time derivative along system 11∗ renders to(16)V˙1x1=x1x2-x1x2∗+x1x2∗.Let(17)x2∗=-c1x1d1-1,c1>0,d1=1+1p1;then(18)V˙1x1=x1x2-x1x2∗+x1x2∗=x1x2-x1x2∗-c1x1d1,and we have(19)V˙1x1≤-c1x1d1+x1x2-x1x2∗.Define the candidate Lyapunov function(20)V2x1,x2=x122+12-1/p1c11+p1∫x2∗x2sp1-x2∗p12-1/p1ds.From [32], we know the following.
V 2 x 1 , x 2 is time derivative and positive definite and(21)V˙2x1,x2=V˙1x1+12-1/p1c11+p1θ2-1/p1u+1c1x2∫x2∗x2sp1-x2∗p11-1/p1ds,where(22)θ=x2p1-x2∗p1=x2p1+c1p1x1.From (19) and (21), we have(23)V˙2x1,x2≤-c1x1d1+x1x2-x1x2∗+12-1/p1c11+p1θ2-1/p1u+1c1x2θ1-1/p1x2-x2∗.Using Lemma 3, we have(24)x1x2-x1x2∗=x1x2-x2∗=x1x2p11/p1-x2∗p11/p1≤21-1/p1θ1/p1x1≤21-1/p1p1x1d11+p1+θd11+p1.For(25)x2x2-x2∗≤x2-x2∗x2-x2∗+x2∗x2-x2∗,using Lemma 3 and (24) we have(26)x2-x2∗x2-x2∗≤22-2/p1θ2/p1,x2∗x2-x2∗≤c121-1/p1θ1/p1x11/p1.Then, by using Lemma 3 and combining (23), (24), and (26), we obtain(27)V˙2x1,x2≤-c1x1d1+21-1/p1p1x1d11+p1+θd11+p1+12-1/p1c11+p1θ2-1/p1u+1c122-2/p1θd1+21-1/p1x1d11+p1+p1θd11+p1.Let(28)c1=2p1-1/p1+ε1;subsisting (11) into (27), we have(29)V˙2x1,x2≤-ε1x1d1-ε1θd1.For(30)V2x1,x2≤x122+12p1-1/p1c11+p1x2-x2∗θ2-1/p1,using Lemma 3, we have(31)V2x1,x2≤x122+2p1-1/p12p1-1/p1c11+p1θ2.Let β=max⁡(1/2,2p1-1/p1/(2p1-1/p1)c11+p1); then V2x1,x2≤βx12+βθ2.
Letb=ε1/2βγ, γ=d1/2, and 0<γ<1; we have(32)V˙2+bV2γ≤-12ε1x1d1-ε1θd1≤0.Using Definition 2, system (10) is globally uniformly asymptotically stabilized.Stage 2.
In this stage, we regulate the state variablesz3, z6 to the origin in finite time T2; to realize the objective, we set F1=0.
The nonlinear subsystem of (8) is(33)z˙3=z6,z˙6=F2;it is a 2-order integrator system; to regulate z3, z6 to origin in finite time, we construct the following controller which can stabilize system (33) in finite time:(34)F1=0,F2=-a2z6p2+ep2z31-δ2/p2,t≥T1.Theorem 7.
The switching controller(35)F1=-a1x2p1+bp1x11-δ1/p1,F2=0,t<T1,F1=0,F2=-a2z6p2+ep2z31-δ2/p2,t≥T1moves the states z2, z3, z4, z6 to zero in finite time T1+T2 and at the end of which we have z2t=z3t=z4t=z6t=0; the state variables z1, z5 are bounded and the closed-loop system is globally finite time stable.Proof.
From the above control laws, the state variablesz2, z4 converge to zero at time T1. When t≥T1, the change of F2 affects the state variables z3, z6 while z2, z4 remain unaffected. Below we illustrate that there does not exist finite time escape phenomenon for z3, z6, when t∈0,T1, F2=0; from z˙6=F2, z6 will be a constant value (z6t=z6(0)) and from z˙3=z6, we know z3 exhibits a linear increase with time and is bounded. From the design of the control law, we have z2t=z3t=z4t=z6t=0, for all t>T1+T2. In fact, z1, z5 are bounded for all t∈[0,T1+T2].
Define the Lyapunov function:(36)V=d222m22z12+m22d22z52.Then(37)
V
˙
=
d
22
2
m
22
z
1
z
˙
1
+
m
22
d
22
z
5
z
˙
5
=
d
22
2
m
22
z
1
-
d
22
m
11
z
1
-
d
22
m
11
z
4
+
z
2
z
6
-
m
22
d
22
z
5
z
6
+
m
22
d
22
z
5
-
d
22
m
22
z
5
-
d
22
m
22
z
6
z
1
+
z
4
=
-
d
22
2
m
11
m
22
z
1
2
-
z
5
2
-
z
1
d
22
2
m
11
m
22
z
4
-
d
22
m
22
z
2
z
6
+
z
4
z
5
z
6
.From (38)V=d222m22z12+m22d22z52,we have(39)z1≤2m22d22V,z5≤2d22m22V.Recalling that z2t, z3t, z4t, z6t are bounded for all t∈[0,T2], we have(40)V˙≤k1V+k2tV,where(41)k1=max⁡-d222m11m22,-1,k2t=d222m11m22z4-d22m22z2z62m22d22+z4z62d22m22.Let δ=V; then(42)δ˙=dVdt≤k12δ+12k2t,so(43)δt≤e-1/2k1T2δ0+12∫0T2e-1/2k1T2-tk2tdt.Recalling that k2t is bounded, so z1, z5 are bounded for all t∈[0,T2].Stage 3.
From the above analysis, whent>T1+T2, the system becomes(44)z˙1=-az1,z˙5=-cz5;it is a Hurwitz system and the system is global uniform asymptotic stability.


## 4. System Simulation

### 4.1. Control Performance of the Proposed Method

According to the structure of BYSQ-3, the sphere-pipe model is established to simplify the analysis of the inertia mass and hydrodynamic coefficients, and the sphere diameter of BYSQ-3 is 0.3 m. the external fluid domain is a cube with 2 m side length, and the sphere-pipe model locates in the cube’s center. The internal cylindrical fluid domain which contain the propeller is built with a diameter of 0.12 m. the assembly and mesh model of BYSQ-3 are shown in Figure3. The hydrodynamic coefficients are simulated with the velocity of 1 m/s. the assembly model is in the center of the external fluid domain with stationary state.Figure 3
The mesh model of BYSQ-3 for CFD.The motion simulations under the above control laws are presented by using the MATLAB programs. The results show that the finite time control laws can steer the BYSQ-3 to the origin fast, accurately, and stably. The control gains are determined by using SIMULINK programs.(45)a1=-17,p1=75,δ1=25,ε1=18,a2=-5.3,p2=3725,δ2=1225,ε2=113.And the parameters are(46)m11=45kg,m22=46kg,m33=45.5kg,d11=0.4kg/s,d22=0.2kg/s,d33=0.001kg/s.The initial conditions are(47)x0=-10.647m,y0=1.65m,φ0=1.8rad,u0=1m/s,v0=0m/s,r0=-0.1rad/s.The time-response of the states is shown in Figure 4. The path traced by BYSQ-3 is shown in Figure 5.Figure 4
Time history of the state variables.
(a) (b) (c) (d) (e) (f)Figure 5
Simulation path traced by BYSQ-3.Figures4 and 5 show the simulations of position and orientation time history of the BYSQ-3; these results show the effectiveness of the proposed finite time control laws. The robot can converge to the origin fast in finite time with desired orientation. The position and orientation errors are less than 0.5% during steady state. It can be seen that the change slope of the surge velocity is bigger than that of the sway, due to the absence of dependence actuated in the sway direction. Figure 4(c) shows that the change of the angle is uniform at the beginning. This is due to the zero value of F2 and the angle velocity being constant; the value of F2 begins to change when t>T1, so the angle begins to change also; the flywheel steering mechanism is the main innovation of BYSQ-3 which can ensure the efficient and flexible steering.


### 4.2. Comparison with the Finite Time Controller in [17]

In this subsection, we compared the finite time control law proposed in [17] and the finite time controller proposed in this paper; we adopt the model parameters and initial conditions proposed in [17]:(48)x0=-3.7142m,y0=-3.8993m,φ0=2rad,u0=1m/s,v0=3m/s,r0=-4rad/s.The gains of the control law proposed in this paper are(49)a1=-10.5,p1=519,δ1=27,ε1=13,a2=-6.8,p2=719,δ2=1325,ε2=313.Figures6 and 7 show the simulation trajectory, propeller thruster, and steering torque of the controller proposed in this paper. Figure 6 shows that the settling-time is more than 100 s by the controller in [17] (see Figure 4), while it is only 30 s by controller in this paper; the propeller thruster and steering torque yielded by the controller in [17] (see Figure 4) are about two times larger than those by controller in this paper; this is because, under the effect of the controller in [17] (see Figure 5), the robot yielded a sudden sharp turn while the trajectory curve is smooth by the controllers proposed in this paper. From Figure 6, we can also find that the travelled distance by the controller in [17] (see Figure 5) is more than two times longer than that in this paper. The numerical simulation results show that the controller can be easily generalized to other nonlinear systems and it can save time and energy.Figure 6
Simulation trajectory comparison of the two controllers.Figure 7
Control torque comparison of the two controllers.Figure 8
The prototype of BYSQ-3.


## 4.1. Control Performance of the Proposed Method

According to the structure of BYSQ-3, the sphere-pipe model is established to simplify the analysis of the inertia mass and hydrodynamic coefficients, and the sphere diameter of BYSQ-3 is 0.3 m. the external fluid domain is a cube with 2 m side length, and the sphere-pipe model locates in the cube’s center. The internal cylindrical fluid domain which contain the propeller is built with a diameter of 0.12 m. the assembly and mesh model of BYSQ-3 are shown in Figure3. The hydrodynamic coefficients are simulated with the velocity of 1 m/s. the assembly model is in the center of the external fluid domain with stationary state.Figure 3
The mesh model of BYSQ-3 for CFD.The motion simulations under the above control laws are presented by using the MATLAB programs. The results show that the finite time control laws can steer the BYSQ-3 to the origin fast, accurately, and stably. The control gains are determined by using SIMULINK programs.(45)a1=-17,p1=75,δ1=25,ε1=18,a2=-5.3,p2=3725,δ2=1225,ε2=113.And the parameters are(46)m11=45kg,m22=46kg,m33=45.5kg,d11=0.4kg/s,d22=0.2kg/s,d33=0.001kg/s.The initial conditions are(47)x0=-10.647m,y0=1.65m,φ0=1.8rad,u0=1m/s,v0=0m/s,r0=-0.1rad/s.The time-response of the states is shown in Figure 4. The path traced by BYSQ-3 is shown in Figure 5.Figure 4
Time history of the state variables.
(a) (b) (c) (d) (e) (f)Figure 5
Simulation path traced by BYSQ-3.Figures4 and 5 show the simulations of position and orientation time history of the BYSQ-3; these results show the effectiveness of the proposed finite time control laws. The robot can converge to the origin fast in finite time with desired orientation. The position and orientation errors are less than 0.5% during steady state. It can be seen that the change slope of the surge velocity is bigger than that of the sway, due to the absence of dependence actuated in the sway direction. Figure 4(c) shows that the change of the angle is uniform at the beginning. This is due to the zero value of F2 and the angle velocity being constant; the value of F2 begins to change when t>T1, so the angle begins to change also; the flywheel steering mechanism is the main innovation of BYSQ-3 which can ensure the efficient and flexible steering.


## 4.2. Comparison with the Finite Time Controller in [17]

In this subsection, we compared the finite time control law proposed in [17] and the finite time controller proposed in this paper; we adopt the model parameters and initial conditions proposed in [17]:(48)x0=-3.7142m,y0=-3.8993m,φ0=2rad,u0=1m/s,v0=3m/s,r0=-4rad/s.The gains of the control law proposed in this paper are(49)a1=-10.5,p1=519,δ1=27,ε1=13,a2=-6.8,p2=719,δ2=1325,ε2=313.Figures6 and 7 show the simulation trajectory, propeller thruster, and steering torque of the controller proposed in this paper. Figure 6 shows that the settling-time is more than 100 s by the controller in [17] (see Figure 4), while it is only 30 s by controller in this paper; the propeller thruster and steering torque yielded by the controller in [17] (see Figure 4) are about two times larger than those by controller in this paper; this is because, under the effect of the controller in [17] (see Figure 5), the robot yielded a sudden sharp turn while the trajectory curve is smooth by the controllers proposed in this paper. From Figure 6, we can also find that the travelled distance by the controller in [17] (see Figure 5) is more than two times longer than that in this paper. The numerical simulation results show that the controller can be easily generalized to other nonlinear systems and it can save time and energy.Figure 6
Simulation trajectory comparison of the two controllers.Figure 7
Control torque comparison of the two controllers.Figure 8
The prototype of BYSQ-3.


## 5. Experiment

BYSQ-3 is an underwater roving robot prototype with a spherical hull, the diameter is 0.30 m, and the weight of air is about 30.6 kg; see Figure8. Compared with BYSQ-2, The BYSQ-3 has an improved turning system due to the use of the flywheel mechanism, which is mainly used for aircraft. In order to validate the above control laws proposed in this paper, the experiments have been conducted on the swimming pool in BUPT, China, at the beginning of January 2016. There is no wind in the swimming pool. The experimental setup consists of some sensors (see Figure 9), the BYSQ-3 prototype, and a PC. The robot adopts real-time wireless remote control mode, the internal controller adopts GD32F105 embedded computer running the VxWorks real-time operating system, the sampling frequency for processing navigation and position data is 50 HZ, and the communication between the host PC and the internal embedded controller of BYSQ-3 is done via wireless connection. The host computer starts a control period when receiving the robot’s motion information and the drive instructions are sent to the internal controller of the robot; the instructions are converted into voltage signal to realize the control task.Figure 9
The sensors of BYSQ-3.
(a)
GY-80 nine-axis digital gyroscope (b)
Micronav navigation system (c)
Ultrasonic displacement sensor (d)
Underwater cameraFigure10 is the motion picture of BYSQ-3 in the swimming pool. Figure 11 is the actual trajectory based on the experiment data, and from Figure 10, we can see the distance between the terminal point of BYSQ-3 and the origin is 0.27 m; the result is better than expected.Figure 10
Underwater motion of BYSQ-3.Figure 11
Actual motion trajectory of BYSQ-3.


## 6. Conclusion

In this paper, the finite time control schemes have been proposed to deal with the point stabilization problem of moving the spherical roving robot from one point to another point. The finite time control laws can steer the state variables to origin in finite time, which is better than merely asymptotic convergence. Especially by using the designed control scheme, the coupling degree can be reduced and the convergence rate can be improved. The virtual control inputs do not exist in the design process, which makes it possible to put the controller into practice. Simulation and experimental validation results demonstrate that designed control scheme has good performance; it is time and energy saving control laws with broad application prospects.



---

*Source: 8606570-2016-09-01.xml*