Spatial Path Following for AUVs Using Adaptive Neural Network Controllers

The spatial path following control problem of autonomous underwater vehicles (AUVs) is addressed in this paper. In order to realize AUVs’ spatial path following control under systemic variations and ocean current, three adaptive neural network controllers which are based on the Lyapunov stability theorem are introduced to estimate uncertain parameters of the vehicle’s model and unknown current disturbances. These controllers are designed to guarantee that all the error states in the path following system are asymptotically stable. Simulation results demonstrated that the proposed controller was effective in reducing the path following error and was robust against the disturbances caused by vehicle’s uncertainty and ocean currents.


Introduction
The research of AUV has been a hot topic in recent years with the development of marine robotics.Voluminous literature, for example [1][2][3], has been presented on the subject of designing path following controllers for AUVs.In order to design an automatic path following control system for AUVs, several problems must be solved.Among them the most difficult and challenging is that AUV's dynamics are highly nonlinear and the hydrodynamic coefficients of vehicles are difficult to be accurately estimated a priori since the variations of these coefficients with different operating conditions.In addition to vehicle dynamics, Caharija et al. [4] pointed out that the sea currents affect the vehicles significantly which are the lack of actuation in sway.As a universal phenomenon, the single AUV's spatial path following problem is a basis for formation coordinated control of multiple AUVs [5,6].
Hereinabove, it is shown that modelling inaccuracy is primary difficult to achieve oriented results.The data driven fault diagnosis and process monitoring methods based on input and output data could be an effective way in realtime implementation where the physical model is hard to obtain [7][8][9].And when it comes to system uncertainty, robust control could be used to attenuate disturbances in a relatively suboptimal extent.For example, load disturbance in the modelling of vehicles could be restricted to a satisfied expectation using the robust H ∞ PID controller [10].Compared with robust control theory, adaptive strategy is an effective method of dealing with optimal control problems in vehicle control systems [11,12].Wang et al. [13] designed an adaptive PID controller for the path tracking system.From the simulation results, it was known that the proposed controller could not satisfy the tracking characteristics during automation performance.Based on Lyapunov stability theory and backstepping, Lapierre and Soetanto [14] proposed a path following controller for the motion control system of an AUV.It was demonstrated that the control characteristics of this kind of controller was relied on the accuracy of the hydrodynamic model.Chen and Wang [15] presented an adaptive control law with a parameter projection mechanism to track the desired vehicle longitudinal motion in the presence of tire-road friction coefficient uncertainties and actively injected braking excitation signals.The simulation results demonstrated that the proposed method was valuable for autonomous vehicle systems.A parameter-dependent adaptive H ∞ controller was constructed in [16] to guarantee robust asymptotic stability of the linear parameter-varying systems.And numerical examples were carried out to verify the effective impact on the attenuation in system disturbance.Li et al. [17] found an adaptive controller using a new neural network model, which was effective to improve the control precision by 30% in the case of system with random disturbance.To compensate the uncertainties in robot control systems, the radial basis functional (RBF) neural network was introduced to enhance system stability and transient performance [18].
In this paper, we propose an adaptive neural network control method for spatial path following control of an AUV.Three lightly interacting subsystems are introduced to fulfil this mission.RBF neural network (NN) is introduced to estimate unknown terms including inaccuracies of the vehicle.Adaptive laws are chosen to guarantee optimal estimation of the weight of NN to make the approximation more accurate.The control performance of the closed-loop systems are guaranteed by appropriately choosing the design parameters.Based on the Lyapunov stability theorem, the proposed controllers are designed to guarantee all the error states in the subcontrol systems which are asymptotically stable.
The paper is organized as follows.Section 2 formulates the vehicle dynamics for an underactuated AUV in the six-degree-of-freedom (6-DOF) form.Section 3 develops three adaptive neural network controllers to solve the path following problem with uncertain dynamics and external disturbance, such as sea currents.The proposed controllers' stability is analysed by Lyapunov theory in this section.The simulation results using the proposed controllers are illustrated in Section 4. Finally, Section 5 contains the main conclusions and describes some problems that warrant further investigation.

