鸦 婧,董 睿,俞竹青
(常州大学 机械与轨道交通学院,江苏 常州 213164)
舰船在海上航行时,由于受到海浪等因素的影响,会发生横摇、纵摇、首摇、横荡、纵荡、垂荡6个自由度的运动,这些非期望运动会对各种舰载设备的正常作业造成干扰[1]。舰载稳定平台可以抵消这些摇摆运动,由于应用在海洋背景下,所以舰载稳定平台控制系统是非线性和不确定性的,采用传统PID控制无法满足控制要求[2]。若能实现PID参数在线自整定,不仅能方便控制系统的调试,还可提高控制系统的自适应能力。由于RBF神经网络可通过自学习自调整其权值和阈值找到最优的1组PID参数,从而逼近任意非线性函数,所以将RBF神经网络与PID控制相结合对液压驱动舰载稳定平台进行控制研究。针对液压系统突然启动、停止、变速或换向时产生的液压冲击问题,提出采用正弦加速度导数连续原则设计稳定平台理想速度曲线。
舰载稳定平台主要由机械结构、执行机构、控制模块和反馈元件组成。控制系统采用以绝对剩余距离为原则的速度控制方式,控制系统原理如图1所示。该控制系统以STM32单片机为控制核心,当平台发生倾斜时,惯性传感器采集平台俯仰和横滚两轴的角度,通过位姿反解求出使平台稳定的活塞杆伸缩位移值,理想速度曲线根据活塞杆移动的剩余距离计算出相应的期望速度,期望速度与实时速度的偏差信号经过RBF神经网络PID控制器,输出PWM电压信号,控制比例阀阀芯产生一定大小的开口,从而控制流入液压缸工作腔的液压油流量,使液压缸按照理想速度伸缩指定位移,从而抵消船体的摇摆对上平台的影响,通过运动补偿使上平台始终保持水平稳定。
图1 稳定平台控制系统原理图Fig.1 Schematic diagram of stable platform control system
已知上平台在空间的位置和姿态,通过运动学逆解求出各伸缩杆的位移值,从而实现舰载稳定平台上台面始终保持水平。要抵消船体摇荡运动的干扰,首先需要解决稳定平台坐标系之间的相互转换问题[3]。可将船体坐标系与惯性坐标系间的位置坐标变换描述为三次连续旋转的欧拉角变换,则船体坐标系与惯性坐标系间的位置旋转变换过程为:先绕Z轴旋转角度ψ,再绕Y轴旋转角度θ,最后绕X轴旋转角度φ,可用如下旋转矩阵表示,即
本文只研究横摇和纵摇,所以绕Z轴旋转的角度ψ=0◦。舰载稳定平台下平台随船体在做旋转运动时还会产生平移运动,设平移位移量分别为xp,yp,zp,则位姿变换矩阵T定义为:
假设Ai(Aix,Aiy,Aiz)(i=1,2)为惯性坐标系中上平台各铰链中心点,为船体坐标系中下平台各铰链中心点。齐次变换矩阵为T,则下平台中心点对应中的坐标Bi(Bix,Biy,Biz)(i=1,2)为:
可得各连杆的长度Li为:
各连杆的初始长度设为Li0,为隔离船体产生的摇荡运动,各连杆应协调伸缩位移∆Li,使上平台相对惯性坐标系保持稳定,各连杆需要移动的位移为:
理想速度曲线的设计是实现速度控制的关键,液压缸突然起动和停止会产生液压冲击,而造成液压冲击的主要原因是液压缸的加速度存在突变,所以液压缸的控制曲线要满足以下基本条件:速度曲线连续;加速度曲线连续;加加速度曲线连续。由于正弦曲线加速度导数连续,所以采用正弦型曲线作为液压缸的期望运行曲线,控制活塞杆在全行程任意点缓冲定位[4]。液压缸的运动行程决定了液压缸能否达到最大速度[5],所以控制曲线需要分成2种情况讨论,如图2所示。若液压缸无法达到最大速度,则采用理想速度曲线1,若液压缸能达到最大速度,则采用理想速度曲线2。其运动过程分为加速段、匀速直线段、减速段。
图2 理想速度曲线Fig.2 Ideal speed curve
设计曲线时,假设加速段和减速段运行时间和运行距离均相等,则有t1=t3,l1=l3,匀速段运行时间t2=2t1,当液压缸流量、液压缸直径、活塞杆直径、缓冲距离确定时,缓冲时间则可确定。
1)加速段
2)匀速段
由于采用的是单活塞杆液压缸,液压缸伸出和缩回两方向的推力和速度不相等,所以需要对液压缸的伸出和缩回过程中的匀速段分别进行分析。该阶段加速度为0,速度为v0,v0是液压缸运行过程中所能达到的最大速度。
活塞杆伸出时匀速段速度为:
活塞杆缩回时匀速段速度为:
3)减速段
减速段初速度为v0,速度v的曲线方程为:
由于上述公式中含有大量三角函数和浮点数的运算,计算过程会花费大量时间,降低了系统的实时性[6],且理想速度曲线是连续的,所以需要将速度曲线离散化,通过表格的形式存储在STM32的Flash中,以固定周期读表获取需要的速度指令。
RBF神经网络可根据稳定平台控制系统的性能要求和运行状态,对权值进行修正,从而对PID参数进行实时调整[7]。本文使用RBF神经网络对舰载稳定平台位置控制系统进行在线辨识,根据得到的Jacobian信息对增量式PID参数进行在线整定。RBF神经网络PID控制器原理如图3所示,r(k)为活塞杆理想速度,y(k)为活塞杆实际速度,e(k)为活塞杆理想速度与实际速度的偏差,u(k)为PID控制器输出的控制量,ym为RBF神经网络的输出。
图3 基于RBF系统辨识的自适应PID控制器原理图Fig.3 Schematic diagram of an adaptive PID controller based on RBF system identification
采用增量式PID控制算法,公式为:
式中:kp,ki,kd为PID的3个调节参数;u(k)为第k次采样时刻的控制量;e(k)为第k次采样时刻期望输出与实际输出的差值。
RBF神经网络包含输入层、单隐含层和输出层[8],输入到输出的映射是非线性的,隐含层到输出层的映射对可调参数而言是线性的,因此加快了学习速度且避免了局部极小的问题[9]。本文采用3-6-1的神经网络结构,其结构如图4所示。
图4 RBF神经网络结构Fig.4 RBF neural network architecture
RBF神经网络通过输入层正向计算求解ym,继而根据y与ym的差值,逆向更新网络的输出权值、基宽参数、节点中心。
1)前向传播
X=[x1,x2,···,xn]T为网络的输入,分别为PID输出控制量u(k)、系统当前实际输出值y(k)、系统上一次实际输出值y(k-1);H=[h1,h2,···,hm]T为隐含层的输出;隐含层到输出层的权值向量W=[ω1,ω2,···,ωm]T;隐含层的激活函数为:
其中Cj=[cj1,cj2,···,cji,···cjn]T为隐含层的第j个节点的中心矢量,bj为隐含层第j个节点的基宽度,基宽向量为:
辨识网络的输出为:
2)反向传播
辨识器的性能指标函数为:
为使J最小,采用梯度下降法调整网络的参数,η为学习速率,α为动量因子,各参数的迭代算法为:
由RBF网络得到Jacobian信息,其算法为:
RBF神经网络整定指标为:
通过梯度下降法调整kp,ki,kd;η1,η2,η3为PID调节参数的学习率:
选用油缸内径D=80 mm,活塞杆直径d=56 mm,行程L=200 mm(−100~100 mm)的液压缸,液压缸活塞杆的位移对指令输入的传递函数为:
故液压缸活塞杆的速度对指令输入的传递函数为:
选用VT-MRPA1-1-1X型比例放大器,可近似为比例环节[10],传递函数为:
式中:Ka为比例放大增益;I(s)为比例放大器输出电流,U(s)为比例放大器的输入电压。
比例阀的输入信号是电压,输出信号是流量,其传递函数由液压动力元件的特性决定。采用4WRE1025-2X/G24K4/M型电液比例阀,其主要参数为:固有频率440 rad/s,阻尼比0.7。根据电液比例阀的自身固有频率与液压动力元件的固有频率的关系[11],可认为是二阶环节,传递函数为:
式中:Ksv为阀的流量增益;ωsv为阀的固有频率;ζsv为阀的阻尼比。
舰载稳定平台控制系统的传递函数方框图,如图5所示。此处选取的是活塞杆做伸出运动时的传递函数。
图5 系统传递函数框图Fig.5 System transfer function block diagram
在Simulink中搭建仿真实验,由于选用的比例阀输入指令信号范围为−10~+10 V,需要加入饱和度模块,上下限分别取+10和−10。分别对液压缸阶跃信号、正弦信号、理想速度曲线的响应进行仿真,并对常规PID控制和基于RBF辨识网络的自适应PID控制的性能进行对比,系统模型的仿真框图如图6所示。
图6 Simulink仿真图Fig.6 Simulink simulation diagram
采样周期为0.001,RBF辨识器为3-6-1结构,其学习速率设为0.3,惯性因子设为0.05,PID参数的学习率设为0.2,仿真时间设为10 s,对RBF-PID控制器和常规PID控制器分别输入一个幅值为0.025 m/s的阶跃信号,并从5 s开始加入一个持续时间为0.05 s的干扰信号,阶跃信号响应结果如图7所示。2种控制方法的响应误差如图8所示。
图7 阶跃信号响应图Fig.7 Step signal response plot
图8 阶跃信号响应误差曲线图Fig.8 Step signal response error plot
由图7可知,PID控制的超调量为16%,RBFPID控制器的响应时间较PID控制快1.6 s,且基本没有超调。在稳定状态受到干扰时,RBF-PID控制器的调整时间较传统PID控制器快1.2 s,回稳较快,且波动较小,因此与传统PID相比,RBF-PID具有更强的适应性和鲁棒性。在响应性能上,RBF-PID控制器优于常规PID控制器。
将上述非线性系统的输入信号改为幅值为0.02 m/s,频率为0.3 Hz的正弦信号,跟踪结果如图9所示,跟踪误差曲线如图10所示。
图9 正弦信号跟踪图Fig.9 Sinusoidal signal tracking diagram
图10 正弦信号跟踪误差图Fig.10 Sinusoidal signal tracking error diagram
可知,在速度跟随控制时存在滞后,但基于RBF辨识网络的自适应PID控制器在调整速度、跟踪精度时均优于传统PID控制器,调整时超调较小,控制精度和效率也较好,且会持续接近跟踪系统。
q=24 L/min,由式(6)~式(9)计算活塞杆伸出0.12 m的理想速度曲线式(36),并在M文件中编写理想速度曲线,理想速度响应曲线如图11所示。
图11 活塞杆伸出12 cm的理想速度曲线跟踪图Fig.11 Piston rod out 12 cm ideal velocity curve tracking diagram
采用RBF-PID控制的仿真曲线与目标速度曲线基本重合,且在启动段和停止段基本没有出现加速度突变,验证了设计的理想速度曲线的可行性。图12为对应的位移响应曲线。
图12 12cm位移响应图Fig.12 12cm displacement response plot
本文对舰载稳定平台的控制进行模型建立和仿真,并验证了设计的理想速度曲线有效性。仿真结果表明,RBF-PID控制器在响应、调整性能、跟踪性能方面均优于常规PID控制器,具有一定的自学习能力。采用RBF-PID控制算法可以在有效提高舰载稳定平台控制精度的同时增强其抗干扰能力,达到了良好的控制效果。