首页> 中国专利> 基于T-S模糊时滞模型的欠驱动UUV垂直面控制方法

基于T-S模糊时滞模型的欠驱动UUV垂直面控制方法

页面导航

摘要
著录项
法律信息
说明书
相似文献

摘要

基于T-S模糊时滞模型的欠驱动UUV垂直面控制方法，涉及一种水下运动体的控制方法。本发明是为了实现在通信时滞情况下，控制欠驱动无人水下航行器平稳达到指定深度。运动控制计算机接到深度指令后，将深度指令偏差及UUV的舵角、俯仰角、航速初始状态输入T-S模糊时滞数学模型计算出状态反馈系数；控制器根据传感器系统传输的实时状态信息结合状态反馈系数计算出舵角指令；执行机构通过执行舵角指令来控制UUV下潜深度。若达到指定深度，则完成本次下潜任务，否则运动控制计算机继续解算、发送指令。本发明实现了欠驱动UUV在通信时滞状态下的垂直面的控制。

著录项

公开/公告号CN105573327A

专利类型发明专利
公开/公告日2016-05-11

原文格式PDF
申请/专利权人哈尔滨工程大学;
展开▼

申请/专利号CN201610118633.1
发明设计人张勋;肖遥;李昀澄;张宏瀚;时延利;陈涛;周佳加;
展开▼

申请日2016-03-02
分类号G05D1/04(20060101);G05D1/06(20060101);
代理机构23109 哈尔滨市松花江专利商标事务所;
代理人岳泉清
地址 150001 黑龙江省哈尔滨市南岗区南通大街145号
入库时间 2023-12-18 15:07:56

法律信息

法律状态公告日

法律状态信息

法律状态
2020-03-10

未缴年费专利权终止 IPC(主分类):G05D1/04 授权公告日:20180717 终止日期:20190302 申请日:20160302

专利权的终止
2018-07-17

授权

授权
2016-06-08

实质审查的生效 IPC(主分类):G05D1/04 申请日:20160302

实质审查的生效
2016-05-11

公开

公开

说明书

技术领域

本发明涉及一种水下运动体的控制方法。具体涉及一种欠驱动无人水下航行器(UUV)在通信时滞状态下垂直面的运动控制方法。

背景技术

无人水下航行器(UUV)是高技术的集成体，其运动控制问题是UUV诸多关键技术中迫切需要究、解决的关键技术之一。同时UUV的运动控制是完成UUV使命的重要技术保障，也是一直是困扰AUV技术工作者的一个十分复杂的问题。UUV运动控制系统的信息量交换大、实时性要求高。UUV垂直面的控制是UUV运动控制系统的一个重要环节。然而网络通信时滞造成信息的不确定使得UUV垂直面控制的难度加大。因此如何抑制在UUV垂直面控制中时滞现象给系统性能造成的影响已成为亟待解决的基本问题。

T-S模糊模型将线性系统理论与模糊理论相结合来解决非线性系统控制问题，将整个非线性系统的控制看作是多个局部线性系统控制的模糊逼近。这不仅开创了模糊模型辩识的新方法，同时也为模糊控制系统的稳定性分析和设计提供了模型基础。

文献《模型不确定时滞欠驱动AUV的模糊变结构控制》(哈尔滨工业大学学报，2010年3月，第42卷第3期)和文献《时滞时变AUV的模糊变结构控制》(系统工程与电子技术，2009年8月，第31卷第8期)均设计的一个模糊变结构控制器，该控制器以变结构控制的切换函数及其变化率为模糊控制器的输入，以变结构控制律的变化率为模糊控制器的输出，为了得到更好的性能，引入了压缩扩张隶属度函数。同时前者设计一定的模糊规则自适应地调整模糊控制器中的比例因子和量化因子。数值仿真表明，各自控制器都能很好地实现对具有控制输入时滞以及各自附加现象AUV的深度控制。然而两篇文献都没有建立具体的UUV垂直面的时滞模型，而是通过控制器的鲁棒性来解决控制输入时滞问题。

文献《含状态时滞的受扰水下航行器的滑模与最优跟踪控制》(中国优秀硕士学位论文全文数据库，2013)研究了一类受到持续扰动的含有状态时滞的水下航行器的滑模控制与最优跟踪控制，该文献建立了AUV的时滞模型，设计了滑模控制器解决AUV水平面在含有状态时滞情况下的位置跟踪问题。该文献研究的是航行器的水平面运动控制。

发明内容

本发明是为了实现在通信时滞情况下，控制欠驱动无人水下航行器平稳达到指定深度，从而提供一种基于T-S模糊时滞模型的欠驱动UUV垂直面控制方法。

