Intelligent PID guidance control for AUV path tracking

Abstract

Based on rational behavior model of three layers, a tracking control system is designed for straight line tracking which is commonly used in underwater survey missions. An intelligent PID control law implemented as planning level during the control system using transverse deviation is came up with. Continuous tracking of path expressed by a point sequence can be realized by the law. Firstly, a path tracking control system based on rational behavior model of three layers is designed, mainly satisfying the needs of underactuated AUV. Since there is no need to perform spatially coupled maneuvers, the 3D path tracking control is decoupled into planar 2D path tracking and depth or height tracking separately. Secondly, planar path tracking controller is introduced. For the reason that more attention is paid to comparing with vertical position control, transverse deviation in analytical form is derived. According to the Lyapunov direct theory, control law is designed using discrete PID algorithm whose parameters obey adaptive fuzzy adjustment. Reference heading angle is given as an output of the guidance controller conducted by lateral deviation together with its derivative. For the purpose of improving control quality and facilitating parameter modifying, data normalize modules based on Sigmoid function are applied to input-output data manipulation. Lastly, a sequence of experiments was carried out successfully, including tests in Longfeng lake and at the Yellow sea. In most challenging sea conditions, tracking errors of straight line are below 2 m in general. The results show that AUV is able to compensate the disturbance brought by sea current. The provided test results demonstrate that the designed guidance controller guarantees stably and accurately straight route tracking. Besides, the proposed control system is accessible for continuous comb-shaped path tracking in region searching.

Keywords

guidance control / region search / underactuated AUV / intelligent PID / path tracking

References

[1] LiY, JiangY-q, ZhangG-c. An underactuated AUV-oriented region search method based on electronic chart [J]. Robot, 2014, 36(5): 609-617

[2] DANA R Y, ALBERT M B, BARRIE B W. Fine-scale seafloor survey in rugged deep-ocean terrain with an autonomous robot [C]// Proceedings of the 2000 IEEE International Conference on Robotics and Automation (ICRA 2000). San Francisco, CA, USA: IEEE, 2000: 1787–1792.

[3] RobertS M, BrettW H, LanceM. Docking control system for a 54-cm-diameter (21-in) AUV [J]. IEEE Journal of Oceanic Engineering, 2008, 33(4): 550-561

[4] SHI Sheng-da. Maneuverability of submarine [M]. Beijing: National Defense Industry Press, 1995: 3–10. (in Chinese)

[5] AzinheiraJ R, MoutinhoA, PaivaE C D. A backstepping controller for path-tracking of an underactuated autonomous airship [J]. International Journal of Robust and Nonlinear Control, 2009, 19(4): 418-441

[6] AnekeN P I, NijmeijerH, JagerA G D. Tracking control of second-order chained form systems by cascaded backstepping [J]. International Journal of Robust and Nonlinear Control, 2003, 13(2): 95-115

[7] PathakK, FranchJ, AgrawalS K. Velocity and position control of a wheeled inverted pendulum by partial feedback linearization [J]. IEEE Transactions on Robotics, 2005, 21(3): 505-513

[8] DierksT, JaganathanS. Output feedback control of a quadrotor UAV using neural networks [J]. IEEE Transactions on Neural Networks, 2010, 21(1): 50-66

[9] SahuB K, SubudhiB. Adaptive tracking control of an autonomous underwater vehicle [J]. International Journal of Automation and Computing, 2014, 11(3): 300-305

[10] AguiarA P, HespanhaJ P. Trajectory-tracking and path-following of underactuated autonomous vehicles with parametric modeling uncertainty [J]. IEEE Transactions on Automatic Control, 2007, 52(8): 1362-1378

[11] FossenT I, StrandJ P. Passive nonlinear observer design for ships using Lyapunov methods [J]. Automatica, 1999, 35(1): 3-15

