基于协同控制的自重构平台算法及试验验证

doi:10.16183/j.cnki.jsjtu.2020.415

基于协同控制的自重构平台算法及试验验证

于特^a, 王磊^,^a^,^b

a.海洋工程国家重点实验室, 上海交通大学, 上海 200240

b.高新船舶与深海开发装备协同创新中心, 上海交通大学, 上海 200240

Algorithm and Experimental Verification of Self-Assembling Platform Based on Cooperative Control

YU Te^a, WANG Lei^,^a^,^b

a. State Key Laboratory of Ocean Engineering, Shanghai Jiao Tong University, Shanghai 200240, China

b. Collaborative Innovation Center for Advanced Ship and Deep-Sea Exploration, Shanghai Jiao Tong University, Shanghai 200240, China

通讯作者: 王磊,男,副教授,博士生导师,电话(Tel.):021-62932025;E-mail:wanglei@sjtu.edu.cn.

责任编辑: 孙伟

收稿日期: 2020-12-11

基金资助:

国家自然科学基金资助项目(51179103)

Received: 2020-12-11

作者简介 About authors

于特(1995-),男,吉林省长春市人,硕士生,研究方向为无人船控制.

摘要

提出一种用于构建新型海上平台的方法.基于多无人船的协同控制实现自重构海上平台,该平台可以根据需求对接成不同形状,并设计旁靠控制器使得无人船进行旁靠对接;采用电磁和连接杆实现对接,同时降低对接难度.利用水池条件构建试验场地,并进行模型试验验证该自重构平台的功能.结果表明:同构的无人船设计使得任意无人船均可以实现对接.与单一海上平台相比,该自重构平台可以完成更复杂的任务,分散的去中心化设计使其更具灵活性和可靠性.

关键词： 自重构; 无人船; 海上平台; 协同控制

Abstract

A method for constructing a novel offshore platform was proposed. Based on the cooperative control of multiple unmanned vessels, a self-assembling platform was realized, which could be reconfigured into different shapes according to requirements. A docking controller was designed to realize the docking of two modules. A connecting rod and electromagnetic forces were adopted to complete the docking and reduce the difficulty. Besides, a test site was constructed using the conditions of pool, and a model test was performed to verify the functions of the proposed self-assembling platform. The results show that the design can realize the docking of any unmanned vessel. Compared with the single platform, this self-assembling platform can perform more complex tasks, whose decentralized design makes it more flexible and reliable.

Keywords： self-assembling; unmanned vessel; offshore platform; cooperative control

PDF (5600KB) 元数据多维度评价相关文章导出 EndNote| Ris| Bibtex 收藏本文

本文引用格式

于特, 王磊. 基于协同控制的自重构平台算法及试验验证[J]. 上海交通大学学报（自然版）, 2021, 55(11): 1493-1498 doi:10.16183/j.cnki.jsjtu.2020.415

YU Te, WANG Lei. Algorithm and Experimental Verification of Self-Assembling Platform Based on Cooperative Control[J]. Journal of shanghai Jiaotong University, 2021, 55(11): 1493-1498 doi:10.16183/j.cnki.jsjtu.2020.415

无人船的发展历史长达百年,从1898年由尼古拉·特斯拉发明的无线电遥控船开始,无人船的自主化程度随着自动控制和计算机技术的发展而不断提高.近年来,人工智能技术的飞速发展使得包括无人船在内的各类无人载器具备了自主执行任务和协同作业的能力.2014年8月,美国海军在弗吉尼亚州詹姆斯河开展了无人艇“蜂群”协同作战演示^[1].该无人艇集群包括5艘自主无人艇和8艘遥控无人艇,通过搭载的不同传感器,可以完成护航和敌船拦截任务,实现集群作战模式,包围和拦截“可疑舰船”.2018年,云洲智能公司在南海万山群岛海域开展了一次由56艘无人艇组成的海上编队航行^[2],该集群可以通过切换队形形成航母图案或汉字.同年,该公司利用81艘“瞭望者”号无人艇实现了更大规模的集群编队演示^[3].

在海上对接技术领域,美国海军早已启动了利用动力定位系统控制两船之间相对位置的理论和模型试验研究.在荷兰水池MARIN的模型试验中,利用动力定位系统的运输船和远征转运船坞(ESD)成功实现在多个波浪角度下的相对位置和艏向角的控制.在民用领域,与对接技术相关的大型海洋装备的旁靠和组块安装作业,已成为海洋工程中的研究和应用热点.Queiroz等^[4,5]利用一致性协同比例积分微分(PID)控制算法,实现了两艘动力定位拖轮的协同控制,在试验中减少了相对距离和艏向的误差.此外,其利用数值仿真方法,验证了基于一致性算法的协同控制可以更好地使两艘拖轮保持相对位置.Cong等^[6]利用PID控制算法控制半潜式生活平台跟随浮式生产储油轮(FPSO),数值仿真结果表明该作业方式有效.