基于T-S模糊时滞模型的欠驱动UUV垂直面控制方法，它由以下步骤实现：

步骤一、初始化UUV，获取初始状态信息当前深度、俯仰角和下潜速度；

步骤二、运动控制计算机接收深度指令，结合传感器反馈的初始状态信息输入T-S模糊时滞数学模型求解出控制器状态反馈系数；

步骤三、控制器通过解算当前传感器反馈的实时状态信息，输出舵角控制指令；

步骤四、舵机执行控制指令，完成UUV深度控制，并判断是否达到指定深度，如果判断结果为是，则结束本次下潜任务；如果判断结果为否，则返回执行步骤三；

实现欠驱动UUV垂直面在时滞状态下的闭环运动控制。

步骤二中所述的T-S模糊时滞数学模型采用UUV垂直面模糊时滞数学模型实现，所述UUV垂直面模糊时滞数学模型具体为：

步骤A1、建立UUV垂直面数学模型：

假设UUV的轴向速度为恒定值，所有横向参数都为零，且系统有且只有一个控制输入，即：水平舵舵角δ_s；

则其运动学和动力学方程表示为：

$> (\begin{matrix} m [\overset{\cdot}{w} - u q - x_{G} \overset{\cdot}{q} - z_{G} q^{2}] = Z_{\overset{\cdot}{q}} \overset{\cdot}{q} + Z_{\overset{\cdot}{w}} \overset{\cdot}{w} + Z_{u q} u q + Z_{u w} u w + Z_{w | w |} w | w | + Z_{q | q |} q | q | \\ + (W - B_{0}) \cos θ + Z_{u u} u^{2} δ_{s} \end{matrix})$ >

$> (\begin{matrix} I_{y y} + m [x_{G} (u q - \overset{\cdot}{w}) + z_{G} w q] = M_{\overset{\cdot}{q}} \overset{\cdot}{q} + M_{\overset{\cdot}{w}} \overset{\cdot}{w} + M_{u q} u q + M_{u w} u w + M_{w | w |} w | w | \\ + M_{q | q |} q | q | - (x_{G} W - x_{B} B_{0}) \cos θ - (z_{G} W - z_{B} B_{0}) \sin θ + M_{u u} u^{2} δ_{s} \end{matrix})$ >

