Finite time pointstabilization of underwater spherical roving robot
Zhimin Liu^{1} , Hanxu Sun^{2} , Yansheng Li^{3} , Qingxuan Jia^{4} , Ming Chu^{5}
^{1, 2, 3, 4, 5}Institute of Automation, Beijing University of Posts and Telecommunications, Beijing 100876, China
^{1}Corresponding author
Journal of Vibroengineering, Vol. 18, Issue 6, 2016, p. 37193733.
https://doi.org/10.21595/jve.2016.16990
Received 17 March 2016; received in revised form 3 August 2016; accepted 18 August 2016; published 30 September 2016
JVE Conferences
This paper addresses the point stabilization problem for the underwater spherical roving robot (BYSQ3) in the horizontal plane. The finitetime stable control laws are adopted to steer the robot to the origin fast, accurately and reliably. Firstly, the inner structure and operational principle of the robot is described and the kinematic and dynamic equations are established. Secondly, the diffeomorphism transformation and change of inputs are introduced to decouple the multivariable coupling system into two subsystems. The second subsystem consists of two double integrator systems. The finitetime controller is introduced to ensure part states converge to zero in finite time. Then, the other states are steered to the origin using the same method. Thirdly, the design process has no virtual input and the stability analysis is simple, the controller designed is easy for engineering implementation. The simulation and experiment results are presented to validate the shorter convergence time and better stability character of the controller.
Keywords: finitetime controller, pointstabilization, underwater spherical roving robot, asymptotic stabilization.
1. Introduction
The past two decades has been witnessed the rapid development of various underwater autonomous unmanned vehicles(UAVs), with the help of the robotics, interacting with and exploring the underwater world becomes more feasible [1]. The underwater spherical robots, with the advantages such as good water pressure resistance, high concealment, flexible movement, zero turning radius, etc., have attracted many scholars and researchers’ attention. BYSQ3 is the thirdgeneration underwater spherical roving robot designed by Beijing University of Posts and Telecommunications (BUPT), in Fig. 1. BYSQ3 is mainly used to perform the roles of deepsea fixedpoint photography and detection. To discharge the tasks，it is necessary to implement precise position and attitude for the UAV, that is, point stabilization problems. In fact, dynamic positioning and automatic docking in harbor can be classified as point stabilization problems. However, the UAVs generally are underactuated mechanical system, which possess more degrees of freedom than the independent control inputs, it is impossible to implement accelerations in all DOF simultaneously [2]. Furthermore, the underactuated UAVs’ kinematic and dynamic equations are highly coupled and strongly intrinsic nonlinear nature. On the horizontal plane, the UAV’s motion principle is similar to the surface vessels. Now, the planar point stabilization control study on the underactuated UAVs and surface vessels has been a field of great interest to various researchers. See for example [37].
The underactuated vehicles fail to meet the brocket’s theorem [8], no smooth or continuous time invariant control law can make the solution of the underactuated UAVs’ kinematic and dynamic equations asymptotically stable. In order to realize the control objective, many scholars and researchers proposed nonsmooth or continuous timevarying control laws. In [9], a timevarying switching control law was proposed to make the underactuated surface vehicles $k$exponential stable. In [10], a discontinuous approach (TSM) was addressed to stabilize the underactuated surface vessels. In [11], through the coordinates change, the dynamical system could be reduced to a thirdorder chained form, by using the timeinvariant discontinuous state feedback law, the global asymptotic stabilization of the system could be guaranteed. In [12], a setpoint controller was described for UAVs by using the transformed equations of motion. In [13], a logicbased hybrid controller was addressed which can guarantee the global asymptotic convergence to an arbitrarily small neighborhood of the origin. The control techniques used in the aforementioned literature have at best exponential convergence rate with infinite settling time, in other words, the underactuated underwater vehicles converge to a final target point with a desired orientation in finite time is impossible. However, some tasks, for example, underwater search and rescue, detection and surveillance, etc., they are time sensitive, it is desirable the underwater robot can accomplish these tasks quickly in finite time rather than infinite asymptotically. The finitetime control laws possess many nice features such as faster convergence rates, higher accuracies and better disturbance rejection properties. Hence, the finitetime design methods for nonholonomic systems have attracted increasing attention worldwide. Particularly, by using the finitetime control method, the authors in [14] proposed the switched method to solve the point stabilization problems of the underactuated underwater vessels, through a sequential series of switched control laws, each stage could achieve a certain objective, in the final the system could be steered to the origin. In [15], the trajectory tracking problem for underactuated UAV in the horizontal plane was addressed, by adopting the finitetime tracking control laws, all the tracking errors of the UAV converged to the origin except for the yaw angular $r$ was BIBO stabilization. In [16], the output feedback stabilization for a class of underactuated systems were investigated and the designed controller guarantees that the state variables converge to zero within finite time. In [17], the highorder uncertain nonlinear systems’ finitetime stabilization problem was investigated, by combining with adaptive technique, the convergent time can be adjusted arbitrarily by preassigning the design parameter. Many other researchers investigated the nonlinear underactuated systems finitetime control problems, see for [1821].
In this paper, the finitetime controller is introduced to ensure part states converge to zero in finite time, then the whole system can converge to zero fastly. Compared with the other traditional approaches, the proposed approaches have shorter convergence time and it is the minimum energy control strategy.
The paper is organized as follows. In Section 2, the inner structure and operational principle of the underwater spherical roving robot is described and the kinematic and dynamic equations are established based on Newton Euler equations. In Section 3, the finite time control laws are designed and the finitetime stability property is analyzed. In Section 4, 5, the simulation and experiment results are depicted and analyzed. Section 6 provides the conclusions.
2. Description of the control problem
2.1. The structure of BYSQ3
BYSQ3 is a novel underwater spherical roving robot with only one propeller located in the middle of the catheter, its posture can be adjusted through heavy pendulum and the flywheel. The catheter is fixedly connected with the spherical shell. The sleeve (generally called long axis or the rolling axis) is mounted the outer wall of the conduit and it can rotate around the catheter. The short axis (or pitching axis) is fixedly connected with the sleeve and perpendicular to the long axis. The weight pendulum mechanism is installed on both ends of the short axis. Driven by the long axis motor, the weight pendulum can rotate around the catheter and the robot’s roll angle can change. Driven by the short axis motor, the weight pendulum can swing around the short axis and the robot’s pitch angle can change. Driven by the flywheel motor, the robot body get the antiforce to change the yaw angle. The serve motors and control circuits were sealed inside the spherical glass fiber hull to reduce the possible damage. The threedimensional structure chart of BYSQ3 are shown in Fig. 1. In the horizontal plane, the control inputs are propeller thrust and steering torque provided by the flywheel.
Fig. 1. Threedimensional structure chart
2.2. Kinematics and dynamics of BYSQ3
The inertial and the bodyfixed reference frame is shown in Fig. 2. The kinematic and dynamic equations of BYSQ3 in horizontal plane can be written as Eq. (1) [2]:
where$x$, $y$ and $\phi $ denote the position and orientation (yaw angle) of BYSQ3 in the inertial frame, $u$, $v$ and $r$ represent the linear surge, sway and angular velocities of BYSQ3 in the body fixed frame. ${m}_{ii}$, ${d}_{ii}$, $i=$1, 2, 3 represent the inertia including added mass effects and hydrodynamic coefficients of the drag terms. ${\tau}_{1}$, ${\tau}_{3}$ represent the external force and torque generated by propeller and flywheel, there is no sway thruster, thus, the 3 DOFs’ horizontal motion must be controlled by the two independent control input, so, Eq. (1) is an underactuated control system.
Assumption: (i) The spherical shell is a perfect spherical with homogeneous mass distribution. (ii) The heave, pitch, and roll motions are neglected and the effects of wave, wind and current are ignored.
Fig. 2. The inertial and the bodyfixed reference frame
2.3. Control objective
The control objective is to deal with the problem to move the underwater spherical roving robot BYSQ3 from one motion point to another point. Without loss of generality，the control problem can be described as the stabilization of the nonlinear dynamical system to the origin from a nonzero initial condition.
3. Design of the control system
3.1. Mathematical preliminaries
Definition 1 [22]. Consider a nonlinear dynamical system:
where $f:{R}^{n}\to {R}^{n}$ is continuous vector field and $f\left(0\right)=0$, ${R}^{n}$ denotes the $n\times 1$ column vectors set. The zero solution $x\left(t\right)=0$ of system Eq. (2) is finite time stable means that an open neighborhood $U\in {R}^{n}$ of the origin exists and the following statements hold
(i) Lyapunov stability.
(ii) Finitetime convergence. That is, for every ${t}_{0}\in [0,\mathrm{\infty})$ and $x\left({t}_{0}\right)={x}_{0}\in U$, there exists a settlingtime function $T({t}_{0},{x}_{0})$, for all $t\in [{t}_{0},T]$, every solution $x(t;{t}_{0};{x}_{0})$ of the dynamical system (2) satisfies $\underset{t\to T}{\mathrm{lim}}x\left(t;{t}_{0};{x}_{0}\right)=0$ and for all $t\in [T,\infty ]$, $x\left(t;{t}_{0};{x}_{0}\right)=0$. If $U={R}^{n}$, the zero solution $x\left(t\right)=0$ of Eq. (2) is globally finitetime stable.
Definition 2 [23]. Consider the continuous vector field $f\left(x\left(t\right)\right)$ of Eq. (2), it is called homogeneous of degree $k$ with respect to$\mathrm{}{r}_{1}$,…, ${r}_{n}$, if there exists positive real numbers ${r}_{1}$,…, ${r}_{n}$, such that ${f}_{i}\left({\epsilon}^{{r}_{1}}{x}_{1},\cdots ,{\epsilon}^{{r}_{n}}{x}_{n}\right)={f}_{i}\left(x\right){\epsilon}^{k+{r}_{i}}$ for all $\epsilon >0$, where $k\ge \mathrm{max}\left({r}_{i}\right)$, $i=$1,…, $n.$
Lemma 1 [23]. System (1) is global finitetime stable if it is globally asymptotically stable and is homogeneous with a negative degree $k$. Throughout this paper, the foregoing definitions and Lemma 1 help to derive the main result.
3.2. Design of the finite time control law
To simplify the controller design, firstly the system Eq. (1) is decoupled by the coordinate transformation, define:
where $T$ is a partitioned matrix, and:
${T}_{12}=\mathrm{d}\mathrm{i}\mathrm{a}\mathrm{g}\left(0,\frac{{m}_{22}}{{d}_{22}},0\right),{T}_{22}=\mathrm{d}\mathrm{i}\mathrm{a}\mathrm{g}\left(\frac{{m}_{11}}{{d}_{22}},\mathrm{1,1}\right).$
From the structure of $T$, it is easy to see $\leftT\right=\left{T}_{11}\right\left{T}_{22}\right\ne 0$, hence, $T$ is a reversible transformation, stabilization of the vector ${[x,y,\phi ,u,v,r]}^{T}$ can be changed into stabilizing the vector ${[{z}_{1},{z}_{2},{z}_{3},{z}_{4},{z}_{5},{z}_{6}]}^{T}$. Based on the coordinate transformation, define:
${F}_{1}$, ${F}_{2}$ are considered as new inputs to be designed later.
Using the above change of coordinates, the kinematic and dynamic Eq. (1) of BYSQ3 can be written as the following two subsystems:
We assume the initial value of ${z}_{6}$ satisfies ${z}_{6}\left(0\right)\ne 0$, the design of the control laws can be divided into three stages.
Stage 1. The objective of this stage is to steer ${z}_{2}$, ${z}_{4}$ to zero in finite time ${T}_{1}$ and we set ${F}_{2}=0$ for this stage.
Theorem 1. Consider the following nonlinear subsystem of Eq. (4):
The following state feedback control law:
where ${k}_{1}>0$, ${k}_{2}>0$, $0<{\alpha}_{1}<0$, ${\alpha}_{2}=2{\alpha}_{1}/1+{\alpha}_{1}$ can stabilize the system Eq. (6) in finite time ${T}_{1}$.
Proof: Based on Lemma 1, the proof of this theorem is divided into two steps:
Step 1 (Asymptotically stable). Consider the candidate Lyapunov function:
its timederivative along the system Eq. (6) renders to:
$\mathrm{}\mathrm{}\mathrm{}\mathrm{}\mathrm{}\mathrm{}{k}_{2}\mathrm{s}\mathrm{i}\mathrm{g}\mathrm{n}\left({z}_{4}{z}_{6}\right){\left{z}_{4}{z}_{6}\right}^{{\alpha}_{2}}={k}_{2}{\left{z}_{4}{z}_{6}\right}^{{\alpha}_{2}}\le 0.$
So the $\dot{V}\left({z}_{2},{z}_{4}\right)$ is negative, and the $V\left({z}_{2},{z}_{4}\right)$ is monotony decrease. From the definition of $V\left({z}_{2},{z}_{4}\right)$, we have $0<V\left({z}_{2},{z}_{4}\right)<V\left({z}_{2}\left(0\right),{z}_{4}\left(0\right)\right)<\infty $, thus $V\left({z}_{2},{z}_{4}\right)$ is bounded, and so its arguments ${z}_{2}$, ${z}_{4}$ must be bounded.
The secondorder timederivative of $V\left({z}_{2},{z}_{4}\right)$along the system Eq. (6) renders to:
Since${z}_{4}$ is bounded, we get that $\ddot{V}\left({z}_{2},{z}_{4}\right)$ is bounded, then $\dot{V}\left({z}_{2},{z}_{4}\right)$ is uniformly continuous. from the Barbalat Lemma [24], we can get:
Remembering that ${F}_{2}=0\text{,}$ from the Eq. (4), we have ${z}_{6}\left(t\right)\equiv {z}_{6}\left(0\right)\ne 0\text{,}$ then $\underset{t\to \infty}{\mathrm{lim}}\dot{V}\left({z}_{2},{z}_{4}\right)=0$ is equivalent to:
To proof that $\underset{t\to \infty}{\mathrm{lim}}{z}_{2}=0$, substituting ${F}_{1}$ into Eq. (5), considering the function ${z}_{2}{z}_{4}$ and its timederivative along the system Eq. (5):
Let:
Remembering that$\mathrm{}{z}_{6}\left(t\right)\equiv {z}_{6}\left(0\right)\ne 0,$${z}_{2}$ is bounded, we can get ${\dot{p}}_{1}\left(t\right)$ is bounded and uniformly continuous. From $\underset{t\to \infty}{\mathrm{lim}}{z}_{4}=0$, we have $\underset{t\to \infty}{\mathrm{lim}}{p}_{2}\left(t\right)=0$, from the Barbalat Lemma, we can get$\underset{t\to \infty}{\mathrm{lim}}{p}_{1}\left(t\right)=0$, it is equivalent to:
From Eqs. (7) and (8), there exist state feedback law Eq. (6) which globally asymptotically stabilize ${z}_{2}$, ${z}_{4}$ to the origin.
Step 2 (Negative homogeneous degree). Let:
and choose ${r}_{1}=1$,${r}_{2}=(1+{\alpha}_{1})/2$, then:
$=\left(\begin{array}{c}{{\epsilon}^{{r}_{2}}z}_{4}{z}_{6}\\ \frac{{k}_{1}\mathrm{s}\mathrm{i}\mathrm{g}\mathrm{n}{\left{{\epsilon}^{{r}_{1}}z}_{2}\right}^{{\alpha}_{1}}{k}_{2}\mathrm{s}\mathrm{i}\mathrm{g}\mathrm{n}\left({{\epsilon}^{{r}_{2}}z}_{4}{z}_{6}\right){\left{{\epsilon}^{{r}_{2}}z}_{4}{z}_{6}\right}^{{\alpha}_{2}}}{{z}_{6}}\end{array}\right)$
$\mathrm{}\mathrm{}\mathrm{}\mathrm{}\mathrm{}\mathrm{}=\left(\begin{array}{cc}{\epsilon}^{{r}_{1}+k}& 0\\ 0& {\epsilon}^{{r}_{2}+k}\end{array}\right)\left(\begin{array}{c}{z}_{4}{z}_{6}\\ \frac{{k}_{1}\mathrm{s}\mathrm{i}\mathrm{g}\mathrm{n}{\left{z}_{2}\right}^{{\alpha}_{1}}{k}_{2}\mathrm{s}\mathrm{i}\mathrm{g}\mathrm{n}\left({z}_{4}{z}_{6}\right){\left{z}_{4}{z}_{6}\right}^{{\alpha}_{2}}}{{z}_{6}}\end{array}\right),$
where $k=\left({\alpha}_{1}1\right)/2<0.$
Based on step 1, we know that system Eq. (5) is global asymptotically stable, from step 2, we know that the system Eq. (5) is homogeneous with a negative degree $k$ based on Lemma 1, system Eq. (5) is global finitetime stable.
Since the system Eq. (5) is global finitetime stable under the control law Eq. (6), hence there exists time ${T}_{1}$, $\forall t\ge {T}_{1}$, ${z}_{2}\left(t\right)={z}_{4}\left(t\right)=0$ and ${F}_{1}=0$. If we render ${F}_{2}\ne 0$ at time ${T}_{1}$, then the change of ${F}_{2}$ affect the state variable ${z}_{3}$, ${z}_{6}$ while ${z}_{2}$, ${z}_{4}$ remains unaffected due to the dynamics of the system Eq. (4).
Stage 2. The objective of this stage is to steer ${z}_{3}$, ${z}_{6}$ to zero in finite time ${T}_{2}$, we set ${F}_{1}=0$ for this stage, in particular, this stage we proof ${z}_{1}$, ${z}_{5}$ is bounded when $t\le {T}_{1}+{T}_{2}$, there is no finite time escape phenomenon for ${z}_{1}$, ${z}_{5}$.
Now consider the subsystem:
it is a double integrator system similar to system Eq. (6), to regulate ${z}_{3}$, ${z}_{6}$ to zero in finite time ${T}_{2}$, the following control law Eq. (10) is applied to system Eq. (9):
Theorem 2. The following switching control law:
Moves the states ${z}_{2}$, ${z}_{3}$, ${z}_{4}$, ${z}_{6}$ to zero in finitetime ${T}_{1}+{T}_{2}$ and at the end of which we have ${z}_{2}\left(t\right)={{z}_{3}\left(t\right)={z}_{4}\left(t\right)=z}_{6}\left(t\right)=0$, the state variable ${z}_{1}$, ${z}_{5}$ is bounded and the closedloop system is globally finitetime stable.
Proof: From the above control law, the state variable ${z}_{2}$, ${z}_{4}$ converge to zero at time ${T}_{1}$, when $t\ge {T}_{1}$, the change of ${F}_{2}$ affect the state variable ${z}_{3}$, ${z}_{6}$ while ${z}_{2}$, ${z}_{4}$ remains unaffected, below we illustrate there don’t exist finite – time escape phenomenon for ${z}_{3}$, ${z}_{6}$, when $t\in \left[0,{T}_{1}\right]$, ${F}_{2}=0$, from ${\dot{z}}_{6}={F}_{2}$, ${z}_{6}$ will be a constant value (${z}_{6}\left(t\right)={z}_{6}\left(0\right)$), from ${\dot{z}}_{3}={z}_{6}$, we know ${z}_{3}$ exhibits a linear increase with time and is bounded. From the design of the control law, we have ${z}_{2}\left(t\right)={{z}_{3}\left(t\right)={z}_{4}\left(t\right)=z}_{6}\left(t\right)=0\text{,}$ for all $t>{T}_{1}+{T}_{2}$ in fact, ${z}_{1}\text{,}$${z}_{5}$ is bounded for all $t\in [0,{T}_{1}+{T}_{2}]$.
Define the Lyapunov function:
then:
$\mathrm{}\mathrm{}\mathrm{}\mathrm{}\mathrm{}\mathrm{}+\frac{{m}_{22}}{{d}_{22}}{z}_{5}\left(\frac{{d}_{22}}{{m}_{22}}{z}_{5}\frac{{d}_{22}}{{m}_{22}}{z}_{6}\left({z}_{1}+{z}_{4}\right)\right)$
$\mathrm{}\mathrm{}\mathrm{}\mathrm{}\mathrm{}\mathrm{}=\frac{{d}_{22}^{2}}{{m}_{11}{m}_{22}}{z}_{1}^{2}{z}_{5}^{2}{z}_{1}\left(\frac{{d}_{22}^{2}}{{m}_{11}{m}_{22}}{z}_{4}\frac{{d}_{22}}{{m}_{22}}{z}_{2}{z}_{6}\right)+{z}_{4}{z}_{5}{z}_{6}.$
From:
we have:
Recalling that ${z}_{2}\left(t\right)$, ${z}_{3}\left(t\right)$, ${z}_{4}\left(t\right)$, ${z}_{6}\left(t\right)$ is bounded for all $t\in [0,{T}_{2}]$, we have:
where:
Let $\delta =\sqrt{V}$, then:
so:
Recalling that ${k}_{2}\left(t\right)$ is bounded, so ${z}_{1}$, ${z}_{5}$ is bounded for all $t\in [0,{T}_{2}]$.
Stage 3. From the above analysis, when $t>{T}_{1}+{T}_{2}$, the system becomes:
It is a Hurwitz system and is global uniform asymptotic stability.
4. System simulation
4.1. Control performance of the proposed method
In this section, a series of numerical simulation results are presented by using the MATLAB2014 /SIMULINK programs to illustrate the performance and of the tracking control laws. The results demonstrate that the tracking control laws can not only effectively achieve the trajectory tracking mission, the tracking control design is independent of the predefined desired trajectory. Specially, these control gains are ${k}_{1}=$4, ${k}_{2}=$ 10, ${k}_{3}=$–0.2, ${k}_{4}=$ –0.3, ${\alpha}_{1}=$0.5, ${\alpha}_{2}=$2/3, ${\alpha}_{3}=$0.3, ${\alpha}_{4}=$6/13.
And the parameters: ${m}_{11}=$25 kg, ${m}_{22}=$25 kg, ${m}_{11}=$25 kg, ${d}_{11}=$0.4 kg/s, ${d}_{11}=$0.2 kg/s, ${d}_{11}=$0.001 kg/s.
The initial conditions are: $x\left(0\right)=$10 m, $y\left(0\right)=$10 m, $\phi \left(0\right)=pi/2$, $u\left(0\right)=$1 m/s, $v\left(0\right)=$0 m/s, $r\left(0\right)=$ –0.1 rad/s.
The timeresponse of the states and the control inputs are shown in Fig. 3. The path traced by BYSQ3 is shown in Figs. 4.
Fig. 3. Simulation results of the finite time control laws
a) BYSQ3x tracking
b) BYSQ3y tracking
c) BYSQ3u tracking
d) BYSQ3v tracking
e) BYSQ3 yaw angle
f) BYSQ3 yaw angle velocity
g) BYSQ3 propeller thruster
h) BYSQ3 steering torgue
Fig. 4. Actual trajectory of BYSQ3
The Figs. 3, 4 show the position and orientation responses of the BYSQ3, these results indicate that the position and orientation can fast converge to the origin in finite time. The position errors $x$ and $y$ are less than 0.08 m and e5 during steady state, the orientation error is less than 103 degree. From the figures, it is easy to see the change slope of the sway velocity is less than that of the sway velocity, this is because there is no dependent control input in the sway, the sway motion is realized by using the couple effect of the surge and yaw. From Fig. 3(e), we know the angle change uniformly in the initial time. This is because the value of ${F}_{2}$ is zero and the angle velocity is a constant, the value of ${F}_{2}$ do not keep zero when $t>{T}_{1}$ until $t={T}_{1}+{T}_{2}$ and the angle begin change, the flywheel can guarantee the effective of the effect. $g$, $h$ of Fig. 3 illustrates the surge control force ${\tau}_{1}$ and the yaw control torque ${\tau}_{3}$. Fig. 4 demonstrated the simulation trajectory of BYSQ3 on the horizontal plane. From Fig. 4, the simulation trajectory of BYSQ3 is similar to the motion of a car reverses to warehousing. In the initial time，BYSQ3 has a forward deceleration behavior, then start reversing, reducing the yaw angle, and return to the origin the change process is relatively stable, and the overshoot is small. Above simulation results show that the designed finite time stabilization control law can effectively implement the underwater probe point stabilization control, convergence time is short, which will help to save energy.
4.2. Comparison with the finite time controller in [14]
In this subsection, the finite time control law proposed in this paper is compared with the finite time control law derived in [14], the initial conditions are: $x\left(0\right)=$–3.7142 m, $y\left(0\right)=$ –3.8993 m, $\phi \left(0\right)=$2 rad, $u\left(0\right)=$1 m/s, $v\left(0\right)=$3 m/s, $r\left(0\right)=$ –4 rad/s.
The gains of the control law proposed in this paper are: ${k}_{1}=$2.3, ${k}_{2}=$ 8, ${k}_{3}=$ –0.5, ${k}_{4}=$ –0.4, ${\alpha}_{1}=$0.5, ${\alpha}_{2}=$2/3, ${\alpha}_{3}=$0.3, ${\alpha}_{4}=$6/13.
The results are given in Figs. 5, 6, which compares the control torque，simulation trajectory by the controller in this paper and the controller in [14], it can be seen that the settling time consumed by the controller in [14] is over three times of that by controller in this paper, the control torque yields by the controller in [14] is relatively larger than that by controller in this paper because the controller in [14] yields a sudden sharp turn while the controller in this paper obtain a smooth motion curve, the distance travelled by the controller in [14] is relatively longer than that by controller in this paper. The numerical results show that the controller in this paper can save time and energy.
Fig. 5. Simulation trajectory comparison of the two controllers
a) Controller in this paper
b) Controller in [14]
5. Experiment
The BYSQ3 is a spherical underwater autonomous roving robot prototype that is 0.40 m diameter, and weighs about 30.6 kg in air (see Figs. 7, 8). The BYSQ3 has an improved turning system structure resulting in better performance compared with BYSQ2 [25]. In order to verify the performance of the control law proposed in this paper, we have conducted the experiments on the swimming pool in BUPT, china. at the end of December 2015, in the swimming pool there is no significant wind disturbance. The sensors are shown in Fig. 7.
Fig. 6. Control torque comparison of the two controllers
a) Propeller thruster in this paper
b) Steering torque in this paper
c) Propeller thruster [14]
d) Steering torgue in [14]
Fig. 7. The sensors of BYSQ3: a) GY80 nineaxis digital gyroscope, b) micronav navigation system, c) ultrasonic displacement sens, d) underwater camera
Fig. 8. The prototype of BYSQ3
BYSQ3 uses realtime wireless remote control mode, the control structure is shown in Fig. 9, the controller adopts GD32F105 embedded computer, control software adopts the VxWorks realtime operating system, the time period for receiving and processing navigation and position data is 200 ms, and the movement state information is sent to the host computer through the communication module, the Control software was developed under visual studio 2012. The host computer starts a control cycle when receiving the robot’s state information and sent the drive instructions to the robot controller, the instructions were converted into output voltage signal to realize the motion control.
In the experimental process, the actual input signals is the input voltage while not the propeller thruster and the flywheel driving torque in the simulation process, to determine the relationship between motor input voltage and propeller thruster we measured the output thrust and torque under different voltages for 20 times. Through analyzing the experiment results, we found forcevoltage relationships a quadratic parabolic at voltages with slightly different in the forward and backward stages. According to the experiment results, the input voltage of propeller thruster and the flywheel driving torque was shown in Figs. 10, 11.
Fig. 9. Control structure of BYSQ3
Fig. 10. Change of input voltage of propeller
Fig. 11. Change of input voltage of flywheel motor
Fig. 12. Underwater motion picture of BYSQ3
Fig. 13 is the actual trajectory based on the experiment data, and from experiment data, we can find the distance between the terminal point of BYSQ3 and the origin is 0.27 m, the result is better than expected.
Fig. 13. Actual trajectory of BYSQ3
6. Conclusions
In this paper, we deal with the point stabilization problem of a novel underwater spherical roving robot BYSQ3. the finite time stabilization controller is designed which can reduce the coupling degree and improve convergence rate of the system. As can be seen from the design process, there is no virtual input, which can improve the processing speed of the computer, Simulation results demonstrate the good performance of the control laws, the designed control laws can save time and therefore can save energy, the experimental results and simulation results have consistency.
Acknowledgements
The authors would like to thank the support of China National Natural Science Foundation (51175048) for the research.
References
 Ehsan Peymani, Thor I. Fossen Path following of underwater robots using Lagrange multipliers. Robotics and Autonomous Systems, Vol. 67, 2015, p. 4452. [Publisher]
 Do K. D., Pan J. Control of Ships and Underwater Vehicles. Advances in Industrial Control, 2009. [Publisher]
 SansMuntadas A., Brekke E. F., Øyvind Hegrenaes, et al. Navigation and probability assessment for successful AUV docking using USBL. Ifac Papersonline, Vol. 48, Issue 16, 2015, p. 204209. [Search CrossRef]
 Hegrenas O., Gade K., Hagen O. K., et al. Underwater transponder positioning and navigation of autonomous underwater vehicles. Oceans IEEE, 2009, p. 17. [Search CrossRef]
 Palomeras N., Ridao P., Ribas D., et al. Autonomous IAUV docking for fixedbase manipulation. 19th World Congress of the International Federation of Automatic Control, 2014, p. 1216012165. [Publisher]
 Shigekuni T., Takimoto T. Stabilization of uncertain equilibrium points by dynamic statederivative feedback control. 13th International Conference on Control, Automation and Systems, 2013, p. 2327. [Publisher]
 Greytak M., et al. Underactuated point stabilization using predictive models with application to marine vehicles hover intelligent robots and systems. IEEE/RSJ International Conference, 2008, p. 37563761. [Search CrossRef]
 Brockett R. W. Asymptotic stability and feedback stabilization. Differential Geometry for Nonlinear Control Theory, Vol. 27, 1983, p. 181191. [Search CrossRef]
 Borhaug E, Pettersen K. Y. Adaptive waypoint tracking control for underactuated autonomous vehicles. 44th Decision and Control, 2005 and 2005 European Control Conference, 2006, p. 40284034. [Search CrossRef]
 Cheng J., Yi J., Zhao D. Stabilization of an underactuated surface vessel via discontinuous control. Proceedings of the American Control Conference, 2007, p. 206211. [Publisher]
 Ghommam J., Mnif F., Benali A., et al. Asymptotic backstepping stabilization of an underactuated surface vessel. Control Systems Technology IEEE Transactions, Vol. 14, Issue 6, 2006, p. 11501157. [Publisher]
 Przemysaw Herman Decoupled PD setpoint controller for underwater vehicles. Ocean Engineering, Vol. 36, 2009, p. 529534. [Publisher]
 Aguiar A. P., Pascoal A. M. Global stabilization of an underactuated autonomous underwater vehicle via logicbased switching. Proceedings of the 41st IEEE Conference on Decision and Control, Las Vegas, NE, USA, 2002, p. 32673272. [Publisher]
 Sankaranarayanan V., Mahindrakar A. D., Banavar R. N. A switched controller for an underactuated underwater vehicle. Communications in Nonlinear Science and Numerical Simulations, Vol. 13, Issue 10, 2008, p. 22662278. [Publisher]
 Yan Zheping, Yun Haomiao, Zhang Wei, et al. Globally finitetime stable tracking control of underactuated UUVs. Ocean Engineering, Vol. 107, 2015, p. 132146. [Publisher]
 Gao Fangzheng, Wu Yuqiang, Zhang Zhongcai Finitetime stabilization of uncertain nonholonomic systems in feedforwardlike form by output feedback. ISA Transactions, Vol. 59, 2015, p. 125132. [Publisher]
 Sun ZongYao, Xue LingRong, Zhang Kemei A new approach to finitetime adaptive stabilization of highorder uncertain nonlinear system. Automatica, Vol. 58, 2015, p. 6066. [Publisher]
 Li W., Xie X. J., Zhang S. Outputfeedback stabilization of stochastic highorder nonlinear systems under weaker conditions. Siam Journal on Control and Optimization, Vol. 49, Issue 3, 2011, p. 12621282. [Publisher]
 Mazinan A. H., Pasand M., Soltani B. Full quaternion based finitetime cascade attitude control approach via pulse modulation synthesis for a spacecraft. ISA Transactions, Vol. 58, 2015, p. 567585. [Publisher]
 Ghasemi Masood, Nersesov Sergey G., Clayton Garrett Finitetime tracking using sliding mode control. Journal of the Franklin Institute, Vol. 351, 2014, p. 29662990. [Publisher]
 Kryachkov M., Polyakov A., Strygin V. Finitetime stabilization of an integrator chain using only signs of the state variables. 11th International Workshop on Variable Structure Systems, IEEE, 2010, p. 510515. [Publisher]
 Haddad M. M., Nersesov S. G., Liang D. Finitetime stability for timevarying nonlinear dynamical systems. Proceedings of the American Control Conference, 2008, p. 41354139. [Publisher]
 Bhat Sanjay P., Bernstein Dennis S. Geometric homogeneity with applications to finitetime stability. Mathematics of Control, Signals, and Systems, Vol. 17, 2005, p. 101127. [Publisher]
 Hou M., Duan G., Guo M. New versions of Barbalat’s lemma with applications. Journal of Control Theory and Applications, Vol. 8, Issue 4, 2010, p. 545547. [Publisher]
 Li Yansheng, Sun Hanxu, Chu Ming, et al. Experiment, simulation and analysis on coupling hydrodynamic forces under key parameters for a spherical underwater exploration robot. Journal of Vibroengineering, Vol. 16, Issue 6, 2014, p. 30143025. [Search CrossRef]
Cited By
IEEE Access
Yingbin Feng, Yanju Liu, Hongwei Gao, Zhaojie Ju

2020

Dongjie Jiang, Yansheng Li 
2020