Problem Formulation
2.1.Vehicle Dynamics.The dynamic model of the AUV in the three dimensional space is described in this section.See details in Bian et al. [19].The vehicle which we studied in this paper measures 7.45 × 2.32 × 1.97 m.It is equipped with two main thrusters for propulsion, which are mounted symmetrically about its longitudinal axis in the horizontal plane.A cruciform tail including two different control surfaces is fixed right behind the thrusters to provide an enlarged torque around the transverse axis in the body fixed frame, which is helpful in enhancing the ability of spatial path following control.This vehicle is underactuated for the lack of propellers about its normal axis and transverse axis.The maximum designed speed of the vehicle with respect to the water is 3.08 m/s approximately.An outline of the vehicle with respect to the earth-fixed coordinate and body-fixed coordinate is shown in Figure 1.
According to the criteria underwater vehicle motion model in Fossen [20], this 6-DOF model can be described as follows.
Dynamic equation: Kinematic equation: The symbols , , , p, q, and r denote the roll, pitch, and yaw angles and velocities, respectively; x, y, z, u, v, and w are the surge, sway, and heave displacements and velocities, respectively.The matrix J() = diag {J 1 ( 2 ), J 2 ( 2 )} is the transformation matrix from the body-fixed coordinated frame to the earth-fixed coordinated frame; M = M  > 0 is the mass and inertia matrix; C(^) is the Coriolis and centripetal matrix; D(^) is the damping matrix;  is the control input, including force and moments generated by propellers and hydroplanes.
2.2.Spatial Path Following.Spatial path following problems of AUV can be solved by a dynamic task and a geometric task, whose objectives are to make the vehicle sail at an expected speed and move to the proposed three-dimensional path.
The former process of path following problem can be briefly stated as follows.Given a spatial path Γ, the goal is to design some feedback control law which yields the control forces for the vehicle's thrusters so that its centre of mass would converge asymptotically to a desired path by forcing its speed to track a desired speed assignment.The latter one can be described as below: considering the AUV depicted in Figure 2, where P is an arbitrary point on the path and Q denotes its centre of mass.The objective is to design the controllers which force the vehicle's position to converge to the desired path by driving the course angle and depth to converge to desired ones.

Controller Design
The objective is to realize the path following for AUVs in three dimensions.Consider Healey and Lienard [21], and according to practical operational applications in AUVs, the 6-DOF nonlinear equations of motion can be separated into three lightly interacting subsystems, including diving, steering, and speed control.Our research will focus on dealing with the problem of spatial path following through the three subsystems.

Speed Control.
For control design purposes, the interactions from the other degrees of freedom is neglected; the speed control model could be given by u where  u and   are dimensional hydrodynamic coefficients in surge;  prop is thrusters' force;   represents modelling inaccuracies and external disturbances.Define Then, (4) can be rewritten as where  prop is the forward force generated by the two main thrusters.
To deal with the uncertain terms, a RBF NN is chosen to estimate   which is described as where  *  is an optimized weight estimation of the neural network; Φ  is the basis function;   is its estimation error.An identification diagram of the RBF neural network is shown in Figure 3. Assume where   > 0; Ŵ is the weight estimation of the neural network.
Choose a Lyapunov function where Equation ( 8)'s derivative can be calculated as Combined with ( 7) and ( 9), An adaptive law is designed as follows: where   > 0;  0 is the initial weight value of the neural network.Then (9) can be changed as Because  is small enough, || < 3.1 m/s, − u ≫ 0, and (/( −  u)) can be considered as small positive constant.
In (12), Based on Lyapunov stability theorem, it is provided that if one of the inequations in ( 14) is true, (15) where   > 0;   is a small positive constant.

