Journal of Applied Mathematics

Volume 2013 (2013), Article ID 732738, 7 pages

http://dx.doi.org/10.1155/2013/732738

## Nonlinear Optimal Control Scheme for an Underwater Vehicle with Regional Function Formulation

^{1}Centre for Artificial Intelligence & Robotics, Universiti Teknologi Malaysia, Jalan Semarak, 54100 Kuala Lumpur, Malaysia^{2}School of Engineering and Physical Sciences, Heriot-Watt University, Edinburgh EH14 4AS, UK

Received 19 July 2013; Accepted 19 September 2013

Academic Editor: Xianxia Zhang

Copyright © 2013 Zool H. Ismail and Matthew W. Dunnigan. This is an open access article distributed under the Creative Commons Attribution License, which permits unrestricted use, distribution, and reproduction in any medium, provided the original work is properly cited.

#### Abstract

A conventional region control technique cannot meet the demands for an accurate tracking performance in view of its inability to accommodate highly nonlinear system dynamics, imprecise hydrodynamic coefficients, and external disturbances. In this paper, a robust technique is presented for an Autonomous Underwater Vehicle (AUV) with region tracking function. Within this control scheme, nonlinear and region based control schemes are used. A Lyapunov-like function is presented for stability analysis of the proposed control law. Numerical simulations are presented to demonstrate the performance of the proposed tracking control of the AUV. It is shown that the proposed control law is robust against parameter uncertainties, external disturbances, and nonlinearities and it leads to uniform ultimate boundedness of the region tracking error.

#### 1. Introduction

A valuable robotic system for the ocean environment is known as an Autonomous Underwater Vehicle (AUV). It has been used for many years in the oil and gas industry to obtain detailed maps of the ocean floor as well as to supervise pipeline activities [1]. The ongoing research on AUVs has given attention to the improvement of navigation and tracking control schemes. The conventional control methodologies are not the most suitable choice and they cannot guarantee the required tracking performance since an underwater vehicle exhibits inherent highly nonlinear system dynamics, imprecise hydrodynamic coefficients, and external disturbances. On the other hand, sliding mode control, due to its robustness against modelling inaccuracies and external disturbances, has been demonstrated to be a very attractive approach to cope with these problems [2–6]. However, a well-known drawback of conventional sliding mode controllers is the chattering effect. Therefore, to overcome the undesired effects of the control chattering, the authors in [7, 8] proposed a saturation function rather than a sign function. This substitution can minimize or, when desired, even completely eliminate chattering, but the trajectory tracking error is uniformly ultimately bounded (UUB), which in fact means that a steady-state error will always remain. In order to enhance the tracking performance inside the boundary layer, some adaptive strategy should be used for uncertainty/disturbance compensation.

Recently, a nonlinear optimal control scheme was adopted for an underwater robotic system as an external tracking control loop and a disturbance observer was used as an internal disturbance compensation loop [9, 10]. The resultant control obtained by combining these two controls is then derived. A brief review of optimality control has been presented in [11]. Moreover, the disturbance observer [12] is chosen, so that the -gain conditions of the nonlinear optimal control are relaxed, the magnitude of extended disturbances is reduced, and the robustness of the resulting control is improved without increasing the control input beyond that of the nonlinear optimal control alone. By using this control, the underwater robotic system can successfully follow the given trajectories, even when uncertainties and disturbances exist. An adaptive region tracking control was presented in [13] for an AUV where a region is used rather than a point due to minimizing the control effort to track the region. Note that the total potential energy of the desired region is a summation of the potential energy associated with each region. Inspired from [13], some related research works such as in [14, 15] have been carried out to ensure that the marine robotic systems can cope with the underwater conditions and missions.

In this paper, a nonlinear optimal control with region tracking function is proposed for an underwater vehicle. The proposed dynamic region control, where it is formulated in task space, aims to reduce the energy consumed by vehicle thrusters. Within the region function formulation, the controller activates and sends commands to the thrusters only when the AUV is outside the desired region, and hence it significantly reduces energy consumption. However, the disturbances such as ocean currents may pull the underwater vehicle out of its desired region. This is likely to occur when the AUV navigates near to the boundary as illustrated in Figure 1. Hence, a nonlinear optimal control is proposed in this paper to counteract this problem. The performance of conventional region tracking control and region function adopted with nonlinear optimal control law can be observed with respect to the existence of unidirectional and bounded ocean current. The rest of the paper is organized as follows: Section 2 describes the kinematic and dynamic properties of an AUV. In Section 3, the nonlinear optimal control with region function formulation is briefly explained. The stability analysis using a Lyapunov-like function is also given in this section. In Section 4, numerical simulation results are provided to demonstrate the performance of the proposed control. Finally, the paper is concluded with some remarks in Section 5.