大型海洋平台往往利用系泊的方法固定在某一区域作业,而小型无人船受其载重影响无法实现强度更大的功能.为了满足未来海上作业需求,提出一种自重构的海上自主变形平台:利用无人船之间的协同控制,包括任务规划、路径规划、轨迹跟踪和旁靠对接,实现无人船之间的自主靠泊对接,从而形成该平台.

1 旁靠控制策略

在大地坐标系中,2个子模块P和Q的旁靠系统如图1所示.模块P依靠自身控制系统定位在原地,模块Q依靠自身控制系统运动到虚线位置.考虑某个子模块的3自由度运动(纵荡、横荡和艏摇),其运动学和动力学可以用数学模型^[7]描述为

(1)

\overset{\cdot}{η}

=J(ψ)v

(2)

\overset{\cdot}{Mv}

+C(v)v+D(v)v=τ_input+τ_w

式中:η= ${[xyψ]}^{T}$ 为子模块在大地坐标系中的位置向量;v= ${[uvr]}^{T}$ 为其在船体(子模块)坐标系中的速度向量,坐标系如图1所示;J(ψ)为大地坐标系与船体坐标系之间的转换矩阵;M为质量矩阵;C(v)为科里奥利向心力矩阵;D(v)为阻尼矩阵;τ_input= ${[τ_{X} τ_{Y} τ_{N}]}^{T}$ ∈R³为控制输入的推力;τ_w为外界环境力干扰.模块P和Q的控制目标均可用数学方程约束为

(3)

\lim_{t \to \infty}

η=η_d

式中:t为时间.即子模块在大地坐标系中的位置向量向预定的位置向量(η_d)收敛.

图1

新窗口打开| 下载原图ZIP| 生成PPT

图1 大地坐标系与船体坐标系

Fig.1 Earth-fixed and body-fixed reference frames

1.1 单模块动力定位控制方法

子模块为过驱动控制,即控制输入的维度大于被控目标的维度.所设计的子模块包括8个固定的推进器,可以实现3个自由度的运动控制.控制算法选择动力定位系统的经典控制算法,即PID控制算法.在水平面3个自由度的PID控制算法为

(4)τ_input=K_pΔx+K_d

\overset{\cdot}{x}

+K_i

\int_{0}^{t}

Δx(τ)dτ

式中:K_p、K_d和K_i分别为比例、微分和积分系数;x和Δx分别为在船体坐标系中子模块3个自由度的位置和相对于预定目标位置的位置偏差;τ为时间微元.利用该方法得到的τ_input无法直接作用于子模块上,还需要对其进行推力分配,以得到每个推进器的推力.

1.2 双模块协同控制策略

图1中的双模块旁靠情况需要2个子模块协同控制.构建双子模块的动力学模型:

(5)M_Q

{\overset{\cdot}{v}}_{Q}

+C(v_Q)v_Q+D(v_Q)v_Q=τ_input+τ_w-M_P

{\overset{\cdot}{v}}_{P}

-C(v_P)v_P-D(v_P)v_P

式中:模块P定位在原地,为领航者;模块Q为跟随者,负责与模块P旁靠,这利用了无人船编队控制中领航-跟随的思想.但该方法使得子模块与子模块之间的“地位”不对等.本设计的核心思想之一为去中心化,使得每个子模块的任务一致,因此提出如图2所示的协同控制策略.在模块P和Q之间选取1个中间动态参考点(M),通过设计点M可以进一步设计2个子模块各自的理想定位点P'和Q'.点M、P'和Q'可分别表达为

(6)η_M=

\frac{1}{2}

(η_P+η_Q)=

[\begin{array}{l} η_{M_x} \\ η_{M_y} \\ η_{M_ψ} \end{array}]

(7)

\begin{array}{l} P'_{x} = η_{M_x} + \frac{1}{2} B \sin η_{M_ψ} \\ P'_{y} = η_{M_y} - \frac{1}{2} B \cos η_{M_ψ} \\ P'_{ψ} = η_{M_ψ} \end{array}\}

(8)

