[发明专利]一种网络化多智能体主动变拓扑的自主协同定位方法

权利要求书

1.一种网络化多智能体主动变拓扑的自主协同定位方法，所述网络化多智能体包括：m个基准智能体构成的集合M和n个普通智能体构成的集合N，m≥3，n≥1，其特征在于，该方法包括以下步骤：

1)定位开始前，通过迭代运算每个普通智能体获得由m个基准智能体包络的位置估计初值的计算基准以及速度估计初值的计算基准，具体步骤如下：

记第i个智能体对于自身位置的估计为r_i，对于自身速度的估计为v_i，i∈M∪N；若任意两个智能体i和j满足距离感知和互相通信条件时，称智能体i与j互为邻居，记邻近变量表示为a_ij＝1，否则表示为a_ij＝0；当a_ij＝1时，两个智能体i和j感知到相对之间的距离测量值表示为标量ρ_ij，距离变率的测量值表示为标量

1-1)对于每个智能体i∈M∪N，分别建立矢量x_i，y_i，tempx_i，tempy_i；

1-2)对于每个基准智能体i∈M，恒等赋值x_i＝r_i，y_i＝v_i，每个基准智能体的r_i和v_i均为实时已知量；对于每个普通智能体i∈N，初始化赋值x_i，y_i分别为零向量；

1-3)每次迭代过程中，每个智能体i∈M∪N赋值tempx_i＝x_i，tempy_i＝y_i；随后，该智能体向邻居j发送自身的tempx_i，tempy_i并接收邻居的发送的tempx_j，tempy_j，则迭代后每个基准智能体i∈M均不更新自己的x_i与y_i，每个普通智能体i∈N按照式(1)更新自身的x_i与y_i：

其中，κ_i是正数，0＜κ_i≤1/Σ_j∈M∪Na_ij，Δt表示两次迭代之间的时间间隔；

1-4)重复步骤1-3)，当步骤1-3)迭代的次数达到迭代次数上限K时，停止迭代，每个普通智能体i∈N获得由m个基准智能体包络的位置估计初值的计算基准r_avg{i}＝x_i以及速度估计初值的计算基准v_avg{i}＝y_i；

2)令当前时刻为k＝0时刻，利用步骤1)得到的结果，每个普通智能体i∈N根据式(2)分别初始化自身位置估计值和速度估计值后，进入定位阶段；表达式如下：

其中，r_i[0]为k＝0时刻普通智能体i的自身位置估计初值，v_i[0]为k＝0时刻普通智能体i的自身速度估计初值，rand()表示取值介于0～1之间小数的随机函数；

3)定位第一阶段；k＝k+1时刻，k＝1,2,…,T，每个普通智能体i∈N迭代更新自己的位置估计，进行定位的第一阶段，具体步骤如下：

3-1)每个智能体i∈M∪N向邻居智能体发送自己上一时刻，即k时刻，对自身位置的估计r_i[k]，并获取来自邻居智能体的r_j[k]，同时通过通信或测量获得k+1时刻与邻居智能体j的距离测量值ρ_ij[k+1]；

3-2)每个普通智能体i∈N，针对每一个邻居智能体j，主动改变计算层面的本地拓扑关系a_ij，生成新的本地拓扑关系表达式如式(3)所示：

其中，bi_trans(a_ij)表示一个满足具有随机性质的、取值只能等于0或1且满足的二值函数；

3-3)根据步骤3-2)变拓扑的结果，每个普通智能体i∈N按式(5)更新对自身的位置估计：

其中，||a||表示向量a的模长，β_i表示收敛因子且β_i＞0，p_ij表示方向与r_j[k]-r_i[k]相同的单位向量；

3-4)每个普通智能体i∈N保持对自身速度的估计不变，即v_i[k+1]＝v_i[k]；

3-5)重复步骤3-1)至3-4)，当迭代次数达到T次时，定位第一阶段结束，进入定位第二阶段；

4)定位第二阶段；k＝k+1时刻，k＝T+1,T+2,T+3,…，每个普通智能体i∈N迭代更新自己的位置估计和速度估计，进行定位的第二阶段，具体步骤如下：

4-1)每个智能体i∈M∪N向邻居智能体发送自己上一时刻，即k时刻，对自身位置的估计r_i[k]与速度估计v_i[k]，并获取来自邻居智能体的r_j[k]与v_j[k]，同时获得k+1时刻与邻居智能体j的距离测量值ρ_ij[k+1]及距离变率测量值

4-2)每个普通智能体i∈N按照式(6)更新对自身速度的估计：

v_i[k+1]＝mldivide(A,B) (6)

其中，mldivide(A,B)表示矩阵左除，即x＝mldivide(A,B)是方程A·x＝B的最小二乘解；式(6)中，矩阵A的每一行是对应于a_ij＝1的行向量(r_i[k]-r_j[k])^T，上标T表示转置；矩阵B的每一行是对应于相应j的标量，该标量等于

4-3)每个普通智能体i∈N，针对每一个邻居智能体j，主动改变计算层面的本地拓扑关系a_ij，生成新的当前本地拓扑关系表达式如式(3)所示；

4-4)根据步骤4-3)的变拓扑的结果，每个普通智能体i∈N按式(7)更新对自身位置的估计：

其中，0＜λ_i≤1表示衡量普通智能体i∈N运动匀速程度的因子，称为匀速因子；

5)当迭代次数k≥500后，网络化多智能体完成自主协同定位，输出定位结果：每个普通智能体i∈N的定位结果为当前时刻的自身位置估计r_i[k]，定速结果为当前时刻的自身速度估计v_i[k]。