#### 2. Kinematic and Dynamic Model of an AUV

##### 2.1. Kinematic Model

The relationship between inertial and body-fixed vehicle velocity can be described using the Jacobian matrix in the following form: where and denote the position and the orientation of the vehicle, respectively, expressed in the inertial fixed frame. and are the transformation matrices expressed in terms of the Euler angles. The linear and angular velocity vectors, and , respectively, are described in terms of the body-fixed frame.

##### 2.2. Dynamic Model

Let the velocity state vector with respect to the body-fixed frame be defined by ; and the underwater vehicle dynamic equation can be expressed in closed form as [16] where and represent the inertia matrix and the Coriolis and centripetal forces matrix including the effects of added mass and hydrodynamic damping by body motion and is the restoring force. contains the effects of external disturbances and the effects of added mass and hydrodynamic damping by body motion in static water. The dynamic (2) preserves the following properties [16, 17].

*Property 1. *The inertia matrix is symmetric and positive definite such that and .

*Property 2. * is the skew-symmetric matrix such that .

In the Property 1, and denote the minimum and maximum eigenvalues of the inertia matrix, respectively. The matrix is the identity matrix that has suitable dimension.

#### 3. Nonlinear Optimal Control Law with Region Formulation

In the region-based control framework, the desired moving target is specified by a region at the desired trajectory. A robust nonlinear optimal control for AUV proposed in this paper is formulated as follows.

First, the vehicle needs to converge into a region with specific shape. The objective function for this region is defined by the following: where are the continuous first partial derivatives of the dynamic region; is the time-varying reference point inside the geometric shape and is a time-varying and nonsingular scaling factor. It is assumed that and are bounded functions of time. To achieve the scaling formation, that is, if the scaling factor increases, then the size of a desired region also increases, a nonsingular matrix is defined as follows: where is the scaling matrix of and is the scaling matrix of . This function is useful when the AUV needs to adapt the moving region, depending on the situation and environment.

The corresponding potential energy function for the desired region described in (3) can be specified as such that where is a positive scalar. Differentiating (6) with respect to gives Now, let (7) be represented as the region error in the following form: If is set to an identity matrix, then a useful vector is defined as where and are arbitrary positive constants. The matrix represents the inverse of the Jacobian matrix. From the arguments of trigonometric functions, this matrix is bounded. Based on the structure of (8) and (9) and the subsequent stability analysis, a filtered tracking error vector for an underwater vehicle is defined as From the definition of in (10), the control law for an AUV can be proposed in the following form: where ; and are the positive definite matrix and identity matrix, respectively. , , and are the nominal matrices and vectors of , , and , respectively. The derivative of in (9) is given as where , , and are all assumed to be bounded functions of time. Substituting (11) into (2) produces a closed-loop dynamic equation for as follows: where is the extended disturbance vector which is defined in the following form: where denotes the parameter estimation error. The modeling error acts as a disturbance in (14) when the AUV is in motion. Note that is the gain for disturbance attenuation satisfying the following condition: where is defined as the weighted sum of the quadratic forms of the error states and the control input. Since nonlinear optimal control scheme is based on feedback tracking errors, can be approximated up to magnitude of these errors.

*Remark 1. *Equation (13) can be represented in state space such that the nonlinear optimality satisfies [18]
with . and in (16) denote the state and input variables, respectively. Meanwhile, the matrices and are state weighting and input weighting matrices, respectively, and they are determined by inverse optimal problem with respect to specific attenuation gain, .

Theorem 2. *Let the filtered tracking error vector be upper bounded as the following form:
**
where is scalar constant and denotes an infinity norm of for a given time interval. Then, the control law (11) above is continuous and the closed-loop system is uniformly ultimately bounded (u.u.b) as defined in [11].*

*Proof. *The following nonnegative function is introduced to analyze the stability of the proposed control law:
Differentiating with respect to time and utilizing (10) and (14), a closed-loop dynamic (13) yields
Simplifying (19) leads to
where Property 2 is used. Let be the minimum diagonal element of gain matrix utilizing the worst case disturbance [11] to yield the following inequality:
From (21), it is necessary to choose sufficiently large value of to ensure the negative definiteness of . Therefore, implying the results and terminology of [19], the ultimate boundedness of can be obtained as in (17).

