专利名称：一种任意队形的群移动机器人密度控制方法
一种任意队形的群移动机器人密度控制方法技术邻域本发明涉及一种任意队形的移动群机器人密度控制方法，属于移动多机器人技术 邻域中的队形控制技术领域。
背景技术：
群移动群机器人系统是由数量众多的微小型移动机器人组成的，适合于侦察、救 援等协作邻域的应用。如何有效组织数量众多的微小型机器人协同工作是群移动群机器人 系统一个重要的课题。在完成任务的过程中，为了有效控制移动机器人之间的间距，以保证 机器人群体的通讯覆盖范围和感知覆盖范围，要求机器人之间不至过于分散，同时，又不至 于过度拥挤而造成碰撞，这是微小型移动群机器人系统应用的基础问题之一。目前，基于多 机器人的队形控制问题主要是特定的刚性几何形状而进行的。此类方法存在的问题是队 形不具备动态调整的能力，灵活性差，在未知环境中的适应性能力不强，移动机器人的密度 不进行专门控制等，造成通讯可能中断或感知范围得不到保障。
发明内容
本发明解决了移动机器人进行过程中机器人密度保持问题，解决了传统多机器人 队形控制方法在先进过程中机器人密度控制与队形变换冲突的问题，同时，改善了传统方 法对未知环境的适应性。该一种任意队形的群移动机器人密度控制方法，其实现步骤如下步骤一、移动机器人的聚群移动机器人检测附近的机器人，统计其感知邻域内的 伙伴数目及分布方位，并向机器人数量较多的方位作为移动方向前进一步，反复执行此过 程直到机器人聚群；步骤二、设定群移动机器人的前进目标点，在各机器人上根据机器人与目标点之 间的距离关系施加一个目标对机器人的目标吸引虚拟力；如果移动机器人之间距离小于预 设值或当障碍物在其排斥范围内时，在机器人上再施加一个虚拟排斥合力，机器人在行进 过程中，每一步移动步长根据目标吸引虚拟力、虚拟排斥合力和拥挤因子的变化而变化；步骤三、移动机器人群的密度发生变化时，如果移动机器人之间相对位置处于可 压缩范围之外，则进行调整如果移动机器人的密度过于拥挤，移动机器人则通过弹簧模型 相互排斥；如果过于分散，则转步骤一，执行聚群行为；当移动机器人间的相对位置处于可 压缩范围内，则无需调整；步骤四、检测群移动机器人是否到达目标位置，若到达目标位置，则整个运动过程 结束；否则，转步骤一。步骤一中移动机器人通过安装在自身周围的传感器检测附近邻域内的机器人。步骤二中合力为机器人之间的排斥力与障碍物的排斥合力，大小与机器人之间的 距离和机器人到障碍物的距离成比例。本发明的有益效果
本发明采用基于有限压缩范围的弹簧模型进行群移动机器人的密度控制，不采用 固定的机器人队形，通过引入拥挤因子和虚拟力保证节点不至过于分散和过于拥挤，从而 保证群移动机器人具有较为均勻的密度，使得群机器人具有较高的通讯和感知范围度。本发明通过拥挤因子调节机器人过于分散的问题，通过可压缩范围的机器人弹簧 模型调节机器人过于拥挤或与障碍物之间过于接近易发生碰撞的安全距离。采用本发明进 行群机器人的运动控制，群移动机器人的队形不固定，可适应未知环境下的移动机器人密 度保持，使得群移动机器人的通讯和感知范围得以有效保障，克服了单个机器人易发生掉 队的现象。采用本发明的方法，使得群移动机器人具有自动化程度高，机器人密度可控，可 根据运动环境进行任意队形组合，从而保证了未知环境下群移动机器人的密度等特点。
图1移动机器人的可压缩弹簧模型图2移动机器人的聚群行为示意3任意队形的群移动机器人密度保持流程图
具体实施例方式所述的一种任意队形的群移动机器人密度控制方法中，移动机器人具有感知邻域 内其它机器人和障碍物的能力，具有和其伙伴机器人通讯的能力。其模型如下首先，建立移动机器人的有限压缩弹簧模型。根据移动机器人的工作特点，采用有 限压缩的弹簧模型(有限压缩范围为一个环形带区域)，建立移动机器人的作用场，原理如 图1所示1)人为设定目标点位置后，对移动机器人施加一个目标吸引虚拟力，移动机器人 受到目标点的吸引力大小与距离的关系成正比，方向为机器人与目标点连线的方向。2)当移动机器人由于碰到避障物或其它原因导致移动机器人间的距离过于接近 时，移动机器人与移动机器人之间或移动机器人与障碍物之间产生虚拟排斥力，以保证移 动机器人运动时的安全距离。当机器人处于相互排斥的范围时，其所有排斥力范围内的移 动机器人或障碍物的合斥力大小与距离成反比，方向为法线方向。3)综合情形1)和2)，移动机器人在运动场中的作用合力为目标吸引虚拟力与虚 拟排斥力的合成。通过移动机器人的有限压缩弹簧模型，可以较好地控制移动机器人间的弹性安全 距离，从而实现移动机器人密度的控制；同时，还可以控制移动机器人与障碍物之间的距 离，避开障碍物。其次，移动机器人的每一步移动步长更新。移动机器人的最大移动步长为η ； δ 为拥挤度因子，与机器人邻域内的机器人伙伴数目成正比。如图2所示，(a)-(c)为移动机器人加入移动机器人群的过程示意图，其中(d)为 最终移动机器人聚群效果图。移动机器人i搜索当前感知邻域内的伙伴数目及其位置分布，伙伴数目与拥挤度 因子Si成正比。移动机器人以机器人数目最多的方向为移动方向，该方向表明有较多的 伙伴移动机器人并且不太拥挤，移动机器人朝该方向前进一步。当移动机器人处于有限压4缩范围内时，停止移动，而进行平衡状态。移动机器人的位置更新为i +1 =Xl + cl. Rand(I) - Si- η + c2 - η - Fi(1)其中，i = l，2，3，…，n(n为移动机器人总数)，cl、c2为加速系数，SiS移动机 器人i的拥挤度因子，Rand(I)为随机因子，々和为机器人当前时刻的位置和下一时 刻的位置。步骤一、二、三所述的一种任意队形的群移动机器人密度控制方法，其具体实现过 程如下步骤一的具体实现过程如图2、3所示，移动机器人通过安装在自身周围的传感 器检测附近邻域内的机器人，统计其感知邻域内的伙伴数目及分布方位，邻域内的伙伴机 器人数目越多，则其拥挤度因子δ越大。移动机器人选择感知邻域内的机器人数量较多的 方位作为移动方向，该方向表明是伙伴机器人的中心有较多的机器人且不太拥挤，则移动 机器人向伙伴的中心位置方向前进最大步长n。反复执行此过程后，直到所有的移动机器 人处于可压缩弹簧模型的平衡范围时，最终移动机器人的聚群实现。最终移动机器人的群 聚状态如图3(d)所示。步骤二的具体实现过程1)在聚群实现后，通过人为设定群移动机器人的前进目标点。此后，在各机器人上 根据机器人与目标点之间的距离关系施加一个目标对机器人的目标吸引虚拟力；2)如果移动机器人之间过于拥挤或当障碍物在其排斥范围内时，此时，在1)的基 础上给机器人再施加一个虚拟排斥合力，此合力为处于排斥范围内机器人之间的排斥力与 障碍物的排斥合力，大小与机器人之间的距离和机器人到障碍物的距离成比例，并将虚拟 合力作为式中第三项调节步长的因子。3)按式(4)考虑虚拟引力和拥挤度因子后更新移动步长，并按该步长前进一步。步骤三的具体实现过程在进行过程中，各移动机器人的相对位置可能发生变化，移动机器人群的密度也 随之发生了变化。1)如果移动机器人之间相对位置处于可压缩范围之外，为了保持移动机器人间的 间距，则应进行调整如果移动机器人的密度过于拥挤，移动机器人则通过弹簧模型相互排 斥；如果过于分散，则转步骤一，执行聚群行为。2)当移动机器人间的相对位置处于可压缩范围内，则无需调整，减小了移动机器 人的振荡；3)检测群移动机器人是否到达目标位置，若到达目标位置，则整个运动过程结束； 否则，转步骤一。权利要求
1.一种任意队形的群移动机器人密度控制方法，其特征在于实现步骤如下 步骤一、移动机器人的聚群移动机器人检测附近的机器人，统计其感知邻域内的伙伴数目及分布方位，并向机器人数量较多的方位作为移动方向前进一步，反复执行此过程直 到机器人聚群；步骤二、设定群移动机器人的前进目标点，在各机器人上根据机器人与目标点之间的 距离关系施加一个目标对机器人的目标吸引虚拟力；如果移动机器人之间距离小于预设值 或当障碍物在其排斥范围内时，在机器人上再施加一个虚拟排斥合力，机器人在行进过程 中，每一步移动步长根据目标吸引虚拟力、虚拟排斥合力和拥挤因子的变化而变化；步骤三、移动机器人群的密度发生变化时，如果移动机器人之间相对位置处于可压缩 范围之外，则进行调整如果移动机器人的密度过于拥挤，移动机器人则通过弹簧模型相互 排斥；如果过于分散，则转步骤一，执行聚群行为；当移动机器人间的相对位置处于可压缩 范围内，则无需调整；步骤四、检测群移动机器人是否到达目标位置，若到达目标位置，则整个运动过程结 束；否则，转步骤一。
2.根据权利要求1所述的一种任意队形的群移动机器人密度控制方法，其特征在于 步骤一中移动机器人通过安装在自身周围的传感器检测附近邻域内的机器人。
3.根据权利要求1或2所述的一种任意队形的群移动机器人密度控制方法，其特征在 于步骤二中合力为机器人之间的排斥力与障碍物的排斥合力，大小与机器人之间的距离 和机器人到障碍物的距离成比例。
全文摘要
本发明公开了一种任意队形的群移动机器人密度控制方法，属于移动多机器人技术邻域。包括移动机器人的聚群、设定群移动机器人的前进目标点、机器人群移动调整；直到到达目标位置。本发明通过拥挤因子调节机器人过于分散的问题，通过可压缩范围的机器人弹簧模型调节机器人过于拥挤或与障碍物之间过于接近易发生碰撞的安全距离，群移动机器人的队形不固定，使得群移动机器人的通讯和感知范围得以有效保障，克服了单个机器人易发生掉队的现象。采用本发明的方法，使得群移动机器人具有自动化程度高，机器人密度可控，可根据运动环境进行任意队形组合，从而保证了未知环境下群移动机器人的密度等特点。
文档编号G05D1/00GK102053621SQ20091023743
公开日2011年5月11日 申请日期2009年11月6日 优先权日2009年11月6日
发明者宋萍, 康晓, 李科杰, 漆光平, 陈昌, 韩惠婕 申请人:北京理工大学