基于T-S模糊观测器补偿的UUV控制方法技术

基于T‑S模糊观测器补偿的UUV控制方法，涉及一种UUV控制方法。为了解决在有海流干扰时UUV跟踪航迹不精确的问题。包括：获取UUV下一步的期望航迹；姿态控制器根据期望轨迹进行跟踪误差，解算出下一步垂直舵与水平舵的舵角信息；T‑S模糊观测器根据海流干扰、当前UUV状态信息和航迹位置误差对UUV进行观测，估计出UUV下一步的状态信息；将UUV下一步的状态信息作为航速控制器的输入信号，获得推进器的下一步的推力；根据垂直舵与水平舵的舵角信息和推力，对UUV进行控制，获得UUV的运动状态，进而确定UUV的航迹，判断该航迹是否达到期望轨迹。本发明专利技术用于UUV跟踪水下线缆或管道、水下搜救、深海资源探测及地形探测。

【技术实现步骤摘要】
基于T-S模糊观测器补偿的UUV控制方法
本专利技术涉及一种UUV控制方法，特别涉及一种基于T-S模糊观测器补偿的一种UUV控制方法。
技术介绍
无人水下航行器(UnderwaterUnmannedVehicle,UUV)在跟踪水下线缆或管道、水下搜救、深海资源探测及地形探测等方面有广泛应用，而精确的三维航迹跟踪是实现上述应用的重要前提。由于本专利技术研究的UUV具有欠驱动及加速度不可积的非完整约束条件，且受外界海流的影响，从而导致所建立的模型复杂。实际应用中所使用的UUV六自由度模型均以忽略高阶项及未建模动态为前提，致使当UUV工作于复杂环境下时，由于未建模动态及高阶项影响增大，实际跟踪精度变差。1999年，TaniguchiT.等人将常规T-S模糊模型推广到更一般的情况，提出了T-S模糊广义系统模型。通过将T-S模糊系统与广义系统理论相结合，从而使得T-S系统可以借助于线性系统的分析和控制手段，为T-S模糊系统的应用开辟了一条崭新的途径。本专利技术通过建立UUVT-S模糊广义模型，引入T-S模糊观测器对UUV未建模动态进行在线观测，将观测结果反馈至控制器。该控制策略控制精度高，抗干扰性能强，具有非常好的使用价值。文献《基于T-S模型的轮式移动机器人轨迹跟踪控制》(控制理论与应用，2007年12月，第24卷第6期)提出了在控制力受限情况下对外部干扰有一定抑制能力的轮式移动机器人(WMR)轨迹跟踪方法。利用轮式移动机器人本身运动特性和参考轨迹建立起跟踪误差系统，并将WMR实时的期望角度以及角度跟踪误差作为模糊推理的前件，对该系统作T-S模型描述，针对每个线性子系统，不考虑各个子系统的相互关系，单独设计满足控制输入约束以及对于外部干扰有一定抑制能力的状态反馈H∞控制器，再利用PDC设计原则构建全局反馈控制器，并验证闭环系统的李雅普诺夫稳定性。文献《基于T-S模糊模型的机器人轨迹跟踪控制》(现代电子技术，2014年4月，第37卷第8期)是针对机器人模型的非线性，通过扇区非线性方法建立T-S模糊模型的。文献考虑到与实际模型之间的差异和扰动的存在，设计了滑模控制器，并利用李雅普诺夫理论证明了其稳定性。设计方法简单，通用性强。但采用现有这些基于T-S模糊模型的控制方法，控制有海流影响的UUV时，不能精确跟踪航迹。
技术实现思路
本专利技术的目的是为了解决现有UUV控制，在有海流干扰时，跟踪航迹不精确的问题，本专利技术提供一种基于T-S模糊观测器补偿的UUV控制方法。本专利技术的基于T-S模糊观测器补偿的UUV控制方法，所述方法包括如下步骤：步骤一：获取UUV下一步的期望航迹；步骤二：姿态控制器根据期望轨迹进行跟踪误差，解算出下一步垂直舵与水平舵的舵角信息；步骤三：T-S模糊观测器根据海流干扰、当前UUV状态信息和航迹位置误差对UUV进行观测，估计出UUV下一步的状态信息；所述航迹位置误差为期望轨迹与T-S模糊观测器当前估计出的状态信息和UUV当前的状态信息的差值；步骤四：将步骤三获得的UUV下一步的状态信息作为航速控制器的输入信号，获得推进器的下一步的推力；步骤五：根据步骤二获得的垂直舵与水平舵的舵角信息和步骤三获得的推力，对UUV进行控制，并获得UUV的运动状态；步骤六：根据步骤五获得的运动状态确定UUV的航迹，判断该航迹是否达到期望轨迹，若是，转入步骤一，若否，则转入步骤二。所述步骤三中，T-S模糊观测器为：所述T-S模糊观测器是针对UUV近水面航行建立，忽略UUV的横倾角；其中，选取未建模动态的观测更新律为：n为T-S模糊观测器建立规则的数量，i＝1,2,...,n；为UUV下一步在{B}下的线速度和角速度矢量；y为UUV当前状态输出；为UUV下一步的状态输出；wi(z)为相应规则的归一化权值函数，z＝[u,v,w,q,r,(v2+w2)2]T，u、v和w为UUV线速度矢量在艇体坐标系{B}下的三个分量；p、q和r分别为UUV角速度矢量在艇体坐标系{B}下的三个分量，p＝0；Ai为相应规则所对应的UUV动力学模型的非线性项线性化的常量矩阵；Di相应规则所对应的输入矩阵；Mi为相应规则的外界干扰的增益矩阵；τ为控制力或控制力矩；Li为相应规则所对应的增益矩阵；T为UUV的系统惯性矩阵，含附加质量，m11为ξ方向的惯性质量，m22为η方向的惯性质量，m33为ζ方向的惯性质量，m44为η方向的惯性矩，m55为ζ方向的惯性矩；外界干扰力或外界干扰力矩τd＝Aδix+Bδiu+ai，Aδi为相应规则所对应的状态干扰系数矩阵，Bδi为相应规则所对应的输入干扰系数矩阵，ai为相应规则所对应的外界干扰系数矩阵；ey为状态观测误差；P为变换矩阵；为C的伪逆；C＝I为线性化后的常矩阵；˙表示求导。所述T-S模糊观测器的获取方法包括：步骤A：建立UUV动力学模型；步骤B：根据动力学模型，获得UUV动力学方程式，并依据模糊规则将UUV动力学方程式转换为T-S模糊模型为：其中，x＝[u,v,w,q,r]T∈R5×1表示UUV当前在艇体坐标系{B}下的线速度和角速度矢量，τd为外界干扰力或外界干扰力矩；Ai∈R5×5,Mi∈R5×5,Di∈R5×5；步骤C：将UUV所受τd表示为τd＝Aδx+Bδu+a，将其带入步骤二中T-S模糊模型得出含有未建模动态的T-S模糊模型为：其中，Aδ为模糊前的状态干扰系数矩阵，Bδ为模糊前的输入干扰系数矩阵，a为模糊前的外界干扰系数矩阵；Aδi∈R5×5，Bδi∈R5×5，ai∈R5×5；步骤D：根据步骤C得出的T-S模糊模型得到模糊观测器：其中，选取未建模动态的观测更新律为：所述动力学模型：式中mvr、mwq、mur和muq均是水动力项系数，分别为mvr＝1/2ρL3X′vr、mwq＝1/2ρL3X′wq、mur＝1/2ρL3Y′r和muq＝1/2ρL3Z′q,L为UUV长度，ρ为水密度，X′vr为v和r的耦合系数，X′wq为w和q的耦合系数，Y′r为艏项角速度系数，Z′q为纵倾角速度系数，du、dv、dw、dq和dr分别为在五个自由度上的非线性水动力阻尼项，Xporp、Mporp和Nporp分别表示推进器推力、水平舵作用力矩和垂直舵作用力矩，w1、w2、w3、w4和w5分别为在五个自由度上的外界干扰力或外界干扰力矩，所述外界干扰力或外界干扰力矩不且为τd减去输入不确定性和状态不确定性。本专利技术的有益效果在于，通过建立UUV的T-S模糊模型估计出UUV的高阶未建模项，设计的T-S模糊观测器使所估计出的UUV状态信息更加接近实际情况，最终使得UUV在复杂环境下能够进行精确航迹跟踪。附图说明图1为具体实施方式中UUV垂直面坐标系示意图。图2为具体实施方式中UUV水平面坐标系示意图。图3为艇体坐标系{B}的原理示意图。图4为具体实施方式中基于T-S模糊观测器补偿的UUV控制方法的流程示意图。具体实施方式本实施方式所述的基于T-S模糊观测器补偿的UUV控制方法，本实施方式研究的UUV具有欠驱动及加速度不可积的非完整约束条件，且受外界海流影响，导致所建立的模型复杂。该UUV模型在尾部安装水平推进器提供纵向推力，垂直舵实现航向控制，水平舵实现纵倾或深度控制。为便于分析，对该UUV模型进一步做出如下假设：UUV航速为非负值，即不本文档来自技高网...

