CN113342010A - 一种自触发通信的水下滑翔机协同控制系统 - Google Patents

一种自触发通信的水下滑翔机协同控制系统 Download PDF

Info

Publication number
CN113342010A
CN113342010A CN202110620072.6A CN202110620072A CN113342010A CN 113342010 A CN113342010 A CN 113342010A CN 202110620072 A CN202110620072 A CN 202110620072A CN 113342010 A CN113342010 A CN 113342010A
Authority
CN
China
Prior art keywords
underwater
underwater glider
path
self
module
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202110620072.6A
Other languages
English (en)
Other versions
CN113342010B (zh
Inventor
王浩亮
柴亚星
刘陆
王丹
孙才勤
王天霖
彭周华
古楠
张义博
卢丽宇
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Dalian Maritime University
Original Assignee
Dalian Maritime University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Dalian Maritime University filed Critical Dalian Maritime University
Priority to CN202110620072.6A priority Critical patent/CN113342010B/zh
Publication of CN113342010A publication Critical patent/CN113342010A/zh
Application granted granted Critical
Publication of CN113342010B publication Critical patent/CN113342010B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/04Control of altitude or depth
    • G05D1/06Rate of change of altitude or depth
    • G05D1/0692Rate of change of altitude or depth specially adapted for under-water vehicles
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02PCLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
    • Y02P90/00Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
    • Y02P90/02Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明公开了一种自触发通信的水下滑翔机协同控制系统,包括路径跟踪制导模块用于计算水下滑翔机的给定纵向速度、俯仰角速度以及纵向跟踪误差;协同模块用于计算水下滑翔机的协同路径参数信息;低频学习与模糊控制模块用于计算纵向速度误差、俯仰角速度误差的估计值;动力学控制模块用于计算水下滑翔机在纵向、俯仰方向运动的控制参数;自触发事件模块用于设计触发条件,判断是否满足触发条件,当满足触发条件时,水下滑翔机之间进行信息交互并计算下一触发时间;通信网络用于建立水下滑翔机之间进行信息传递的通信结构。应用于多水下滑翔机并实现协同潜水控制,通信策略采用自触发通信,大大减少了因不间断通信带来的不必要的机载能量消耗。

Description

一种自触发通信的水下滑翔机协同控制系统
技术领域
本发明涉及水下滑翔机控制领域,尤其涉及一种自触发通信的水下滑翔机协同控制系统。
背景技术
在过去几十年里,随着自主海洋航行器的迅速发展,其运动控制问题一直是众多学者研究的热点。水下滑翔机通过搭载不同功能的传感器执行海洋任务,由于载荷能力弱、航速低,所以单台水下滑翔机的观测或探测功能相对单一,单位时间的作业范围非常有限。多水下滑翔机以集群的形式协同作业可大大提高其执行复杂任务的综合能力,将成为未来近海岸及深远海移动观测与探测的重要技术手段之一,也是水下滑翔机的必然发展趋势。
目前,在水下滑翔机的路径跟踪控制方面,已有学者提出了许多可行的路径跟踪控制方法,但现有控制方法仍存在以下问题:
第一,现有水下滑翔机协同潜水控制方案通常采用周期性通信策略,而在实际水下作业时,水下滑翔机通常采用水声信道进行通信。由于水声通信具有窄带宽、高噪声、长延迟等问题,使得缺乏有效的通信链路成为多水下滑翔机协同面临的一个重要挑战。
第二,现有水下航行器控制研究大多局限于单水下航行器控制,但是由于水下航行器存在载荷能力弱、航速低等特点,使得单台海洋航行器的观测或探测功能相对单一,单位时间的作业范围非常有限。
第三,现有水下滑翔机动力学系统存在模型不确定性、输入受限和海洋环境扰动等问题,使得水下滑翔机在沿参数化路径运动时存在一定的难度。
发明内容
本发明提供一种自触发通信的水下滑翔机协同控制系统,以克服上述技术问题。
一种自触发通信的水下滑翔机协同控制系统,其特征在于,包括通信网络、水下滑翔机、路径跟踪制导模块、协同模块、低频学习与模糊控制模块、动力学控制模块、自触发事件模块,
路径跟踪制导模块用于获取水下滑翔机的位置、航向、速度以及给定路径信息,计算水下滑翔机的给定纵向速度、俯仰角速度以及纵向跟踪误差;
协同模块用于获取水下滑翔机的邻居的路径参数和纵向跟踪误差信息,计算水下滑翔机的协同路径参数信息;
低频学习与模糊控制模块用于获取给定纵向速度、俯仰角速度,水下滑翔机的纵向速度和俯仰角速度,计算纵向速度误差、俯仰角速度误差的估计值;
动力学控制模块用于获取给定纵向速度、俯仰角速度,纵向速度误差、俯仰角速度误差的估计值,有界权值,计算水下滑翔机在纵向、俯仰方向运动的控制参数;
自触发事件模块用于获取水下滑翔机在当前触发时间的基于自身估计的路径参数、基于邻居水下滑翔机估计的路径参数,设计触发条件,判断是否满足触发条件,当满足触发条件时,水下滑翔机之间进行信息交互并计算下一触发时间;
通信网络用于建立水下滑翔机之间进行信息传递的通信结构;
路径跟踪制导模块共三个输入端,其中两个输入端分别与水下滑翔机的输出端、协同模块的一个输出端相连,第三个输入端为给定的参考路径信号,路径跟踪制导模块的两个输出端分别与自触发事件模块的输入端、动力学控制模块的一个输入端相连;
协同模块的三个输入端分别与路径跟踪制导模块的一个输出端、通信网络的输出端和经过触发后的自触发事件模块相连;
低频学习与模糊控制模块的两个输入端分别与路径跟踪制导模块的一个输出端、水下滑翔机的输出端相连;低频学习与模糊控制模块的输出端与动力学控制模块的一个输入端相连;
动力学控制模块的输出端与水下滑翔机的输入端相连;自触发事件模块的输出端与触发开关相连。
优选地,计算水下滑翔机的给定纵向速度、俯仰角速度以及纵向跟踪误差是通过公式(1)、(2)进行计算,
Figure BDA0003099467140000031
xie=[xi-xidi)]cosθid-[zi-zidi)]sinθid (2)
其中,xi、zi为水下滑翔机的位置信号,θi为航向信号,ui、qi为速度信号以及xid、zid为给定路径信号,uiu、qiq与θ分别为给定纵向速度信号、俯仰角速度信号和俯仰角信号;xie、zie、θie分别表示水下滑翔机的纵向跟踪误差、垂向跟踪误差和俯仰角误差;
Figure BDA0003099467140000032
分别为纵向速度误差uie、俯仰角速度误差qie的估计值;
Figure BDA0003099467140000033
θid为预定义路径的切线角;
Figure BDA0003099467140000034
为路径参数更新速度,
Figure BDA0003099467140000035
分别为给定参数化路径xidi)、zidi)的偏导数;vs是路径参数χi的路径更新速度;
Figure BDA0003099467140000036
Figure BDA0003099467140000037
Figure BDA0003099467140000038
是水下滑翔机的总速度;ki1,ki2,Δix和Δ为正常数;
Figure BDA0003099467140000039
优选地,计算水下滑翔机的协同路径参数信息是通过公式(3)计算,
Figure BDA00030994671400000310
其中μi为正常数,自触发协同误差
Figure BDA00030994671400000311
Figure BDA00030994671400000312
Figure BDA00030994671400000313
为第i个水下滑翔机基于自身估计的路径参数,χj表示第j个水下滑翔机基于第i个水下滑翔机估计的路径参数;
Figure BDA00030994671400000314
为当前触发时间;
Figure BDA00030994671400000315
为下一触发时间,vs是路径参数χi的路径更新速度,ωi为协同路径参数。
优选地,计算纵向速度误差、俯仰角速度误差的估计值是通过公式(4)进行计算,
Figure BDA00030994671400000316
其中βiuiu)和βiqiq)是已知连续隶属函数,其满足
Figure BDA00030994671400000317
Figure BDA00030994671400000318
这里
Figure BDA00030994671400000319
Figure BDA00030994671400000320
是正常数;ki3∈R,ki4∈R,Kiu∈R和Kiq∈R是正常数;
Figure BDA00030994671400000321
分别为纵向速度误差uie、俯仰角速度误差qie的估计值,
Figure BDA00030994671400000322
Figure BDA00030994671400000323
Figure BDA00030994671400000331
Figure BDA00030994671400000324
为有界权值,用来通过模糊系统对系统动态进行估计;
Figure BDA00030994671400000325
Figure BDA00030994671400000326
分别是
Figure BDA00030994671400000327
Figure BDA00030994671400000328
的估计值。
优选地,
Figure BDA00030994671400000329
Figure BDA00030994671400000330
的计算过程为,
Figure BDA0003099467140000041
Figure BDA0003099467140000042
为水下滑翔机在升沉、俯仰方向上的总扰动,fiu(t,ui,wi,θi,qi)和fiq(t,ui,wi,θi,qi)分别代表在纵向和俯仰方向上与水动力阻尼效应有关的非线性函数,diu、diq分别为水下滑翔机在纵向、俯仰方向上的外部环境扰动,miu、miq分别表示水下滑翔机在纵向、俯仰方向上的惯性矩阵,用模糊系统对其进行逼近,给定
Figure BDA0003099467140000043
Figure BDA0003099467140000044
则存在有界权值
Figure BDA0003099467140000045
Figure BDA0003099467140000046
定义:
Figure BDA0003099467140000047
其中εiu和εiq是估计偏差,其满足
Figure BDA0003099467140000048
Figure BDA0003099467140000049
Figure BDA00030994671400000410
其中
Figure BDA00030994671400000411
Figure BDA00030994671400000412
是用来估计
Figure BDA00030994671400000413
Figure BDA00030994671400000414
的低通滤波器权值;σiu,σiq
Figure BDA00030994671400000415
Figure BDA00030994671400000416
是正常数;Proj[]表示投影算子。
优选地,计算水下滑翔机在纵向、俯仰方向上运动的控制参数是通过公式(7)进行计算,
Figure BDA00030994671400000417
其中
Figure BDA00030994671400000418
Figure BDA00030994671400000419
Δiu∈R,Δiq∈R为正常数;
Figure BDA00030994671400000420
当biu≥0时,sign(biu)=1,当biu<0时,sign(biu)=-1;
Figure BDA00030994671400000421
当biq≥0时,sign(biq)=1,当biq<0时,sign(biq)=-1,εiu∈R和εiq∈R都是正常数,分别用来处理当biu=0或biq=0时的奇异性,Tiu和Tiq分别为水下滑翔机在纵向、俯仰方向运动的控制参数。
优选地,计算下一触发时间是通过公式(8)进行计算,
Figure BDA00030994671400000422
其中α1>0,β1>0,α2>0,β2>0;定义第一次触发时间
Figure BDA0003099467140000051
Figure BDA0003099467140000052
Figure BDA0003099467140000053
本发明提供一种自触发通信的水下滑翔机协同控制系统,与现有采用周期性通信策略进行多水下滑翔机的信息交互方法相比,本发明的一种自触发通信策略,使得每个水下滑翔机只需要在自身的触发时间进行传送,并在它们的触发时间听取并接收到来自邻居水下滑翔机的接下来的信息,这样就克服了连续监听的问题,同时降低了通信频率。
与现有针对单水下滑翔机的控制器相比,本发明通过采用多水下滑翔机的协同潜水控制策略,使得所提出的协同控制方法适用于多水下滑翔机,拓展了水下滑翔机的应用范围,使得该协同控制系统更有利于实际应用。
本发明提出了基于低频学习策略的模糊估计模块,用于提取不确定和干扰的高频分量,并实现快速自适应;采用低频学习方案和模糊控制方法估计内部不确定性和外部环境干扰,并利用该方法为每个水下滑翔机建立非线性自适应动力学控制律。
综上所述,本发明可应用于多水下滑翔机并能实现协同潜水控制,更重要的是通信策略采用自触发通信,大大减少了因不间断通信带来的不必要的机载能量消耗。而且控制系统采用低频学习与模糊控制的模块化设计,显著降低了控制系统的复杂性、减少了计算负荷、易于工程实现。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作一简单地介绍,显而易见地,下面描述中的附图是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。
图1是本发明自触发通信的水下滑翔机协同控制系统结构示意图;
图2是本发明三艘水下滑翔机通信网络结构示意图;
图3是本发明三艘水下滑翔机协同运动轨迹示意图;
图4是本发明三艘水下滑翔机协同路径参数曲线图;
图5是本发明三艘水下滑翔机纵向、垂向位置误差曲线图;
图6是本发明1号水下滑翔机自触发通信与事件触发通信对比图;
图7是本发明三艘水下滑翔机扰动估计性能图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
图1为本发明自触发通信的水下滑翔机协同控制系统结构示意图,如图1所示,本实施例可以包括:
一种自触发通信的水下滑翔机协同控制系统,包括通信网络、水下滑翔机、路径跟踪制导模块、协同模块、低频学习与模糊控制模块、动力学控制模块、自触发事件模块。
通信网络为基于自触发通信机制的通信网络,用于建立水下滑翔机之间进行信息传递的通信结构。多个水下滑翔机协同潜水时,各水下滑翔机间的通信结构可由图G={V,E}表示。其中V={n1,…,nN}为节点集合,每个无人船对应一个节点。E={(ni,nj)∈V×V}为任意两个节点的无序对集合,表示第i艘水下滑翔机和第j艘水下滑翔机之间存在信息传递,称为边集,边(ni,nj)表示节点间的通信关系。图的邻接矩阵记作
Figure BDA0003099467140000061
并满足
Figure BDA0003099467140000062
欠驱动圆碟形水下滑翔机的运动学模型为:
Figure BDA0003099467140000063
动力学模型为:
Figure BDA0003099467140000064
式中下标i表示第i艘水下滑翔机;ui、wi、qi分别为水下滑翔机的纵向速度、垂向速度和俯仰角速度;xi、zi、θi分别为水下滑翔机在纵向、垂向和俯仰方向的位置信息;biu、biq分别为水下滑翔机在纵向、俯仰方向上的未知控制增益,其与水下滑翔机质量相关;diu、diw、diq分别为水下滑翔机在纵向、垂向、俯仰方向上的外部环境扰动;Tiu和Tiq分别为水下滑翔机在纵向、俯仰方向上运动的控制参数;fiu(t,ui,wi,θi,qi)、fiw(t,ui,wi,θi,qi)和fiq(t,ui,wi,θi,qi)分别代表在纵向、垂向和俯仰方向上与水动力阻尼效应有关的非线性函数。miu、miw、miq分别表示水下滑翔机在纵向、垂向、俯仰方向上的惯性矩阵。
路径跟踪制导模块共三个输入端,其中两个输入端分别与水下滑翔机的输出端、协同模块的一个输出端相连,第三个输入端为给定的参考路径信号;路径跟踪制导模块的另外两个输出端分别与自触发事件模块的输入端、动力学控制模块的一个输入端相连。
路径跟踪制导模块的输入信号包括水下滑翔机的位置信号xi、zi,航向信号θi,速度信号ui、qi以及给定路径信号xid、zid;经计算,所述的路径跟踪制导模块的输出信号uiu、qiq表示为:
Figure BDA0003099467140000071
路径跟踪制导模块的输出信号xie设计如下:
xie=[xi-xidi)]cosθid-[zi-zidi)]sinθid (5)
其中,uiu、qiq与θ分别为给定的纵向速度信号、俯仰角速度信号和俯仰角信号;xie、zie、θie分别表示水下滑翔机的纵向跟踪误差、垂向跟踪误差和俯仰角误差;
Figure BDA0003099467140000072
分别为纵向速度误差uie、俯仰角速度误差qie的估计值;
Figure BDA0003099467140000073
θid为预定义路径的切线角;
Figure BDA0003099467140000074
为路径参数更新速度,x′idi)、z′idi)分别为给定参数化路径xidi)、zidi)的偏导数;vs是路径参数χi的路径更新速度;
Figure BDA0003099467140000076
Figure BDA0003099467140000077
Figure BDA0003099467140000078
是水下滑翔机的总速度;ki1,ki2,Δix和Δ为正常数;
Figure BDA0003099467140000079
协同模块的三个输入端分别与路径跟踪制导模块的一个输出端、通信网络的输出端和经过触发后的自触发事件模块相连;
协同模块的输入信号为第i个水下滑翔机的邻居的路径参数信息和路径跟踪制导模块输出的第i个水下滑翔机的纵向位置误差xie,所述的协同模块的输出信号ωi的设计如下:
Figure BDA0003099467140000081
其中μi为正常数;自触发协同误差
Figure BDA0003099467140000082
Figure BDA0003099467140000083
Figure BDA0003099467140000084
Figure BDA0003099467140000085
为第i个水下滑翔机基于自身估计的路径参数,
Figure BDA0003099467140000086
表示第j个水下滑翔机基于第i个水下滑翔机估计的路径参数;
Figure BDA0003099467140000087
为当前触发时间;
Figure BDA0003099467140000088
为下一触发时间,ωi为协同路径参数。
低频学习与模糊控制模块的两个输入端分别与路径跟踪制导模块的一个输出端、水下滑翔机的输出端相连;低频学习与模糊控制模块的输出端与动力学控制模块的一个输入端相连。低频学习与模糊控制模块的输入信号为路径跟踪制导模块的输出信号uiu、qiq,及水下滑翔机的输出信号ui、qi,所述的低频学习与模糊控制模块的输出信号
Figure BDA0003099467140000089
设计如下:
Figure BDA00030994671400000810
其中βiuiu)和βiqiq)是已知连续隶属函数,其满足
Figure BDA00030994671400000811
Figure BDA00030994671400000812
这里
Figure BDA00030994671400000813
Figure BDA00030994671400000814
是正常数;ki3∈R,ki4∈R,Kiu∈R和Kiq∈R是正常数;
Figure BDA00030994671400000815
Figure BDA00030994671400000816
Figure BDA00030994671400000836
Figure BDA00030994671400000837
为有界权值,用来实现模糊系统对系统动态的估计;
Figure BDA00030994671400000819
Figure BDA00030994671400000820
分别是
Figure BDA00030994671400000821
Figure BDA00030994671400000822
的估计值。
Figure BDA00030994671400000823
Figure BDA00030994671400000824
为水下滑翔机在升沉、俯仰方向上的总扰动。本发明用模糊系统对其进行逼近,给定
Figure BDA00030994671400000825
Figure BDA00030994671400000826
则存在有界权值
Figure BDA00030994671400000835
Figure BDA00030994671400000828
定义:
Figure BDA00030994671400000829
其中εiu和εiq是估计偏差,其满足
Figure BDA00030994671400000830
Figure BDA00030994671400000831
所述的低频学习与模糊控制模块的输出信号
Figure BDA00030994671400000832
Figure BDA00030994671400000833
的设计如下:
Figure BDA00030994671400000834
其中
Figure BDA0003099467140000091
Figure BDA0003099467140000092
是用来估计
Figure BDA0003099467140000093
Figure BDA0003099467140000094
的低通滤波器权值;σiu,σiq
Figure BDA0003099467140000095
Figure BDA0003099467140000096
是正常数;Proj[]表示投影算子。
动力学控制模块的输出端与水下滑翔机的输入端相连。动力学模块控制的输入信号为路径跟踪制导模块的输出信号uiu、qiq以及低频学习与模糊控制模块的输出信号
Figure BDA0003099467140000097
Figure BDA0003099467140000098
动力学控制模块设计为:
Figure BDA0003099467140000099
其中
Figure BDA00030994671400000910
Figure BDA00030994671400000911
Δiu∈R,Δiq∈R为正常数;
Figure BDA00030994671400000912
当biu≥0时,sign(biu)=1,当biu<0时,sign(biu)=-1;
Figure BDA00030994671400000913
当biq≥0时,sign(biq)=1,当biq<0时,sign(biq)=-1。εiu∈R和εiq∈R都是正常数,分别用来处理当biu=0或biq=0时的奇异性。
自触发事件模块的输出端与触发开关相连,通过设计好的触发条件确定是否进行信息包的传播和接受,若满足触发条件则输出到协同模块的输入端和通信网络的输入端。
自触发事件模块的输入信号为路径跟踪制导模块的输出信号
Figure BDA00030994671400000914
和χi(t),所述的自触发事件模块的输出
Figure BDA00030994671400000915
设计如下:
Figure BDA00030994671400000916
其中α1>0,β1>0,α2>0,β2>0;定义第一次触发时间
Figure BDA00030994671400000917
Figure BDA00030994671400000918
Figure BDA00030994671400000919
实施例中以一个具体的三艘水下滑翔机协同控制为例对本发明进行进一步说明。图1所示为本发明的结构示意图,水下滑翔机协同控制中的每艘水下滑翔机都满足式(2)、(3)所示的运动学和动力学模型,三艘水下滑翔机协同潜水的通信网络结构如图2所示,1号水下滑翔机与2号水下滑翔机进行路径参数信息的相互交换;2号水下滑翔机与3号水下滑翔机进行信息的来回传递。
此例的控制目标是三艘水下滑翔机能够跟踪给定的参数化路径(xidi),zidi)),并保证协同潜水的任务,同时减少实时信息传递,降低不必要的通信频率。
本发明设计的模型的具体参数如下:
三个水下滑翔机的初始状态为:
(x1,y1,z1,θ1)=(0,0,0,0)
(x2,y2,z2,θ2)=(10,-16,-5,0)
(x3,y3,z3,θ3)=(20,16,-10,0)
水下滑翔机分别跟踪的三条参数化路径设计如下:
Figure BDA0003099467140000101
控制参数选择如下:
Ki1=diag{90,90,90},Ki2={2700,2700,2700},
Figure BDA0003099467140000102
Figure BDA0003099467140000103
Figure BDA0003099467140000104
li={0.0001,0.0001,0.0001},kix=0.2,k=0.2,kiu=4,kiq=2,
Figure BDA0003099467140000105
vs=0.1,μi=0.04,k=0.06
仿真结果如图3-7所示。图3是三艘水下滑翔机在垂直平面上基于状态反馈控制的协同运动轨迹,图中的实线为给定的参数化路径,虚线为三艘水下滑翔机的实际运动轨迹,从图中可以看出三艘水下滑翔机跟踪上了给定参考参数化路径,完成了协同控制任务。图4为三艘水下滑翔机的路径参数变化,从图中可以看出经过一段暂态调整过程,三艘水下滑翔机的路径参数趋于一致,达到了路径参数同步的控制效果。图5显示的是三艘水下滑翔机的纵向跟踪误差xie和垂向跟踪误差zie,可以看出经过一段时间后两者均可收敛到零值附近。图6描述了在自触发通信机制和事件触发通信机制下一号水下滑翔机的通信事件,可以看出,与事件触发不同的是,本发明所提出的自触发通信方案可以提前预知下一次触发时间,避免持续的信息监听。图7分别给出了升沉和俯仰方向的不确定性估计性能,可以看出所设计的模糊系统可以有效估计水下滑翔机的模型不确定性和外部环境扰动。
整体有的有益效果:
第一,与现有采用周期性通信策略进行多水下滑翔机的信息交互方法相比,本发明提出一种自触发通信策略,使得每个水下滑翔机只需要在自身的触发时间进行传送,并在它们的触发时间听取并接收到来自邻居水下滑翔机的接下来的信息,这样就克服了连续监听的问题,同时降低了通信频率。
第二,与现有针对单水下滑翔机的控制器相比,本发明通过采用多水下滑翔机的协同潜水控制策略,使得所提出的协同控制方法适用于多水下滑翔机,拓展了水下滑翔机的应用范围,使得该协同控制系统更有利于实际应用。
第三,本发明提出了基于低频学习策略的模糊估计模块,用于提取不确定和干扰的高频分量,并实现快速自适应;采用低频学习方案和模糊控制方法估计内部不确定性和外部环境干扰,并利用该方法为每个水下滑翔机建立非线性自适应动力学控制律。
第四,综上所述,本发明可应用于多水下滑翔机并能实现协同潜水控制,更重要的是通信策略采用自触发通信,大大减少了因不间断通信带来的不必要的机载能量消耗。采用低频学习与模糊控制模块的模块化设计,显著降低了控制系统结构的复杂性、减少了计算负荷、易于工程实现。
最后应说明的是:以上各实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述各实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分或者全部技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的范围。