*Remark 3. *It is assumed that the norm of extended disturbance which includes tracking errors is not deviated largely, when a control input (11) is used in (2). Thus, the control gain can be changed according to (17), so that the satisfactory performance of proposed control law with region function formulation can be achieved.

#### 4. Simulation Results

In this section, simulation studies are carried out to assess the effectiveness of the proposed nonlinear optimal control law with region function formulation for an underwater vehicle. The performance of conventional tracking control and the proposed technique is observed concerning two cases: the first case is the conventional region tracking control and the second case is where the region function is adopted with nonlinear optimal control law. Both control laws are observed with respect to the existence of random disturbances and bounded ocean current. The ODIN AUV [20, 21] that is known as a near-spherical omnidirectional vehicle equipped with four horizontal thrusters and four vertical thrusters is chosen as the Autonomous Underwater Vehicle model in these numerical simulations. The following inequality function is defined as where the element of is the component of the time-varying scaling matrix and is a scalar tolerance. In these simulations, the matrix is defined as the identity matrix and is set to 0.25. Note that (22) can also be represented as the root mean square error for all axes. In Table 1, the norm values of required forces for four vertical thrusters are presented. The total control input is included to signify the overall energy needed for the system to maintain at depth −1.2 meter. Notice that when the proposed controller is utilized, the energy requirement is reduced as compared with set-point tracking method.

The underwater vehicle is required to track a predefined trajectory as illustrated in Figure 2 where the green (cross-section) path is the horizontal basis position initialized at the position m. Moreover, the vehicle is initialized at the same position m while its attitude is kept constant during simulation and the initial values are degrees. From Figures 3, 4, 5, and 6, it has been shown that the proposed control scheme exhibited a more robust tracking performance than the conventional region control, when parameter uncertainties, current effects, and disturbances exist. In Figure 4, the acute fluctuations in the early stages of the simulation were mainly caused by parameter uncertainties in the restoring force and moment. However, as long as the AUV is inside the desired region, the control input is turned off, and when the disturbances pull the vehicle out, the control input is applied to navigate the AUV back into the region.

#### 5. Conclusion

A new nonlinear optimal control law with region function formulation for a hovering underwater vehicle with four horizontal and four vertical thrusters has been presented in this paper. Two cases have been considered: the first case is the conventional region tracking control and the second case is where the region function is adopted with the nonlinear optimal control law. Both control laws are observed with respect to the existence of unidirectional and bounded ocean currents. Although the underwater disturbances exist during task execution, the AUV is still able to track a desired moving region. A Lyapunov-like function has been proposed for stability analysis. Simulation results have been presented to demonstrate the performance of the proposed controller.

#### Appendix

An omnidirectional intelligent navigator (ODIN) is a near-spherical AUV designed in the University of Hawaii. The dynamic model of ODIN is given by [20, 21] where the subscripts and represent the rigid body and added mass terms of the relevant parameters, respectively. The numerical values for the matrices of the vehicle dynamic equation (A.1) are given as where are the moments of inertia about the principle axes.

Consider

Provided that is the radius of ODIN, is the mass of ODIN, is the distance of the center of gravity from the geometric center, is the average density of the ODIN AUV, is the density of fresh water, and . The hydrodynamic derivatives are given by , the translational quadratic damping factor , the angular quadratic damping factor , and the angular linear damping factor .

#### Conflict of Interests

The authors declare that there is no conflict of interests regarding the publication of this paper.

#### Acknowledgments

The authors would like to thank Offshore Geo-Surveys (OGS) Sdn. Bhd. for invaluable help and advice on the underwater vehicle. This work was supported in part by the Ministry of Higher Education, Malaysia, and Universiti Teknologi Malaysia under Grant no. R.J130000.7823.4L049.

#### References

