CN116321192A - 一种基于最优刚性图的潜器组网编队方法 - Google Patents

一种基于最优刚性图的潜器组网编队方法 Download PDF

Info

Publication number
CN116321192A
CN116321192A CN202310176473.6A CN202310176473A CN116321192A CN 116321192 A CN116321192 A CN 116321192A CN 202310176473 A CN202310176473 A CN 202310176473A CN 116321192 A CN116321192 A CN 116321192A
Authority
CN
China
Prior art keywords
submersible
submarines
distance
graph
rigidity
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
CN202310176473.6A
Other languages
English (en)
Other versions
CN116321192B (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.)
Yanshan University
Original Assignee
Yanshan 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 Yanshan University filed Critical Yanshan University
Priority to CN202310176473.6A priority Critical patent/CN116321192B/zh
Publication of CN116321192A publication Critical patent/CN116321192A/zh
Application granted granted Critical
Publication of CN116321192B publication Critical patent/CN116321192B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • HELECTRICITY
    • H04ELECTRIC COMMUNICATION TECHNIQUE
    • H04WWIRELESS COMMUNICATION NETWORKS
    • H04W16/00Network planning, e.g. coverage or traffic planning tools; Network deployment, e.g. resource partitioning or cells structures
    • H04W16/18Network planning tools
    • HELECTRICITY
    • H04ELECTRIC COMMUNICATION TECHNIQUE
    • H04BTRANSMISSION
    • H04B11/00Transmission systems employing sonic, ultrasonic or infrasonic waves
    • HELECTRICITY
    • H04ELECTRIC COMMUNICATION TECHNIQUE
    • H04WWIRELESS COMMUNICATION NETWORKS
    • H04W16/00Network planning, e.g. coverage or traffic planning tools; Network deployment, e.g. resource partitioning or cells structures
    • H04W16/22Traffic simulation tools or models
    • HELECTRICITY
    • H04ELECTRIC COMMUNICATION TECHNIQUE
    • H04WWIRELESS COMMUNICATION NETWORKS
    • H04W4/00Services specially adapted for wireless communication networks; Facilities therefor
    • H04W4/02Services making use of location information
    • H04W4/023Services making use of location information using mutual or relative location information between multiple location based services [LBS] targets or of distance thresholds
    • HELECTRICITY
    • H04ELECTRIC COMMUNICATION TECHNIQUE
    • H04WWIRELESS COMMUNICATION NETWORKS
    • H04W4/00Services specially adapted for wireless communication networks; Facilities therefor
    • H04W4/02Services making use of location information
    • H04W4/029Location-based management or tracking services
    • HELECTRICITY
    • H04ELECTRIC COMMUNICATION TECHNIQUE
    • H04WWIRELESS COMMUNICATION NETWORKS
    • H04W4/00Services specially adapted for wireless communication networks; Facilities therefor
    • H04W4/06Selective distribution of broadcast services, e.g. multimedia broadcast multicast service [MBMS]; Services to user groups; One-way selective calling services
    • HELECTRICITY
    • H04ELECTRIC COMMUNICATION TECHNIQUE
    • H04WWIRELESS COMMUNICATION NETWORKS
    • H04W40/00Communication routing or communication path finding
    • H04W40/02Communication route or path selection, e.g. power-based or shortest path routing
    • H04W40/20Communication route or path selection, e.g. power-based or shortest path routing based on geographic position or location
    • HELECTRICITY
    • H04ELECTRIC COMMUNICATION TECHNIQUE
    • H04WWIRELESS COMMUNICATION NETWORKS
    • H04W84/00Network topologies
    • H04W84/18Self-organising networks, e.g. ad-hoc networks or sensor networks
    • 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
    • Y02DCLIMATE CHANGE MITIGATION TECHNOLOGIES IN INFORMATION AND COMMUNICATION TECHNOLOGIES [ICT], I.E. INFORMATION AND COMMUNICATION TECHNOLOGIES AIMING AT THE REDUCTION OF THEIR OWN ENERGY USE
    • Y02D30/00Reducing energy consumption in communication networks
    • Y02D30/70Reducing energy consumption in communication networks in wireless communication networks

