3D Docking Guidance Algorithm Based on Dipole Field for a Moving Dock Station
-
摘要: 针对自主水下航行器(AUV)的自主回收问题, 提出了一种基于偶极势场的移动回收站空间回坞导引算法。在回收站移动的情况下, AUV动态测量应答器的位置, 从而获得AUV在对接坐标系下的坐标和姿态角, 利用建立的偶极势场计算出期望的航向角和俯仰角, 期望的横滚角设为零。在偶极势场的导引下, AUV沿回收站的中轴线进入回收站。将AUV的控制分解为纵平面和水平面两部分, 通过采用自适应非奇异终端滑模控制的方法, 分别保证航向角和俯仰角回坞控制的鲁棒性和自适应性。最后, 仿真结果证明了在回收站移动的情况下, 所设计的空间回坞导引算法是有效的。文中的工作可为移动回收站的回坞对接研究提供参考。
-
关键词:
- 自主水下航行器 /
- 移动回收站 /
- 空间回坞导引 /
- 偶极势场 /
- 自适应非奇异终端滑模控制
Abstract: To solve the autonomous docking problem of an autonomous undersea vehicle(AUV), a three-dimensional (3D) docking guidance algorithm based on dipole field is presented for a moving dock station. The position of the transponder is dynamically measured under moving condition of the dock station, and the coordinate and attitude angle of the AUV in docking coordinate system are obtained. The expected heading angle and pitch angle are calculated by using the established dipole field, and the expected roll angle is set to zero. Under the guidance of dipole field, the AUV enters the dock station along the central axis. The control of the AUV is decomposed into two parts in respective longitudinal plane and horizontal plane. By adopting adaptive nonsingular terminal sliding mode control, the robustness and adaptability of controlling heading angle and pitch angle in docking are guaranteed. Simulation shows that the 3D docking guidance algorithm is effective for the moving dock station. This work may provide a reference for the research on docking of moving dock station. -
[1] Lee P M, Jeon B H, Kim S M. Visual Servoing for Underwater Docking of an Autonomous Underwater Vehicle with One Camera[C]//Proceedings of the MTS/IEEE Oceans Conference. San Diego, California, USA: MTS/ IEEE, 2003: 677-682. [2] Park J Y, Jun B H, Lee P M, et al. 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, Japan: IEEE, 2011: 1-6. [3] McEwen R S, Hobson B W, McBride L, et al. Docking Control System for a 54-cm-Diameter(21-in) AUV[J]. IEEE Journal of Oceanic Engineering, 2008, 33(4): 550-562. [4] Ken T, Edgar A, Pierre-Philippe J. A robust Fuzzy Autonomous Underwater Vehicle(AUV) Docking Approach for Unknown Current Disturbances[J]. IEEE Journal of Oceanic Engineering, 2012, 37(2): 143-155. [5] 吴泽伟, 吴晓锋. 基于有限时间系统同步的自治水下航行器回收控制[J]. 自动化学报, 2013, 39(12): 2164- 2169.Wu Ze-wei, Wu Xiao-feng. Recovery Control for Autonomous Underwater Vehicle based on Finite-time Synchronization of Systems[J]. Acta Automatica Sinica, 2013, 39(12): 2164-2169. [6] Gao J, Liu C X, Wang Y X. Backstepping Adaptive Docking Control for a Full-actuated Autonomous Underwater Vehicle with Onboard USBL System[C]//Oceans’14 MTS/ IEEE St. John’s, St. John’s, Newfoundland, Canada: MTS/ IEEE, 2014: 1-6. [7] Panagou D, Tanner H G, Kyriakopoulos K J. Dipole-like Fields for Stabilization of Systems with Pfaffian Constraints[C]//IEEE International Conference on Robotics and Automation(ICRA). Anchorage, Alaska, USA: IEEE, 2010: 4499-4504. [8] 严卫生, 齐贝贝, 高剑, 等. 基于偶极势场的自主水下航行器回坞导引算法[J]. 系统工程与电子技术, 2016, 38(4): 902-908.Yan Wei-sheng, Qi Bei-bei, Gao Jian, et al. Dipolar Field based Homing Guidance Algorithm for an Autonomous Underwater Vehicle[J]. Systems Engineering and Electronics, 2016, 38(4): 902-908. [9] Fossen T I. Guidance and Control of Ocean Vehicles[M]. Hoboken, NJ, USA: John Wiley & Sons Inc, 1994. [10] 秦永元. 惯性导航[M]. 北京: 科学出版社, 2014. [11] 梁灿彬, 秦光戎, 梁竹健. 电磁学[M]. 北京: 高等教育出版社, 2004. [12] Panagou D, Kyriakopoulos K J. Dynamic Positioning for an Underactuated Marine Vehicle Using Hybrid Control[J]. International Journal of Control, 2014, 87(2): 264-280. [13] Feng Y , Yu X H, Man Z H. Non-singular Terminal Sliding Mode Control of Rigid Manipulators[J]. Automatica, 2002, 38(12): 2159-2167. [14] Loannou P, Fidan B. Adaptive Control Tutorial[M]. Philadelphia: Society for Industrial and Applied Mathematics, 2006.
点击查看大图
计量
- 文章访问数: 866
- HTML全文浏览量: 1
- PDF下载量: 307
- 被引次数: 0