- T. Ura, “Autonomous underwater vehicle,”
*Journal of the Robotics Society of Japan*, vol. 18, no. 7, pp. 933–936, 2000 (Japanese). View at Google Scholar - D. R. Yoerger and J. E. Slotine, “Robust trajectory control of underwater vehicles,”
*IEEE Journal of Oceanic Engineering*, vol. 10, no. 4, pp. 462–470, 1985. View at Google Scholar · View at Scopus - R. Cristi, F. A. Papoulias, and A. J. Healey, “Adaptive sliding mode control of autonomous underwater vehicles in the dive plane,”
*IEEE Journal of Oceanic Engineering*, vol. 15, no. 3, pp. 152–160, 1990. View at Publisher · View at Google Scholar · View at Scopus - A. J. Healey and D. Lienard, “Multivariable sliding mode control for autonomous diving and steering of unmanned underwater vehicles,”
*IEEE Journal of Oceanic Engineering*, vol. 18, no. 3, pp. 327–339, 1993. View at Publisher · View at Google Scholar · View at Scopus - J. Guo, F.-C. Chiu, and C.-C. Huang, “Design of a sliding mode fuzzy controller for the guidance and control of an autonomous underwater vehicle,”
*Ocean Engineering*, vol. 30, no. 16, pp. 2137–2155, 2003. View at Publisher · View at Google Scholar · View at Scopus - A. Pisano and E. Usai, “Output-feedback control of an underwater vehicle prototype by higher-order sliding modes,”
*Automatica*, vol. 40, no. 9, pp. 1525–1531, 2004. View at Publisher · View at Google Scholar · View at Zentralblatt MATH · View at Scopus - J. J. E. Slotine, “Sliding controller design for nonlinear systems,”
*International Journal of Control*, vol. 40, no. 2, pp. 421–434, 1984. View at Publisher · View at Google Scholar · View at Scopus - J. J. E. Slotine and W. Li,
*Applied Nonlinear Control*, Prentice-Hall, New Jersey, NJ, USA, 1991. - J. Han and K. C. Wan, “Coordinated motion control of underwater vehicle-manipulator system with minimizing restoring moments,” in
*Proceedings of the IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS '08)*, pp. 3158–3163, Nice, France, September 2008. View at Publisher · View at Google Scholar · View at Scopus - J. Han, J. Park, and W. K. Chung, “Robust coordinated motion control of an underwater vehicle-manipulator system with minimizing restoring moments,”
*Ocean Engineering*, vol. 38, no. 10, pp. 1197–1206, 2011. View at Publisher · View at Google Scholar · View at Scopus - Y. Choi and W. K. Chung,
*PID Trajectory Tracking Control for Mechanical Systems (Lecture Notes in Control and InFormation Sciences)*, Springer, Berlin, Germany, 2004. - B. Kim, H. Choi, W. K. Chung, and I. H. Suh, “Analysis and design of robust motion controllers in the unified framework,”
*ASME Journal of Dynamic Systems, Measurement and Control*, vol. 124, no. 2, pp. 313–321, 2002. View at Publisher · View at Google Scholar · View at Scopus - X. Li, S. P. Hou, and C. C. Cheah, “Adaptive region tracking control for autonomous underwater vehicle,” in
*Proceedings of the 11th International Conference on Control, Automation, Robotics and Vision (ICARCV '10)*, pp. 2129–2134, Singapore, December 2010. View at Publisher · View at Google Scholar · View at Scopus - Z. H. Ismail, B. M. Mokhar, and M. W. Dunnigan, “Tracking control for an autonomous underwater vehicle based on multiplicative potential energy function,” in
*Proceedings of the OCEANS 2012 MTS/IEEE Conference*, Yeosu, Republic of Korea, 2012. - Z. H. Ismail, N. Sarman, and M. W. Dunnigan, “Dynamic region boundary-based control scheme for multiple autonomous underwater vehicles,” in
*Proceedings of the OCEANS 2012 MTS/IEEE Conference*, Yeosu, Republic of Korea, 2012. - T. I. Fossen,
*Guidance and Control of Ocean Vehicles*, John Wiley and Sons, New York, NY, USA, 1st edition, 1994. - G. Antonelli,
*Underwater Robots: Motion and Force Control of Vehicle-Manipulator Systems*, Springer, Berlin, Germany, 2003. - J. Park, W. Chung, Y. Youm, and M. Kim, “${H}_{\infty}$ robust motion control of kinematically redundant manipulators,” in
*Proceedings of the IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS '98)*, pp. 330–335, Victoria, Canada, October 1998. View at Scopus - H. K. Khalil,
*Nonlinear Systems*, Prentice-Hall, Berlin, Germany, 3rd edition, 2001. - T. K. Podder and N. Sarkar, “Fault-tolerant control of an autonomous underwater vehicle under thruster redundancy,”
*Robotics and Autonomous Systems*, vol. 34, no. 1, pp. 39–52, 2001. View at Publisher · View at Google Scholar · View at Scopus - S. Choi, J. Yuh, and N. Keevil, “design of omni-directional underwater robotic vehicle,” in
*Proceedings of the Conference on Engineering in Harmony with Ocean (Oceans '93)*, pp. I192–I197, October 1993. View at Scopus