Landscapes

  • Engineering & Computer Science (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Signal Processing (AREA)
  • Multimedia (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明公开了一种基于最优刚性图的潜器组网编队方法,属于水下传感器组网编队技术领域,具体为在监测区域随机部署n个潜器,潜器之间可以相互通信;潜器通过广播自身位置获得邻域内潜器的位置,同时采用时间差计算距离;当邻域潜器间平均距离大于距离阈值dthreshold,潜器采用基于距离刚性方法生成局部刚性拓扑;反之,采用基于方位刚性方法生成局部刚性拓扑;进一步控制中心利用局部刚性图,生成全局最优刚性图;潜器利用拓扑信息与目标位置设计宽度学习控制器,驱动潜器移动监测目标;当潜器位置不满足刚性组网与目标跟踪条件,重复上述步骤;否则保持当前跟踪速度。本发明可运用在水下传感器网络对移动目标的监测,可保证通信稳健性,同时提升能量有效性。

Description

一种基于最优刚性图的潜器组网编队方法
技术领域
本发明属于水下传感器组网编队技术领域,尤其涉及一种基于最优刚性图的潜器组网编队方法。
背景技术
水下传感器网络在军事与民用领域都发挥了巨大的作用。一方面,完成上述任务的本质都是依赖于传感器网络的通信稳健性与能量有效性;在通信过程中,水下传感器网络的通信链路越多通信越稳健,相对应地,通信能耗越大。另一方面,面对移动被监测目标问题,传统的传感器节点由于其机动性不足无法对移动目标进行检测。因此,如何构建一个能够保持通信稳健性且提高能量有效性的移动水下传感器网络是一个尚待解决的问题。
在现有技术中,公开号为CN106879042A,名称为一种水下无线传感器网络最短路径路由算法。该方法通过采集第i级节点和第i+1级节点的深度值、从第i级节点发出命令包到接收到第i+1级节点集合反馈命令包的往返时间、网络节点的剩余能量值和链路质量,计算并比较代表通信能耗的余弦值,进而筛选出由K个节点连接构成的水下无线传感器网络最短路径。该方案能够利用最短路径实现低通信能耗传输,但是没有考虑水下网络刚性结构的问题,这使得通信稳健性降低。
再有,公开号为CN112148023A,名称为一种自治水下机器人等平面水下编队方法,该系统包括了由多个潜器组成的机器人编队,该编队以领航-跟随的方式、形成一种几何队形进行作业。该方法通过对自治水下机器人安装布置蓝绿激光发射器,标定定位点与定位扇面,实现多台自治水下机器人组成的编队的队形设置、队形保持与编队跟踪。该方案中水下机器人之间无需信息交互,解决了水下弱通信或无通信的问题。由于激光在水下传播时都会受到强烈的吸收衰减作用,因此上述编队方法仅仅适用于水面艇的编队控制,而不能直接用于潜器组网。
发明内容
为解决上述问题,本发明提出一种基于最优刚性图的潜器组网编队方法,可保证通信稳健性,同时提升能量有效性,弥补了传统传感器网络机动性的不足,进而可以对移动目标实现全方位的跟踪监测。
为实现上述目的,本发明提供了以下技术方案:
一种基于最优刚性图的潜器组网编队方法,包括以下步骤:
步骤S1:在监测区域,随机部署n个带有通信装置和摄像头的潜器。潜器具有与邻域内其他潜器相互通信的功能,同时可以测量自身位置与视距范围内任意一点位置的方位;
步骤S2:潜器通过水声通信广播自身位置以获得自身邻域内潜器的位置,并利用从发送信号到接收返回信号的时间差计算与邻居潜器的距离;
步骤S3:当潜器间平均距离大于距离阈值dthreshold,潜器通过水声通信寻找自身邻居节点,建立各自的邻居列表,生成距离刚度矩阵Ri,然后采用距离刚性图生成方法对传感器网络生成局部拓扑Gi,i∈{1,...,n},其中n是潜器的个数,最后将局部刚性图上传控制中心;
步骤S4:当潜器间平均距离小于距离阈值dthreshold,潜器通过水声通信寻找自身邻居节点,建立各自的邻居列表,生成方位刚度矩阵Ri,然后采用方位刚性图生成方法对传感器网络生成局部拓扑Gi,i∈{1,...,n},其中n是潜器的个数,最后将局部刚性图上传控制中心;
步骤S5:控制中心收集局部刚性图G1,...,Gn,利用这些图中被重复使用的边,组成新的全局刚性图,即最优刚性图;
步骤S6:收集组网邻居潜器的状态信息与自身状态信息,根据通信拓扑,设计宽度学习网络输入Ei和宽度学习编队控制算法,驱动潜器运动;
步骤S7:判断潜器是否同时满足最优刚性图和跟踪监测移动目标的条件;如果满足,潜器保持当前跟踪速度,控制结束,反之,返回步骤2。
本发明技术方案的进一步改进在于:潜器间距离测量包括:在时间戳tA,i时刻,潜器i发送声波信号,然后等到来自邻居潜器j∈Ni返回位置及节点连通信息,记录时间戳为
Figure BDA0004101019390000031
其中Ni表示为潜器i的邻居潜器集合。潜器i与潜器j之间的距离差可表示为
Figure BDA0004101019390000032
其中c=1500m/s是在水下声波信号的传播速度。
本发明技术方案的进一步改进在于:所述距离刚性图生成方法,包括:定义εi是潜器i与邻居潜器组成的边集,其位置为pi=[x(t),y(t),z(t)]T;其中x、y、z分别表示潜器在X轴、Y轴和Z轴的位置坐标。
当邻域内潜器间平均距离大于dthreshold时,潜器i根据各自邻居列表,建立方位刚度矩阵Ri;这里刚度矩阵的行对应拓扑中通信链路,例如(i,j)∈εi可表示为
Figure BDA0004101019390000033
其中,i∈{1,…,ni},ni是潜器i的邻居节点个数;初始化刚度矩阵RΔ为R的第一行,然后按照潜器间距离升序,将对应的通信边加入矩阵
Figure BDA0004101019390000039
直到/>
Figure BDA0004101019390000034
至此为止,就构造了一个关于潜器i的局部距离刚性图Gi;随后潜器i将Gi上传给控制中心。
本发明技术方案的进一步改进在于:所述方位刚性图生成方法,包括:当邻域内潜器间平均距离小于dthreshold时,在潜器i根据各自地邻居列表,建立方位刚度矩阵Ri;这里刚度矩阵的行对应拓扑中通信链路,例如(i,j)∈εi可表示为[0 … 0 -P(uij)/||pi-pj||…P(uij)...pi-pj||0 … 0];
其中
Figure BDA0004101019390000035
是正交投影算子矩阵;uij是潜器i与j间测量方位;初始化刚度矩阵/>
Figure BDA0004101019390000036
为Ri的前3行,将对应的通信链路加入/>
Figure BDA0004101019390000037
使得/>
Figure BDA0004101019390000038
至此为止,就构造了一个关于潜器i的局部距离刚性图Gi;潜器i将Gi上传给控制中心。
本发明技术方案的进一步改进在于:所述构造设计宽度学习网络输入,其中包括:收集组网邻居潜器的状态信息与自身状态信息,设计宽度学习网络输入,
Figure BDA0004101019390000041
是来自步骤5的固定最优刚性图通信拓扑,最终激活函数被定义为S=[Zf|He];
其中
Figure BDA0004101019390000047
具体地,/>
Figure BDA0004101019390000042
Ht=φ(ZfWtt),t=1,...,ne;Wh和Wt分别是随机权重矩阵;ρh和ρt分别是随机偏置矩阵;nf是特征神经元的个数,ne是增强神经元的个数;φ()=tanh()是一个非线性函数转换。
本发明技术方案的进一步改进在于:所述潜器利用宽度学习编队算法形成的最优刚性图进行保持与目标跟踪,在第k个时间步,包括:
定义奖励函数为
Figure BDA0004101019390000043
其中p=[p1;...;pn];pd是目标点的位置;pc(k)是航行器的几何中心点;ε是整个图的边集合;τi是第i个潜器的推进力向量;
Figure BDA0004101019390000044
反映在运动过程中维持刚性图的奖励项;当该奖励项越大,表示刚性图的与预定的刚性结构差距越大,ai可以控制维持刚性图奖励项在整个奖励函数中所占的比例,比例越大,说明越重视维持刚性结构;||pd-pc(k)||2反映在运动过程中传感器网络几何中心与目标的接近程度;该奖励越大,说明跟踪效果越差;bi可以控制跟踪目标奖励项在整个奖励中所占比例,比例越大,说明越重视目标跟踪;
通过得到实时的奖励函数来更新当前位置的价值函数Vi(pii),在时间步k时,函数Vi(pi(k),τi(k))定义如下:Vi(pi(k),τi(k))=Ji(p(k))+γVi(pi(k+1),τi(k+1));
其中γ∈(0,1]表示对未来时间的折扣因子;可以通过寻找最优策略
Figure BDA0004101019390000048
策略可表示为
Figure BDA0004101019390000045
本发明技术方案的进一步改进在于:所述最优刚性图和跟踪监测移动目标的条件,可以分别表示为
Figure BDA0004101019390000046
其中l是保持最优刚性图效果达标的阈值;/>
Figure BDA0004101019390000051
是目标跟踪效果达标的阈值。
与现有技术相比,本发明具有以下优点:
本发明结合潜器进行组网,对该网络进行拓扑优化;本发明根据潜器部署距离自适应地调整组网方法,灵活性强;该发明可以确保能量有效性,同时可以提升通信稳健性。
本发明提出了一种基于网络连通度信息的目标跟踪策略来驱动潜器运动,本发明还提出了一种基于宽度学习控制器的目标跟踪编队控制方法。该方法相比于传统的人工势场方法可以避免陷入局部最优,同时相比于传统的深度学习控制,利用单层网络结构,可以保证学习精度的同时,减少训练过程的计算量。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图做以简单地介绍,显而易见地,下面描述中的附图是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。
图1是本发明实施例中一种基于最优刚性图的潜器组网编队方法的流程图;
图2是本发明实施例中水下网络体系结构的模型示意图;
图3是本发明实施例中潜器机载摄像头与通信装置图;
图4是本发明实施例中基于距离最优刚性图的组网模拟示意图;
图5是本发明实施例中基于方位最优刚性图的组网模拟示意图;
图6是本发明实施例中基于宽度学习的神经网络结构示意图;
其中,1、潜器,2、被监测目标,3、浮标,4、通信链路,5、期望轨迹,6、控制中心,1-1、左通信单元,1-2、右通信单元,2-1、左摄像头,2-2、右摄像头。
具体实施方式
为了使本技术领域的人员更好地理解本发明方案,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分的实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都应当属于本发明保护的范围。
需要说明的是,本发明的说明书和权利要求书及上述附图中的术语“第一”、“第二”等是用于区别类似的对象,而不必用于描述特定的顺序或先后次序。应该理解这样使用的数据在适当情况下可以互换,以便这里描述的本发明的实施例能够以除了在这里图示或描述的那些以外的顺序实施。此外,术语“包括”和“具有”以及他们的任何变形,意图在于覆盖不排他的包含,例如,包含了一系列步骤或单元的过程、方法、系统、产品或设备不必限于清楚地列出的那些步骤或单元,而是可包括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或单元。
参见图1,其示出了一种基于最优刚性图的潜器组网编队方法的流程图,具体包括以下步骤:
步骤1:在监测区域,随机部署n个带有通信装置和摄像头的潜器,如图3所示,其中左通信单元1-1,右通信单元1-2,左摄像头2-1,右摄像头2-2;
步骤2:潜器通过水声通信广播自身位置以获得自身邻域内潜器的位置,并利用从发送信号到接收返回信号的时间差计算与邻居潜器的距离;
浮标3的作用是通过卫星信号给潜器进行定位授时,其保证了潜器时钟同步,位置精确。在时间戳tA,i时刻,潜器i发送声波信号,然后等到来自其邻居潜器j∈Ni返回其位置及节点连通信息,记录时间戳为ti A,j,则潜器i与潜器j之间的距离差可计算为:
Figure BDA0004101019390000061
其中c=1500m/s是在水下声波信号的传播速度。
网络规模大小判断。根据当网络规模小于距离阈值dthreshold时,可以通过相机测得方位角,进而根据步骤4形成局部方位刚性图;反之,根据步骤3形成局部距离刚性图。
步骤3:当潜器间平均距离大于距离阈值dthreshold,潜器通过水声通信寻找自身邻居节点,建立各自的邻居列表,生成距离刚度矩阵Ri,然后采用距离刚性图生成方法对传感器网络生成局部拓扑Gi,i∈{1,…,n},其中n是潜器的个数,最后将局部刚性图上传控制中心;
将潜器的位置定义为pi=[xi,yi,zi]T,因此本发明实施例提供一种基于距离刚性组网方法,潜器i构建距离刚性矩阵可表示为:
Figure BDA0004101019390000071
其中,i∈{1,…,ni};ni是潜器i的邻居节点个数;pi是潜器i的位置。
初始化刚度矩阵
Figure BDA0004101019390000072
为Ri的第一行,然后按照潜器间距离升序,依次将对应的通信链路加入/>
Figure BDA0004101019390000073
如果/>
Figure BDA0004101019390000074
的秩大于之前的秩值就保留该行,并记录对应的通信链路,否则去掉新增加的链路,并进行下一次迭代。
重复上述过程,直到
Figure BDA0004101019390000075
就构造了一个关于潜器i的局部距离刚性图。依次类推,可以产生局部方位刚性图分别G1,...,Gn
步骤4:当潜器间平均距离小于距离阈值dthreshold,潜器通过水声通信寻找自身邻居节点,建立各自的邻居列表,生成方位刚度矩阵Ri,然后采用方位刚性图生成方法对传感器网络生成局部拓扑Gi,i∈{1,...,n},其中n是潜器的个数,最后将局部刚性图上传控制中心;
因此本发明实施例提供一种基于方位刚性组网方法,其中潜器i构建方位刚性矩阵可表示为:
Figure BDA0004101019390000076
其中,i∈{1,…,ni};ni是潜器i的邻居节点个数;pi是潜器i的位置;uij是潜器i与j之间用摄像头测量获得的方位;详细见图3中摄像头2-1和2-2。
将对应的通信链路加入
Figure BDA0004101019390000081
使得/>
Figure BDA0004101019390000082
这里值得注意的是一个由ni个潜器构成的局部图,其最少边个数是
Figure BDA0004101019390000083
其中
Figure BDA0004101019390000086
mod(·)和sgn(·)分别为向下取整函数,取余函数和符号函数。
当满足
Figure BDA0004101019390000084
就构造了一个关于潜器i的局部方位刚性图;依次类推,可以产生局部方位刚性图分别G1,...,Gn
步骤5:控制中心收集局部刚性图G1,...,Gn,利用这些图中被重复使用的边,组成新的全局刚性图,即最优刚性图;
每一个潜器将自身保存的通信链路集合发送给控制中心6,进行求解最优刚性拓扑。具体地,在步骤3与步骤4得到的局部距离/方位刚性图中不可避免出现被重复使用的通信链路,相对应的有的通信链路只被使用了一次,由于非重复链路所在子图中的其他链路都已经被其他重复链路保证了其刚性,因此非重复链路被去除,并且不会影响整个图的刚性结构,即,基于距离/方位最优刚性图和最优刚性图被生成,如图4和图5所示。
步骤6:收集组网邻居潜器的状态信息与自身状态信息,根据通信拓扑,设计宽度学习网络输入Ei和宽度学习编队控制算法,驱动潜器运动;
因此本发明实施例潜器i基于步骤1得到的其邻居潜器j∈Ni位置及节点连通信息,再根据目标位置,构建宽度学习网络输入。
在k时刻,潜器i位置误差为ei(k)=pd-pi(k)。确定潜器的目标位置,然后控制中心6将控制命令发送到潜器。通过浮标3与卫星实时确定其状态位置,并发送到控制中心6;要实现位置跟踪任务,潜器与目标点之间的相对位置和速度最终需要为零;因此定义宽度学习输入为:
Figure BDA0004101019390000085
其中,
Figure BDA0004101019390000091
是刚性图保持项;ei(k)表示潜器i目标跟踪项的系数;ai≠0和bi≠0分别表示刚性图保持项与目标跟踪项前的系数。
接下来,特征神经元与增强神经元可构建为:
Figure BDA0004101019390000092
Ht=φ(ZfWtt),t=1,...,ne (7)
其中Wh和Wt分别是特征神经元与增强神经元的随机权重矩阵;ρh和ρt分别是随机偏置矩阵;另外,nf是特征神经元的个数;ne是增强神经元的个数;
φ(·)=tanh()是一个非线性函数转化;
Figure BDA0004101019390000093
是特征神经元向量,最终激活函数为S=[Zf|He];其中/>
Figure BDA0004101019390000094
本发明实施例中定义
Figure BDA0004101019390000095
其中/>
Figure BDA0004101019390000096
是潜器的偏转角;定义τi=[Fu,Fv,Fw,Tr]T,其中Tr是偏航中施加的扭矩;Fu、Fv和Fw分别表示在滚动、摇摆和起伏时施加的力。
接下来潜器的推进扭矩可通过基于宽度学习算法的控制器求解:定义代价函数为
Figure BDA0004101019390000097
通过得到及时的代价函数Vi(pii)来更新当前位置的值函数,函数Vi(pi(k),τi(k))定义如下:
Vi(pi(k),τi(k))=Ji(p(k))+γVi(pi(k+1),τi(k+1)), (8)
其中γ∈(0,1]表示对未来时间的折扣因子,当γ越靠近1,说明价值函数对未来的当前迭代策略下未来收益越重视,反之,越关注当前的奖励。
为了使得代价函数最小化,最优策略
Figure BDA0004101019390000098
可表示为:
Figure BDA0004101019390000099
将宽度神经网络激活函数Si=[Zf|He]用于近似逼近Vi(pi(k),τi(k)),可表示为
Figure BDA00041010193900000910
其中/>
Figure BDA00041010193900000911
是在第s次迭代被学习的权重向量,因此第s次迭代的贝尔曼方程可以写为:
Figure BDA0004101019390000101
进一步的k+1更新策略可表示为:
Figure BDA0004101019390000102
步骤7:判断潜器当前所在位置是否同时满足最优刚性图和跟踪监测移动目标的条件:
Figure BDA0004101019390000103
其中l是保持最优刚性图效果达标的阈值;
Figure BDA0004101019390000104
是目标跟踪效果达标的阈值。若满足,潜器保持当前跟踪速度,控制过程结束,反之,返回步骤2。
本发明实施例具有以下优点:
本发明结合潜器进行组网,对该网络进行拓扑优化;本发明根据潜器部署距离自适应地调整组网方法,灵活性强;本发明可以确保能量有效性,同时可以提升通信稳健性。
本发明提出了一种基于网络连通度信息的目标跟踪策略来驱动潜器运动,本发明还提出了一种基于宽度学习控制器的目标跟踪编队控制方法。该方法相比于传统的人工势场方法可以避免陷入局部最优,同时相比于传统的深度学习控制,利用单层网络结构,可以保证学习精度的同时,减少训练过程的计算量。
最后应说明的是:以上各实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述各实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分或者全部技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的范围。

Claims (10)

1.一种基于最优刚性图的潜器组网编队方法,其特征在于包括以下步骤:
步骤S1:在监测区域,随机部署n个带有通信装置和摄像头的潜器(1);
步骤S2:潜器(1)通过水声通信广播自身位置以获得自身邻域内潜器的位置,并利用从发送信号到接收返回信号的时间差计算与邻居潜器的距离;
步骤S3:当潜器(1)间平均距离大于距离阈值dthreshold,潜器通过水声通信寻找自身邻居节点,建立各自的邻居列表,生成距离刚度矩阵Ri,然后采用距离刚性图生成方法对传感器网络生成局部拓扑Gi,i∈{1,...,n},其中n是潜器的个数,最后将局部刚性图上传控制中心;
步骤S4:当潜器间平均距离小于距离阈值dthreshold,潜器通过水声通信寻找自身邻居节点,建立各自的邻居列表,生成方位刚度矩阵Ri,然后采用方位刚性图生成方法对传感器网络生成局部拓扑Gi,i∈{1,...,n},其中n是潜器的个数,最后将局部刚性图上传控制中心;
步骤S5:控制中心收集局部刚性图G1,...,Gn,利用这些图中被重复使用的边,组成新的全局刚性图,即最优刚性图;
步骤S6:收集组网邻居潜器的状态信息与自身状态信息,根据通信拓扑,设计宽度学习网络输入Ei和宽度学习编队控制算法,驱动潜器运动;
步骤S7:判断潜器是否同时满足最优刚性图和跟踪监测移动目标的条件;如果满足,潜器保持当前跟踪速度,控制结束,反之,返回步骤S2。
2.根据权利要求1所述的一种基于最优刚性图的潜器组网编队方法,其特征在于:步骤S1中潜器(1)具有与邻域内其他潜器相互通信的功能,同时可以测量自身位置与视距范围内任意一点位置的方位。
3.根据权利要求1所述的一种基于最优刚性图的潜器组网编队方法,其特征在于:步骤S2中潜器间距离测量包括:在时间戳tA,i时刻,潜器i发送声波信号,然后等到来自邻居潜器j∈Ni返回位置及节点连通信息,记录时间戳为
Figure FDA0004101019320000027
其中Ni表示为潜器i的邻居潜器集合,潜器i与潜器j之间的距离差可表示为/>
Figure FDA0004101019320000021
其中c=1500m/s是在水下声波信号的传播速度。
4.根据权利要求1所述的一种基于最优刚性图的潜器组网编队方法,其特征在于:定义εi是潜器i与邻居潜器组成的边集,其位置为pi=[x(t),y(t),z(t)]T;其中x、y、z分别表示潜器在X轴、Y轴和Z轴的位置坐标,步骤2的作用是收集潜器间距离信息,并判断潜器间平均距离与距离阈值的大小关系。
5.根据权利要求4所述的一种基于最优刚性图的潜器组网编队方法,其特征在于:当潜器间平均距离大于距离阈值,步骤S3具体步骤为将潜器的位置定义为pi=[xi,yi,zi]T,潜器i构建距离刚性矩阵可表示为:
Figure FDA0004101019320000022
其中,i∈{1,…,ni};ni是潜器i的邻居节点个数;pi是潜器i的位置;初始化刚度矩阵
Figure FDA0004101019320000023
为Ri的第一行,然后按照潜器间距离升序,依次将对应的通信链路加入/>
Figure FDA0004101019320000024
如果/>
Figure FDA0004101019320000025
的秩大于之前的秩值就保留该行,并记录对应的通信链路,否则去掉新增加的链路,并进行下一次迭代;
重复上述过程,直到
Figure FDA0004101019320000026
就构造了一个关于潜器i的局部距离刚性图;依次类推,就可以得到n个局部方位刚性图,分别记作G1,...,Gn
6.根据权利要求4所述的一种基于最优刚性图的潜器组网编队方法,其特征在于:当潜器间平均距离小于距离阈值dthreshold,步骤S4的具体步骤为其中潜器i构建方位刚性矩阵可表示为:
Figure FDA0004101019320000031
其中,i∈{1,…,ni};ni是潜器i的邻居节点个数;pi是潜器i的位置;uij是潜器i与j之间用摄像头测量获得的方位;
将对应的通信链路加入
Figure FDA0004101019320000032
使得/>
Figure FDA0004101019320000033
一个由ni个潜器构成的局部图,其最少边个数是:
Figure FDA0004101019320000034
其中
Figure FDA0004101019320000036
mod(·)和sgn(·)分别表示向下取整函数,取余函数和符号函数;当满足
Figure FDA0004101019320000035
构造了关于潜器i的局部方位刚性图;依次类推,就可以得到n个局部方位刚性图,分别记作G1,...,Gn
7.根据权利要求1所述的一种基于最优刚性图的潜器组网编队方法,其特征在于:步骤S5中只保留G1,...,Gn中被重复使用的边,最终得到最优刚性图;每一个潜器将自身保存的通信链路集合发送给控制中心(6),进行求解最优刚性拓扑,在步骤S3与步骤S4得到的局部距离/方位刚性图中不可避免出现被重复使用的通信链路(4),相对应的有的通信链路(4)只被使用了一次,由于非重复链路所在子图中的其他链路都已经被其他重复链路保证了其刚性,因此非重复链路被去除,并且不会影响整个图的刚性结构,进而基于距离/方位的最优刚性图被生成。
8.根据权利要求1所述的一种基于最优刚性图的潜器组网编队方法,其特征在于:步骤S6具体为潜器i基于步骤S1得到的其邻居潜器j∈Ni位置及节点连通信息,再根据目标位置,构建宽度学习网络输入;
在k时刻,潜器i位置误差为ei(k)=pd-pi(k);确定潜器的目标位置,然后控制中心(6)将控制命令发送到潜器;通过浮标(3)与卫星实时确定其状态位置,并发送到控制中心(6);要实现位置跟踪任务,潜器与目标点之间的相对位置和速度最终需要为零,定义宽度学习输入为:
Figure FDA0004101019320000041
其中,
Figure FDA0004101019320000042
是刚性图保持项;ei(k)表示潜器i目标跟踪项的系数;ai≠0和bi≠0分别表示刚性图保持项与目标跟踪项前的系数;
特征神经元与增强神经元可构建为:
Figure FDA0004101019320000043
Ht=φ(ZfWtt),t=1,...,ne
其中Wh和Wt分别是特征神经元与增强神经元的随机权重矩阵;ρh和ρt分别是随机偏置矩阵;nf是特征神经元的个数;ne是增强神经元的个数;φ(·)=tanh(·)是一个非线性函数转化;
Figure FDA0004101019320000044
是特征神经元向量,最终激活函数为S=[Zf|He];其中
Figure FDA0004101019320000045
9.根据权利要求8所述的一种基于最优刚性图的潜器组网编队方法,其特征在于:基于宽度学习的潜器k+1更新策略待学习的权重向量可由Vi(pi(k),τi(k))=Ji(p(k))+γVi(pi(k+1),τi(k+1))求解,在求解出最优权重向量以后,潜器根据更新后的权重值生成推进器策略,所生成的路径即为最佳路径。
10.根据权利要求1所述的一种基于最优刚性图的潜器组网编队方法,其特征在于:步骤S7中判断潜器当前所在位置是否同时满足最优刚性图和跟踪监测移动目标的条件可表示为:
Figure FDA0004101019320000046
和/>
Figure FDA0004101019320000047
其中l是最优刚性图效果合格的阈值;
Figure FDA0004101019320000051
是目标跟踪效果合格的阈值。
CN202310176473.6A 2023-02-28 2023-02-28 一种基于最优刚性图的潜器组网编队方法 Active CN116321192B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202310176473.6A CN116321192B (zh) 2023-02-28 2023-02-28 一种基于最优刚性图的潜器组网编队方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202310176473.6A CN116321192B (zh) 2023-02-28 2023-02-28 一种基于最优刚性图的潜器组网编队方法

Publications (2)

Publication Number Publication Date
CN116321192A true CN116321192A (zh) 2023-06-23
CN116321192B CN116321192B (zh) 2023-09-19

Family

ID=86817917

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202310176473.6A Active CN116321192B (zh) 2023-02-28 2023-02-28 一种基于最优刚性图的潜器组网编队方法

Country Status (1)

Country Link
CN (1) CN116321192B (zh)

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20030235337A1 (en) * 2002-02-01 2003-12-25 Nikolaos Paragios Non-rigid image registration using distance functions
CN106879042A (zh) * 2017-03-20 2017-06-20 青海民族大学 一种水下无线传感器网络最短路径路由算法
CN111970658A (zh) * 2020-07-16 2020-11-20 西安理工大学 一种基于最优刚性图的无人机蜂群编队网络路由方法
CN111988181A (zh) * 2020-08-24 2020-11-24 燕山大学 一种UASNs中基于信任机制的网络拓扑控制方法
US20210153097A1 (en) * 2019-11-20 2021-05-20 Qinghai Normal University Depth and distance-based single-path routing method
CN113901593A (zh) * 2021-12-09 2022-01-07 浙江大学 一种水下柔性回收机构形态与刚度调控方法
WO2022155999A1 (zh) * 2021-01-19 2022-07-28 鹏城实验室 无人潜航器柔性回收装置、母船以及柔性回收方法
CN114895703A (zh) * 2022-04-29 2022-08-12 北京航空航天大学 基于拓扑优化重构的分布式容错时变编队控制方法及系统
CN115183771A (zh) * 2022-08-08 2022-10-14 上海交通大学 一种基于距离与到达角复合测量的多潜器协同定位方法

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20030235337A1 (en) * 2002-02-01 2003-12-25 Nikolaos Paragios Non-rigid image registration using distance functions
CN106879042A (zh) * 2017-03-20 2017-06-20 青海民族大学 一种水下无线传感器网络最短路径路由算法
US20210153097A1 (en) * 2019-11-20 2021-05-20 Qinghai Normal University Depth and distance-based single-path routing method
CN111970658A (zh) * 2020-07-16 2020-11-20 西安理工大学 一种基于最优刚性图的无人机蜂群编队网络路由方法
CN111988181A (zh) * 2020-08-24 2020-11-24 燕山大学 一种UASNs中基于信任机制的网络拓扑控制方法
WO2022155999A1 (zh) * 2021-01-19 2022-07-28 鹏城实验室 无人潜航器柔性回收装置、母船以及柔性回收方法
CN113901593A (zh) * 2021-12-09 2022-01-07 浙江大学 一种水下柔性回收机构形态与刚度调控方法
CN114895703A (zh) * 2022-04-29 2022-08-12 北京航空航天大学 基于拓扑优化重构的分布式容错时变编队控制方法及系统
CN115183771A (zh) * 2022-08-08 2022-10-14 上海交通大学 一种基于距离与到达角复合测量的多潜器协同定位方法

Non-Patent Citations (7)

* Cited by examiner, † Cited by third party
Title
HAIYAN ZHAO: "Ubiquitous Tracking for Autonomous Underwater Vehicle With IoUT: A Rigid-Graph-Based Solution", 《IEEE INTERNET OF THINGS JOURNAL 》 *
SHIKAI SHAO等: "Control of multi-agent formation with optimally persistent graph", 《 2012 24TH CHINESE CONTROL AND DECISION CONFERENCE (CCDC)》 *
曹丹丹: "无线紫外光协作无人机编队通信拓扑优化方法研究", 《硕士电子期刊》 *
罗小元;李昊;马巨海;: "基于最小刚性图代数特性的无线网络拓扑优化算法", 物理学报, no. 24 *
薛亮;陈晰;赵继军;黎作鹏;关新平;: "无线传感器网络中基于Voronoi覆盖及Delaunay三角剖分图的最小刚性拓扑控制算法", 自动化学报, no. 10 *
闫彦霖: "基于最优刚性图的无线传感器网络拓扑优化算法研究", 《硕士电子期刊》 *
闫敬;张立;罗小元;濮彬;关新平;: "异步时钟下基于信息物理融合的水下潜器协同定位算法", 自动化学报, no. 04 *

Also Published As

Publication number Publication date
CN116321192B (zh) 2023-09-19

Similar Documents

Publication Publication Date Title
CN110333739B (zh) 一种基于强化学习的auv行为规划及动作控制方法
WO2021135554A1 (zh) 一种无人车全局路径规划方法和装置
Liu et al. Intelligent multi-task allocation and planning for multiple unmanned surface vehicles (USVs) using self-organising maps and fast marching method
Liu et al. The fast marching method based intelligent navigation of an unmanned surface vehicle
Sun et al. Mapless motion planning system for an autonomous underwater vehicle using policy gradient-based deep reinforcement learning
Luis et al. A multiagent deep reinforcement learning approach for path planning in autonomous surface vehicles: The Ypacaraí lake patrolling case
Cao et al. Target search control of AUV in underwater environment with deep reinforcement learning
Ouahouah et al. Deep-reinforcement-learning-based collision avoidance in uav environment
CN111340868B (zh) 基于视觉深度估计的无人水下航行器自主决策控制方法
US20210191400A1 (en) Autonomous vessel simulation system and operating method thereof
JP6663606B2 (ja) 無人航空機位置推定方法及びシステム
CN106022471A (zh) 基于粒子群优化算法的小波神经网络模型船舶横摇实时预测方法
Yan et al. Autonomous underwater vehicles: localization, tracking, and formation
CN116300909A (zh) 一种基于信息预处理和强化学习的机器人避障导航方法
Yanes Luis et al. A multiagent deep reinforcement learning approach for path planning in autonomous surface vehicles: the Ypacaraí lake patrolling case
Wen et al. Intelligent multi-AUG ocean data collection scheme in maritime wireless communication network
Yildiz et al. State-of-the-art system solutions for unmanned underwater vehicles
Lin et al. Research on UUV obstacle avoiding method based on recurrent neural networks
CN116321192B (zh) 一种基于最优刚性图的潜器组网编队方法
Cai et al. Long-range UWB Positioning based Automatic Docking Trajectory Design for Unmanned Surface Vehicle
Fernández-Perdomo et al. Single and multiple glider path planning using an optimization-based approach
Guo et al. Intelligent assistance positioning methodology based on modified iSAM for AUV using low-cost sensors
CN114943168B (zh) 一种水上浮桥组合方法及系统
CN114840928B (zh) 一种基于深度学习的水下航行器集群运动仿真方法
CN114609925B (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