-
0 引言
-
自主水下机器人(AUV)是当前人类探索海洋的有效工具之一,可用于绘制海底地图、研究水生动植物生活模式、观测海洋现象、安装海底管道和国防应用等[1]。随着水下任务的日益复杂,需要通过多AUV协作的方式来完成单个AUV无法完成的水下任务。在一些任务中,多AUV还需要按照固定的队形编队运动[2]。
-
近年来许多学者对多AUV编队控制进行了研究,比较成熟的编队控制方法有以下几种:基于虚拟结构法[3]、基于行为法[4]、基于跟随领航者法[5-7]、基于人工势场法[8-9]、基于路径跟随法[10-12] 和基于信息一致性法[13-14]等。文献[15]对多AUV编队方法进行了综述,其中跟随领航者法最易于理解,工程应用最为广泛。文献[16]在跟随领航者法的基础上,基于跟随者的状态反馈制定领航者的运动策略,解决了跟随者出现异常时队形可能保持的问题。文献[6]使用文献[16]中提出的方法,在国内较早的基于水声通信对编队控制方法展开外场试验验证,同时分析了实际应用中水声通信存在的问题和难点,并对此提出了宝贵的解决意见。随后也有研究人员提出了多种编队控制方法,但大多处于理论分析和仿真实验验证阶段,没有在实际中进行应用。
-
本文在水声通信的基础上,对传统的跟随领航者法进行改进,提出了一种基于改进跟随领航者法的编队控制方法。通过仿真实验验证该方法的可行性并确定关键控制参数,然后在湖上对该方法进行试验验证,对编队控制结果进行定量描述和详细分析,证明该编队控制方法的实用性和有效性。
-
1 编队控制方法
-
传统的跟随领航者法是指多AUV在三维水下环境编队运动时,领航者按照给定的航行路线和速度运动,在此期间通过水声通信周期性广播自身位置和速度信息,跟随者根据接收到的领航者信息自主调整航行路线和速度,与领航者保持期望的队形。
-
本文研究3台AUV的编队控制,将其划分为1台领航者和2台跟随者。在跟随领航者法的基础上进行改进,跟随者通过跟踪虚拟目标点实现编队,将对跟随者的航向和速度控制简化成单一的速度控制,并采用多级调控方法对跟随者的速度进行精准调控。建立一套队形评价标准,对编队控制的快速性、准确性和稳定性进行定量评价。
-
1.1 改进的跟随领航者法
-
对传统的跟随领航者法改进,改进方法中AUV之间通信数据量变小,更适应通信受限情况下的水声环境。同时在通信效果不稳定时,AUV仍能按照预设轨迹运动,抗扰动能力强,改进方法分为以下2步。
-
第1步,简化控制变量。给定AUV的运动深度和航向,AUV在不同深度定深运动,提高水声通信成功率。AUV沿预设航线运动,将对跟随者的航向和速度控制简化为只对速度控制。
-
第2步,精确调控速度。跟随者基于与领航者之间的距离误差反馈,调整速度以形成和保持队形。根据距离误差的大小,设置多级调控模式,提高队形形成的快速性和队形保持的稳定性。
-
某一时刻领航者和跟随者的位置关系如图1所示,其中代表领航者的真实位置和发送给跟随者的位置,和代表2个跟随者的位置,O 1 和O 2 为跟随者的虚拟目标点,为期望的编队队形。对其中一台跟随者B的速度控制方法进行数学说明。将整个平面划分成区域Ⅰ和Ⅱ2部分,分别表示跟随者在领航者的后方和前方2种情况。
-
图1 领航者和跟随者位置关系
-
Fig.1 Position relation between leader and followers
-
式中:为射线与之间的夹角,根据的大小,确定跟随者所处的区域。
-
式中:代表跟随者所处区域,表示处于区域 Ⅰ,表示处于区域Ⅱ。令
-
式中: L 为跟随者与领航者之间的期望距离; e 为跟随者与领航者之间的距离误差。
-
根据公式(2)–(3),提出4种跟随者B相对与虚拟目标点O 1 的位置状态:正常(N),激进 (A),落后(L)和脱离(B)。根据位置状态,制定跟随者速度控制策略,如表1所示。
-
表中R ≥0,表示允许的距离误差; vb和 vb 为跟随者和领航者的速度;和 为比例系数且 ;v min 和 v max 表示设定的AUV最小和最大航行速度。跟随者在正常状态下,缓慢调整速度,维持队形。在激进或者落后状态下,快速调整速度,形成队形。在脱离状态下,需要以最小速度航行等待领航者,由脱离状态变成激进状态后快速形成队形。
-
1.2 队形评价指标
-
为定量评价编队控制效果,从队形形成的快速性、准确性和队形保持的稳定性3个方面定义队形评价指标。
-
定义1:队形误差。
-
式中:为其中2台AUV的距离误差;为2台AUV之间的欧氏距离;为2台AUV的期望距离; E 为队形误差,其大小可以代表编队控制的精度。
-
定义2:队形形成时间。
-
式中:为首次形成队形的时间,其大小可以描述编队控制的快速性。
-
定义3:队形保持时间。
-
设AUV误差采样周期为 Terror,误差采样点集合为,若,都有,则称在采样点时刻保持了队形。
-
式中: N hold 为的总数;T total 为队形保持时间,其大小可以反映编队控制的稳定性。
-
2 仿真验证
-
对编队控制方法进行仿真验证,同时确定控制方法中参数k 1和 k 2取值。在MATLAB上进行仿真实验,3台AUV分别从坐标点 (0,15)、(0,0)和 (0,-15)(领航者位于中间)沿 X 轴方向运动约500m,领航者的期望速度 va=1.2m/s,通信周期T=5s,AUV之间期望距离,整体为正三角形队形。通信成功率 C=80%,其中 C 的定义为
-
式中: Nr 为跟随者接收到领航者信息的总包数; Ns 代表领航者发送信息的总包数; C 越大,代表通信效果越好。
-
利用遗传算法对参数k 1和 k 2进行优化,过程如下。
-
Step1:编码。给定k 1和 k 2的取值范围均为(0, 1],采用二进制编码方式,k 1和 k 2分别对应10条染色体的前5位和后5位。
-
Step2:初始化种群。随机产生4个10位二进制个体。
-
Step3:解码。对种群个体解码,得到4组k 1和 k 2的值。
-
Step4:评估种群中个体适应度。取队形误差的平均值作为目标函数,误差采样周期 T error=1s,将其转化成适应度函数为
-
计算每个个体适应度值。
-
Step5:选择。采用最佳保留选择算子,即将适应度最高的个体完整的复制到下一代群体中,其余个体按照轮盘赌选择方法执行选择操作。
-
Step6:交叉。采用随机配对方法,对每组个体进行单点交叉,交叉概率 Pc=0.5。
-
Step7:变异。采用均匀变异方法,变异概率 Pm=0.005。
-
Step8:进化终止条件。迭代次数 N=50时停止,否则执行Step3。
-
优化后的结果如图2所示,随着迭代次数的增加,最优适应度越来越大。将最后一步迭代得到的最优个体解码得到参数。当取上述参数时,3台AUV的运动轨迹如图3所示,编队效果很好。
-
图2 最优适应度值的迭代曲线
-
Fig.2 Iteration curves of the optimal fitness value
-
图3 仿真运动轨迹
-
Fig.3 Trajectory of AUVs in the simulation test
-
3 外场试验
-
为验证本文编队控制方法的实用性,使用3台 “探索100”AUV[17]进行了水下编队试验,如图4所示。编队试验中期望队形为正三角形,即。领航者保持在队伍的前方,跟随者在后方两侧保持跟随,试验方案如下:3台AUV定深航行,预定航线为3条间距约15m的由西向东平行直线,航行距离约500m。试验中,取 R=5m,v min=0.5m/s,v max=1.9m/s,Terror=1s。一共进行了多次编队试验,每次试验结果差别不大,由于本文篇幅有限,任取其中一次实验数据具体分析,如图5–9。
-
图4 试验中的AUV
-
Fig.4 AUVs in the field test
-
图5 航行轨迹
-
Fig.5 Trajectory of AUVs
-
图6 航行速度信息
-
Fig.6 Speed of AUVs
-
图7 航向角信息
-
Fig.7 Heading of AUVs
-
图8 深度信息
-
Fig.8 Depth of AUVs
-
图9 队形误差
-
Fig.9 Formation errors
-
图5 显示了多AUV的航行轨迹,可以看出正三角形队形逐渐形成并趋于稳定。图6为多AUV航行速度变化,可以看出跟随者1和跟随者2不断调整自身速度以保持期望队形。图7为多AUV航向信息,航向角基本与预设值相同,证明改进跟随领航者法中简化控制变量是简单有效的。图8为深度变化图,在垂直面上3台AUV分别在不同深度定深运动,且深度控制稳定,有利于减小对水平面上航向和速度控制的扰动。图9为队形误差图,可以看出三角形每条边的误差和总误差不断收敛,队形形成速度快,控制精度高,期望队形不断趋于稳定。
-
4 结束语
-
在水声通信的基础上,对跟随领航者编队控制方法进行改进,在MATLAB上对该方法进行仿真验证并确定关键控制参数,最后在湖上进行外场试验验证。试验结果表明:该方法在队形形成的快速性、维持队形的稳定性和队形控制的精确性等方面表现得很好。
-
AUV导航精度对编队效果影响很大,本文中采用电子罗盘+多普勒计程仪的低成本组合导航方法,短距离内导航误差较小。未来将对AUV导航方式进行升级,拟采用惯导+多普勒计程仪的高精度导航方法,提高编队精度。
-
本文试验环境中水声通信效果较好,下一步计划在水声通信效果较差甚至无法通信的环境中,对本文提出的方法进行改进,实现编队控制,最大限度的解决通信问题对编队控制的影响。
-
参考文献
-
[1] 许真珍,封锡盛.多UUV协作系统的研究现状与发展[J].机器人,2007,29(2):186-192.
-
[2] LI X,ZHU D Q,QIAN Y.A survey on formation control algorithms for multi-AUV system[J].Unmanned Systems,2014,02(04):351-359.
-
[3] 崔荣鑫,严卫生,徐德民,等.基于虚拟参考点的AUV编队控制[J].火力与指挥控制,2008,33(10):53-57.
-
[4] BALCH T,ARKIN R C.Behavior-based formation control for multirobot teams[J].IEEE Transactions on Robotics & Automation,1998,14(6):926-939.
-
[5] BURLUTSKIY N,TOUAHMI Y,LEE B H.Power efficient formation configuration for centralized leader-follower AUVs control[J].Journal of Marine Science & Technology,2012,17(3):315-329.
-
[6] 阎述学,李一平,封锡盛.基于水声通信的多AUV队形控制实现[J].控制工程,2017,24(S1):118-122.
-
[7] 冯之文,姚尧,苗艳,等.基于时延补偿的AUV领航跟随编队控制[J].舰船电子对抗,2020,43(1):29-36.
-
[8] 黄海,张强,张树迪,等.欠驱动AUV自适应编队控制策略[J].哈尔滨工程大学学报,2015,36(5):633-637.
-
[9] 潘无为,姜大鹏,庞永杰,等.人工势场和虚拟结构相结合的多水下机器人编队控制[J].兵工学报,2017,38(2):326-334.
-
[10] LAPIERRE L,SOETANTO D,PASCOAL A.Coordinated motion control of marine robots[C]//6th IFAC Conference on Manoeuvering and Control of Marine Craft.Girona:2003.
-
[11] GHABCHELOO R,AGUIAR A P,PASCOAL A,et al.Coordinated path-following control of multiple underactuated autonomous vehicles in the presence of communication failures[C]//The 45th Conference on Decision & Control.San Diego:2006.IEEE,2006.
-
[12] GHABCHELOO R.Coordinated path following of multiple autonomous vehicles[D]//Thesis of Technical University of Lisbon.Lisbon:2007.
-
[13] OLFATI-SABER R,MURRAY R M.Consensus Problems in Networks of Agents with Switching Topology and Time-Delays[C]//Transactions on Automatic Control.IEEE 2004.
-
[14] 王银涛,严卫生.多自主水下航行器系统一致性编队跟踪控制[J].控制理论与应用,2013,30(3):379-384.
-
[15] DAS B,SUBUDHI B,PATI B B.Cooperative formation control of autonomous underwater vehicles:an overview[J].International Journal of Automation and Computing,2016,13(3):199-225.
-
[16] LI,Y P,YAN S X.Formation control of multiple autonomous underwater vehicles based on state feedback[C]//11th World Congress on Intelligent Control and Automation.Shenyang:IEEE,2014.
-
[17] 曾俊宝,李硕,李一平,等.便携式自主水下机器人控制系统研究与应用[J].机器人,2016,38(1):91-97.
-
摘要
针对多自主水下机器人(多 AUV)编队问题,提出了一种基于改进跟随领航者法的编队控制方法,通过仿真实验和湖上试验进行了验证。将对跟随者的航向和速度控制简化成单一的速度控制,并采用多级精准速度调控方法进行编队控制。然后,通过仿真实验对该方法进行初步验证,并确定关键控制参数。最后,建立一套队形评价指标,通过外场试验验证该方法有效性。试验结果表明:该编队控制方法在控制的快速性、准确性和稳定性等方面均表现很好。
Abstract
To solve the formation problem of multiple autonomous underwater vehicles(AUVs),a formation control method based on the improved leader-follower method is proposed in this paper.The method is verified by simulation experiment and lake experiment. The leader-follower formation control method is improved by simplifying the control of heading and speed into a single speed control for the follower. A multi-stage precise speed control method is used for formation control. Then,the method is verified by simulation experiment,and the key control parameters are determined. Finally,a set of formation evaluation index is established,and the proposed method is verified by field tests. The result proves that the proposed method performs well in terms of response speed,accuracy and stability.
关键词
自主水下机器人(AUV) ; 编队控制 ; 水声通信 ; 编队试验