CN104185310B - 一种基于蜂拥控制的移动传感器目标跟踪的方法 - Google Patents
一种基于蜂拥控制的移动传感器目标跟踪的方法 Download PDFInfo
- Publication number
- CN104185310B CN104185310B CN201310205840.7A CN201310205840A CN104185310B CN 104185310 B CN104185310 B CN 104185310B CN 201310205840 A CN201310205840 A CN 201310205840A CN 104185310 B CN104185310 B CN 104185310B
- Authority
- CN
- China
- Prior art keywords
- msub
- mrow
- target
- sensor
- node
- 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.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims abstract description 22
- 238000005381 potential energy Methods 0.000 claims abstract description 23
- 230000001133 acceleration Effects 0.000 claims abstract description 17
- 238000004891 communication Methods 0.000 claims abstract description 8
- 230000004044 response Effects 0.000 claims description 7
- 230000009471 action Effects 0.000 claims description 5
- 238000013459 approach Methods 0.000 claims description 4
- 239000011159 matrix material Substances 0.000 claims description 4
- 238000012545 processing Methods 0.000 claims description 3
- 238000013461 design Methods 0.000 abstract description 2
- 230000033001 locomotion Effects 0.000 description 10
- 238000004422 calculation algorithm Methods 0.000 description 6
- 238000012544 monitoring process Methods 0.000 description 6
- 238000010586 diagram Methods 0.000 description 4
- 230000000694 effects Effects 0.000 description 3
- 238000004458 analytical method Methods 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 230000002708 enhancing effect Effects 0.000 description 1
- 231100001261 hazardous Toxicity 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 239000000126 substance Substances 0.000 description 1
- 208000011580 syndromic disease Diseases 0.000 description 1
Landscapes
- Feedback Control In General (AREA)
Abstract
本发明提出了一种基于蜂拥控制的移动传感器目标跟踪的方法，包括以下步骤：建立移动传感器网络，移动传感器网络是一个由N个相同节点组成的移动传感器网络，设MSN（Mobile Sensor Network）的运动学方程和MSN跟踪目标的运动学方程为，传感器节点的通信半径或观测半径为R，即传感器与的距离小于R的目标信息(包括位置、速度和加速度)都可以被观测到，传感半径为Rs，采用布尔传感器模型，传感器需要与目标之间设置安全距离，建立势能函数，设计ui控制律。本发明控制部分传感器节点，节省了控制成本。在安全性上，保护传感器与目标保持一定距离，设计了调节传感器和目标距离的势能函数。无需对每个传感器节点控制器都添加了保持距离的势能函数，成本更低。
Description
技术领域
本发明涉及移动传感器的目标跟踪，具体是移动传感器网络基于蜂拥控制的单目标跟踪。
背景技术
近年来，移动传感器的使用越来越广泛，一般用于人为无法到达的监测的环境，或者超出静态传感器的感知半径，例如：室内危险品跟踪监测，火场监测，野外标本数据监测，化工厂气体监测等。
实现以上所有监测的前提是锁定跟踪目标，以往的移动传感器目标跟踪，需要每个节点获知目标信息（位置，速度等），这样节点的运动控制需要投入很高的成本。从控制的角度来说，能够进行计算的移动传感器实质上是智能体。
经对现有技术文献的检索发现，Saber等人提出了三种蜂拥控制算法，其中之一就是所有智能体获知目标信息时追踪目标的蜂拥控制算法。Saber提出的追踪目标的蜂拥控制算法，控制所有节点，成本最高。将牵制控制的思想引入蜂拥控制取得了一些重要的成果，即对少数节点施加控制以实现群集行为，苏厚胜等人提出少数节点具有虚拟领导者信息的蜂拥控制算法，汪小帆等人进一步基于人工势场法实现多智能体网络的牵制蜂拥同步，但这两种控制方法在跟踪者和目标之间没有引入保护跟踪者的势能函数。涂志亮等人针对移动传感器网络中动态目标的监测优化问题，提出基于蜂拥控制的传感器节点部署分布式控制算法，这种控制方法在实现跟踪者避免碰撞目标时对所有跟踪者都引入人工势能，这种控制成本高于对部分跟踪者引入人工势能。
发明内容
本发明是针对现有技术中同时确保控制少量节点降低成本和引入保护跟踪者的势能函数，提供了可以同时兼顾成本和安全的一种基于蜂拥控制的移动传感器目标跟踪的方法。
为解决上述技术问题，本发明提出了一种基于蜂拥控制的移动传感器目标跟踪的方法，包括以下步骤：
步骤一：建立移动传感器网络MSN（Mobile Sensor Network），所述移动传感器网络是一个由N个相同节点组成的移动传感器网络，并用无向图用来表示；
步骤二：设MSN的运动学方程为：
其中，i=1,2,…,N；xi,vi,ui∈Rn分别是节点i的位置、速度和加速度控制输入，且vi,ui有界；
步骤三：设MSN跟踪目标的运动学方程为：
步骤四：传感器节点的通信半径或观测半径为R，即与所述传感器的距离小于R的目标信息都可以被观测到，传感半径为Rs，采用布尔传感器模型，所述目标信息包括位置、速度和加速度；
步骤五：传感器需要与目标之间设置安全距离，建立势能函数：
则有
步骤六：设计如下ui控制律，对于每个所述节点i：
其中，c1,c2为正值。
进一步的，前述的一种基于蜂拥控制的移动传感器目标跟踪的方法，步骤一中所述无向图由G=(V,E,A)来表示，集合V={1,2,…,N}表示所有传感器节点，边集E={(i,j)|i,j∈V,i≠j}。用A=[aij]∈RN×N表示节点之间的邻接关系，称之为邻接矩阵，其中aij≠0是(i,j)∈E的等价表示，所述节点i和所述节点j之间的距离越近，邻接权值aij就越大，相互的影响也就越大；当距离大于一定值时，相互的影响可以不计。
进一步的，前述的一种基于蜂拥控制的移动传感器目标跟踪的方法，步骤二中所述ui为控制律，在只有本地和单跳邻居节点的信息可用时，得到稳定的网络拓扑结构，协同所有节点速度与目标一致，覆盖目标，并且所有节点与目标保持安全距离。
进一步的，前述的一种基于蜂拥控制的移动传感器目标跟踪的方法，步骤四中所述布尔传感器模型，位于xi处的传感器检测到xT处目标的概率为
所述节点i的单跳邻居集合为Ni＝{j|‖xi-xj‖≤R}，且使用GPS等定位系统的单跳通信使得传感器获知目标信息，若j∈Ni，那么所述节点i可以自身观测获取所述节点j的位置，速度和加速度的信息。
进一步的，前述的一种基于蜂拥控制的移动传感器目标跟踪的方法，步骤五中所述安全距离记作r，且当‖xi-xT‖≤r+δ，所述节点i开始受到目标的排斥力作用,δ为虚拟力的响应距离；
令
其中，
设所述势能函数：
则
同理，节点之间也要保持一定距离来避免碰撞，记节点间的安全距离和响应距离为r'，δ'。
进一步的，前述的一种基于蜂拥控制的移动传感器目标跟踪的方法，步骤六中在所述ui控制律中，第一行为目标跟踪项，使能直接观测到目标的节点加速度和速度趋于目标加速度和速度，并且保证节点和目标之间的安全距离；第二行为MSN节点的速度一致性项；第三行为MSN节点的防碰撞项，通过邻居节点的协同，在群体速度趋于一致的同时，保证节点之间的距离。节点i为获知目标信息的节点时，hi=1；否则，hi=0。
本发明采用以上技术方案具有以下技术效果：本发明设计的传感器节点控制器，在跟踪目标功能上，控制部分传感器节点，无需控制所有节点，节省了控制成本。在安全性上，考虑了保护传感器，与目标保持一定距离，设计了调节传感器和目标距离的势能函数。与此同时，本发明只对离目标最近的一些传感器节点添加了保持距离的势能函数，这样通过势能函数控制的节点更少，无需对每个传感器节点控制器都添加了保持距离的势能函数，成本更低。
附图说明
图1是t=0s时12个传感器在控制协议(3)作用下的初始状态示意图。
图2是t=10s时各传感器的运动示意图。
图3是t=50s时各传感器的运动示意图。
图4是群体的平均速度收敛于被跟踪的目标速度的示意图。
其中：。表示获知目标信息的传感器，·表示未获知目标信息的传感器，*表示被跟踪的目标。
具体实施方式
为了加深对本发明的理解，下面将结合附图和实施例对本发明作进一步详细描述，该实施例仅用于解释本发明，并不对本发明的保护范围构成限定。
本发明的实质是利用已知的网络模型、运动模型、传感器模型和目标模型的前提下，根据势能函数，新增了控制律ui控制节点的运动。
本发明的具体实施过程如下：
步骤一：建立移动传感器网络MSN（Mobile Sensor Network），所述移动传感器网络是一个由N个相同节点组成的移动传感器网络，并用无向图用来表示，所述无向图由G=(V,E,A)来表示，集合V={1,2,…,N}表示所有传感器节点，边集E={(i,j)|i,j∈V,i≠j}。用A=[aij]∈RN×N表示节点之间的邻接关系，称之为邻接矩阵，其中aij≠0是(i,j)∈E的等价表示，所述节点i和所述节点j之间的距离越近，邻接权值aij就越大，相互的影响也就越大；当距离大于一定值时，相互的影响可以不计；
步骤二：设MSN的运动学方程为：
其中，i=1,2,…,N；xi,vi,ui∈Rn分别是节点i的位置、速度和加速度控制输入，且vi,ui有界；
所述ui为控制律，在只有本地和单跳邻居节点的信息可用时，得到稳定的网络拓扑结构，协同所有节点速度与目标一致，覆盖目标，并且所有节点与目标保持安全距离；
步骤三：设MSN跟踪目标的运动学方程为：
步骤四：传感器节点的通信半径或观测半径为R，即与所述传感器的距离小于R的目标信息都可以被观测到，传感半径为Rs，采用布尔传感器模型，所述目标信息包括位置、速度和加速度；
所述布尔传感器模型，位于xi处的传感器检测到xT处目标的概率为：
所述节点i的单跳邻居集合为Ni＝{j|‖xi-xj‖≤R}，且使用GPS等定位系统的单跳通信使得传感器获知目标信息，若j∈Ni，那么所述节点i可以自身观测获取所述节点j的位置，速度和加速度的信息；
步骤五：传感器需要与目标之间设置安全距离，建立势能函数：
则有
所述安全距离记作r，且当‖xi-xT‖≤r+δ，所述节点i开始受到目标的排斥力作用,δ为虚拟力的响应距离；
令
其中，
设所述势能函数：
则有
同理，节点之间也要保持一定距离来避免碰撞，记节点间的安全距离和响应距离为r'，δ'；
步骤六：设计如下ui控制律，对于每个所述节点i：
其中，c1,c2为正值；
在所述ui控制律中，第一行为目标跟踪项，使能直接观测到目标的节点加速度和速度趋于目标加速度和速度，并且保证节点和目标之间的安全距离；第二行为MSN节点的速度一致性项；第三行为MSN节点的防碰撞项，通过邻居节点的协同，在群体速度趋于一致的同时，保证节点之间的距离，节点i为获知目标信息的节点时，hi=1；否则，hi=0。
针对MSN（Mobile Sensor Network）蜂拥系统的稳定性，做以下阐述：
定理1:对于一个由N个移动传感器构成的网络,其运动方程由公式(l)描述,目标运动方程由公式(2)描述，控制律为公式(3)，则有如下结论:
(1)所有传感器的速度渐渐收敛到与目标一致；
(2)各传感器之间的相对距离以及传感器与目标之间的相对距离收敛到定值；
(3)各传感器之间不会发生碰撞。
记那么由公式(1)，可推得i=1,2,…,N。设 由此控制律(3)可以重写为
定义Lyapunov函数为W=K+U，也是系统能量函数，具体为
对函数K和函数U分别求导，有
进而，可得函数W的导数
其中H=diag{h1,…,hN}，1N为元素全为1的N维列向量。若uT=0或H=IN(即h1,…,hN=1)，则有对于无向图G，方阵H和L都是正半定矩阵。c1>0时，c1H+L也是正半定矩阵，显然有总之，在满足uT=0或H=IN(即h1,…,hN=1)的前提下，c1>0是速度误差系统稳定的充分条件，使得所有传感器节点速度与目标趋于一致。由此结论(1)得证。由于vi＝vT＝vj，i≠j，i,j＝1,2,...,N，则vi-vj＝0，从而证明了结论(2)。
设系统的初始能量为W0(W0＞0)。定义水平集
由于W是关于连续函数，从而Ω是闭集。又因为由W的表达式(5)，可推知即进而所以Ω为有界闭正向不变集。根据LaSalle不变集原理，系统从水平集Ω出发的任意解会收敛到集合的最大不变集。
系统各传感器之间不会发生碰撞。我们采用反证法，假设发生碰撞即则节点之间势能函数导致W→∞，这与已知结论相矛盾，故假设不成立，结论(3)得到证明。
根据本发明的控制算法(3)和定理1，还可以得到新的结论定理2。
定理2:对于一个由N个移动传感器构成的网络，其运动方程由公式(l)描述，控制输入为公式(3)，目标运动方程由公式(2)描述。如果初始网络G(0)是连通的并且初始的能量W0为一个有限值，那么对于任意时间t≥0，网络G(t)保持连通。
假设网路G(t)在时刻tk(k=1,2,……)发生切换，于是G(t)在时间区间[tk-1,tk)的拓扑结构式固定的。在时间段[t0,t1)，能量方程W(t)对时间的导数为于是可以得到在时间段[t0,t1)有W(t)≤W0＜∞。从人工势能函数的定义，可知于是，可以得到时间段[t0,t1)所有存在的连边的距离都不会趋向R，这就说明了所有存在的连边都不会在切换时刻t1断开。因此，新连边会在切换时刻t1增加。因为存在加边延迟效应，所以新加边产生的势能会是一个有限值。因此，W(t1)为一个有限值。
根据相似的分析方法，可以算出能量W(t)在时间段[tk-1,tk)对时间的导数为
于是可以得到在时间段[tk-1,tk)(k=1,2,……)有
W(t)≤W(tk-1)＜∞
因此，在时间段[tk-1,tk)(k=1,2,……)所有存在的连边的距离都不会趋向R，这就说明了所有存在的连边都不会在切换时刻tk断开。因为存在加边延迟效应，所以在时刻tk的能量W(tk)为一个有限值。
因为G(0)是连通的并且所有初始连边E(0)都不会断开，所以对于任意时间t≥0，网络G(t)保持连通。至此，定理2得证。
利用MATLAB的M文件编制程序仿真来验证此发明中所提分布式控制器设计方案的正确性与有效性。在移动传感器网络中，往往用群体的平均速度是否趋近于目标的速度考察系统的跟踪性能。
取12个具有相同动态方程的传感器，在控制律(3)的作用下运动在二维空间，通信半径R为4.5，初始位置和初始速度在[0,5]×[0,5]及[0,0.01]×[0,0.01]内随机选择，目标的初始位置[0;0]，速度始终保持[1;1]。其他参数设置：c1=0.5，c2=0.5，ε=0.1，h=0.2，r=2，δ=0.1，r'=3.464，δ'=0.2。
其中：。表示获知目标信息的传感器，·表示未获知目标信息的传感器，*表示被跟踪的目标。
采用四阶Runge-Kutta方法不断更新传感器的当前位置和速度，以下是当加速度为控制输入时，移动传感器的位置、速度更新方程：
其中，tt为更新的时间间隔，q(i)、p(i)为当前时刻传感器i的位置和速度，q1(i)、p1(i)为上一时刻传感器i的位置和速度。
综上所述，本发明设计的传感器节点控制器，在跟踪目标功能上，控制部分传感器节点，无需控制所有节点，节省了控制成本。在安全性上，考虑了保护传感器，与目标保持一定距离，设计了调节传感器和目标距离的势能函数。与此同时，本发明只对离目标最近的一些传感器节点添加了保持距离的势能函数，这样通过势能函数控制的节点更少，无需对每个传感器节点控制器都添加了保持距离的势能函数，成本更低。本发明同时兼顾低成本、高性能、安全等优点，可广泛用于移动传感器网络的单目标跟踪。
Claims (3)
1.一种基于蜂拥控制的移动传感器目标跟踪的方法，其特征在于，包括以下步骤：
步骤一：建立移动传感器网络MSN，所述移动传感器网络是一个由N个相同节点组成的移动传感器网络，并用无向图用来表示；所述无向图由G＝(V,E,A)来表示，集合V＝{1,2,…,N}表示所有传感器节点，边集E＝{(i,j)|i,j∈V,i≠j}，用A＝[aij]∈RN×N表示节点之间的邻接关系，称之为邻接矩阵，其中aij≠0是(i,j)∈E的等价表示，所述节点i和所述节点j之间的距离越近，邻接权值aij就越大，相互的影响也就越大；当距离大于一定值时，相互的影响可以不计；
步骤二：设MSN的运动学方程为：
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>i</mi>
</msub>
<mo>=</mo>
<msub>
<mi>v</mi>
<mi>i</mi>
</msub>
<mo>,</mo>
<msub>
<mover>
<mi>v</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>i</mi>
</msub>
<mo>=</mo>
<msub>
<mi>u</mi>
<mi>i</mi>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
其中，i＝1,2,…,N；xi,vi,ui∈Rn分别是节点i的位置、速度和加速度控制输入，且vi,ui有界；
步骤三：设MSN跟踪目标的运动学方程为：
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>T</mi>
</msub>
<mo>=</mo>
<msub>
<mi>v</mi>
<mi>T</mi>
</msub>
<mo>,</mo>
<msub>
<mover>
<mi>v</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>T</mi>
</msub>
<mo>=</mo>
<msub>
<mi>u</mi>
<mi>T</mi>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mrow>
步骤四：传感器节点的通信半径或观测半径为R，即与所述传感器的距离小于R的目标信息都可以被观测到，传感半径为Rs，采用布尔传感器模型，所述目标信息包括位置、速度和加速度；所述布尔传感器模型，位于xi处的传感器检测到xT处目标的概率为：
<mrow>
<mi>P</mi>
<mrow>
<mo>(</mo>
<mi>i</mi>
<mo>,</mo>
<mi>T</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mn>1</mn>
<mo>,</mo>
<mo>|</mo>
<mo>|</mo>
<msub>
<mi>x</mi>
<mi>i</mi>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mi>T</mi>
</msub>
<mo>|</mo>
<mo>|</mo>
<mo>&le;</mo>
<msub>
<mi>R</mi>
<mi>s</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mn>0</mn>
<mo>,</mo>
<mo>|</mo>
<mo>|</mo>
<msub>
<mi>x</mi>
<mi>i</mi>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mi>T</mi>
</msub>
<mo>|</mo>
<mo>|</mo>
<mo>></mo>
<msub>
<mi>R</mi>
<mi>s</mi>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
所述节点i的单跳邻居集合为Ni＝{j|||xi-xj||≤R}，且使用GPS定位系统的单跳通信使得传感器获知目标信息，若j∈Ni，那么所述节点i可以自身观测获取所述节点j的位置，速度和加速度的信息；
步骤五：传感器需要与目标之间设置安全距离，建立势能函数：
<mrow>
<mi>&Psi;</mi>
<mrow>
<mo>(</mo>
<mi>z</mi>
<mo>,</mo>
<mi>r</mi>
<mo>,</mo>
<mi>&delta;</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<munderover>
<mo>&Integral;</mo>
<mi>z</mi>
<mrow>
<mo>|</mo>
<mo>|</mo>
<mi>r</mi>
<mo>+</mo>
<mi>&delta;</mi>
<mo>|</mo>
<msub>
<mo>|</mo>
<mi>&sigma;</mi>
</msub>
</mrow>
</munderover>
<mi>&psi;</mi>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>,</mo>
<mi>r</mi>
<mo>,</mo>
<mi>&delta;</mi>
<mo>)</mo>
</mrow>
<mi>d</mi>
<mi>s</mi>
</mrow>
则有
其中，z为传感器与目标间的实际距离，r为传感器与目标间的安全距离，δ为虚拟力的响应距离，s为节点i和节点j间的距离；
步骤六：设计如下ui控制律，对于每个所述节点i：
<mrow>
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>u</mi>
<mi>i</mi>
</msub>
<mo>=</mo>
<msub>
<mi>h</mi>
<mi>i</mi>
</msub>
<msub>
<mi>u</mi>
<mi>T</mi>
</msub>
<mo>-</mo>
<msub>
<mi>h</mi>
<mi>i</mi>
</msub>
<msub>
<mi>c</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>v</mi>
<mi>i</mi>
</msub>
<mo>-</mo>
<msub>
<mi>v</mi>
<mi>T</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>-</mo>
<msub>
<mi>h</mi>
<mi>i</mi>
</msub>
<msub>
<mi>c</mi>
<mn>2</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mi>T</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>h</mi>
<mi>i</mi>
</msub>
<mi>&psi;</mi>
<mrow>
<mo>(</mo>
<mo>|</mo>
<mo>|</mo>
<msub>
<mi>x</mi>
<mi>i</mi>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mi>T</mi>
</msub>
<mo>|</mo>
<msub>
<mo>|</mo>
<mi>&sigma;</mi>
</msub>
<mo>)</mo>
</mrow>
<mfrac>
<mrow>
<msub>
<mi>x</mi>
<mi>i</mi>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mi>T</mi>
</msub>
</mrow>
<mrow>
<mo>|</mo>
<mo>|</mo>
<msub>
<mi>x</mi>
<mi>i</mi>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mi>T</mi>
</msub>
<mo>|</mo>
<msub>
<mo>|</mo>
<mi>&sigma;</mi>
</msub>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>+</mo>
<munder>
<mo>&Sigma;</mo>
<mrow>
<mi>j</mi>
<mo>&Element;</mo>
<msub>
<mi>N</mi>
<mi>i</mi>
</msub>
</mrow>
</munder>
<msub>
<mi>a</mi>
<mrow>
<mi>i</mi>
<mi>j</mi>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>X</mi>
<mo>)</mo>
</mrow>
<mrow>
<mo>(</mo>
<msub>
<mi>v</mi>
<mi>j</mi>
</msub>
<mo>-</mo>
<msub>
<mi>v</mi>
<mi>i</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<munder>
<mo>&Sigma;</mo>
<mrow>
<mi>j</mi>
<mo>&Element;</mo>
<msub>
<mi>N</mi>
<mi>i</mi>
</msub>
</mrow>
</munder>
<mi>&psi;</mi>
<mrow>
<mo>(</mo>
<mo>|</mo>
<mo>|</mo>
<msub>
<mi>x</mi>
<mi>i</mi>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mi>T</mi>
</msub>
<mo>|</mo>
<msub>
<mo>|</mo>
<mi>&sigma;</mi>
</msub>
<mo>)</mo>
</mrow>
<mfrac>
<mrow>
<msub>
<mi>x</mi>
<mi>j</mi>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mi>i</mi>
</msub>
</mrow>
<mrow>
<mo>|</mo>
<mo>|</mo>
<msub>
<mi>x</mi>
<mi>j</mi>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mi>i</mi>
</msub>
<mo>|</mo>
<msub>
<mo>|</mo>
<mi>&sigma;</mi>
</msub>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
</mtable>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>3</mn>
<mo>)</mo>
</mrow>
</mrow>
1
其中，c1,c2为正值；aij(X)为位置X处的节点i和节点j之间的邻接权值，Ni为节点i的单跳邻居集合；
在所述ui控制律中，第一行为目标跟踪项，使能直接观测到目标的节点加速度和速度趋于目标加速度和速度，并且保证节点和目标之间的安全距离；第二行为MSN节点的速度一致性项；第三行为MSN节点的防碰撞项，通过邻居节点的协同，在群体速度趋于一致的同时，保证节点之间的距离，节点i为获知目标信息的节点时，hi＝1；否则，hi＝0。
2.根据权利要求1所述的一种基于蜂拥控制的移动传感器目标跟踪的方法，其特征在于：所述ui为控制律，在只有本地和单跳邻居节点的信息可用时，得到稳定的网络拓扑结构，协同所有节点速度与目标一致，覆盖目标，并且所有节点与目标保持安全距离。
3.根据权利要求1所述的一种基于蜂拥控制的移动传感器目标跟踪的方法，其特征在于：所述安全距离记作r，且当||xi-xT||≤r+δ，所述节点i开始受到目标的排斥力作用,δ为虚拟力的响应距离；
令
其中，
设所述势能函数：
<mrow>
<mi>&Psi;</mi>
<mrow>
<mo>(</mo>
<mi>z</mi>
<mo>,</mo>
<mi>r</mi>
<mo>,</mo>
<mi>&delta;</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<munderover>
<mo>&Integral;</mo>
<mi>z</mi>
<mrow>
<mo>|</mo>
<mo>|</mo>
<mi>r</mi>
<mo>+</mo>
<mi>&delta;</mi>
<mo>|</mo>
<msub>
<mo>|</mo>
<mi>&sigma;</mi>
</msub>
</mrow>
</munderover>
<mi>&psi;</mi>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>,</mo>
<mi>r</mi>
<mo>,</mo>
<mi>&delta;</mi>
<mo>)</mo>
</mrow>
<mi>d</mi>
<mi>s</mi>
</mrow>
则
同理，节点之间也要保持一定距离来避免碰撞，记节点间的安全距离和响应距离为r'，δ'。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201310205840.7A CN104185310B (zh) | 2013-05-27 | 2013-05-27 | 一种基于蜂拥控制的移动传感器目标跟踪的方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201310205840.7A CN104185310B (zh) | 2013-05-27 | 2013-05-27 | 一种基于蜂拥控制的移动传感器目标跟踪的方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN104185310A CN104185310A (zh) | 2014-12-03 |
| CN104185310B true CN104185310B (zh) | 2017-12-05 |
Family
ID=51965954
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201310205840.7A Expired - Fee Related CN104185310B (zh) | 2013-05-27 | 2013-05-27 | 一种基于蜂拥控制的移动传感器目标跟踪的方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN104185310B (zh) |
Families Citing this family (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN110262523B (zh) * | 2019-07-31 | 2022-05-27 | 华东交通大学 | 一种分布式群体机器人的自主避障蜂拥控制方法 |
| CN115022892B (zh) * | 2022-05-31 | 2023-12-01 | 南京邮电大学 | 基于改进虚拟力的化工厂环境中传感器节点部署方法 |
Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101394422A (zh) * | 2008-11-06 | 2009-03-25 | 上海交通大学 | 时效性约束下无线传感网络生命期最大化的跨层优化方法 |
| CN101521872A (zh) * | 2009-02-25 | 2009-09-02 | 南京邮电大学 | 一种基于无线多媒体传感器网络区域目标跟踪方法 |
| CN102547973A (zh) * | 2010-12-17 | 2012-07-04 | 上海工程技术大学 | 一种基于rssi的多传感器融合移动节点跟踪方法 |
| CN102573052A (zh) * | 2011-04-13 | 2012-07-11 | 中国人民解放军国防科学技术大学 | 一种基于无线传感器网络的目标定位跟踪方法及系统 |
Family Cites Families (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US8892704B2 (en) * | 2006-04-07 | 2014-11-18 | The Mitre Corporaton | Dynamic rule-based distributed network operation for wireless sensor networks |
-
2013
- 2013-05-27 CN CN201310205840.7A patent/CN104185310B/zh not_active Expired - Fee Related
Patent Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101394422A (zh) * | 2008-11-06 | 2009-03-25 | 上海交通大学 | 时效性约束下无线传感网络生命期最大化的跨层优化方法 |
| CN101521872A (zh) * | 2009-02-25 | 2009-09-02 | 南京邮电大学 | 一种基于无线多媒体传感器网络区域目标跟踪方法 |
| CN102547973A (zh) * | 2010-12-17 | 2012-07-04 | 上海工程技术大学 | 一种基于rssi的多传感器融合移动节点跟踪方法 |
| CN102573052A (zh) * | 2011-04-13 | 2012-07-11 | 中国人民解放军国防科学技术大学 | 一种基于无线传感器网络的目标定位跟踪方法及系统 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN104185310A (zh) | 2014-12-03 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| Liang et al. | Distributed coordinated tracking control of multiple unmanned surface vehicles under complex marine environments | |
| CN109379125B (zh) | 一种多智能体编队控制方法及系统 | |
| Ge et al. | Distributed formation control of networked multi-agent systems using a dynamic event-triggered communication mechanism | |
| Liu et al. | Event-triggered coordination for formation tracking control in constrained space with limited communication | |
| Chen et al. | Formation control: a review and a new consideration | |
| CN110658821B (zh) | 一种多机器人抗干扰分组时变编队控制方法及系统 | |
| Ailon | Simple tracking controllers for autonomous VTOL aircraft with bounded inputs | |
| Tang et al. | Swarm robots search for multiple targets based on an improved grouping strategy | |
| CN107065859A (zh) | 多移动机器人的轨迹预测方法 | |
| Yang et al. | Event-triggered finite-time formation control for multiple unmanned aerial vehicles with input saturation | |
| CN113341956A (zh) | 基于改进人工势场法的多智能体主从式编队控制方法 | |
| CN112947086A (zh) | 一种无人机和无人车组成的异构多智能体系统编队控制中执行器故障的自适应补偿方法 | |
| CN104185310B (zh) | 一种基于蜂拥控制的移动传感器目标跟踪的方法 | |
| CN110412984B (zh) | 一种群集安全一致性控制器及其控制方法 | |
| Tnunay et al. | Distributed collision-free coverage control of mobile robots with consensus-based approach | |
| Cui et al. | Byzantine resilient joint localization and target tracking of multi-vehicle systems | |
| Shen et al. | Multi-robot cooperative hunting | |
| Sabattini et al. | Achieving the desired dynamic behavior in multi-robot systems interacting with the environment | |
| Li et al. | A control strategy for unmanned surface vehicles flocking | |
| CN111007848A (zh) | 一种基于有界空间的多智能体协同作业控制方法 | |
| Chen | UUV path planning algorithm based on virtual obstacle | |
| Zhou et al. | Time-varying formation tracking for UAV swarm systems with switching interaction topologies | |
| Li et al. | Cooperative attitude synchronization for rigid-body spacecraft via varying communication topology | |
| CN114265315A (zh) | 异构线性集群系统时变输出编队跟踪控制方法及系统 | |
| Wang | Multi-agent time-varying formation control based on consistency |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| PB01 | Publication | ||
| C10 | Entry into substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant | ||
| CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20171205 |