基于t-s模糊时滞模型的欠驱动uuv垂直面控制方法
【技术领域】
[0001] 本发明涉及一种水下运动体的控制方法。具体涉及一种欠驱动无人水下航行器 (UUV)在通信时滞状态下垂直面的运动控制方法。
【背景技术】
[0002] 无人水下航行器(UUV)是高技术的集成体，其运动控制问题是UUV诸多关键技术中 迫切需要究、解决的关键技术之一。同时UUV的运动控制是完成UUV使命的重要技术保障，也 是一直是困扰AUV技术工作者的一个十分复杂的问题。UUV运动控制系统的信息量交换大、 实时性要求高。UUV垂直面的控制是UUV运动控制系统的一个重要环节。然而网络通信时滞 造成信息的不确定使得UUV垂直面控制的难度加大。因此如何抑制在UUV垂直面控制中时滞 现象给系统性能造成的影响已成为亟待解决的基本问题。
[0003] Τ-s模糊模型将线性系统理论与模糊理论相结合来解决非线性系统控制问题，将 整个非线性系统的控制看作是多个局部线性系统控制的模糊逼近。这不仅开创了模糊模型 辩识的新方法，同时也为模糊控制系统的稳定性分析和设计提供了模型基础。
[0004] 文献《模型不确定时滞欠驱动AUV的模糊变结构控制》(哈尔滨工业大学学报，2010 年3月，第42卷第3期)和文献《时滞时变AUV的模糊变结构控制》(系统工程与电子技术，2009 年8月，第31卷第8期)均设计的一个模糊变结构控制器，该控制器以变结构控制的切换函数 及其变化率为模糊控制器的输入，以变结构控制律的变化率为模糊控制器的输出，为了得 到更好的性能，引入了压缩扩张隶属度函数。同时前者设计一定的模糊规则自适应地调整 模糊控制器中的比例因子和量化因子。数值仿真表明，各自控制器都能很好地实现对具有 控制输入时滞以及各自附加现象AUV的深度控制。然而两篇文献都没有建立具体的UUV垂直 面的时滞模型，而是通过控制器的鲁棒性来解决控制输入时滞问题。
[0005] 文献《含状态时滞的受扰水下航行器的滑模与最优跟踪控制》（中国优秀硕士学位 论文全文数据库，2013)研究了一类受到持续扰动的含有状态时滞的水下航行器的滑模控 制与最优跟踪控制，该文献建立了AUV的时滞模型，设计了滑模控制器解决AUV水平面在含 有状态时滞情况下的位置跟踪问题。该文献研究的是航行器的水平面运动控制。
【发明内容】
[0006] 本发明是为了实现在通信时滞情况下，控制欠驱动无人水下航行器平稳达到指定 深度，从而提供一种基于Τ-S模糊时滞模型的欠驱动UUV垂直面控制方法。
[0007] 基于Τ-S模糊时滞模型的欠驱动UUV垂直面控制方法，它由以下步骤实现：
[0008] 步骤一、初始化UUV，获取初始状态信息当前深度、俯仰角和下潜速度；
[0009] 步骤二、运动控制计算机接收深度指令，结合传感器反馈的初始状态信息输入T-S 模糊时滞数学模型求解出控制器状态反馈系数；
[0010] 步骤三、控制器通过解算当前传感器反馈的实时状态信息，输出舵角控制指令；
[0011] 步骤四、舵机执行控制指令，完成UUV深度控制，并判断是否达到指定深度，如果判 断结果为是，则结束本次下潜任务;如果判断结果为否，则返回执行步骤三；
[0012] 实现欠驱动UUV垂直面在时滞状态下的闭环运动控制。
[0013] 步骤二中所述的T-S模糊时滞数学模型采用UUV垂直面模糊时滞数学模型实现，所 述UUV垂直面模糊时滞数学模型具体为：
[0014] 步骤A1、建立UUV垂直面数学模型：
[0015]假设UUV的轴向速度为恒定值，所有横向参数都为零，且系统有且只有一个控制输 入，即：水平舵舵角心；
[0016]则其运动学和动力学方程表示为：
[0021] 式中:m为UUV的质量，q为纵倾角速度j为纵倾角的加速度，Θ为纵倾角，w为基于艇 体坐标系的下潜速度，#为基于艇体坐标系的下潜加速度，I yy为关于纵倾角的转动惯量，u 为UUV的巡航速度，z为UUV的深度，f为基于固定坐标系下潜速度，W和Bo分别为的重力和浮 力，、Zuq、Zuw、Zw | w |、Zq | q |、Zuu、、Muq、Muw、Mw | w |、Mq | q |、Muu为的水动力参数；（XG， yc，zc)和(χβ，υβ，ζβ)分别为UUV的重心和浮力中心。
[0022] 忽略二阶系数且令(XG，yG，ZG) = (XB，yB，ZB)=O，x=(wq0z)T，u(t) = 5s(tWlJS (1)线性化的方程组为：
[0028] 步骤A2、建立UUV垂直面模糊时滞数学模型：
[0029]根据（1)中的UUV垂直面的数学模型，结合信息从传感器到控制器的时滞为tsc，控 制器到执行机构时滞为
[0030] 令τ = 建立UUV垂直面时滞模型为：
[0032] 式中：Z =辦Π ，：?二(1 -约妒U，β为UUV垂直面通信时滞系数；
[0033] 令心=X (t-τ)有以下T-S模糊规则：
[0038]则有UUV垂直面T-S模糊时滞模型的状态方程：
[0040]其中:MU(t))为模糊规则间的隶属函数且
[0041]本发明涉及的一种基于T-S模糊时滞模型的欠驱动UUV垂直面控制方法的工作原 理:运动控制计算机在接收到深度指令后，将UUV的俯仰角、航速初始状态输入T-S模糊时滞 模型计算出状态反馈系数输入控制器，控制器系统通过接收当前时刻t和滞后T S。时刻（t-ts。时刻)反馈的状态信息计算出相应的舵角，下达舵角指令控制执行机构，执行机构执行滞 后时刻(t_^ a时刻)形成闭环系统控制UUV达到指定深度。
[0042]本发明的优点在于通过建立欠驱动UUV垂直面T-S模糊时滞模型设计控制器，解决 UUV垂直面在通信时滞状态下的深度控制。
【附图说明】
[0043] 图1欠驱动UUV网络硬件结构图；
[0044] 图2欠驱动UUV的控制方法示意图；
[0045]图3 UUV垂直面控制系统工作流程图；
【具体实施方式】
[0046]【具体实施方式】一、结合图3, 一种基于T-S模糊时滞模型的欠驱动UUV垂直面控制具 体实施步骤可描述为：
[0047] 1、初始化UUV，获取初始状态信息当前深度、俯仰角；
[0048]