\begin{array}{l} Q'_{x} = η_{M_x} - \frac{1}{2} B \sin η_{M_ψ} \\ Q'_{y} = η_{M_y} + \frac{1}{2} B \cos η_{M_ψ} \\ Q'_{ψ} = η_{M_ψ} \end{array}\}

式中:B为单个子模块的型宽.利用上述方法选取定位点,可以实现去中心化的设计.模块P和Q执行同样的目标任务,利用PID控制算法,实现双模块旁靠.

图2

新窗口打开| 下载原图ZIP| 生成PPT

图2 动态参考点M

Fig.2 Dynamic reference point M

1.3 推力分配策略

本设计中的子模块为8个推进器,其布置如图3所示.

图3

新窗口打开| 下载原图ZIP| 生成PPT

图3 推进器布置

Fig.3 Thruster arrangement

对τ_input进行推力分配,得到8个推进器的转速,并使其作用于子模块上.τ_input由8个推进器作用产生的合力组成,表示为

(9)τ_input=B(α)T

式中:T∈R⁸为推进器的推力;α∈R⁸为推进器的角度,本设计采用固定式推进器,则

α= ${[\begin{array}{l} 0 & \frac{π}{2} & \frac{π}{2} & π & π & \frac{- π}{2} & \frac{- π}{2} & 0 \end{array}]}^{T}$

该矩阵所描述的推进器顺序为船体坐标系下X轴正向顺时针的遍历.B(α)为3×8矩阵,其第i列为

(10)B_i(α_i)=

[\begin{array}{l} \cos α_{i} \\ \sin α_{i} \\ - l_{iy} \cos α_{i} + l_{ix} \sin α_{i} \end{array}]

式中:α_i为第i个推进器的角度;l_ix和l_iy为第i个推进器在船体坐标系中的位置.将α代入B(α)即可得到全部推进器作用矩阵,不再赘述.推力分配问题可以通过求解以下最优化问题解决.

(11)min J(T, s)=

\overset{8}{\sum_{i = 1}}

W_i(u_i)+s^TQs

(12)s.t. s+B(α)T=τ_input

(13)0≤T_i≤T_{i_}_max

(14)0≤T_i-T₀≤(ΔT)_max

式中:J(T, s)为目标函数; $\overset{8}{\sum_{i = 1}}$ W_i(u_i)为总功率消耗;s为松弛变量,是推力分配后的实际推力与目标推力的差值;s^TQs表示实际分配后的推力与目标推力之间误差的罚函数,设计Q矩阵足够大,则可以保证分配后的推力误差尽可能小;T_i为第i个推进器的推力;T₀为前一时刻推进器的推力.利用序列二次规划法求解上述问题可以得到每个推进器控制输入的推力.

2 子模块软硬件设计

设计如图4所示的驳船型船体子模块,船长为 80 cm,船宽为 40 cm.其由3部分组成,从上至下依次为甲板、主船体和推进器.其中,甲板内包含对接机构;主船体内搭载岸机通信模块、控制模块、定位模块和供电设备等;推进器布置与图3所示一致.

图4

新窗口打开| 下载原图ZIP| 生成PPT

图4 子模块硬件布置

Fig.4 Hardware arrangement of a single module

2.1 对接机构

图5为对接机构的构型.每个子模块上均分布着公头和母头,母头为引导装置,公头通过控制器进行伸缩以实现模块之间的对接与分离.在对接时,公头从甲板内伸出,利用协同控制算法控制子模块运动,进而带动公头向母头靠拢;利用引导装置和子模块的自身运动,使得公头完全进入母头,采用电磁方式将公头末端与母头固连,实现对接,如图6所示.

图5

新窗口打开| 下载原图ZIP| 生成PPT

图5 对接示意图

Fig.5 Sample of docking method

图6

新窗口打开| 下载原图ZIP| 生成PPT

图6 对接完成

Fig.6 Docking completed

2.2 控制逻辑

全局的任务规划在岸上上位机中实现,上位机通过无线通信技术(Wi-Fi)和底层通信模块进行数据传输.底层控制器通过结算上位任务,得到所需执行的具体任务,具体控制(子模块对接)逻辑如下:

步骤1 输入最终对接的定位点.

步骤2 上位机对已有子模块进行路劲规划,给出每个循迹点和终点坐标,通过局域网发布.

步骤3 子模块接收步骤2中的坐标点,进行轨迹跟踪.

步骤4 当检测到2个子模块之间的相对距离不大于其设计参数时,进行对接.

步骤5 2个子模块通过1.2节中的控制策略进行旁靠对接.