$> \overset{\cdot}{z} = w >cosθ-u>sinθ>> \overset{\cdot}{θ} = q - - - (1) >式中：m为UUV的质量，q为纵倾角速度，为纵倾角的加速度，θ为纵倾角，w为基于艇体坐标系的下潜速度，为基于艇体坐标系的下潜加速度，I yy 为关于纵倾角的转动惯量，u为UUV的巡航速度，z为UUV的深度，为基于固定坐标系下潜速度，W和B 0 分别为的重力和浮力， Z uq 、Z uw 、Z w|w| 、Z q|q| 、Z uu 、 M uq 、M uw 、M w|w| 、M q|q| 、M uu 为的水动力参数；(x G ，y G ，z G)和(x B ，y B ，z B)分别为UUV的重心和浮力中心。忽略二阶系数且令(x G ，y G ，z G)＝(x B ，y B ，z B)＝0，x＝(wqθz) T ，u(t)＝δ s (t)则式(1)线性化的方程组为：> W \overset{\cdot}{x} (t) = A x (t) + B u (t) - - - (2) >其中：> W = (\begin{matrix} m - Z_{\overset{\cdot}{w}} & - Z_{\overset{\cdot}{q}} & 0 & 0 \\ - M_{\overset{\cdot}{w}} & I_{y y} - M_{\overset{\cdot}{q}} & 0 & 0 \\ 0 & 0 & 1 & 0 \\ 0 & 0 & 0 & 1 \end{matrix}) >> A = (\begin{matrix} Z_{u w} u & Z_{u q} + m u & 0 & 0 \\ M_{u w} u & M_{u q} u & 0 & 0 \\ 0 & 1 & 0 & 0 \\ 1 & 0 & - u & 0 \end{matrix}) >> B = (\begin{matrix} Z_{u u} u^{2} \\ M_{u u} u^{2} \\ 0 \\ 0 \end{matrix}); >步骤A2、建立UUV垂直面模糊时滞数学模型：根据(1)中的UUV垂直面的数学模型，结合信息从传感器到控制器的时滞为τ sc ，控制器到执行机构时滞为τ ca ；令τ＝τ sc +τ ca 建立UUV垂直面时滞模型为：> \overset{\cdot}{x} (t) = \overline{A} x (t) + {\overline{A}}_{d} x (t - τ) + \overline{B} u (t) - - - (3) >式中： β为UUV垂直面通信时滞系数；令x τ ＝x(t-τ)有以下T-S模糊规则：规则1：当航速u＝U 1 ，则规则2：当航速u＝U 2 ，则……规则n：当航速u＝U n ，则则有UUV垂直面T-S模糊时滞模型的状态方程：> \overset{\cdot}{x} = Σ_{i = 1}^{n} λ_{i} (ξ (t)) {{\overline{A}}_{i} x + {\overline{A}}_{d i} x_{τ} + {\overline{B}}_{i} u} >其中：λ i (ξ(t))为模糊规则间的隶属函数且本发明涉及的一种基于T-S模糊时滞模型的欠驱动UUV垂直面控制方法的工作原理：运动控制计算机在接收到深度指令后，将UUV的俯仰角、航速初始状态输入T-S模糊时滞模型计算出状态反馈系数输入控制器，控制器系统通过接收当前时刻t和滞后τ sc 时刻(t-τ sc 时刻)反馈的状态信息计算出相应的舵角，下达舵角指令控制执行机构，执行机构执行滞后τ ca 时刻(t-τ ca 时刻)形成闭环系统控制UUV达到指定深度。本发明的优点在于通过建立欠驱动UUV垂直面T-S模糊时滞模型设计控制器，解决UUV垂直面在通信时滞状态下的深度控制。附图说明图1欠驱动UUV网络硬件结构图；图2欠驱动UUV的控制方法示意图；图3UUV垂直面控制系统工作流程图；具体实施方式具体实施方式一、结合图3，一种基于T-S模糊时滞模型的欠驱动UUV垂直面控制具体实施步骤可描述为：1、初始化UUV，获取初始状态信息当前深度、俯仰角；2、运动控制计算机接收深度指令，结合传感器反馈的初始状态信息输入T-S模糊时滞模型求解出控制器状态反馈系数。3、控制器通过解算当前传感器反馈的实时状态信息，输出舵角控制指令；4、舵机执行控制指令，完成UUV深度控制，若达到指定深度则结束，若没有则转至步骤3。如此形成闭环控制系统实现欠驱动UUV垂直面在时滞状态下的运动控制。欠驱动UUV垂直面在网络通信时滞状态下的控制包含了硬件结构的搭建、T-S模糊时滞模型的建立、控制器的解算，结合附图对本发明详细的描述：结合图1，搭建的UUV垂直面的网络硬件结构图。多普勒计程仪、可编程运动控制器、深度传感器、姿态传感器组成UUV垂直面的传感器系统；ARM和运动控制计算机组成UUV垂直面的控制器系统；可编程运动控制器和水平舵组成UUV垂直面的执行机构。传感器系统提供俯仰角、航速、深度信息，这些信息通过串口发送给运动控制计算机。运动控制计算机在接收到数据后进行相应的模数转换并结算出舵角指令，同时通过以太网输出舵角指令给ARM后控制执行机构控制UUV的深度。结合图2，建立T-S模糊时滞模型。本发明研究欠驱动UUV的垂直面运动。假设UUV的轴向速度为恒定值，所有横向参数都为零，且系统有且只有一个控制输入，即水平舵舵角δ s 。其运动学和动力学方程可表示为：> (\begin{matrix} m [\overset{\cdot}{w} - u q - x_{G} \overset{\cdot}{q} - z_{G} q^{2}] = Z_{\overset{\cdot}{q}} \overset{\cdot}{q} + Z_{\overset{\cdot}{w}} \overset{\cdot}{w} + Z_{u q} u q + Z_{u w} u w + Z_{w | w |} w | w | + Z_{q | q |} q | q | \\ + (W - B_{0}) \cos θ + Z_{u u} u^{2} δ_{s} \end{matrix}) >> (\begin{matrix} I_{y y} + m [x_{G} (u q - \overset{\cdot}{w}) + z_{G} w q] = M_{\overset{\cdot}{q}} \overset{\cdot}{q} + M_{\overset{\cdot}{w}} \overset{\cdot}{w} + M_{u q} u q + M_{u w} u w + M_{w | w |} w | w | \\ + M_{q | q |} q | q | - (x_{G} W - x_{B} B_{0}) \cos θ - (z_{G} W - z_{B} B_{0}) \sin θ + M_{u u} u^{2} δ_{s} \end{matrix}) >> \overset{\cdot}{z} = w >cosθ-u>sinθ>> \overset{\cdot}{θ} = q - - - (1) >式中，m为UUV的质量，q为纵倾角速度，为纵倾角的加速度，θ为纵倾角，w为基于艇体坐标系的下潜速度，为基于艇体坐标系的下潜加速度，I yy 为关于纵倾角的转动惯量，u为UUV的巡航速度，z为UUV的深度，为基于固定坐标系下潜速度，W和B 0 分别为的重力和浮力， Z uq 、Z uw 、Z w|w| 、Z q|q| 、Z uu 、 M uq 、M uw 、M w|w| 、M q|q| 、M uu 为的水动力参数；(x G ，y G ，z G)和(x B ，y B ，z B)分别为UUV的重心和浮力中心。忽略二阶系数且令(x G ，y G ，z G)＝(x B ，y B ，z B)＝0，x＝(wqθz) T ，u(t)＝δ s (t)则将式(1)线性化可的方程组为> W \overset{\cdot}{x} (t) = A x (t) + B u (t) - - - (2) >其中：> W = (\begin{matrix} m - Z_{\overset{\cdot}{w}} & - Z_{\overset{\cdot}{q}} & 0 & 0 \\ - M_{\overset{\cdot}{w}} & I_{y y} - M_{\overset{\cdot}{q}} & 0 & 0 \\ 0 & 0 & 1 & 0 \\ 0 & 0 & 0 & 1 \end{matrix}) >> A = (\begin{matrix} Z_{u w} u & Z_{u q} + m u & 0 & 0 \\ M_{u w} u & M_{u q} u & 0 & 0 \\ 0 & 1 & 0 & 0 \\ 1 & 0 & - u & 0 \end{matrix}) >> B = (\begin{matrix} Z_{u u} u^{2} \\ M_{u u} u^{2} \\ 0 \\ 0 \end{matrix}) >在图2中有信息从传感器到控制器的时滞为τ sc ，控制器到执行机构时滞为τ ca 。令τ＝τ sc +τ ca 建立UUV垂直面时滞模型为> \overset{\cdot}{x} (t) = \overline{A} x (t) + {\overline{A}}_{d} x (t - τ) + \overline{B} u (t) - - - (3) >其中 β为UUV垂直面通信时滞系数。令x τ ＝x(t-τ)有以下T-S模糊规则：规则1：如果航速u＝U 1 ，则规则2：如果航速u＝U 2 ，则……规则n:如果航速u＝U n ，则于是有UUV垂直面T-S模糊时滞模型的状态方程：> \overset{\cdot}{x} = Σ_{i = 1}^{n} λ_{i} (ξ (t)) {{\overline{A}}_{i} x + {\overline{A}}_{d i} x_{τ} + {\overline{B}}_{i} u} >其中λ i (ξ(t))为模糊规则间的隶属函数且针对每个模糊规则设计模糊状态反馈控制器有：> u = Σ_{i = 1}^{n} λ_{i} (ξ (t)) K_{i} x_{i} (t) >选择适当的Lyapunov函数，通过LMI求解出相应的状态反馈系数。去获取专利，查看全文>相似文献专利中文文献外文文献 1. 基于T-S模糊时滞模型的欠驱动UUV垂直面控制方法 [P] . 中国专利：
CN105573327B . 2018.07.17 2. 基于T-S模糊时滞模型的欠驱动UUV垂直面控制方法 [P] . 中国专利：
CN105573327A . 2016-05-11 3. UNMANNED SURFACE VEHICLE CONTROL METHOD BASED ON SWITCHING T-S FUZZY SYSTEM UNDER DOS ATTACK [P] . WO2022000945A1 . 2022-01-06 机译：基于切换T-S模糊系统的无人曲面车辆控制方法 4. APPARATUSES AND METHODS FOR MACHINE VISION SYSTEMS INCLUDING CREATION OF A POINT CLOUD MODEL AND/OR THREE DIMENSIONAL MODEL BASED ON MULTIPLE IMAGES FROM DIFFERENT PERSPECTIVES AND COMBINATION OF DEPTH CUES FROM CAMERA MOTION AND DEFOCUS WITH VARIOUS APPLICATIONS INCLUDING NAVIGATION SYSTEMS, AND PATTERN MATCHING SYSTEMS AS WELL AS ESTIMATING RELATIVE BLUR BETWEEN IMAGES FOR USE IN DEPTH FROM DEFOCUS OR AUTOFOCUSING APPLICATIONS [P] . 美国专利：