Claims (7)

1.一种自触发通信的水下滑翔机协同控制系统,其特征在于,包括通信网络、水下滑翔机、路径跟踪制导模块、协同模块、低频学习与模糊控制模块、动力学控制模块、自触发事件模块,
路径跟踪制导模块用于获取水下滑翔机的位置、航向、速度以及给定路径信息,计算水下滑翔机的给定纵向速度、俯仰角速度以及纵向跟踪误差;
协同模块用于获取水下滑翔机的邻居的路径参数和纵向跟踪误差信息,计算水下滑翔机的协同路径参数信息;
低频学习与模糊控制模块用于获取给定纵向速度、俯仰角速度,水下滑翔机的纵向速度和俯仰角速度,计算纵向速度误差、俯仰角速度误差的估计值;
动力学控制模块用于获取给定纵向速度、俯仰角速度,纵向速度误差、俯仰角速度误差的估计值,有界权值,计算水下滑翔机在纵向、俯仰方向运动的控制参数;
自触发事件模块用于获取水下滑翔机在当前触发时间的基于自身估计的路径参数、基于邻居水下滑翔机估计的路径参数,设计触发条件,判断是否满足触发条件,当满足触发条件时,水下滑翔机之间进行信息交互并计算下一触发时间;
通信网络用于建立水下滑翔机之间进行信息传递的通信结构;
路径跟踪制导模块共三个输入端,其中两个输入端分别与水下滑翔机的输出端、协同模块的一个输出端相连,第三个输入端为给定的参考路径信号,路径跟踪制导模块的两个输出端分别与自触发事件模块的输入端、动力学控制模块的一个输入端相连;
协同模块的三个输入端分别与路径跟踪制导模块的一个输出端、通信网络的输出端和经过触发后的自触发事件模块相连;
低频学习与模糊控制模块的两个输入端分别与路径跟踪制导模块的一个输出端、水下滑翔机的输出端相连;低频学习与模糊控制模块的输出端与动力学控制模块的一个输入端相连;
动力学控制模块的输出端与水下滑翔机的输入端相连;自触发事件模块的输出端与触发开关相连。
2.根据权利要求1所述的一种自触发通信的水下滑翔机协同控制系统,其特征在于,所述计算水下滑翔机的给定纵向速度、俯仰角速度以及纵向跟踪误差是通过公式(1)、(2)进行计算,
Figure FDA0003099467130000021
xie=[xi-xidi)]cosθid-[zi-zidi)]sinθid (2)
其中,xi、zi为水下滑翔机的位置信号,θi为航向信号,ui、qi为速度信号以及xid、zid为给定路径信号,uiu、qiqθiθ分别为给定纵向速度信号、俯仰角速度信号和俯仰角信号;xie、zie、θie分别表示水下滑翔机的纵向跟踪误差、垂向跟踪误差和俯仰角误差;
Figure FDA0003099467130000022
分别为纵向速度误差uie、俯仰角速度误差qie的估计值;
Figure FDA0003099467130000023
θid为预定义路径的切线角;
Figure FDA0003099467130000024
为路径参数更新速度,x′idi)、z′idi)分别为给定参数化路径xidi)、zidi)的偏导数;vs是路径参数χi的路径更新速度;
Figure FDA0003099467130000025
Figure FDA0003099467130000026
是水下滑翔机的总速度;ki1,ki2,Δix和Δiθ为正常数;
Figure FDA0003099467130000027
3.根据权利要求1所述的一种自触发通信的水下滑翔机协同控制系统,其特征在于,所述计算水下滑翔机的协同路径参数信息是通过公式(3)计算,
Figure FDA0003099467130000028
其中μi为正常数,自触发协同误差
Figure FDA0003099467130000029
Figure FDA00030994671300000210
Figure FDA00030994671300000211
为第i个水下滑翔机基于自身估计的路径参数,
Figure FDA00030994671300000212
表示第j个水下滑翔机基于第i个水下滑翔机估计的路径参数;
Figure FDA00030994671300000213
为当前触发时间;
Figure FDA00030994671300000214
为下一触发时间,vs是路径参数χi的路径更新速度,ωi为协同路径参数。
4.根据权利要求1所述的一种自触发通信的水下滑翔机协同控制系统,其特征在于,所述计算纵向速度误差、俯仰角速度误差的估计值是通过公式(4)进行计算,
Figure FDA00030994671300000215
其中βiuiu)和βiqiq)是已知连续隶属函数,其满足
Figure FDA00030994671300000216
Figure FDA00030994671300000217
这里
Figure FDA0003099467130000031
Figure FDA0003099467130000032
是正常数;ki3∈R,ki4∈R,Kiu∈R和Kiq∈R是正常数;
Figure FDA0003099467130000033
分别为纵向速度误差uie、俯仰角速度误差qie的估计值,
Figure FDA0003099467130000034
Figure FDA0003099467130000035
Figure FDA0003099467130000036
为有界权值,用来通过模糊系统对系统动态进行估计;
Figure FDA0003099467130000037
Figure FDA0003099467130000038
分别是
Figure FDA0003099467130000039
Figure FDA00030994671300000310
的估计值。
5.根据权利要求4所述的一种自触发通信的水下滑翔机协同控制系统,其特征在于,所述
Figure FDA00030994671300000311
Figure FDA00030994671300000312
的计算过程为,
Figure FDA00030994671300000313
为水下滑翔机在升沉、俯仰方向上的总扰动,fiu(t,ui,wi,θi,qi)和fiq(t,ui,wi,θi,qi)分别代表在纵向和俯仰方向上与水动力阻尼效应有关的非线性函数,diu、diq分别为水下滑翔机在纵向、俯仰方向上的外部环境扰动,miu、miq分别表示水下滑翔机在纵向、俯仰方向上的惯性矩阵,用模糊系统对其进行逼近,给定
Figure FDA00030994671300000314
Figure FDA00030994671300000315
则存在有界权值
Figure FDA00030994671300000316
Figure FDA00030994671300000317
定义:
Figure FDA00030994671300000318
其中εiu和εiq是估计偏差,其满足
Figure FDA00030994671300000319
Figure FDA00030994671300000320
Figure FDA00030994671300000321
其中
Figure FDA00030994671300000322
Figure FDA00030994671300000323
是用来估计
Figure FDA00030994671300000324
Figure FDA00030994671300000325
的低通滤波器权值;σiu,σiq
Figure FDA00030994671300000326
Figure FDA00030994671300000327
是正常数;Proj[]表示投影算子。
6.根据权利要求1所述的一种自触发通信的水下滑翔机协同控制系统,其特征在于,所述计算水下滑翔机在纵向、俯仰方向上运动的控制参数是通过公式(7)进行计算,
Figure FDA00030994671300000328
其中
Figure FDA00030994671300000329
Δiu∈R,Δiq∈R为正常数;
Figure FDA00030994671300000330
当biu≥0时,sign(biu)=1,当biu<0时,sign(biu)=-1;
Figure FDA0003099467130000041
当biq≥0时,sign(biq)=1,当biq<0时,sign(biq)=-1,εiu∈R和εiq∈R都是正常数,分别用来处理当biu=0或biq=0时的奇异性,Tiu和Tiq分别为水下滑翔机在纵向、俯仰方向运动的控制参数。
7.根据权利要求1所述的一种自触发通信的水下滑翔机协同控制系统,其特征在于,所述计算下一触发时间是通过公式(8)进行计算,
Figure FDA0003099467130000042
其中a1>0,β1>0,a2>0,β2>0;定义第一次触发时间
Figure FDA0003099467130000043
Figure FDA0003099467130000044
CN202110620072.6A 2021-06-03 2021-06-03 一种自触发通信的水下滑翔机协同控制系统 Active CN113342010B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110620072.6A CN113342010B (zh) 2021-06-03 2021-06-03 一种自触发通信的水下滑翔机协同控制系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110620072.6A CN113342010B (zh) 2021-06-03 2021-06-03 一种自触发通信的水下滑翔机协同控制系统