步骤6 当检测到2个子模块之间的纵荡方向误差不大于其设计参数时,伸出公头.

步骤7 双模块对接完成.

步骤8 剩余2个子模块重复步骤3~7.

步骤9 将已经对接完成的2个双模块视为2个新子模块,重复步骤3~7.

步骤10 4个子模块对接完成.

3 数值仿真结果及分析

在进行试验之前,利用数值仿真对上述策略进行验证.在ROS(机器人操作系统)中建立4个子模块的运动学和动力学模型,对4个子模块首尾对接形成的浮桥进行仿真.为真实还原外界环境力的影响,选择外界干扰为

(15)τ_w=

[\begin{array}{l} 5 + 5 \sin (0.1 t + \frac{π}{2}) - 2.5 \sin (0.05 t) \\ 5 + 5 \sin (0.4 t + \frac{π}{2}) - 2.5 \sin (0.05 t) \\ 10 \sin (0.1 t + \frac{π}{2}) - 5 \sin (0.05 t) \end{array}]

仿真结果如图7和8所示.4个子模块的初始位置距离较近,在仿真中忽略模块之间的碰撞,模块首先运动到各自定位点,然后控制艏向一致以实现对接.图9为图7最左侧模块艏摇角的时历曲线.模块的横向误差和艏摇角存在一定超调,在实际应用中可能导致模块之间的碰撞, 因此需要对控制逻辑进行优化.

图7

新窗口打开| 下载原图ZIP| 生成PPT

图7 子模块轨迹

Fig.7 Trajectories of four modules

图8

新窗口打开| 下载原图ZIP| 生成PPT

图8 子模块拼接过程

Fig.8 Procedure of combination of four modules

图9

新窗口打开| 下载原图ZIP| 生成PPT

图9 子模块跟踪误差

Fig.9 Tracking error of module

4 自重构平台对接试验

搭建软硬件设备,在水池条件下试验对接流程,测试4个子模块拼接为一个2×2浮体的过程,如图10所示.4个子模块(红)由初始位置出发,进行两两对接(蓝),然后再次对接形成1个平台(绿).试验中,每个子模块按照路径规划循迹至需要对接的子模块附近, 然后进行位置保持,待两者艏向相同,纵向位置一致时,即开始进行向内侧的旁靠运动,借助对接机构实现对接任务.四船对接采取相同方法,只是控制参数有所不同.每组双船的旁靠对接大概需要120 s,随后大概需要60 s拼接为一个2×2的整体,试验中4个子模块的拼接过程如图11所示.在试验中发现:小模型的惯性较小不易控制,8桨的推进器也不利于实现预定推力.因此,在后续工作中可以制作缩尺比更小的模型,并安装4个全回转推进器,从而更好地实现目标对接.

图10

新窗口打开| 下载原图ZIP| 生成PPT

图10 子模块自主对接

Fig.10 Autonomous docking of four modules

图11

新窗口打开| 下载原图ZIP| 生成PPT

图11 试验模块拼接过程

Fig.11 Procedure of combination of text modules

5 结语

本设计提出一种自重构平台的设想,并进行初步的试验验证,为进一步研究做铺垫.首先从理论层面分析,明确方法和技术,然后将问题转化为2个子模块如何利用各自的动力定位能力实现旁靠对接,并对控制方法和推力分配进行设计,仿真结果表明了控制逻辑和算法的有效性.为了验证自重构平台的可行性,依托实验室条件进行模型试验,结果表明:4个子模块能够利用通信系统与岸机交互信息,执行控制指令,并逐步实现两两对接,最终拼接为一个整体平台.未来将继续开展更贴近实际的试验验证,制作缩尺比较小的模型,并对推进装置进行优化,考虑使用全回转推进器;在对接过程中适当引入风浪流外载荷干扰,进而验证算法的鲁棒性.

参考文献

原文顺序

文献年度倒序

文中引用次数倒序

被引期刊影响因子

[1]

杨振华, 冷沙.

管窥外军典型无人化作战装备

[J]. 军事文摘, 2020(19):31-34.

[本文引用: 1]

YANG

Zhenhua

, LENG

Sha

On typical unmanned combat equipment of foreign army

[J]. Military Digest, 2020(19):31-34.

[本文引用: 1]

[2]

张伟, 廖煜雷, 姜峰, 等.

无人水面艇技术发展回顾与趋势分析

[J]. 无人系统技术, 2019, 2(6):1-9.

[本文引用: 1]

ZHANG

