2. 天津瀚海蓝帆海洋科技有限公司,天津 300300;
3. 天津市深远海智能移动勘测装备研发重点实验室,天津 300300
2. Tianjin Hanhai-lanfan Marine Technology Co., Ltd., Tianjin 300300, China;
3. Tianjin Key Laboratory of Deep-sea Intelligent Mobile Survey Equipment, Tianjin 300300, China
近年来,海上风力发电机凭借其利用率高、清洁、装配灵活等优点装机规模飞速增长[1]。受海上环境影响,与海水接触的桩机表面、牺牲阳极等容易长满藤壶等海洋附着物,容易被腐蚀,降低寿命。因此,定期清理风电桩显得尤为重要,传统人工清洗方式存在安全风险高、作业周期长等缺点,基于缆控水下机器人(Remotely Operated Vehicle,ROV)的自动化清洗技术已成为当前研究热点。ROV具备工作时间长、作业范围广、操作简单等优点,在海洋资源开发、风电桩清洗等方面应用广泛。
ROV运动控制性能直接影响清洗作业效率。近年来,已有众多学者对此展开研究。熊保星等[2]将模糊线性自抗扰控制策略应用于ROV定深控制中,利用模糊控制在线整定控制器参数,解决传统PID控制鲁棒性较差问题。梁一飞等[3]提出一种基于降阶扩张状态观测的ROV自抗扰控制方法,具有较好的信号跟踪精度和扰动抑制能力。宋大雷等[4]提出一种水动力模型补偿的自抗扰控制方法,利用已知信息对观测器进行补偿,可以减小观测器负担,提高控制精度。郑伦川等[5]基于重构粒子群算法对机械臂自抗扰控制进行控制优化,减小机械臂在扰动作用下控制误差。单正等[6]利用灰狼算法对燃气轮机自抗扰控制进行参数整定,极大程度地降低调参难度,并减小控制调节时间,提高综合控制性能。
同时部分学者对水下清洗设备进行研究。陈建均[7]提出采用高压水泵和空气压缩机配合水下机器人对海上钢管淤泥进行清理,超高水压快速冲刷钢管表面淤泥,同时压缩机将空气分散成为小气泡,气泡上升过程中形成气流带动淤泥离开水底。整体清洗方式风险系数小,作业效率高。蔡洪建等[8]提出一种移动支座式辅助冲洗装置,人工时刻调整移动支座,支座带动清洗设备进行移动,人工方式实现大范围空间的高精度定位,减小清洗设备对控制算法的依赖程度,方便时刻对准作业对象,减小作业难度,提高清洗工作效率。
本文提出一种支架式辅助清洗控制方法,通过支架约束,极大程度减小ROV控制难度在风电桩清洗ROV深度和艏向角控制回路采取自抗扰控制(Active Disturbance Rejection Control,ADRC)。同时利用淘金优化器(Gold Rush Optimizer,GRO)优化自抗扰控制器参数,减小调参难度,增加工程上的可用性。
1 风电桩清洗方案设计考虑到海上风电桩清洗环境,桩机处水流紊乱、近水面受波浪力影响大。传统清洗方案可借鉴船舶动力定位思想,实现ROV位置控制,然后进行清洗工作。但是考虑到清洗时ROV与风电桩间距离较近,实现ROV精准动力定位控制,难度较大,并且存在撞击风险。本文以天津瀚海蓝帆海洋科技有限公司自主研发的ROV为研究对象,在ROV前方增加支撑架,以机械臂夹持空化射流枪实现清洗工作。辅助式支架清洗方式如图1所示。
|
图 1 辅助式支架清洗方式 Fig. 1 Auxiliary stent cleaning method |
ROV通过辅助支架与风电桩表面形成刚性接触,同时水平推进器施加一定推力,保持ROV与风电桩间的紧密贴合状态。可保证清洗作业的安全距离,降低水流冲击影响。此时俯仰角和横滚角变化较小,对空化射流清洗轨迹影响可忽略不计。
基于支架的物理约束,对ROV的位姿控制转化为对深度和艏向角的控制。辅助支架与风电桩间存在摩擦力,清洗时空化射流枪也存在反作用力,传统PID控制无法对此进行扰动补偿,鉴于自抗扰控制的独特扰动观测机制,利用扩张状态观测器将复杂扰动扩张成总扰动从而进行补偿,故在深度和艏向角回路采取自抗扰控制方法。
2 ROV数学模型 2.1 坐标系建立为方便描述ROV在水下三维空间运动时的状态量,建立惯性参考坐标系
|
图 2 ROV坐标系 Fig. 2 ROV coordinate system |
ROV运动各参数定义如表1所示。
|
|
表 1 ROV参数表 Tab.1 ROV parameter |
坐标系中运动坐标系经3次坐标旋转变换与固定坐标系重合[9],ROV运动坐标系到惯性坐标系的转换方程为:
| $ \left\{\begin{aligned}&\dot{\eta}=\left[\dot{\eta}_1,\dot{\eta}_2\right]=J\left(\eta\right)V,\\ &\eta_1=\left[{x},{y},{z}\right]^{\mathrm{T}},\\ &\eta_2=\left[\phi,\theta,\psi\right]\mathrm{^T},\\ &V=\left[u,v,w,p,q,r\right]^{\mathrm{T}}。\end{aligned}\right. $ | (1) |
式中:
根据Fossen公式[10],结合ROV实际作业场景,ROV在水下未知环境中,六自由度动力学方程为:
| $ M\dot{V}+\boldsymbol{C}\left(\boldsymbol{V}\right)\boldsymbol{V}+\boldsymbol{D}\left(\boldsymbol{V}\right)\boldsymbol{V}+\boldsymbol{g}\left(\boldsymbol{\eta}\right)=\boldsymbol{\tau}+F_c 。$ | (2) |
式中:
得益于计算机技术的发展,本文采取CFD方法对ROV水动力系数进行计算。首先对ROV模型进行化简,以便得到高质量网格。基于以下原则对ROV模型进行化简:
1) 忽略ROV控制舱、动力舱、观测舱的内部结构,化简成圆柱体;
2)忽略推进器桨叶、桨叶特征及推进器外部造型倒角;
3)在保留ROV主要特征前提下,对机械臂、摄像头、照明灯、天线等部件进行化简,以合适规格的圆柱体进行替代。
可得到ROV化简模型如图3所示。
|
图 3 ROV化简模型 Fig. 3 ROV simplification model |
采取长方体计算域,Realizable k-ε湍流模型,在STAR-CCM+中通过竖直方向的上升下潜运动和水平方向回转运动求取水动力系数。具体计算过程见文献[11]。
2.4 推进器模型该研究对象采用8个推进器布置,水平面4个推进器与水平线成30°夹角,采用矢量布置;竖直面4个推进器轴线与坐标系竖直坐标轴平行,竖直面推进器距离运动坐标系
|
图 4 推进器布局 Fig. 4 Thruster layout |
水平面推进器安装在ROV重心高度位置,故水平面推进器不会对竖直面3个自由度产生力(力矩),ROV各自由度目标力及力矩
| $ \left\{\begin{array}{*{20}{l}}\tau_c=\boldsymbol{Bf},\\ \tau_c=\left[X,Y,Z,K,M,N\right]^{\mathrm{T}},\\ \boldsymbol{f}=\left[{T}_1,{T}_2,{T}_3,{T}_4,{T}_5,{T}_6,{T}_7,{T}_8\right]^{\mathrm{T}}。\end{array}\right. $ | (3) |
| ${ {\boldsymbol{B}} = \left[ {\begin{array}{*{20}{c}} {{c_1}}&{{c_1}}&{{c_1}}&{{c_1}}&0&0&0&0 \\ { - {c_2}}&{{c_2}}&{ - {c_2}}&{{c_2}}&0&0&0&0 \\ 0&0&0&0&1&1&1&1 \\ 0&0&0&0&{{l_x}}&{{l_x}}&{ - {l_x}}&{ - {l_x}} \\ 0&0&0&0&{{l_y}}&{ - {l_y}}&{ - {l_y}}&{{l_y}} \\ { - {c_1}{l_y} - {c_2}{l_x}}& {{c_1}{l_y} + {c_2}{l_x}}& {{c_1}{l_y} + {c_2}{l_x}}& { - {c_1}{l_y} - {c_2}{l_x}}&0&0&0&0 \end{array}} \right] }。$ | (4) |
式中:
自抗扰控制结构主要包括微分跟踪器(Tracking Differentiator,TD)、扩张状态观测器(Extended State Observer,ESO)和非线性误差反馈控制律(Nonlinear State Error Feedback,NLSEF)。TD主要解决输入信号超调量和快速性之间的矛盾;ESO用于估计系统实时总扰动并给予补偿;NLSEF用于构造合适的非线性函数完成控制器反馈[12]。自抗扰控制流程如图5所示。
|
图 5 自抗扰控制结构框图 Fig. 5 ADRC structural block diagram |
将深度和艏向角看做二阶系统进行控制,以深度控制为例,期望深度进入到TD中,TD输出期望深度的跟踪信号
微分跟踪器可以对输入信号进行平滑过渡,为适应计算需求,其离散形式为:
| $ \left\{ {\begin{aligned} &{{x_1}\left( {k + 1} \right) = {x_1}\left( k \right) + h{x_2}\left( k \right)},\\ &{{x_2}\left( {k + 1} \right) = {x_2}\left( k \right) + hfhan} 。\end{aligned}} \right. $ | (5) |
式中:
| $ \left\{\begin{aligned} & d=r_0h_0^2 ,\\ & a_0=h_0x_2 ,\\ & y=x_1+a_0 ,\\ & a_1=\sqrt{d\left(d+8\left|y\right|\right)} ,\\ & a_2=a_0+\mathrm{sign}\left(y\right)\left(a_1-d\right)\mathord{\left/\vphantom{\left(a_1-d\right)2}\right.}2 ,\\ & s_y=\left[\mathrm{sign}\left(y+d\right)-\mathrm{sign}\left(y-d\right)\right]\mathord{\left/\vphantom{\left[sign\left(y+d\right)-sign\left(y-d\right)\right]2}\right.}2 ,\\ & a=\left(a_0+y-a_2\right)s_y+a_2 ,\\ & s_a=\left[\mathrm{sign}\left(a+d\right)-\mathrm{sign}\left(a-d\right)\right]\mathord{\left/\vphantom{\left[sign\left(a+d\right)-sign\left(a-d\right)\right]2}\right.}2 ,\\ & fhan=-r\left[a\mathord{\left/\vphantom{ad-sign\left(a\right)}\right.}d-\mathrm{sign}\left(a\right)\right]s_a-r_0\mathrm{sign}\left(a\right)。\end{aligned}\right. $ | (6) |
式中:
扩张状态观测器是实现自抗扰的核心,将控制系统未建模动态与未知扰动扩张成一个总扰动,从而实现自抗扰。以非线性函数
| $ \left\{ {\begin{aligned} &{{e_1} = {z_1}\left( k \right) - y\left( k \right)},\\ &{{z_1}\left( {k + 1} \right) = {z_1}\left( k \right) + h\left( {{z_2}\left( k \right) - {\beta _1}{e_1}} \right)},\\ &{{z_2}\left( {k + 1} \right) = {z_2}\left( k \right) + h\left( {{z_3}\left( k \right) - {\beta _2}fal\left( {{e_1},{\alpha _1},\delta } \right) + bu} \right)},\\ &{{z_3}\left( {k + 1} \right) = {z_3}\left( k \right) - h{\beta _3}fal\left( {{e_2},{\alpha _2},\delta } \right)} 。\end{aligned}} \right. $ | (7) |
式中:
| $ fal\left( {e,\alpha ,\delta } \right) = \left\{ {\begin{aligned} &{\displaystyle\frac{e}{{{\delta ^{1 - \alpha }}}},\left| e \right| \leqslant \delta } ,\\ &{{{\left| e \right|}^\alpha }{\rm{sign}}\left( e \right),\left| e \right| > \delta } 。\end{aligned}} \right. $ | (8) |
式中:
基于TD、ESO,得到系统的输入误差信号和误差微分信号,以非线性组合形式进行误差反馈补偿,非线性误差反馈控制律如下:
| $ \left\{ {\begin{aligned} &{{e_1} = {x_1} - {z_1}},\\ &{{e_2} = {x_2} - {z_2}},\\ &{{u_0} = {k_p}fal\left( {{e_1},{\alpha _1},\delta } \right) + {k_d}fal\left( {{e_2},{\alpha _2},\delta } \right)},\\ &{u = {u_0} - {{{z_3}} \mathord{\left/ {\vphantom {{{z_3}} b}} \right. } b}} 。\end{aligned}} \right. $ | (9) |
式中:
淘金优化器算法是一种基于人类淘金活动的元启发式算法,以淘金活动中的迁移、合作、挖掘3种核心行为抽象而来[13],目的是寻找到最优金矿。
淘金者总是向黄金最多的位置进行迁移,将迁移行为定义为:
| $ {D_1} = {C_1}\cdot{X_*}(t) - {X_i}(t),$ | (10) |
| $ X_{\mathrm{new}i}(t+1)=X_i(t)+A_1\cdot D_1。$ | (11) |
式中:
| $ {A_1} = 1 + {{l} _1}\left( {{r_1} + \frac{1}{2}} \right) ,$ | (12) |
| $ {C_1} = 2{r_2}。$ | (13) |
式中:
| $ {l_e} = {\left( {\frac{{{{\max }_{iter}} - iter}}{{{{\max }_{iter}} - 1}}} \right)^e}\left( {2 - \frac{1}{{{{\max }_{iter}}}}} \right) + \frac{1}{{{{\max }_{iter}}}} 。$ | (14) |
挖掘金矿时,每个淘金者的位置都被近似认为是金矿位置,挖掘行为表示为:
| $ {D_2} = {X_i}\left( {{t}} \right) - {X_r}\left( {{t}} \right) ,$ | (15) |
| $ X_{\mathrm{new}i}\left({t}+1\right)=X_r\left({t}\right)+A_2.D_2 。$ | (16) |
式中:
| $ {A_2} = 2{{{l}}_2}{r_1} - {{{l}}_2}。$ | (17) |
淘金行为有时是团队行为,式(18)、式(19)表示淘金者团队行为。
| $ {D_3} = {X_{g2}}\left( {{t}} \right) - {X_{g1}}\left( {{t}} \right),$ | (18) |
| $ X_{\mathrm{new}i}\left({t + 1}\right)=X_i\left({t}\right)+r_1\cdot D_3。$ | (19) |
式中:
在算法执行过程中,如果新位置黄金量更多,则搬迁到新位置进行淘金,循环往复直到算法结束,搬迁行为定义为式(20),通过对比适应度函数值选择是否搬迁到新金矿位置。
| $ X_i\left({t+1}\right) = X_{\mathrm{new}i}\left({t+1}\right),{f}\left(X_{\mathrm{new}i}\left({t + 1}\right)\right) < {f}\left(X_i\left({t}\right)\right)。$ | (20) |
GRO算法的基本流程如图6所示。
|
图 6 GRO算法基本流程图 Fig. 6 GRO algorithm basic flowchart |
开发能力和探索能力是智能算法的两大特征,已有学者结合智能算法对ADRC参数进行优化,本文选择灰狼优化算法、粒子群算法进行对比。选择CEC2005测试集中单峰测试函数和多峰测试函数各一种进行对比,验证GRO算法的开发与探索性能,测试函数如下:
| $ \left\{ {\begin{aligned} &{{f_1} = \displaystyle\sum\limits_{i = 1}^n {{x_i}^2} },\\ &{{f_{11}} = \displaystyle\frac{1}{{4000}}\displaystyle\sum\limits_{i = 1}^n {{x_i}^2} - \prod\limits_{i = 1}^n {\cos \left( {\displaystyle\frac{{{x_i}}}{{\sqrt i }}} \right)} + 1}。\end{aligned}} \right. $ | (21) |
式中:
|
图 7
|
|
图 8
|
以深度控制回路为例对自抗扰控制器参数进行优化。
选择ITAE[14]作为适应度函数,其定义式为:
| $ f = \int_0^\infty {t\left| {e\left( t \right)} \right|{\rm{d}}t}。$ | (22) |
式中:
参数
|
图 9 GRO优化ADRC流程 Fig. 9 GRO optimizes the ADRC process |
ADRC控制器中参数经验值如表2所示。
|
|
表 2 ADRC参数表 Tab.2 ADRC parameter |
淘金优化器中初始化淘金者数量为10,最大迭代次数100,仿真运行10次,取其中适应度值最小的一次作为优化结果,适应度值如图10所示,参数实时优化过程如图11所示。
|
图 10 适应度值 Fig. 10 Fitness value |
|
图 11 参数优化 Fig. 11 Optimization |
ROV清洗风电桩属于近水面作业,主要受海流和波浪影响,考虑到清洗风电桩实际工况:小流、低速、低浪。忽略海流影响,主要考虑波浪力影响,采取ITTC单参数谱对波浪进行描述,波面方程[15]为:
| $ {\eta _w} = {\alpha _w}\cos \left( {{\omega _w}t - {k_x}x - {k_y}y} \right)。$ | (23) |
式中:
深度和艏向角上速度为:
| $ v_{\mathrm{wav}z}=\sum\limits_N^{ }w_{wj},$ | (24) |
| $ v_{\mathrm{wav}y}=\left[\sum\limits_N^{ }u_{wj}\right]\sin\left(\psi_w\right)。$ | (25) |
式中:
将GRO优化后的参数带入深度与艏向角控制器进行仿真,与PID控制、未经参数优化的ADRC控制进行对比,深度和艏向角仿真参数情况如表3所示。
|
|
表 3 优化前后参数 Tab.3 Parameters before and after optimization |
期望深度2 m,期望角度20°,在60 s时加入扰动,响应曲线如图12和图13所示,数据对比结果如表4所示。
|
图 12 深度仿真 Fig. 12 Depth simulation |
|
图 13 艏向角仿真 Fig. 13 Yaw simulation |
|
|
表 4 不同控制策略结果 Tab.4 Results of different control strategies |
分析可知,在深度与艏向角回路中,PID控制存在明显不足,动态响应过程中出现较大超调,且调节时间长;经过参数优化后的ADRC在超调量、响应速度方面均有所提高,在施加波浪扰动后,深度回路稳态误差仅0.01 m,通过对比发现在深度通道GRO-ADRC控制策略稳态误差较PID、ADRC策略分别减小92%、83%。艏向角回路几乎无稳态误差,优化后的ADRC策略稳态误差比PID、ADRC均减小90%以上,展现出较强的鲁棒性。故自抗扰控制策略更适合风电桩清洗ROV控制,且参数优化后的ADRC综合控制性能有所提高。
6 清洗试验在某风电场进行风电桩清洗试验,当日风电场海域为二级海况,桩机附近流速1 kn左右。风电桩周围的水域环境复杂,水流方向多变,且受到潮流、波浪和水流速变化的综合影响,导致ROV在作业过程中受到显著的外部扰动。在此环境下验证支架式辅助控制方法的可行性。在ROV清洗过程中采集深度与艏向角数据,分析ADRC控制效果,数据采样时间0.5 s。
由图14可知,清洗过程中,深度基本可保持在1.1 m,上下浮动最大误差不超过0.1 m,虽然频率较高,但是幅度不大。由图15可知,角度保持在260°左右,偏转角度误差在8°以内。虽然深度与艏向角回路存在较小误差,但是针对海上风电桩清洗这一工况,符合清洗要求。由空化射流清洗结果可知ROV位置控制稳定,空化射流枪可进行有序清洗,且效果较好,证明所提清洗控制方法的有效性。
|
图 14 深度跟踪曲线 Fig. 14 Depth tracking curve |
|
图 15 艏向角跟踪曲线 Fig. 15 Yaw tracking curve |
1) 通过支架与风电桩基形成刚性接触,将风电桩清洗ROV 六度控制转换为深度与艏向角控制,大大降低控制难度。
2) 联合GRO对ADRC部分参数进行优化,仿真证明参数优化后的自抗扰控制相较于PID、ADRC控制在深度通道稳态分别降低92%、83%;在艏向角通道稳态误差均降低90%以上。降低参数整定难度,大幅度提高控制效果。
3) 海上清洗试验表明所提控制方法在深度和艏向角回路控制误差保持在0.1 m和8°以内,验证了支架式辅助清洗控制策略的可行性,为海上风电桩基、导管架平台及桩基式采油平台清洗提供了参考。
| [1] |
林玉鑫, 张京业. 海上风电的发展现状与前景展望[J]. 分布式能源, 2023, 8(2): 1-10. |
| [2] |
熊保星, 甘文洋, 陈铭治, 等. 基于模糊线性自抗扰的水下机器人定深控制[J/OL]. 控制工程, 2025, 1−9.
|
| [3] |
梁一飞, 李永龙, 王皓冉, 等. 基于降阶扩张状态观测器的水下机器人自抗扰运动控制[J]. 传感器与微系统, 2024, 43(8): 141-144+149. |
| [4] |
宋大雷, 严志鹏, 郭亭亭, 等. 模型补偿的水下桥墩检测机器人抗扰控制研究[J]. 现代电子技术, 2022, 45(5): 129-133. |
| [5] |
郑伦川, 梁新元, 袁乖宁. 机械臂自抗扰控制的自适应-重构粒子群优化[J]. 机械设计与制造, 2025(2): 231-235. |
| [6] |
单正, 王元龙, 白若忱, 等. 基于灰狼优化算法的燃气轮机自抗扰控制参数整定研究[J]. 热能动力工程, 2023, 38(4): 1−6.
|
| [7] |
陈建均. 深远海复杂海况下钢管桩清淤工艺的应用研究[J]. 南方能源建设, 2025, 12(1): 109−115.
|
| [8] |
蔡洪建, 许玮, 李振杰, 等. 一种支座式辅助冲洗装置及其方法[P]. 中国专利: CN107971267B, 2020-06-09.
|
| [9] |
周卫祥. 深海作业型ROV建模方法的研究[D]. 哈尔滨: 哈尔滨工程大学, 2015.
|
| [10] |
FOSSEN T I. Handbook of marine craft hydrodynamics and motion control[M]. John Wiley & Sons Ltd, 2021.
|
| [11] |
季葛盛. 开架式水下机器人水动力及其悬停控制仿真研究[D]. 镇江: 江苏科技大学, 2023.
|
| [12] |
王翻, 武建国, 王晓鸣, 等. 改进型自抗扰在ROV位姿控制中的应用[J]. 舰船科学技术, 2024, 46(18): 91−98. WANG F, WU J G, WANG X M, et al. Application of improved active disturbance rejection in ROV pose control[J]. Ship Science and Technology. 2021, 46(18): 91−98. |
| [13] |
ZOLFI K. Gold rush optimizer: A new population-based metaheuristic algorithm[J]. Operations Research and Decisions 2023, 33(1): 113−150.
|
| [14] |
张彦. 基于多目标遗传算法和多属性决策的船舶PID控制器参数整定[J]. 舰船科学技术, 2009, 31(3): 42−45. ZHANG Y. Multi-objective optimization and multi-attribute decision making for PID controller parameters tuning in ship design[J]. Ship Science and Technology, 2009, 31(3): 42−45. |
| [15] |
姚绪梁, 孟令卫, 牛小丽. 基于航行阻力优化的近水面机器人减纵摇控制[J]. 中国舰船研究, 2017, 12(3): 111-119. YAO X L, MENG L W, NIU X L. LQR pitch control strategy of AUVs based on the optimum of sailing resistance[J]. Chinese Journal of Ship Research, 2017, 12(3): 111-119. DOI:10.3969/j.issn.1673-3185.2017.03.016 |
2025, Vol. 47