Diving Control.
Consider the vehicle dynamics referred in Silvestre and Pascoal [22], and for the sake of diving control design, it is defined as follows: If the surge speed is  =  0 , the depth control model can be simplified as To be convenient for controller design, (17) can be rewritten as where In this section the backstepping techniques are adopted based on iterative methodology, where a virtual control input is introduced to ensure that the diving error can be converged to zero.And based on the Lyapunov stability theorem, an adaptive neural network controller is designed to guarantee that all the error states in the diving control system are asymptotically stable.
From (18), a more simplified pure-feedback form is shown as follows: Step 1.Given a desired depth  1 , the depth error is described as Define a virtual control variable: From V 1 / 2 = 0, we can know When we take  2 as the input of the virtual control variable, there must exist a Referring to the mean value theorem of Lagrange,  1 (0 <  1 < 1) can be found which yields where Combined with ( 21) and ( 24), (20) can be rewritten as Then  * 1 can be estimated by RBF neural network as follows: , where Ŵ is to be the estimation of  * .Then (25) becomes where W = Ŵ −  * .Choose a Lyapunov function: The derivative of (28) can be calculated as With the adaptive law, where  is a small positive constant.
Step 2. Consider It is assumed that Choose another Lyapunov function: The derivative of (33) can be calculated as Step 3. Define  3 =  3 −  2 .
It can be calculated as And, we can obtain Then the unknown term (1/  )  can be estimated by RBF NN, and the ideal optimal control law can be written as Finally, we obtain the actual control input: From ( 35)-(37), it can be derived that Consider a Lyapunov function: We can obtain its derivative where As what we did in Step 1, (41) can be calculated as where  * 30 :=  30 > 0. Consider the Lyapunov stability theorem, it can be concluded that all the signals in the diving control system are bounded.Furthermore, the output tracking error of the system will converge to a small neighbourhood zero domain by appropriately choosing control parameters.

Line-of-Sight Guidance.
Referring to Fossen [20] and Oh and Sun [23], we briefly introduce Line-of-Sight guidance law in this section for path following in the horizontal plane and discuss its application for straight lines and circular arcs.
Calculate the angle between the proposed path and the north of earth-fixed coordinate in Figure 4: Considering the cross track error   () and a look-ahead distance Δ, the desired course angle for the steering control system can be computed as where Δ =  ( = 2∼5).When it comes to the circular arcs in Figure 5, we can obtain the guidance law just as (44) in form.

Steering Controller Design.
Referring to the vehicle dynamics in horizontal plane in [24] and considering the advantage of steering controller design, we define The kinetics model of the AUV in horizontal plane can be simplified as where  :=   (, V, ) includes the nonlinear terms with , V, and  in the steering equation;   is the disturbance satisfied with |  | ≤  0 ,  0 > 0.   Consider a heading track error:

Mathematical Problems in Engineering
where the desired course angle   =   .
Choose  ∈  which makes (48) a stabilized system: Then the derivative of the steering error system can be written as follows: where  = − and  = 1.
Then we can find  > 0 and  ≥ 0 which make the following Lyapunov stable equation solvable: On the assumption that   () and   are known and   = 0, a linear controller can be obtained as (51) using poleassignment method: Combined with (46), we can find For  is chosen appropriately according to (48), it can be derived that lim  → ∞   () = 0.
In fact,   () and   are uncertain, and   does exist.To deal with the uncertain terms, a RBF NN is chosen to estimate   (): where  * is an optimized weight estimation of the neural network; Φ() is a vector of Gaussian function Φ() = exp (‖ −  0 ‖ 2 / 0 2 ),  0 ∈  is its centre, and  0 is the width of the basis function.
If the weight estimation of neural network Ŵ is uniformly bounded, a positive constant  can be found, which satisfies ‖ Ŵ‖ <  0 .
For   is the estimation error of the RBF NN, then Meanwhile, consider a weight error for the RBF NN: Combined with (49), (54), and (55), it can be calculated as In order to compensate for estimation error and current disturbance as shown in (56), a virtual control input described as ( 17) is introduced as where  =  +   and  ≥ |Δ  | + |  |;   is a small positive constant.
Mathematical Problems in Engineering 7 Herein, (56) can be rewritten as follows: Introduce adaptive laws: where  1 and  2 are positive constants.
To deal with the problem of stability, a Lyapunov function (60) is chosen to guarantee the proposed adaptive NN controller satisfying that the signals in the steering control system are bounded: The differentiation of (60) can be calculated as With a combination of ( 59) and ( 61), it can be derived that Similar to the derivation of diving controller, it can be concluded that all the signals in the steering control system are bounded.Furthermore, the output tracking error of the system will converge to a small neighbourhood zero domain by appropriately choosing control parameters.
Finally, the control input can be given by