Wei

, LIAO

Yulei

, JIANG

Feng

, et al.

Development review and trend analysis of unmanned surface vehicles technology

[J]. Unmanned Systems Technology, 2019, 2(6):1-9.

[本文引用: 1]

[3]

熊勇, 余嘉俊, 张加, 等.

无人艇研究进展及发展方向

[J]. 船舶工程, 2020, 42(2):I0010-I0017.

[本文引用: 1]

XIONG

Yong

, YU

Jiajun

, ZHANG

Jia

, et al.

Research progress and development direction of unmanned aerial vehicle

[J]. Ship Engineering, 2020, 42(2):I0010-I0017.

[本文引用: 1]

[4]

QUEIROZ FILHO A

, TANNURI E

Experimental results of cooperative control applied to multi-vessel DP operations

[C]// Proceedings of ASME 2013 32nd International Conference on Ocean, Offshore and Arctic Engineering. Nantes, France: ASME, 2013.

[本文引用: 1]

[5]

QUEIROZ FILHO A

, TANNURI E

Cooperative control applied to DP systems-numerical analysis

[J]. IFAC Proceedings Volumes, 2013, 46(33):268-273.

[本文引用: 1]

[6]

CONG P

, MAGEE A

, JAIMAN

, et al.

Hydrodynamic analysis including shielding effects and advanced DP controls for improved uptime of a floatel connected to an FPSO by a gangway

[C]// Proceedings of the Offshore Technology Conference Asia. Kuala Lumpur, Malaysia: Offshore Technology Conference, 2018.

[本文引用: 1]

[7]

FOSSEN T

Handbook of marine craft hydrodynamics and motion control

[M]. Hoboken, USA: Wiley, 2011.

[本文引用: 1]

管窥外军典型无人化作战装备

... 无人船的发展历史长达百年,从1898年由尼古拉·特斯拉发明的无线电遥控船开始,无人船的自主化程度随着自动控制和计算机技术的发展而不断提高.近年来,人工智能技术的飞速发展使得包括无人船在内的各类无人载器具备了自主执行任务和协同作业的能力.2014年8月,美国海军在弗吉尼亚州詹姆斯河开展了无人艇“蜂群”协同作战演示^[1].该无人艇集群包括5艘自主无人艇和8艘遥控无人艇,通过搭载的不同传感器,可以完成护航和敌船拦截任务,实现集群作战模式,包围和拦截“可疑舰船”.2018年,云洲智能公司在南海万山群岛海域开展了一次由56艘无人艇组成的海上编队航行^[2],该集群可以通过切换队形形成航母图案或汉字.同年,该公司利用81艘“瞭望者”号无人艇实现了更大规模的集群编队演示^[3]. ...

管窥外军典型无人化作战装备

无人水面艇技术发展回顾与趋势分析

2019

无人水面艇技术发展回顾与趋势分析

2019

无人艇研究进展及发展方向

2020

无人艇研究进展及发展方向

2020

Experimental results of cooperative control applied to multi-vessel DP operations

2013

... 在海上对接技术领域,美国海军早已启动了利用动力定位系统控制两船之间相对位置的理论和模型试验研究.在荷兰水池MARIN的模型试验中,利用动力定位系统的运输船和远征转运船坞(ESD)成功实现在多个波浪角度下的相对位置和艏向角的控制.在民用领域,与对接技术相关的大型海洋装备的旁靠和组块安装作业,已成为海洋工程中的研究和应用热点.Queiroz等^[4,5]利用一致性协同比例积分微分(PID)控制算法,实现了两艘动力定位拖轮的协同控制,在试验中减少了相对距离和艏向的误差.此外,其利用数值仿真方法,验证了基于一致性算法的协同控制可以更好地使两艘拖轮保持相对位置.Cong等^[6]利用PID控制算法控制半潜式生活平台跟随浮式生产储油轮(FPSO),数值仿真结果表明该作业方式有效. ...

Cooperative control applied to DP systems-numerical analysis

2013

Hydrodynamic analysis including shielding effects and advanced DP controls for improved uptime of a floatel connected to an FPSO by a gangway

2018

Handbook of marine craft hydrodynamics and motion control

2011

... 在大地坐标系中,2个子模块P和Q的旁靠系统如图1所示.模块P依靠自身控制系统定位在原地,模块Q依靠自身控制系统运动到虚线位置.考虑某个子模块的3自由度运动(纵荡、横荡和艏摇),其运动学和动力学可以用数学模型^[7]描述为 ...

〈

〉