[12] PARK J Y, JUN B H, LEE P M. Modified linear terminal guidance for docking and a time-varying ocean current observer [C]// Underwater Technology (UT), 2011 IEEE Symposium on and 2011 Workshop on Scientific Use of Submarine Cables and Related Technologies (SSC). Tokyo: IEEE, 2011: 1–6.

[13] XIANG Xiao-bo, LAPIERRE L, LIU Chao, JOUVENCEL B. Path tracking: Combined path following and trajectory tracking for autonomous underwater vehicles [C]// Intelligent Robots and Systems (IROS), 2011 IEEE/RSJ International Conference on. San Francisco, CA: IEEE, 2011: 3558–3563.

[14] BragaJ M AControl of underwater vehicles on autonomous docking maneuvers [D], 2010Porto, PortugalFaculdade de Engenharia da Universidade do Porto

[15] DavisD TPrecision control and maneuvering of the phoenix autonomous underwater vehicle for entering a recovery tube [R], 1996Monterey, California, USADepartment of Computer Science, Naval Postgraduate School

[16] FOSSEN T I. Guidance and control of ocean vehicles [M]. New York, USA: Wiley, 1994: 273–295.

[17] COWEN S, BRIEST S, DOMBROWSKI J. Underwater docking of autonomous undersea vehicles using optical terminal guidance [C]// Oceans’97 Mts/IEEE Conference Proceedings. Halifax, NS: IEEE, 1997: 1143–1147.

[18] ParkJ Y, JunB H, LeeP M, LimY K, OhJ H. Docking problem and guidance laws considering drift for an underactuated AUV [C]. OCEANS, 2011 IEEE-Spain, 2011SantanderIEEE1-7

[19] HOBSON B W, McEwen R S, ERICKSON J, HOOVER T, McBRIDE L, SHANE F, BELLINGHAM J G. The development and ocean testing of an AUV docking station for a 21" AUV[C]// OCEANS 2007. Vancouver, BC: IEEE, 2007: 1–6.

[20] WangF, WanL, LiYe. A review of control technology of underactuated AUV [J]. Shipbuilding of China, 2010, 25(2): 227-235

[21] SussammH J. A general theorem on local controllability [J]. SIAM Journal on Control and Optimization, 1987, 25(1): 158-194

[22] ValavanisK P, GracaninD, MatijasevicM, KolluruR, DemetriouG A. Control architectures for autonomous underwater vehicles [J]. IEEE Control Systems Magazine, 1997, 17(6): 48-64

[23] BREIVIK M, FOSSEN T I. Guidance laws for autonomous underwater vehicles [M]. Austria: InTech, 2008: 51–76.

[24] HealeyA J, LienardD. Multivariable sliding-mode control for autonomous diving and steering of unmanned underwater vehicles [J]. IEEE Journal of Oceanic Engineering, 1993, 18(3): 327-339

[25] CACCIA M, BRUZZONE G, VERUGGIO G. Guidance of unmanned underwater vehicles: experimental results [C]// Robotics & Automation, 2000 Proceedings ICRA’00. IEEE International Conference on. San Francisco, California, USA: IEEE, 2000: 1799–1804.

[26] LapierreL, SoetantoD, PascoalA. Nonlinear path following with applications to the control of autonomous underwater vehicles [C]. Decision and Control, 2003. Proceedings 42nd IEEE Conference on, 2003Maui, Hawaii, USAIEEE1256-1261

[27] LiP, YangS-l, ChenS-l. Seasonal variation characteristics of current in southern Zhejiang coastal sea [J]. Acta Oceanologica Sinica, 2014, 36(3): 19-28

[28] HeQ, WeiZ-x, WangY-g. Ocean current observation in continental shelf slope area of northern South China Sea [J]. Acta Oceanologica Sinica, 2012, 34(1): 17-26

[29] MaY-lLoop current observation of northern South China Sea [D], 2014DalianCollege of Marine Science and Environment, Dalian Ocean University