发明内容
本发明的目的是解决一种非线性船舶动力***的定位跟踪控制问题,在存在风、浪和流的海况条件下,针对多维非线性船舶***设计自适应容错控制器,以分别实现船舶定位***正常和发生有界故障情形下的定位控制,提高***的定位精度和控制可靠性。
根据本发明提供的技术方案,所述非线性船舶动力***的自适应定位跟踪容错控制方法包括如下步骤:
第一步:在惯性参考系下建立船舶动力学模型
船舶受到力和力矩作用后如何改变运动位置和姿态属于动力学问题;在惯性参考系下建立船舶动力学模型,以大地作为参考系
在船舶模型动力方程(1)中,xL1,xL2分别为X方向,纵向的船位移和速度;xL3,xL4分别为Y方向,横向的船位移和速度;xL5,xL6分别为艏摇角度和角速度;xC1,xC2分别为海流在X方向和Y方向的速度;xC3表示流力矩;v1,v2分别为X方向和Y方向的风力;v3表示风力矩;u1,u2分别为X方向和Y方向的螺旋桨推力;u3表示螺旋桨推力矩;ηL1,ηL2,ηL3表示零均值高斯白噪声序列;d1,d2,d3,d4为阻力系数和力矩系数,以船艏与流向间的夹角的函数给出;m1,m2,m3为惯性系数;
第二步:构建船舶非线性状态变量动力方程
针对船舶模型动力方程(1)构建非线性状态变量动力方程
其中i表示子***个数,i=1,2,3;fi(x,t)和bi(x,t)表示与全局状态变量相关的子***模型的连续函数向量,其中bi(x,t)恒不为零;xi=[xi1 xi2]T表示子***部分的状态变量,是***的全局状态变量,ui(t)表示***输入,gi(xi,t)表示执行器端的未知不确定性,yi表示***输出,wi(xi,t)表示***扰动或执行器故障;船舶定位***中常见的执行器故障由执行器卡死、失效或元器件松动因素引起,而扰动则体现为执行器的机械震动和冲击现象;
进而非线性状态变量动力方程(2)的各子***可以统一构造为如下形式:
其中
第三步:设计性能参考解耦子模型信号发生器
综合考虑实际船舶定位运行的静态和动态特性,针对船舶模型动力方程(1),同时考虑式(3)所示非线性***在m个自由度上运动的特点,虽然船舶各子***间状态关系相互耦合,但各轴控制独立,因此参考模型信号发生器设计成由m个解耦独立的子***组成
令xmi=[xmi1 xmi2]T,则式(4)可进一步改写为
其中Kmi1和Kmi2为保证矩阵Ami满足负定条件且使式(5)具有稳态和动态性能的参数,xmi为参考模型的状态变量,ymi为参考模型输出,vmi为参考模型输入,即指令信号发生;
第四步:设计自适应模糊逻辑器估计船舶模型未知项
***(3)中的连续函数向量fi(x,t)和bi(x,t)一般均未知或仅部分已知,以自适应模糊逻辑器估计得到和的相关项;模糊逻辑语言描述:
其中q=1,2,…,2m,和分别表示模糊规则里向量zfq和zbq所属的条件集合,和为分别用于估计连续函数向量fi(x,t)和bi(x,t)的模糊输出集合,j1=1,2,…,k,j2=1,2,…,l,而k和l表示IF-THEN模糊规则数,进一步可得
其中和为由和构成的可调参数向量,自适应更新律为
其中可调参数和均为任意正数; 为模糊基函数向量
其中和分别表示条件向量zfq和zbq在模糊集合和内的相关隶属度;
第五步:设计船舶定位自适应跟踪容错控制器
定位跟踪误差ei=yi-ymi,令σi=Ciei,其中Ci为各元素均为正的行向量,且CiB0≠0,船舶各子***的自适应跟踪容错控制器为
相应的自适应项为
其中 和i=1,2,3,j=0,1,2为任意正数;
将式(5),式(6)、式(7)和式(10)、式(11)、式(12)代入式(9)就可得到定位跟踪容错控制器。
本发明的优点是:本方法针对多子***组成,执行器发生故障的船舶非线性***,不依赖船舶各维子***模型已知,利用各子***独立状态来控制单一子***,将与船舶全局变量相关的部分纳入到不确定性来处理;通过模糊逻辑器和自适应容错控制器动态补偿船舶建模误差、不确定性和执行器故障影响,减小人为预估造成的定位不精确性;可进一步推广到机器人点焊、磁盘磁道读取和仓储搬运等容错定位跟踪问题。
具体实施方式
下面结合附图和实施例对本发明做进一步说明。
针对一类由多个子***组成的复杂非线性船舶动力***的定位控制问题,基于***模型未知的情形,非线性船舶动力***的自适应定位跟踪容错控制方法的整体框架如图1所示,以动态补偿建模误差、不确定性和船舶执行器故障的影响,实现相对较为平稳而迅速的定位。
如图2所示是船舶动力***的水平运动坐标系和惯性坐标系。图中的ξ,η分别表示北和东方向,ξOη为部分惯性坐标,其中O是任意选定的、固定于地球表面的坐标系原点。通常可以选择在t=0时刻,即船舶重心所在的位置;X,Y分别表示纵向和横向,XOY表示水平运动坐标;xR,yR分别表示惯性坐标系中测得的船位;x,y表示平行坐标系中测得的船位;φ表示相对于惯性坐标系中北坐标纵的船舶艏向;u,v表示平行坐标系中船舶的速度分量;VA,VC分别表示风速和海流速度;VR表示船舶相对于水的速度;φA表示相对于惯性坐标系中北坐标纵的风向角;φC表示相对于惯性坐标系中北坐标纵的海流方向角。
第一步:根据式(1)建立船舶耦合运动模型,构成如式(2)所示的非线性方程,并改写成如式(3)所示的向量形式。由于船舶在进行钻探、敷设电缆等活动时,经常会处于风、浪和流共同作用的复杂海况条件下,在海面上作六自由度的运动,这些运动由两部分组成。第一部分是船舶的高频运动(0.3~1.6rad/s),它是由一级波浪所引起的,这部分运动并不反馈给控制***,控制器也不需要控制这部分运动,因为这部分运动仅会造成船舶的振荡,而不会造成船舶的位移;第二部分是船舶的低频运动(小于0.5rad/s),它是由风、海流和二阶波浪所引起的运动,动力定位***仅需要控制这部分运动,这样处理可以减少推力器的磨损、减少控制所需的能量、降低设备的制造成本。为此本发明仅需控制低频运动,而将高频运动部分纳入式(3)中的未知不确定性部分来处理。
第二步:建立性能参考解耦子模型方程。由于定位时要求参考模型(5)中矩阵Ami的特征根都具有负实部,即满足稳定性要求。若任意选择Kmi1和Kmi2船舶定位***的实际动态性能效果并不一定理想。秉承工程设计简易化的思想,对参考模型(4)进行拉普拉斯变换后可得
其中为独立单元状态的拉普拉斯变换,为参考子模型独立单元输入的拉普拉斯变换,则可进一步改写为
从经典控制理论可知,该独立单元的自然频率阻尼比选取合适的Kmi1和Kmi2即可产生符合动态和静态性能指标的指令信号。由于参考模型子***得到的指令信号ymi或xmi的稳态值仅为期望指令信号vmi的1/Kmi1倍,一般需要在参考模型子***的输出端配置放大器,放大Kmi1倍以作为信号补偿。因此,为避免船舶在X和Y方向上运动过于剧烈而造成船员出现晕眩现象,X和Y方向上的子***参考模型(5)都设计成为过阻尼***。
第三步:针对式(1)所示的非线性船舶定位***,选择模糊规则数k=9,l=9,模糊推理逻辑:
其中x(t)=[xL1 xL2 xL3 xL4 xL5 xL6]T,i=1,2,3,隶属度函数取为
第四步:设计式(9)所示的自适应容错控制器
采取式(10)、(11)和(12)的自适应律,联合调整参数 j=0,1,2;i=1,2,3;C1,C2,C3;Q1,Q2,Q3,以对不确定性和故障影响进行联合抑制。
设定船舶的初始位置,若横向位移x、纵向位移y和艏向角φ分别取为(0m,0m,0°),而要求的定位点为(200m,500m,0°)。在风速10m/s,风向角135°,浪高2m,浪向角120°,流速1.5m/s,流向角30°的海况下船舶若船舶的推力器因机械结构老化和磨损而失效30%,但仍在功率有效的工作范围内。图3给出了此时的纵向、横向、艏向运动曲线及平面俯瞰运动曲线。实线为采用本发明方法后得到的运行轨迹,而虚线则采用人为设定调整的方法。从俯瞰图可以看出,实线部分在最终定位点有略微的振荡现象出现,这同样是由于风、浪和流的影响,同时也是滑模运动的基本特性,但±0.1m以内的误差区基本不影响海洋作业。同时也可以看出,由于此时控制端的不确定因素进一步影响了未知不确定部分的结构和参数,不确定程度出现了过度不匹配,因此直接设定估计范数界的方法就更易预计不当。从虚线部分的运动轨线可以看出,此时船舶由于控制器的作动力不足,***在定位跟踪过程中出现凌乱的振荡和偏差。更为严重的是,船舶在海域内会沿着浪和流共同作用的方向出现振荡漂移,从而逐渐漂离定位点。
上述实施例仅仅是为清楚地说明本发明所作的举例,而并非是对本发明的实施方式的限定,对于所属领域的普通技术人员来说,在上述说明的基础上还可以做出其它不同形式的变化或变动。