Simulation Results
In order to validate the proposed controller, it is assessed in the C/C++ simulation environment with a full nonlinear model for the designed vehicle.It is assumed that the states of the system are updated with a period of T = 0.1 s (seconds).Considering jacket healthy state detection which is a regular task for offshore platform, a spiral three-dimensional path is programmed to complete the detection job.In order to fulfil this mission successfully, the control objective is going to achieve a high tracking precision with the proposed control method.
Two simulations are carried out to demonstrate the advantage of the proposed method, including path following conditions without sea current and undersea current, where the unvarying current is set to be heading east with 0.25 m/s.The vehicle is initially rest at a random position (, , ) = (0 m, 35 m, 0.5 m) with an unspecified attitude (, , ) = (0 ∘ , 0 ∘ , 90 ∘ ).The desired forward speed is 1.8 m/s.The gains and parameters for the adaptive neural network speed controller are   = 1.2,   = 2.5, and   = 1.8, while the ANN steering controller's initial values are set as follows:  1 = 5,  2 = 12,  3 = 10,  = 3.8386 − 005, Γ 1 = Γ 2 = diag {1.5}, and  1 =  3 = 0.5.The parameters for the diving control system are chosen as  = 2.8,   = 0.1,  1 = 2, and  2 = 1.5.And the initial weights of RBF NN for the three subsystems are chosen as zero.
Figures 6-9 show the simulation results for spatial path following between different ocean circumstances.It is shown that the proposed mission under disturbance of current or not could be achieved by the designed adaptive neural network controllers.It is clear that the proposed method is suitable to follow the spatial path with a random position and attitude, which is very practical in jacket healthy state detection mission.
Figure 6 is the response of spatial path following under different circumstances in three-dimensional space, where S means the start point and E is the end of the mission.We can see that the performances in the two simulations are good in general.It can be seen that the two tracks are identical with the same initial values for controllers' compensation to the uncertain dynamics and ocean current.
From Figure 7, it is shown that the position track errors during the jacket detection missions are gradually converged to zero.Combined with Figures 7 and 8, we can clearly see that although the overshoots have a little increase at the 67th second and the 54th one, which indicate the presence of ocean current in the process, the errors decrease to zero very quickly using the proposed controllers, which was designed to guarantee the errors in the spatial path following systems to be restricted to a small value gradually.In the meanwhile, when it is compared to the surge speed responses under different circumstances in Figure 9, it is evident that the fluctuant speed is the primary reason responsible for the overshoots in the spatial path following.
The simulation results obtained illustrate that the proposed methodology is effective and reduces the path following errors.Moreover, it is relatively simple to apply this proposed control in simulation.

Conclusions
The objective of this paper was to accurately follow a given path in the presence of systemic variations and ocean current.On one hand, three lightly interacting subsystems, including diving, steering, and speed control, were proposed to simplify the controller design for the spatial path following with 6-DOF nonlinear equations.On the other hand, those three controllers were designed to guarantee that all the error states in the spatial path following system were asymptotically stable by using adaptive neural network method.The simulation results illustrated that the proposed methodology was effective and attenuated the path following error under current.Future work will address the problems of path following

Figure 2 :
Figure 2: Spatial path following control problem.

Figure 3 :
Figure 3: Diagram of RBF neural network for identification.

Figure 4 :
Figure 4: Principle of LOS guidance for straight line.

Figure 5 :
Figure 5: Principle of LOS guidance for circular arc.

Figure 6 :
Figure 6: Spatial path following under different circumstances.

Figure 7 :
Figure 7: Position track errors in the horizontal plane.

Figure 8 :
Figure 8: Depth track errors in the vertical plane.

Figure 9 :
Figure 9: Surge speed errors under different circumstances.
would come true which guarantees the speed error converge to a small neighbourhood zero domain.