3 e' M$ B1 R; X) B, I( z. z
* H @) Q! P$ n4 x' z2 F! \
本文刊载于《集成技术》2021年第2期“海洋工程技术专题”, q2 g- d4 y- K# P1 X
' P5 u: h+ ?# a" O. w2 Z7 r) k8 u9 @0 `; I$ k2 [4 y( w
, C+ C& h7 b1 h- v0 u% h6 @杨文林1，周小琦1,2*，吕浩亮1*，张 弓1，侯至丞1，王卫军10 {; ^: ^7 i/ G" |9 C: u- ?
1 广州中国科学院先进技术研究所 广州1 D0 Q: P8 L. |! |5 v L+ |
2 陕西科技大学机电工程学院 西安3 Z! V! ?( u/ s( M
) l3 l. w6 ~, }, Q# u7 S
8 f: Z6 C0 N H摘要
, m; v) r4 Q* w' PAbstract
! w9 ~- n3 }% j' v# T针对海工装备上人员与物资安全转运的工程需求，该文对六自由度主动波浪补偿系统中的关键技术展开研究，设计了一个完整的主动波浪补偿系统，包括运动测量系统、控制系统和执行机构。运动测量系统采用 MTi 惯性传感器，结合自适应高通滤波器进行船舶运动检测，同时采用双目视觉系统检 测补偿平台末端运动，并基于卷积神经网络实现两类传感器数据的融合。控制系统采用基于神经网络进行参数整定的自抗扰控制器，可以实现良好的快速响应特性、控制误差补偿和抗干扰特性。执行机构采用基于液压驱动的 Stewart 平台。通过 MATLAB/Simulink 和 AMESim 平台建立了机、电、液联合仿真模型，并对所设计平台的先进性和可行性进行了仿真验证。
1 v: n! }' K! `" @
( y% H: b* R8 y" n: G& E1 `! |: v! B, G& {' b* Q
1 引 言
3 i# x0 D1 }3 v: @- X- k- \6 I/ d; `% ]9 E: }2 C
/ K/ u. z/ }8 I/ f- }21世纪以来，各种类型的海上构造物日渐增多，且其需要极频繁的维护。运维船在海浪、海风的作用下会产生横荡、纵荡、升沉、横摇、纵摇和艏摇的六自由度运动，给海上人员转运和物资补给带来极大的影响，甚至威胁到海上作业人员的生命安全。因此，研究六自由度主动波浪补偿栈桥具有非常重要的现实意义和理论价值。 J4 N9 ?/ S; y- P) Y- w8 Q b; c
7 k+ f# Y, _7 w, [$ l' ]2 N& s. q( r* I' P
苏长青等提出一种用于登乘栈桥的主动波浪补偿方法，设计出一种由趋向 3 个不同方向伸缩的液压缸进行三自由度补偿的结构，并对其补偿模型和控制系统进行了分析设计，最后通过人工造浪的方式验证了系统的指标，但其所采用的分离式栈桥结构适应性不强；李春林等阐述了六自由度主动波浪补偿平台系统的工作原理，利用 AMESim 建模仿真，并且还搭建了样机试验系统，证明 Stewart 平台用作补偿的可行性，但尚未研究 6 个液压缸之间的耦合作用的影响，仅进行了单通道控制系统的研究；胡勇攀等提出了基于牵引绳并联机构的六自由度补偿系统结构，并对奇异位形规避设计了新的算法，针对并联补偿系统中参数不确定及存在未知干扰的问题，提出了带有边界层的滑模控制方法和负载惯性参数辨识方法，最后采用 Matlab 和 Adams 进行联合仿真；Liang 等对一种串联运动补偿系统建立运动学和动力学模型，然后导出了系统的雅可比矩阵和系统运动的动力学方程，并设计了基于逆动力学的控制器，将 ITTC(国际拖曳水池会议) 双参数谱作为波浪扰动在 Matlab/Simulink 中建立仿真模型并进行仿真。总体来看，学者们对控制、结构、仿真等领域进行了一定的研究，但尚未出现以船舶的运动测量作为起点对主动波浪补偿进行整体性循环控制的研究。& ~9 `! h! Q3 P7 S( @' }# j4 d
8 f& g8 C) g4 \' I/ R3 ?% }) a0 Q# }
! c9 L, a9 m i( ^3 n. N本文在总结国内外研究现状和技术发展趋势的基础上，开展对主动波浪补偿装置的关键技术——“测量方案”和“控制策略”进行分析研究。具体地，以船舶的运动测量作为主动波浪补偿的基础、以 Stewart 平台作为补偿执行机构，设计一种主动波浪补偿系统，提出基于惯性测量模块的船舶运动姿态与基于视觉技术的 Stewart 平台末端姿态信息融合的运动测量方案，以及基于神经网络自抗扰控制器的六自由度主动波浪补偿控制算法，最后建立六自由度主动波浪补偿装置机、电、液系统联合仿真的模型，为装置的性能分析验证与设计优化提供有效方法。
% [' k& |+ L' u! N( t. c# ]. |% l+ [* K1 `% Z. W
/ q* h8 R, J" R3 U5 N. N
2 主动波浪补偿整体系统0 K3 S2 k0 n. m( [1 ^. U; J
7 {0 y9 b/ \; ?% E8 t4 O: L% U& j, ^3 m4 S/ B, Q" X9 j" ]
主动波浪补偿一般由运动测量系统、控制系统、执行机构等部分组成。如图 1 所示，六自由度波浪补偿装置基于 Stewart 平台，检测系统将两种传感器测得的运动信号经过多源融合算法处理输入到控制系统，在该系统完成数据的处理分析后，经过位姿反解得出 Stewart 平台 6 个液压缸伸长量的期望值，此时控制执行机构产生与船舶运动大小相等、方向相反的六自由度运动，实现波浪补偿。最终，将各个液压缸的实际位置与期望值构成的运动控制偏差输入自抗扰控制器，构成完整的控制回路。Stewart 平台液压系统的电液伺服阀控制液压缸的进油方向与流量，进而驱动液压缸平滑、稳定地伸缩。
# U, V) {2 E& V ^) t6 x
5 {+ u5 Z2 U+ a
1 J7 H2 V- S, Y3 测量系统
9 q% Y$ Q" n) E; G5 T( x7 y, X
5 M8 N& }+ y/ {; X1 P
6 O+ Y9 e6 }# }# K1 t3.1# h" E- b7 i! c- c
海工装备运动姿态测量系统% w8 R2 H; C3 U B/ M. R
为保证补偿后船舶的海工装备和其上的补偿平台可以保持相对静止或运动幅度大大降低，首先需要掌握海工装备母船实时准确的运动信息，作为主动补偿栈桥运动控制的输入。目前比较常用的船舶运动检测方法有卫星定位系统、惯性测量模块以及基于激光或机器视觉的相对运动测量方法等。由于微惯性传感器集成了加速度测量、倾斜测量、转动测量和振动测量，且安装方便、实时性强，本文设计选择使用微惯性传感器测量船舶运动。0 V3 t! d0 |2 g) y, j
! T. X/ _# v9 z1 `# {; I9 L
* U3 o$ H/ f8 H) {3.1.1 微惯性模型
! n. ]9 n1 n; |% d基于微电子机械系统(MEMS)的微惯性传感器，包括微加速度器、微陀螺仪，可以测量 6 个自由度的运动，包括微加速度器测得的三维加速度和微陀螺仪获取的物体姿态和转动角速度。微加速度器将测得的加速度数据经过对时间一次积分可得到母船的速度、二次积分可得到母船的位移，最终得到位置的增量变化。1 y% }1 c' `% }
% u8 r/ X l( X7 Z' ~) X; ]/ C
8 P$ D" d M9 S% ^' P c
MTi 是荷兰 Xsens 开发生产的一款可以精准测量姿态和航向以及惯性运动参数的产品，具有体积小、集成度高、输出稳定、抗干扰性强等优点。赵健冬对 MTi 的工作原理及底层驱动进行了理论研究。; h H# X w. M/ l
6 B+ Q' v- ^% j0 S4 B$ P3 b; R9 S8 q5 n' }+ I
3.1.2 滤波器的选择
; V; Y9 C+ q/ ~% Q K8 I' V4 xMTi 中的陀螺仪作为一种敏感元件，特别容易受到无用干扰源的影响，且成为加速度数据中的余项，积分后导致误差越积越大，即陀螺仪时飘现象，故运算中需要将这些干扰源去掉。其原理是：由于积分过程实际是一个低通滤波器，所以积分后的信号中出现了较多的低频信号噪声。积分后的信号可以用一个高通滤波器进行滤波，以削弱数值积分在信号中产生的低频噪声。李婧采用现代滤波器-扩展卡尔曼滤波器(EKF) 对测量的船舶升沉位移进行滤波处理，减少了测量误差。但使用卡尔曼滤波器(KF)需要获得船舶升沉运动的频率特性，然后根据其选择相应的滤波器参数，这种方法降低了不同条件下的适应性。卢道华等采用无迹卡尔曼滤波器(UKF)，对比 EKF 通过一阶泰勒展开使其线性化，并在一定范围内收敛，UKF 可以直接进行非线性函数状态及其方差的传播。该实验结果表明，与 EKF 相比，UKF 确实获得了更快的收敛速度和测量精度。另外，传统数字滤波器分为有限冲激响应滤波器(FIR)和无限冲激响应滤波器(IIR)两种，工业上多使用 IIR 滤波器，但需要解决其相位超前问题。袁书明等提出一种基于加权傅立叶线性组合算法(WFLC)的自适应频率估计算法来延时校正相位超前量；陈琦等提出一种自适应巴特沃斯滤波器，采用互为滤波的方法降低延时，截止频率可以根据升沉运动的频率特性优化调整，实验表明数据精度满足补偿要求。本文在分析多种滤波方法的基础上，为尽可能地保证信号在通带内没有纹波，选择巴特沃斯滤波器，以实现减少测量的积分误差以及自身的幅值、相位误差。& M+ m B0 g, R7 G; a
' y# B9 n4 Y7 {& \) f+ ~
! t" [( o. c3 V( V* V0 v9 ^4 A
3.2; Y ^9 A- q- I0 e2 W/ a) Z
补偿平台末端姿态测量与基于多元融合算法的测量系统
9 {. \' ^* e+ C+ y% J3.2.1 机器视觉术用于平台末端姿态检测; C' J/ S) d( A: l P
机器视觉具有成本低、安装调试方便、精度高且非接触测量的优势。大连理工大学的李木国等研究了基于机器视觉的舰船姿态检测方法，并进行了水池船模实验。崔伟研究了基于双目视觉的补偿系统检测中的摄像机标定与立体校正方法、图像特征提取、立体匹配与特征跟踪方法、以及位姿解算，实验结果显示位置和姿态精度较高，表明了视觉技术用于主动波浪补偿的可行性。
4 v1 V0 K- o& y* a2 U [5 A1 W, @* K. n+ P9 k; t2 l& c" V
& y2 `& F( V6 j: O" @
本文采用双目视觉测量波浪补偿平台末端的姿态，通过检测目标图像上的特征点，获得特征点在世界坐标系中的空间坐标，进而解算目标的空间位姿。多个特征点即可立体匹配获得三维图像，因此跟踪特征点可得到多个三维图像，从而获得补偿平台末端的姿态变化。相应技术流程如图 2 所示，具体步骤如下。 N4 d& v$ f4 w- X# Y
(1)完成图像采集后，系统先对摄像机进行标定和双目图像的立体校正，求解出相机模型的参数，包括内部参数(单位长度的像素个数fx、fy，主点坐标（cx，cy）等）与外部参数(表征左右两相机间关系的旋转矩阵 R 和平移向量 t) 并对左右两幅图像进行处理使它们共面且对称。
+ N: _6 Y- A, `; M! b5 |1 I2 s4 j
, F9 V8 m1 g9 E+ N& c5 \! J B
* U: N5 O( Y1 `7 E! b3 v(2)在 MATLAB 中导入所采集的图像并提取特征点，其中提取方法通常可分为边缘点提取、角点提取和各种兴趣算子。角点包含丰富的局部特征和形状信息，因此综合考虑选取特征点数量、定位准确性、提取速度以及抗噪性四方面，选择角点作为目标特征。较有代表性的角点提取算法有 Harris 算法和 SUSAN 算法。本文采用 SUSAN 算法提取角点，针对该算法运算速度慢的问题，采用简单的方法先对角点作初选。
8 ]8 p* k) F$ A2 a* t2 O8 E% O( K# Y
4 z: J8 @$ ~& b* u
(3)利用特征进行局部立体匹配和跟踪，由区域匹配算法求得两个图像平面的视差，可通过 OpenCV 获得稀疏视差图，后经插值算法获得稠密视差图。随后，通过提取图像上的目标特征点和图像坐标矩阵，并根据所建立的定位相机模型，解算出目标在世界坐标系中的位姿。 p! v! H3 t4 N; b3 w( T
5 W; \- ]# ?0 \7 h5 K
6 l% g7 O# Z' c3 D
(4)在实现运动目标相对位姿求解的基础上，检测平台末端的运动信息，并反馈给控制系统。基于视觉的检测技术测量精度高，但需要处理图像多，解算过程复杂，数据更新慢，需要通过融合惯性测量模块获得姿态数据，进而使测量结果具有较高的精度和较快的速度。
: f7 f7 _4 k0 q* o5 X$ m4 _9 j2 t: v2 [& E2 p9 ]& [( s3 l$ H
& `& s# B7 Z4 e% @8 q# b+ C
3.2.2 借助卷积神经网络构建扩展卡尔曼滤波观测模型的多传感器信息融合
7 G5 R9 V4 F# V! F( o对于多传感器融合的方法有：贝叶斯估计、模糊理论、D-S 证据推理、卡尔曼滤波理论、神经网络理论。静如雪等通过自适应加权算法融合多传感器的数据，不需知道任何先验概率，首先检验数据的一致性、剔除异常数据，随后使用支持度最高的数据替换被剔除的数据，加权法计算改进后的数据，结果表明自适应加权算法具有较好的精度，但当数据庞大，或传感器的测量不是针对同一属性时，无法很好地使用。Foxlin 等采用卡尔曼滤波算法融合惯性传感器与光学传感器的位姿测量结果，但若未知系统噪声和观测噪声的特性，很难获得较好的融合 结果。孙长库等针对两种噪声有界的情况， 采用 H∞滤波器融合分别经欧拉角迭代公式和POSIT 算法解算的惯性传感器(IMU)和单目相机的目标姿态，并通过融合结果与惯性测量的差值修正时漂误差。代欣设计了一种结合误差反向传播(Back Propagation，BP)神经网络和深度自编导网络的算法，先由自编码预训练将结果输入 BP 神经网络，并通过 MATLAB 和 Python 训练。本文将 IMU 与双目视觉进行数据融合的过程如下。
3 e" ^/ O& |6 c8 l+ Q4 ^& U7 O! f f* ?/ X5 y# F
% D, L) ~. L/ s b
(1)首先要解决的问题是坐标统一。由 IMU 分别采集 3 个轴的角速度和加速度，建立捷联惯性测量系统，从角速度出发，姿态解算出姿态矩阵cbn，实现将 IMU 在载体坐标系中测出的位置 P、速度 v 和姿态 Q(航向角 ψ、俯仰角 θ、滚转角 γ)转换到世界坐标系。姿态解算的方法有：欧拉角法、方向余弦法和四元素法。类似地，双目视觉测量原理表明，可获得特征点的空间三维坐标和姿态。
( m3 S& K) k) V; W3 |( K; c$ p- \
! [/ a! r0 X$ Q% X+ |
& [: J a2 L3 F" I. }* d! R5 ~" ](2)两传感器测得的均为船舶的位置、姿态信息，故可实现同一维度(坐标对坐标)的数据融合。扩展卡尔曼滤波融合算法原理是：以惯性测量单元的测量值作为预测值、双目视觉测量值作为观测值，由预测值与观测值作误差处理；经过初始化状态方程及量程方程、预测变化和反馈更新 3 个步骤，循环修正直到系统内参数最优估计值。
6 s3 `8 g8 ~& R/ i1 L7 V1 _
) k, u* B# o/ e0 A9 Q" S8 [" z5 v# g6 U5 r1 X
其中，状态向量为 X=[P,v,θ,ba,bw,R,t]T，ba 和 bw 分别为加速度计和陀螺仪的偏置。. ~. L; J5 V$ T& ?/ J5 [
& E- c8 `. X; o% Y; I/ @9 ~& a6 n
: ` \1 ]( i) B" i/ \
(3)卷积神经网络也可被用于姿态估计：在融合系统没有函数模型的情况下，其通过测试数据的大量训练得到网络结构和映射关系，帮助构建卡尔曼滤波观测模型中特征点的匹配，具有良好的自适应性，输入完整的图片，将姿态以坐标的形式输出。BP 神经网络中，每一层都是全连接的，需要训练的权重多。而卷积神经网络的卷积层每个节点与上一层某个区域通过卷积核连接，而与该区域以外的区域无连接，这使训练相对容易很多。) ^3 ], t8 h6 F
3 D$ V5 @; w$ |% v0 h- C4 B4 V! q- n, t3 K& R: {9 g% r
针对主动波浪补偿装置在波浪作用下快速运动导致相邻图像间特征点跟踪失效问题，可采用惯性引导视觉采样一致性分析的思路。在栈桥末端执行器前向运动学模型和惯性姿态估计模型的基础上，预先判断当前姿态是一般性运动(旋转 ＋平移)或退化性运动。针对一般性运动，采用单应性矩阵模型来描述图像间的特征光流运动；针对退化性运动，采用本质矩阵模型来描述图像间的特征光流。) N& D# f7 g5 `, \
如图 3 所示，待估计的特征点光流预测模型：
) t6 |; F/ x& [$ ~6 f; ?8 u# S. u) Z4 |
其中，pk＋1 和 pk分别为相邻图像间特征点的像素坐标；Δtk+1和 Δtk 分别为前后相邻图像的时间差；wk＋1为权重；Bk 为相机旋转的旋转矩阵。
) ~5 L5 b ]" V6 k2 `, p1 f5 _4 Q5 G$ v0 D: u( ^/ v. T
- \( x5 Z% d. { t a( F3 }
/ G4 H. M; _! E* D
此外，为了提高光流跟踪的运算速度，采用深度神经网络模型的光流跟踪机制。网络模型由级联的卷积神经网络组成，网络的输入端是相邻帧图像的特征点集合。在训练阶段，将外极线几何约束和匹配点对共同送入到网络输入端，第一级卷积网络的输出是图像间的匹配点集合和对应的空间关联关系；在此基础上，将匹配点对送入到第二级卷积神经网络，二级网络输出一组组匹配点集合。4 c4 A; U. F$ D5 R. Q2 }
Z" z4 T* n$ c3 L: }9 r/ w% }+ w) c
1 K0 D- E0 ^- v1 \& E针对运动估计的长期漂移问题，本文采用运动学链式约束模型，将多源信息融合得到的姿态信息引入到栈桥链式几何模型中，通过最小二乘法抑制末端执行器的姿态漂移问题，待优化的目标函数为：
1 m G4 q" ~- l5 y* a其中，i 为关节点的序号；pti,eq为在 t 时刻由运动 力学链式模型得到的第 i 个关节点的位置；pti,vi为在 t 时刻由视觉惯性融合方法得到的第 i 个关节点的位置；pti为待估计的第 i 个关节点的位置；λi,eq 和 λi,vi分别为pti,eq和pti,vi相关的权重系数。% R7 Z1 B9 `/ A+ w% |
# u1 \$ f- L: w* w% s# w K7 O9 {/ ?' t, f
本模型中引入了正则项
4 c' d% R2 i7 ~平滑因子，目的是使捕捉的动作更为连贯，以此来抑制随机性噪声干扰对位置估计的影响。
2 f% w' x% k1 b8 G( G$ e6 A
" M, z& Y/ L. I. \+ @0 @6 b& ^+ s9 m+ u0 g7 O3 h
4 主动波浪补偿栈桥系统5 M. }7 R/ h) b6 ?, r* e; d- G
4 N7 Q5 |7 W) Q& x |0 c* S" C! F: z$ a
4.1
1 A- l( G9 M D4 a( g9 b液压系统与执行机构
, W/ R2 W1 H) c8 p4 x; x8 ]栈桥的动力部分基于 Stewart 平台(见图 4)，在 Stewart 平台的上平台连接舷梯以及舷梯回转、俯仰、伸缩等执行机构；Stewart 平台的下平台固定于海工船舶的甲板上。为节省空间，Stewart 平台液压驱动部分的蓄能器组安放在下平台中央位置。' e/ F* L! S6 d5 U" ~8 \
电液伺服驱动的 Stewart 平台具有精度高、结构紧凑、空间占用少、承载能力强等优点，同时也需要选择合适的控制策略解决液压驱动的主动波浪补偿栈桥存在的负载惯量大、大延时、非对称、参数时变以及强耦合等问题。0 U n# m1 v$ o" L" [
Y# ~: `: T9 t; u
: x% n' d4 c1 H* U, W9 a5 _& z; K: @
4.2
- x. @, ~' u; H/ p基于神经网络的自抗扰控制系统# y3 M& \, p+ L/ P4 h" O$ M# \
传统的比例-积分-微分(Proportion Integration
( p/ h: q5 W3 m; A/ f7 Y6 W% `6 V1 `4 Q! m
Differentiation，PID)控制器结构简单，参数调节 比较容易，在工业控制中具有广泛应用。但当其面对系统对象参数变化较大或非线性效应较明显时，很难保持较好的控制效果，并且其线性组合的方式常常会引起系统快速性和超调量之间的矛盾。唐建林研究了关节空间和任务空间基于 Stewart 平台的自适应控制策略，有效提高动态响应和平稳性，但实时性不强；王荣林等采用基于神经网络(Neural Network，NN)的自抗扰(ADRC)控制电液伺服系统，在 MATLAB 中对比 PID 控制和 NN-ADRC 控制，加入阶跃扰动显示 NNADRC 控制对外界负载扰动具有更好的鲁棒性， NN-ADRC 控制跟踪正弦响应曲线结果误差更好， 具有更好的控制效果，表明了该设计的可行性。; u$ F5 y- m( H( L+ ~4 B
# N2 C* K/ d. q* y2 }- C L R# F7 M. ], s0 m5 Q
4.2.1 自抗扰控制器
" m6 R, A$ k2 R( C P) R自抗扰控制技术是一种由 PID 控制改进而来的非线性数字控制技术，主要由跟踪微分器 (Trace Differentiator，TD)、扩张状态观测器 (Extended State Observer，ESO)和非线性状态误差反馈器(NLSEF)三部分组成。自抗扰控制可以将不同因素引起的扰动归类为系统的总扰动，然后用扩张状态观测器进行估计、补偿，将复杂问题简单化，使其转化为线性系统的标准型。
/ F9 G% f$ D3 _
& F0 t! s) n+ y B0 X7 [9 C, a( ]- w1 e1 K+ B
与 PID 控制器相比，自抗扰控制器不依赖于被控对象的精确数学模型，具有更好的适应性和鲁棒性，适用于非线性系统 Stewart 平台，但在应用过程中首先要解决其可调参数多、参数整定比较困难的障碍。( B# p/ ?2 g! w! d( H
7 d, J6 P: H1 V
/ O1 i, x8 K$ q3 e/ Q" A1 F+ X2 J
以图 5 中二阶自抗扰控制为例，关于二阶 ESO 的分析已有较完整的结果。图中，TD、ESO、NLSEF 的模型在 Simulink 子系统中建立。" S+ I# J! J+ f6 D$ a$ o
(1)TD 的输出 v1(t) 跟踪输入 v(t)、v2(t) 跟踪 v(t) 的微分，用来协调超调性与响应速度的矛盾，TD 的离散表达式为公式(3)：/ P/ Y; ^, [+ b1 s' w! H) ~
& \+ n8 J' l5 l. t/ A. u: `# ^, D
其中，需要整定的参数包括速度因子 r、积分步长 h 和滤波因子 h0 。r与过渡时间相关，r 越大过渡时间越短，为抑制超调，一般取 r＜1；滤波因子 h0 较小时会产生震荡，设定 h ≤ h0态震颤。fst函数由 Simulink 中 MATLAB Function模块编写。; E9 Y9 [0 Z& N
Q3 d5 f, @; L/ I
) ~) Z7 E: @7 N7 n
. d2 V$ D( q3 u(2) ESO 的输出 z1(t)跟踪输出变量 y(t)、z2(t)跟踪 y(t)的微分，z3(t)为系统未知扰动和外部未知扰动总和的估计值，其中估计值将被控对象补偿为“积分串联型”。ESO 的离散表达式见公式(4～5)：' G# R$ k- U8 q- ^8 d
其中，β01 、β02 、β03被称为系统误差校正增益，是 ESO 的观测器系数，整定原则是保证 ESO 稳定，选择合适的参数，可以很好地对扰动进行估 计。根据经验，一般 β01＝1/h、β02 ＝β01 /h、β03 ＝β02/h。fal函数由 Simulink 中 MATLAB Function模块编写。8 p( u3 Y! ?" q. \1 c) [
9 H0 l" H% u* |' d# S( b; l1 E) e
. s h, i% |, b(3)NLSEF 的作用是生成一个控制量，相当于用 PID 控制器来控制被化为“积分串联型”的对象。NLSEF 的输入是 ESO 的状态估计值与 TD 输出之间的误差，如公式(6)所示，NLSEF 的离散表达式见公式(7)：
9 ]# B8 l) y! Y/ A+ v" ^4 V其中，u0为控制量；u(k)为自抗扰控制器的总输 出。NLSEF 的参数中，β1为比例系数，β2为微分增益，类似于 PID 控制，当调节速度慢时可适当增大 β1，但调节速度加快的同时也会引起超调量的增大和系统震荡；b0既与控制量 u 有关，又与 ESO 的 3 个状态变量相联系，不同的b0会使总扰动值在不同的范围内变化。b0的选取原则是：当对象有迟延时取大值，使得 b0u 的值较大；从 z3/b0 可以看出，b0取较大值的另一个好处可以有效补偿扰动和模型的不确定因素。7 T8 b7 R: U# M- B, T- v
1 S% F6 R/ l$ w$ p
# P- R2 t9 b" s: s5 D0 L6 Z \$ p 4.2.2 基于神经网络进行 NLSEF 参数整定
$ s5 x, S: N+ ~* `3 K二阶自抗扰控制器所有参数中，a1 和 a2 是指数的幂，δ 和 δ0 是 fal(.)的参数，此 4 个参数被称为非线性参数，通常一经设定就不再改动；大部分参数{r, h, β01, β02, β03}可以在控制器启动时在线调节或直接根据经验设为固定值，而经常需要调试的参数只有 NLSEF 的{β1, β2 ,b0}。
5 ]) m% q7 o k- H0 L" p; B
" F1 z$ I2 T* R1 p9 k
p! Q9 n. u9 R# f+ m7 |利用一定结构的人工神经网络(Artificial Neural Network，ANN)能任意逼近非线性函数的性质，将神经网络嵌入到 ADRC 对 NLSEF 中的 {β1, β2 , b0}进行参数整定，采用辨识出的 ANN 来补偿对象的一部分，即近似地认为是原对象的变化范围变小，从而让 ADRC 的控制品质变高，并利用仿真反复试选。
o0 U6 s0 z! E( _. ~7 W) e6 A6 [' J
1 J3 @7 H0 F7 W5 V& _: Y
6 t( R! d; F" N* I3 Y对应的操作流程如下：
4 \) x6 o& o( x(1)先整定 TD 和 ESO 的参数，使得能基本控制所述系统。 5 Q- G# `& R1 x3 Q
(2)在控制好的系统里，从 ESO 中取出 z1、z2 、z3 的数据，并将其保存下来。
; L6 t# v8 H. ~3 ?6 G+ F: O+ |" N+ Z(3) 在保存的数据中，将 z1、z2 络训练的输入、z3 作为期望输出，并给出一定结构的网络结构和训练的终止条件，利用径向基 (RBF)神经网络算法进行参数自学习训练。
$ l+ {2 b1 V* e& s* F. Y* e4 R. p* w' I; B0 g% @
3 r J- f3 l, d2 k* t1 ~: b8 VNNC 为单神经元自适应控制器，β1 和 β2 作为 NNC 的加权系数，可通过单神经元的自学习功能进行在线调节。采用梯度下降法，该方法与神经元的输入、输出和系统的偏差有关。NNC 的输入为x1=fal[e1(k), a3, δ0] 和 x2=fal[e2(k), a4, δ0]，则单神经元自适应控制器输出为：
, }/ A8 l( D7 m, t( b/ _令单神经元的学习指标为：4 I/ m7 U$ V9 z( K' S( I* h7 T: c: }
6 s: F' r% I, \% E采用梯度下降法可得 β1 和 β2如下：
0 Q T' V$ J. t# s1 c
, R# C4 \/ B4 }1 J" g! O: y(4)将得到训练的非线性函数 fNN 放在图 6 所示位置，来观测控制的效果。RBFNN 作为辨识器，实现被控对象 Jacobian 信息辨识。
' c$ [1 [* R1 T0 h) ?# s) }' b5 `1 M; H5 x
令 RBFNN 的输入r1(k)=θ(k)，r2(k)=u(k)，则 RBFNN 的学习指标函数为：
- j2 w* U2 a) j( S
/ [8 E! e* d* U1 {与单纯的自抗扰控制结构相比，神经网络与自抗扰控制器结合的控制结构具有更好的控制效果。其中，自抗扰控制器及其参数整定的具体方法详见王荣林和石晨曦的研究。% r4 g0 n5 Z9 Z8 L0 @7 U
- B u+ j0 t6 G" w- g( u5 u! k$ V5 K m5 g/ n' ~8 {
5 联合仿真
6 ~7 a( u# [8 Z7 J1 e! p% i
* k6 Z. W; I+ N) J$ J- g, `! m
- \' m, \2 |0 B/ ?* a6 t将六自由度主动波浪补偿装置根据功能分成机械、控制和液压三个子系统，运用 MATLAB/ Simulink 搭建补偿装置的机械(机构多体动力学模型)与控制系统模型(图 5)，所建立的六自由度平台多体动力学模型如图 7 所示。在 AMEsim 建立液压系统模型并以它为主控平台进行机、电、液 联合仿真，获得更加真实准确的仿真结果。! [) z8 Y" R* f( Q
AMEsim 液压系统模型主要由液压系统各组成元器件、控制器、测量模块、参考输入和接口组成，单个支腿的液压系统如图 8 所示。在 AMEsim 建立与 MATLAB/Simulink 接口模块，接口可以进行数据实时交互，采用 Visual C++编译语言实现两个软件无缝连接，从而实现联合仿真。创建接口模块时，需定义各液压缸驱动力为输入变量 i，执行作业的机械系统在液压系统提供的驱动力/力矩的作用下，遵守机械动力学运动原理和模型的约束条件产生机械运动，输出各活塞杆伸出的速度和位移响应变量 v 和 w，同时这些响应量又反馈到前者的模型作为系统输入，实现仿真数据在不同系统领域的软件中的双向传递功能。
! \/ Q5 J, h: @# A3 q y; |5 [2 M$ U
3 R/ D; G1 ~( {) y- W0 O: a基于 Stewart 平台的主动波浪补偿装置联合仿真模型如图 9 所示。联合仿真充分发挥各领域专业仿真工具的优势，并综合考虑了多体动力学、液压系统、控制系统之间的相互耦合关系，其仿真结论与真实实验更接近。在装备体积庞大、造价昂贵的情况下，联合仿真可部分代替装备的真实实验，为装备和系统开发提供有力的理论支撑。
4 `0 W4 N6 J, q. @* W
4 X- H+ q1 N3 U6 m8 r8 w _
2 Z! b! @( [8 N/ @ [0 g9 N' m& ^+ X6 p5 F5 V5 q$ i( d5 _
6 讨论与分析. N2 L6 q4 r! ? d e- n" I6 T
! D6 g# ~& s {* ]4 N
6 k- `# c: p6 r; J+ w, A+ b虽然很多学者已对六自由度主动波浪补偿装置进行了深入的研究，大部分学者都采用 Stewart 平台作为主要结构，通过选择不同的控制器以达到快速响应、精准定位的效果，但涉及到船舶运动测量的研究仍较少。本文以船舶运动姿态和补偿平台末端姿态检测为研究起点，通过扩展卡尔曼滤波算法融合两个传感器的信息，实现了惯性测量与视觉测量的互补结合，可获得结构简单、操作方便、快速且准确的运动数据，从而获得更好的补偿效果，后续研究可以进行卷积神经网络在姿态估计中的算法研究。
" B/ |+ X |! [ p& i1 V3 q
$ {: f- V. q8 J1 q8 Y }
/ z0 A: C {4 H针对 Stewart 并联补偿平台难以控制的问题，普通的 PID 控制已无法满足需求，故需对 PID 控制算法进行改进。潘学海 PID 的模糊控制算法，侯远欣等研究了基于引用反向传播神经网络算法，采用梯度下降法对反向传播神经网络加权值进行修正，通过学习速率来补偿控制系统输出误差，从而实现 PID 控制器参数在线调节，但尚未从根本突破 PID“快速性”和“超调”之间矛盾。由此，越来越多的学者对自抗扰控制器和自适应控制展开研究。张萌研究了在自抗扰控制器基础上，设计出基于非奇异快速终端滑膜控制技术的波浪补偿有限时间控制，解决了参数不确定和负载未知时变的问题，但这种方式误差收敛速度不达标。本文选用自抗扰控制器，在 MATLAB/Simulink 中建立模型，再由神经网络解决其中 NLSEF 参数难以整定的问题，后续研究可以对神经网络进行训练找到合适参数后进行与其他控制器对比仿真。最后通过联合仿真模型的建立，可以实现从测量到运动控制的完整流程，具有创新意义。
% k, F: l5 m% R# J( x; J& T( [
* U) X7 D6 d G4 k6 p. b
; Q4 I5 I: Y5 ~7 结 论
# g8 P: l2 K0 o: ?0 b( I2 {" Y5 S& [% R& U: t
4 d: k1 h9 d- {3 c4 ?7 s/ V0 Q l: [
以海工装备主动波浪补偿装置实现更快速的响应、更高的补偿精度为目的，本文从运动测量、主动波浪补偿控制、多系统联合仿真等方面对六自由度主动波浪补偿装置开展深入研究。其中，建立了卷积神经网络改进的主动波浪补偿运动测量系统，该系统通过高通滤波器降低惯性传感器测量船舶运动的时漂误差，结合双目视觉对平台末端的检测，借助卷积神经网络的扩展卡尔曼算法将两传感器的数据融合，比传统单传感器测量系统具有更高的测量稳定性；采用具有更强的实时性和抗干扰性自抗扰控制器进行主动波浪补偿控制；建立了六自由度主动波浪补偿装置机、电、液联合仿真模型，为系统性能分析验证提供了有效的工具。
9 L7 h/ E* I; h# ~* ^0 U! q. w" s: u# G- E
该文章来源互联网，如有侵权请联系删除 Y8 c& W* T9 p. G" ^
查看原文：www.52ocean.cn |
' h' F$ V1 T) X( `7 ?8 x
" J8 N& ?- p1 s! H6 k
$ Q% a: k. L5 B. y
6 u# U( ^: m2 v% n( n# c2 d
+ `: K4 O' K. H
