法律状态公告日
法律状态信息
法律状态
2019-07-26
授权
授权
2017-02-01
实质审查的生效 IPC(主分类):G05D1/02 申请日:20160819
实质审查的生效
2017-01-04
公开
公开
技术领域
本发明涉及多机器人系统领域,具体涉及一种分布式多机器人系统协作控制方法。
背景技术
移动机器人由于具有可移动性,可以代替人到各种环境中执行探险、探测和巡查等任务。移动机器人经过多年的研究与发展,已经逐步走向实用化,在制造业、物流业、军事等多个领域,已经有了不少使用移动机器人提高生产效率或者替代人工作业的实例。而在一些诸如国防等具有重大战略意义的项目中,移动机器人的需求也日益明显。随着科技的进步,多移动机器人系统在月球探测、深海开发、战争、反恐、地震救助、高危品处理等领域逐渐发挥出巨大的作用,并显现出广泛的应用前景。尤其是在广阔的环境中,多机器人系统中各个机器人因距离以及随身可携带负载的限制,通常不具有全局通信的能力,也即,多机器人系统中,每个机器人只能与自己附近的机器人通信。多机器人系统的控制可分为中央式和分布式,中央式维护一个中央模块负责整体任务决策;而分布式结构中每个机器人根据自身以及邻居机器人的状态进行决策。在大规模环境下,机器人之间有可能因为彼此之间距离较远而难以通信,导致信息不能随时、随地进行共享,而现有研究中一般都假设多机器人之间的通讯距离满足无穷大,因此可以随时、随地进行通讯,而很少有研究能够考虑多机器人之间的通信距离约束问题。
发明内容
本发明所要解决的技术问题是提供一种分布式的、用于多机器人系统的竞争协作巡查控制方法,能克服通信距离受限的不足,较好地完成多机器人系统竞争协作的巡查控制任务。
为解决上述技术问题,本发明通过以下技术方案予以实现:
一种分布式多机器人系统竞争协作的巡查控制方法,包括如下步骤:
1)多机器人系统中的每个机器人(共有n个)在工作空间中随机分布,各自实时地获得自己与移动目标物的距离,且距离小于最大通信距离的机器人之间相互交换自己与移动目的物的距离信息。即第i个机器人能够实时地获得其与移动目标物之间的距离di,此外,第i个机器人以其所在位置(xi,yi)为圆心,半径为最大通信距离dc的范围内的机器人通信,互相交换距离信息di;
2)基于步骤1)的距离信息di,各个机器人通过算法自行确定(即竞争)自己是否属于m(m<n)个距离移动目标物最近的机器人之一,即各个机器人通过算法自行确定自己是否需要保持在启动状态;
3)基于步骤2)的结果,前m个距离移动目标物最近的机器人启动完成巡查移动目标物任务,其余机器人不动。
2、定义一个矩阵
>
>
zik+1=-γ(nηik+1-m)τ+zik,
>
其中,si对应于第i个机器人的启动状态,即当其为0时,第i个机器人不启动,否则启动,si的初始值sik=0=si0随机给定即可,值得指出的是,经过一定的迭代次数,si的状态为1或0;zi、ηi与μi为辅助变量,其初始值随机给定;di为第i个机器人实时获得的其与移动目标物之间的距离;
3、将上述步骤中第i个机器人所获得的
>
其中,
附图说明
图1为本发明流程图。
图2为双轮差分驱动的移动机器人底座示意图。
图3为多机器人系统中各个机器人在发现移动目标物时的分布示意图。
图4为多机器人系统中获得竞争胜利(即距离移动目标物最近)的机器人对移动目标物时进行巡查的示意图。
具体实施方式
下面结合附图对本发明做进一步的说明。
图1所示的一种分布式多机器人系统竞争协作的巡查控制方法,首先各个机器人实时地获得自己与移动目标物的距离,且距离小于最大通信距离的机器人之间相互交换信息;然后各个机器人通过算法自行确定(即竞争)自己是否属于m(m<n)个距离移动目标物最近的机器人之一;最后前m个距离移动目标物最近的机器人启动以追踪巡查移动目标物,其余机器人不动。
图2为双轮差分驱动的移动机器人底座示意图,其底座双轮之间的距离为l=5.3厘米。
如图3所示的多机器人系统中的每个机器人(共有10个)在工作空间中随机分布,各自实时地获得自己与移动目标物的距离di,且距离小于最大通信距离dc的机器人之间相互交换信息。即第i个机器人能够实时地获得其与移动目标物之间的距离di。每次任务只派出距离移动目标物最近的一个机器人前往巡查,即多机器人系统每次竞争的优胜者只有一个,也即m=1。定义一个矩阵
>
>
zik+1=-γ(10ηik+1-1)τ+zik,
>
其中,si对应于第i个机器人的启动状态,即当其为0时,第i个机器人不启动,否则启动,si的初始值sik=0=si0随机给定即可。值得指出的是,经过一定的迭代次数,si的状态为1或0;zi、ηi与μi为辅助变量,其初始值随机给定;di为第i个机器人实时获得的其与移动目标物之间的距离;b=0.01;j∈N(i)表示与第i个机器人连接权值为1的机器人编号;γ=10000;τ=0.01秒;c0=5与c1=5;上标k表示第k次迭代。每个机器人独立地决定是否保持在启动状态,即每次迭代后第i个机器人所获得的
>
其中,
如图4所示的多机器人系统中的第7个机器人追踪上移动目标物进行巡查。
机译: COOPMAX:一种用于IEEE 802.16网络的具有分布式分布式空间时间编码的协作MAC
机译: 一种改进分布式和协作产品制造的系统
机译: 一种改善分布式和协作产品制造的系统