Publications (2)

Publication Number Publication Date
CN113342010A true CN113342010A (zh) 2021-09-03
CN113342010B CN113342010B (zh) 2023-05-23

Family

ID=77473473

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110620072.6A Active CN113342010B (zh) 2021-06-03 2021-06-03 一种自触发通信的水下滑翔机协同控制系统

Country Status (1)

Country Link
CN (1) CN113342010B (zh)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113970887A (zh) * 2021-11-22 2022-01-25 大连海事大学 一种基于能耗最优的多水下滑翔机路径规划系统
CN114460948A (zh) * 2022-02-06 2022-05-10 西北工业大学 一种基于事件触发策略的水下滑翔机俯仰角鲁棒自适应控制方法

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8862290B1 (en) * 2013-04-18 2014-10-14 Ge Aviation Systems Llc Flight system for an aircraft having an autoland system
WO2018204816A1 (en) * 2017-05-05 2018-11-08 Intel IP Corporation Methods and arrangements to signal for aerial vehicles
CN112666832A (zh) * 2020-12-23 2021-04-16 大连海事大学 一种非周期通信的水下滑翔机协同控制器结构及设计方法
CN112882473A (zh) * 2021-01-25 2021-06-01 大连海事大学 一种事件触发的无人艇集群分布式协同控制器、结构及方法

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8862290B1 (en) * 2013-04-18 2014-10-14 Ge Aviation Systems Llc Flight system for an aircraft having an autoland system
WO2018204816A1 (en) * 2017-05-05 2018-11-08 Intel IP Corporation Methods and arrangements to signal for aerial vehicles
CN112666832A (zh) * 2020-12-23 2021-04-16 大连海事大学 一种非周期通信的水下滑翔机协同控制器结构及设计方法
CN112882473A (zh) * 2021-01-25 2021-06-01 大连海事大学 一种事件触发的无人艇集群分布式协同控制器、结构及方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
王浩亮;王丹;彭周华;王天霖;张春来;: "水下滑翔机垂直面运动的前馈级联控制", 大连海事大学学报 *

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113970887A (zh) * 2021-11-22 2022-01-25 大连海事大学 一种基于能耗最优的多水下滑翔机路径规划系统
CN113970887B (zh) * 2021-11-22 2023-11-14 大连海事大学 一种基于能耗最优的多水下滑翔机路径规划系统
CN114460948A (zh) * 2022-02-06 2022-05-10 西北工业大学 一种基于事件触发策略的水下滑翔机俯仰角鲁棒自适应控制方法
CN114460948B (zh) * 2022-02-06 2024-02-02 西北工业大学 一种基于事件触发策略的水下滑翔机俯仰角鲁棒自适应控制方法