【技术保护点】
一种基于T‑S模糊观测器补偿的UUV控制方法，其特征在于，所述方法包括如下步骤：步骤一：获取UUV下一步的期望航迹；步骤二：姿态控制器根据期望轨迹进行跟踪误差，解算出下一步垂直舵与水平舵的舵角信息；步骤三：T‑S模糊观测器根据海流干扰、当前UUV状态信息和航迹位置误差对UUV进行观测，估计出UUV下一步的状态信息；所述航迹位置误差为期望轨迹与T‑S模糊观测器当前估计出的状态信息和UUV当前的状态信息的差值；步骤四：将步骤三获得的UUV下一步的状态信息作为航速控制器的输入信号，获得推进器的下一步的推力；步骤五：根据步骤二获得的垂直舵与水平舵的舵角信息和步骤三获得的推力，对UUV进行控制，并获得UUV的运动状态；步骤六：根据步骤五获得的运动状态确定UUV的航迹，判断该航迹是否达到期望轨迹，若是，转入步骤一，若否，则转入步骤二。

【技术特征摘要】
1.一种基于T-S模糊观测器补偿的UUV控制方法，所述方法包括如下步骤：步骤一：获取UUV下一步的期望航迹；步骤二：姿态控制器根据期望轨迹进行跟踪误差，解算出下一步垂直舵与水平舵的舵角信息；步骤三：T-S模糊观测器根据海流干扰、当前UUV状态信息和航迹位置误差对UUV进行观测，估计出UUV下一步的状态信息；所述航迹位置误差为期望轨迹与T-S模糊观测器当前估计出的状态信息和UUV当前的状态信息的差值；步骤四：将步骤三获得的UUV下一步的状态信息作为航速控制器的输入信号，获得推进器的下一步的推力；步骤五：根据步骤二获得的垂直舵与水平舵的舵角信息和步骤三获得的推力，对UUV进行控制，并获得UUV的运动状态；步骤六：根据步骤五获得的运动状态确定UUV的航迹，判断该航迹是否达到期望轨迹，若是，转入步骤一，若否，则转入步骤二；所述步骤三中，T-S模糊观测器为：所述T-S模糊观测器是针对UUV近水面航行建立，忽略UUV的横倾角；其中，选取未建模动态的观测更新律为：n为T-S模糊观测器建立规则的数量，i＝1,2,...,n；为UUV下一步在{B}下的线速度和角速度矢量；y为UUV当前状态输出；为UUV下一步的状态输出；wi(z)为相应规则的归一化权值函数，z＝[u,v,w,q,r,(v2+w2)2]T，u、v和w为UUV线速度矢量在艇体坐标系{B}下的三个分量；p、q和r分别为UUV角速度矢量在艇体坐标系{B}下的三个分量，p＝0；Ai为相应规则所对应的UUV动力学模型的非线性项线性化的常量矩阵；Di相应规则所对应的输入矩阵；Mi为相应规则的外界干扰的增益矩阵；τ为控制力或控制力矩；Li为相应规则所对应的增益矩阵；T为UUV的系统惯性矩阵，含附加质量，m11为ξ方向的惯性质量，m22为η方向的惯性质量，m33为ζ方向的惯性质量，m44为η方向的惯性矩，m55为ζ方向的惯性矩；外界干扰力或外界干扰力矩τd＝Aδix+Bδiu+ai...

【专利技术属性】
技术研发人员：张勋，赵晓芳，时延利，张宏瀚，陈涛，周佳加，李本银，
申请(专利权)人：哈尔滨工程大学，
类型：发明
国别省市：黑龙江;23