Formation Path Following Control of Multiple AUVs Based on Serret-Frenet Coordinate System
-
摘要: 针对多自主水下航行器(AUV)的编队路径跟踪控制问题, 提出了基于Serret-Frenet坐标系的虚拟结构编队控制方法, 分为单个AUV队形路径跟踪控制, 以及多个AUV间路径跟踪参考点的一致性协调控制两部分。首先为每个AUV定义一个沿期望路径运动的路径跟踪参考点, 并以其为原点建立Serret-Frenet坐标系描述编队跟踪误差及动态模型。通过对AUV的航向角和速度的控制, 使其跟踪并收敛于该Serret-Frenet坐标系下的期望队形位置。然后采用基于比例-积分控制的一致性算法, 调节各个参考点的路径参数变化率使其达到一致, 并以给定的期望速度沿路径运动。通过数学仿真实现了3个AUV以一定队形跟踪期望路径, 验证了该算法的有效性。
-
关键词:
- 自主水下航行器 /
- 编队控制 /
- 路径跟踪 /
- Serret-Frenet坐标系
Abstract: A virtual structure formation control method based on a Serret-Frenet coordinate system is proposed for the formation path following control of multiple autonomous underwater vehicles(AUVs). The formation control system is composed of two parts, namely, the path following control for each AUV and the consistency coordination control for the path following reference points of multiple AUVs. Firstly, a path following reference point is defined for each AUV which moves along the desired path, and a Serret-Frenet coordinate system, which takes the reference point as its origin, is built to describe the formation path following errors and the dynamic model. The course angle and velocity are prop-erly controlled to make the AUV converge to its predefined desired position in the Serret-Frenet coordinate system. Secondly, a proportional-integral consistency algorithm for path parameters is designed for all AUVs to make the virtual reference points synchronously move at a given change rate along the desired path with the desired velocity. At last, three AUVs in following a desired path with a certain formation are simulated, and the results validate the effectiveness of the proposed control method. -
[1] Healey A J. Application of Formation Control for Multi- Vehicle Robotic Mine Sweeping[C]//Proceedings of the IEEE Conference on Decision and Control. New York: IEEE, 2001: 1497-1502. [2] Benediktsson J A, Swain P H. Consensus Theoretic Clas-sification Methods[J]. IEEE Transactions System, Man, Cybernetics, 1992, 22(4): 688-704. [3] Olfati-Saber R, Murray R M. Consensus Problems in Networks of Agents with Switching Topology and Time- Delays[J]. IEEE Transactions Automatic Control, 2004, 49(9): l520-l533. [4] Do K D, Pan J. State-and-Output Feedback Robust Path-Following Controllers for Underactuated Ships Us-ing Serret-Frenet Frame[J]. Ocean Engineering, 2004, 31 (5/6): 587-613. [5] Lapierre L, Soetanto D. Nonlinear Path-Following Con-trol of an AUV[J]. Ocean Engineering, 2007, 34(11/12): 1734-1744. [6] Ren W, Sorensen N. Distributed Coordination Architec-ture for Multi-robot Formation Control[J]. Robotics and Autonomous Systems, 2008, 56(4): 324-333. [7] 毕鹏, 罗建军, 张博. 一种基于一致性理论的航天编队飞行器协同控制方法[J]. 宇航学报, 2010, 31(1): 70-74.Bi Peng, Luo Jian-jun, Zhang Bo. Cooperate Control Al-gorithm for Spacecraft Formation Flying Based on Con-sensus Theory[J]. Journal of Astronautics, 2010, 31(1): 70-74. [8] Børhaug E, Pavlov A, Pettersen K. Straight Line Path Following for Formations of Underactuated Marine Sur-face Vessels[J]. IEEE Transactions on Control Systems Technology, 2011, 19(3): 493- 506. [9] 袁健, 唐功友. 采用一致性算法与虚拟结构的多自主水下航行器编队控制[J]. 智能系统学报, 2011, 6(3): 248-253.Yuan Jian, Tang Gong-you. Formation Control of Auton- omous Underwater Vehicles with Consensus Algorithms and Virtual Structure[J]. CAAI Transactions on Intelligent Systems, 2011, 6(3): 248 -253. [10] 王银涛, 严卫生. 多自主水下航行器系统一致性编队跟踪控制[J]. 控制理论与应用, 2013, 30(3): 379-384.Wang Yin-tao, Yan Wei-sheng. Consensus Formation Tra- cking Control of Multiple Autonomous Underwater Vehi-cle Systems[J]. Control Theory & Applications, 2013, 30(3): 379-384. [11] 高剑, 刘富樯, 赵江, 等. 欠驱动自主水面船的非线性路径跟踪控制[J]. 机器人, 2012, 34(3): 329-336.Gao Jian, Liu Fu-qiang, Zhao Jiang, et al. Non-linear Path Following Control of Underactuated Autonomous Surface Vehicles[J]. Robot, 2012, 34(3): 329-336. [12] Fossen Thor I. Marine Control Systems: Guidance, Navig- ation and Control of Ships, Rigs and Underwater Vehi-cles[M]. Trondheim, Norway: Marine Cybernetics, 2002. [13] Kaminer I, Yakimenko O, Pascoal A, et al. Path Genera-tion, Path Following and Coordinated Control for Time- Critical Missions of Multiple UAVs[C]//Proceedings of the American Control Conference, Minneapolis, Minne-sota, USA, 2006: 4906-4913. [14] Prestero T. Verification of a Six-degree of Freedom Simu- lation Model for The REMUS Autonomous Underwater Vehicle[D]. MS Thesis, MIT/WHOI Joint Program in Oc- eanographic Engineering, 2001.
点击查看大图
计量
- 文章访问数: 1134
- HTML全文浏览量: 2
- PDF下载量: 666
- 被引次数: 0