Also Published As

Publication number Publication date
CN113342010B (zh) 2023-05-23

Similar Documents

Publication Publication Date Title
CN113189979B (zh) 一种无人船的分布式队列有限时间控制方法
Zhang et al. Robust model predictive control for path-following of underactuated surface vessels with roll constraints
Park Adaptive formation control of underactuated autonomous underwater vehicles
CN109976349B (zh) 一种含约束无人船的路径跟踪制导与控制结构的设计方法
CN112666832B (zh) 一种非周期通信的水下滑翔机协同控制器系统及设计方法
Huang et al. Robust practical fixed-time leader–follower formation control for underactuated autonomous surface vessels using event-triggered mechanism
CN111284732B (zh) 一种基于事件触发通信的航天器抗干扰姿态协同控制方法
CN113342010A (zh) 一种自触发通信的水下滑翔机协同控制系统
CN112965371B (zh) 基于固定时间观测器的水面无人艇轨迹快速跟踪控制方法
CN109189103B (zh) 一种具有暂态性能约束的欠驱动auv轨迹跟踪控制方法
CN108303880B (zh) 一种基于时延补偿的机器人遥操作预测控制方法
CN110687918A (zh) 一种基于回归型神经网络在线逼近的水下机器人轨迹跟踪控制方法
CN114442640B (zh) 一种水面无人艇轨迹跟踪控制方法
Zhang et al. Improved LVS guidance and path-following control for unmanned sailboat robot with the minimum triggered setting
Jing et al. Self-tuning adaptive active disturbance rejection pitch control of a manta-ray-like underwater glider
Wang et al. Adaptive fuzzy control of underwater vehicle manipulator system with dead-zone band input nonlinearities via fuzzy performance and disturbance observers
CN109240317B (zh) 考虑螺旋桨故障的海底地震检波飞行节点有限时间构型包含控制方法
CN112882473B (zh) 一种事件触发的无人艇集群分布式协同控制器
Rego et al. Cooperative path-following control with logic-based communications: Theory and practice
Song et al. Event-triggered fuzzy finite-time reliable control for dynamic positioning of nonlinear unmanned marine vehicles
Qi et al. Three-dimensional formation control based on filter backstepping method for multiple underactuated underwater vehicles
Xia et al. Adaptive neural network control with backstepping for surface ships with input dead-zone
Zhang et al. Robust adaptive control for dynamic positioning vehicles in presence of adjustable threshold rule and input constraints
CN116449703A (zh) 一种有限时间框架下的auh编队协同控制方法
CN116048090A (zh) 一种具有能耗优化效应的风帆助航船路径跟踪控制方法

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant