买专利卖专利找龙图腾，真高效！ 查专利查商标用IPTOP,全免费！专利年费监控用IP管家,真方便！

申请/专利权人：北京理工大学

摘要：本发明公开了多无人车群组规模自适应分组的终端时间协同控制方法，属于多智能体控制领域，包括以下步骤：构建无人车与目标位置的相对运动学模型；由初始状态估算无人车终端时间，获得所有无人车的终端时间范围估计；构建无人车群组的通信网络结构，使每个无人车了解到所有无人车的终端时间范围估计；根据各无人车终端时间范围估计及所需的各群组最小规模，进行群组划分；采用非光滑控制方法设计垂直于视线方向加速度分量控制；基于各群组无人车之间的信息交互，确定沿视线方向的加速度分量控制；将垂直于视线和沿视线方向的加速度控制转化为无人车的加速度与角加速度控制，判断各群组内无人车是否同时到达目标位置。

主权项：1.多无人车群组规模自适应分组的终端时间协同控制方法，其特征在于，包括以下步骤：步骤1、构建无人车与目标位置之间的相对运动学模型；步骤2、根据步骤1构建的相对运动学模型，计算各无人车的终端时间估计，并通过速度限制确定各无人车的终端时间范围估计；步骤3、构建各无人车之间的通信网络结构，使各无人车进行多次信息交互，得到全体无人车的终端时间范围估计；步骤4、根据各无人车终端时间范围估计和各群组中所需的最少无人车规模数量，确定各群组无人车的时间范围可达域，完成无人车规模自适应群组划分；步骤5、在步骤1构建的相对运动学模型的基础上，利用非光滑控制构建垂直于视线方向的加速度分量控制，使各无人车垂直于视线方向的速度分量在期望时间内收敛为零；步骤6、根据步骤1构建的相对运动学模型及无人车之间的信息交互，建立沿视线方向的加速度分量控制；步骤7、根据步骤3中的通信网络结构和步骤4中的无人车的分组情况及步骤5和步骤6建立的垂直于视线方向和沿视线方向的加速度控制方案，构建无人车的加速度与角加速度控制方案；步骤8、根据步骤1构建的相对运动学模型及步骤3中的通信网络结构，更新无人车的位置和速度，判断各群组内无人车是否同时到达目标位置，若各群组内无人车同时抵达目标位置，则停止对外发送信息；若各群组内无人车没有同时抵达目标位置，则将各群组落后的无人车重新进行群组划分，返回步骤5继续执行；步骤1的具体过程如下：在惯性坐标系下，针对无人车群组对无人车建立如下运动学模型： 其中，x*i,y*i为无人车质心的位置坐标，θi为无人车i的航向角，具体为速度与x轴正方向夹角，ωi为无人车航向角变化速率，vi为无人车速度，aq,i与af,i分别表示无人车i的切向加速度与法向加速度；假设目标位置为x#,y#，则无人车i与目标的相对位置关系通过以下运动模型描述： 其中，为无人车i与目标位置间的距离，λi＝atan2x#-x*i，y#-y*i为无人车i的视线角，φi为无人车i的前置角，根据相对位置的运动学模型，进一步建立相对位置与控制输入的关系模型如下： 其中，uy,i＝aq,icosφi-af,isinφi,uc,i＝aq,isinφi-af,icosφi分别表示无人车沿视线方向和垂直于视线方向的加速度控制输入；步骤2中通过速度限制确定各无人车的终端时间范围估计的具体表达式如下： 其中，和分别为无人车从初始位置抵达目标位置的所需要的最短时间估计和最长时间估计，为无人车可实现的速度范围；步骤3中全体无人车的终端时间范围估计的具体过程如下：S31、构建通信网络结构其中包括以各无人车为顶点的集合以及表示无人车通信交互关系的边集合S32、在通信网络结构中，无人车i向邻居j∈Ni发送自身终端时间范围估计，并接收邻居j的终端时间范围估计，经过n-1次信息交互后，各无人车获得所有无人车的终端时间范围估计，其中，Ni为无人车i的邻居集合；步骤4中由各无人车的终端时间范围估计和各群组中所需的最少无人车规模数量，得到各群组无人车时间范围可达域进行无人车规模自适应群组划分，具体操作如下：S41、将各无人车终端时间范围上界进行升序排序，m＝1,2，…,n，并将无人车从1到n进行重新编号，满足S42、令s＝1，将无人车n至无人车ks＝n-P+1归入到第1群组中，P为各群组中所含无人车最少数量，假设第一组时间范围可达域不为空集；S43、判断此时未分组无人车数量是否大于P；S431、若此时未分组无人车数量仍大于P，则更新s＝s+1，ks＝ks-1-P,判断是否为空集；S4311、如果不为空集，则将编号ks-1-1至ks无人车划分为第s群组，跳转至S43；S4312、若为空集，则令ks-1＝ks-1-1,ks＝ks-1，将无人车ks-1纳入到第s-1群组，无人车ks纳入到第s群组，判断是否为空集，跳转至S4311；S432、若此时剩余无人车数量小于P，则进入群组数量反向调节部分，跳转至S44；S44、令ks＝1,h＝s，h为划分后的群组数量，判断是否为空集；S441、若不为空集，则将无人车ks-1-1至无人车ks正式划分为第s群组，跳转至S45；S442、若为空集，则令ks-1＝ks-1-1，将无人车ks-1划分到第s-1群组，判断是否为空集，跳转至S441；S45、判断是否遍历所有无人车，s是否大于1；S451、若s大于1，令s＝s-1，判断是否为空集，跳转至S441；S452、若s不大于1，跳转至S46；S46、完成无人车群组划分步骤5中采用非光滑控制方法来构建垂直于视线方向的加速度控制的具体表达式如下： 其中，gi,ac,i,bc,i＞0为常参数，且满足0＜ac,i＜1＜bc,i，sgnβ·具体为：sgnβx＝|xβsignx其中，sign·为符号函数；步骤6中建立沿视线方向的加速度分量控制的具体表达式如下： 其中，li0为收敛系数，aij表示通信拓扑邻接矩阵的元，其中，aii＝0，如果无人车i接受无人车j所发出的信息，则aij0，否则aij＝0；步骤7中构建无人车的加速度与角加速度控制方案的具体过程如下：S71、通过构建的通信网络结构满足无人车i到邻居无人车j均存在连通路径；S72、若无人车j已抵达目标或者两者不在同一群组内，则停止发送信息，S73、无人车i加速度与角加速度控制如下表示： 其中 步骤8中根据变量χ的取值判断同一群组中的无人车是否全部抵达目标位置，具体表达式如下： 其中，rs,i代表第s群组中编号为i的无人车当前位置与目标位置之间的距离；当χ＝1，则表示第s群组中无人车全部同时抵达目标位置；当χ＝0，则表示第s群组中无人车没有全部同时抵达目标位置。

全文数据：

权利要求：

百度查询： 北京理工大学 多无人车群组规模自适应分组的终端时间协同控制方法