面向船舶动力定位系统的自适应权值矩阵加权伪逆推力分配和饱和处理方法技术方案

本发明专利技术涉及一种面向船舶动力定位系统的自适应权值矩阵加权伪逆推力分配和饱和处理方法，该方法包括：建立固定角度分配模式下的推力分配数学模型；求解无约束最优化问题的解；建立权值自适应律，实时调整权值矩阵来达到解决推进器推力饱和的问题；反复迭代直至推进器的推力满足不等式约束。本发明专利技术充分利用权值矩阵中元素对推进器的抑制、增强作用，建立了加权伪逆的权值自适应律，不需再对饱和推力进行截断、退出分配处理。采用此办法既有效利用了伪逆法计算速度快的优点又解决了简单加权伪逆在求解推力分配问题存在的推进器推力饱和的问题。

【技术实现步骤摘要】

本专利技术涉及一种船舶动力定位推力分配方法，特别是涉及一种采用自适应权值矩阵的加权伪逆的推力分配和饱和处理方法。
技术介绍
随着陆地上传统能源煤、石油的日益枯竭及人们对能源的巨大需求，人类对海洋的开发探索逐渐深入。在深水区作业的海洋结构物，例如平台供应船、钻探船、钻井平台等的定位作业精度愈来愈高。动力定位技术在这一背景下迅速得到重视，成为进行海洋开发探索的关键技术之一。安装有动力定位系统的海洋结构物采用卫星、GPS等定位手段获得当前海洋结构物的位置，控制器根据其与设定位置的偏差计算出所需要的力和力矩，再由推进器系统产生所需要的力和力矩，最终达到定位作业的要求。推力分配是动力定位系统的重要组成部分之一，它需要快速实时地将上一级控制系统计算得到的合力和合力矩以最优的方式分配到各个推进器上，还需要考虑推进器的物理限制及实现能耗最优，因此推力分配问题实际上是一个优化问题。伪逆法以其原理简单、实时性好而被广泛应用于求解飞机、卫星、船舶等的受限控制分配问题。推力分配必须考虑到推进器的物理限制即推进器的推力大小、推力变化率和角度变化率限制。若控制系统向推进器发出过大的推力指令，推进系统实则无法达到所要求的推力大小，这将导致推进系统产生的力和力矩不等于控制系统所要求的力和力矩，最终导致定位作业失败。针对该问题，国内外学者提出了零空间、级联广义逆和加权伪逆等方法。采用零空间法处理推进器饱和问题时存在无解时无法处理和算法复杂度随推进器数量增加而剧增的问题；级联广义逆法采取饱和截断、配置矩阵重构的方式进行饱和处理，但该方法不能为所有可达输出给出可行解，且在分配一组变化较为剧烈环境载荷时出现分配失败现象。加权伪逆方法依据权值元素的大、小对推进器的抑制、增强作用进行饱和处理，简便易行，无需配置矩阵重构，实时性好。
技术实现思路
本专利技术目的在于克服现有技术中在求解推力分配问题存在的推进器推力饱和的问题，进而提出一种面向船舶动力定位系统的自适应权值矩阵加权伪逆推力分配和饱和处理方法。实现本专利技术目的采用的技术方案是：一种面向船舶动力定位系统的自适应权值矩阵加权伪逆推力分配和饱和处理方法，该方法包括以下步骤：S100、建立固定角度分配模式下的推力分配数学模型；S200、求解无约束最优化问题的解；S300、建立权值自适应律，实时调整权值矩阵来达到解决推进器推力饱和的问题；S400、反复迭代直至推进器的推力满足不等式约束。进一步地，S100中，针对固定角度分配模式下的推力分配建立数学模型，将推力分配问题转化为优化问题，以能耗为目标函数，得到如下模型：minJ＝uTWu(1.1)s.tB*u=τmax(Tmin,T0-ΔT)≤u≤min(Tmax,T0+ΔT)---(1.2)]]>其中，J目标函数；W为权值矩阵，初值设为单位矩阵，在其后的控制周期内在线更新；u为待求解推进器的推力；T0为上一控制周期的推进器推力大小；Tmin、Tmax分别为推进器的所能发出的推力最小、最大推力；ΔT为推进器推力在一个控制周期内推力的最大改变量；τ为所要求的总推力和力矩；B为由推进器布置决定的配置矩阵，其第i列为：Bi=cos(αi)sin(αi)-liycos(αi)+lixsin(αi)---(1.3)]]>其中，αi为推进器的方向；(lxilyi)为推进器在随船坐标系下的安装位置坐标.进一步地，步骤S200中，在仅考虑等式约束时采用增广拉格朗日乘子法将步骤S100中的等式约束优化问题转化为无约束最优化问题，依据KKT条件可得到问题的简单伪逆解为：u＝W-1BT(BW-1BT)-1(1.4)进一步地，步骤S300中，通过实时调整权值矩阵来达到解决推进器推力饱和的问题，具体为：将式(1.4)作如下恒等变形：u＝[I+(I-BT(BBT)-1B)W]BT(BBT)-1τ(1.5)引入Ω＝diag(BT(BBT)-1τ)，上式可写成下述表达：u＝BT(BBT)-1τ+(I-BT(BBT)-1B)ΩW(1.6)式中，W＝[w11w22…wnn]T，为权值矩阵的对角元素组成的列向量；定义uc是由式(1.4)得到的直接伪逆解，u是经饱和处理后的推进器推力，偏差eu由下式定义：eu＝uc-u(1.7)由式(1.6)和(1.7)可得偏差eu的表达式为：eu＝[I-BT(BBT)-1B]ΔWΦ(1.8)式中，ΔW＝[W11-W11*W22-W22*…Wnn-Wnn*]T；设定如下权值矩阵自适应律：ΔW＝ProjW>0{-γΩT(I-BT(BBT)-1B)eu本文档来自技高网...

【技术保护点】
一种面向船舶动力定位系统的自适应权值矩阵加权伪逆推力分配和饱和处理方法，其特征在于，包括以下步骤：S100、建立固定角度分配模式下的推力分配数学模型；S200、求解无约束最优化问题的解；S300、建立权值自适应律，实时调整权值矩阵来达到解决推进器推力饱和的问题；S400、反复迭代直至推进器的推力满足不等式约束。

【技术特征摘要】
1.一种面向船舶动力定位系统的自适应权值矩阵加权伪逆推力分配和饱和处理方法，
其特征在于，包括以下步骤：
S100、建立固定角度分配模式下的推力分配数学模型；
S200、求解无约束最优化问题的解；
S300、建立权值自适应律，实时调整权值矩阵来达到解决推进器推力饱和的问题；
S400、反复迭代直至推进器的推力满足不等式约束。
2.根据权利要求1所述的面向船舶动力定位系统的自适应权值矩阵加权伪逆推力分配
和饱和处理方法，其特征在于：S100中，针对固定角度分配模式下的推力分配建立数学模
型，将推力分配问题转化为优化问题，以能耗为目标函数，得到如下模型：
minJ＝uTWu(1.1)
其中，J目标函数；W为权值矩阵，初值设为单位矩阵，在其后的控制周期内在线更新；u
为待求解推进器的推力；T0为上一控制周期的推进器推力大小；Tmin、Tmax分别为推进器的所
能发出的推力最小、最大推力；ΔT为推进器推力在一个控制周期内推力的最大改变量；τ为
所要求的总推力和力矩；
B为由推进器布置决定的配置矩阵，其第i列为：
其中，αi为推进器的方向；(lxilyi)为推进器在随船坐标系下的安装位置坐标。
3.根据权利要求1所述的自适应权值矩阵的加权伪逆推力分配和饱和处理方法，其特
征在于...

【专利技术属性】
技术研发人员：徐海祥，付海军，殷进军，
申请(专利权)人：武汉理工大学，中国船舶重工集团公司第七一二研究所，
类型：发明
国别省市：湖北;42