US2019122378A1 . 2019-04-25 机译：机器视觉系统的装置和方法，包括建立点云模型和/或三维模型，该模型基于不同角度的多个图像并结合了来自摄像机运动和深度的深度信息以及包含导航系统的各种应用程序，包括导航系统估计深度模糊或自动对焦应用中使用的图像之间的相对模糊 5. INTERACTIVE T-S FUZZY SEMANTIC MODEL ESTIMATION METHOD AND SYSTEM, AND COMPUTER READABLE STORAGE MEDIUM [P] . 世界知识产权组织专利：

WO2020113354A1 . 2020-06-11 机译：交互式t-s模糊语义模型估计方法，系统及计算机可读存储介质 1. 基于模糊Lyapunov-Krasovskii函数的离散时滞T-S模糊模型的非二次镇定条件 [J] . 王仁明,肖建修,潘俊涛 . 三峡大学学报（自然科学版） . 2006,第006期 2. 参数摄动下基于积分滑模的欠驱动UUV轨迹跟踪控制方法 [J] . 严浙平,李响,宋育武 . 鱼雷技术 . 2018,第003期 3. 参数摄动下基于积分滑模的欠驱动UUV轨迹跟踪控制方法 [J] . 严浙平1,李响1,宋育武2 . 水下无人系统学报 . 2018,第003期 4. 基于T-S模型的模糊时滞系统混杂输出控制 [J] . 杨红,李猛,宋健 . 沈阳大学学报 . 2016,第001期 5. 基于 T-S 模型的多时滞模糊系统的非易碎 H∞控制 [J] . 徐颖 . 科技创新与应用 . 2014,第033期 6. 基于T-S模糊模型的非线性时滞系统的稳定性分析 [C] . 罗俊芝,易良海,刘艳霞 . 2008年国防科技工业与数学学术研讨会 . 2008 7. 含状态时滞的欠驱动UUV深度控制方法研究 [A] . 肖遥 . 2017 1. Movement Control in Recovering UUV Based on Two-Stage Discrete T-S Fuzzy Model [J] . ZhepingYan, BingHao, YiboLiu, Discrete dynamics in nature and society
. 2014,第1期机译：基于两阶段离散T-S模糊模型的UUV恢复运动控制 2. Delay-dependent exponential H ∞ ${H_{infty}}$ filter for uncertain nonlinear singular time-delay systems through T-S fuzzy model [J] . Yuechao Ma, Menghua Chen Advances in Difference Equations
. 2015,第1期机译：基于T-S模糊模型的不确定非线性奇异时滞系统的时滞相关指数H∞$ {H _ { infty}} $滤波器 3. Application of fuzzy H{sup}∞ control via T-S fuzzy models for nonlinear time-delay systems [J] . Feng-Hsiag Hsiao, Wei-Ling Chiang, Cheng-Wu Chen International Journal of Artificial Intelligence Tools: Architectures, Languages, Algorithms
. 2003,第2期机译：基于T-S模糊模型的模糊H {sup}∞控制在非线性时滞系统中的应用 4. H_∞ Robust Fault-Tolerant Control for a Class of Uncertain Nonlinear Singular Systems with Time Delay Based on T-S Fuzzy Models [C] . Zuoyou Yin, Wenjin Zheng, Xiaoheng Chang, Chinese Control and Decision Conference
. 2013 机译：基于T-S模糊模型的时滞时滞的一类不确定非线性奇异系统强大的容错控制 5. Robust Hinfinity Model Reference Tracking Control of Singular Systems Using T-S Fuzzy Model and LMI [D] . Rohit, Shamendu Roy. 2014 机译：基于T-S模糊模型和LMI的鲁棒Hinfinity模型参考跟踪控制 6. Delay-dependent stability and stabilization criteria for T–S fuzzy singular systems with interval time-varying delay by improved delay partitioning approach [O] . Chao Sun, Fuli Wang, Xiqin He -1 机译：时滞时滞的TS模糊奇异系统的时滞相关稳定性和镇定准则 7. Delay-dependent exponential filter for uncertain nonlinear singular time-delay systems through T-S fuzzy model [O] . 2015 机译：基于T-S模糊模型的不确定非线性奇异时滞系统的时滞依赖指数滤波器 8. Approach to Synchronization Control of Magnetic Bearings Using Fuzzy Logic [R] . Yang, Li-Farn 1996 机译：基于模糊逻辑的磁力轴承同步控制方法获取专利意见反馈回到顶部回到首页关于掌桥资源导航新手指南常见问题网站地图版权声明客服邮箱：kefu@zhangqiaokeyan.com 京公网安备：11010802029741号 ICP备案号：京ICP备15016152号-6 六维联合信息科技 (北京) 有限公司©版权所有客服微信服务号$