[发明专利]一种任意队形的群移动机器人密度控制方法

说明书

技术邻域

本发明涉及一种任意队形的移动群机器人密度控制方法，属于移动多机器人技术邻域中的队形控制技术领域。

背景技术

群移动群机器人系统是由数量众多的微小型移动机器人组成的，适合于侦察、救援等协作邻域的应用。如何有效组织数量众多的微小型机器人协同工作是群移动群机器人系统一个重要的课题。在完成任务的过程中，为了有效控制移动机器人之间的间距，以保证机器人群体的通讯覆盖范围和感知覆盖范围，要求机器人之间不至过于分散，同时，又不至于过度拥挤而造成碰撞，这是微小型移动群机器人系统应用的基础问题之一。目前，基于多机器人的队形控制问题主要是特定的刚性几何形状而进行的。此类方法存在的问题是：队形不具备动态调整的能力，灵活性差，在未知环境中的适应性能力不强，移动机器人的密度不进行专门控制等，造成通讯可能中断或感知范围得不到保障。

发明内容

本发明解决了移动机器人进行过程中机器人密度保持问题，解决了传统多机器人队形控制方法在先进过程中机器人密度控制与队形变换冲突的问题，同时，改善了传统方法对未知环境的适应性。

该一种任意队形的群移动机器人密度控制方法，其实现步骤如下：

步骤一、移动机器人的聚群：移动机器人检测附近的机器人，统计其感知邻域内的伙伴数目及分布方位，并向机器人数量较多的方位作为移动方向前进一步，反复执行此过程直到机器人聚群；

步骤二、设定群移动机器人的前进目标点，在各机器人上根据机器人与目标点之间的距离关系施加一个目标对机器人的目标吸引虚拟力；如果移动机器人之间距离小于预设值或当障碍物在其排斥范围内时，在机器人上再施加一个虚拟排斥合力，机器人在行进过程中，每一步移动步长根据目标吸引虚拟力、虚拟排斥合力和拥挤因子的变化而变化；

步骤三、移动机器人群的密度发生变化时，如果移动机器人之间相对位置处于可压缩范围之外，则进行调整：如果移动机器人的密度过于拥挤，移动机器人则通过弹簧模型相互排斥；如果过于分散，则转步骤一，执行聚群行为；当移动机器人间的相对位置处于可压缩范围内，则无需调整；

步骤四、检测群移动机器人是否到达目标位置，若到达目标位置，则整个运动过程结束；否则，转步骤一。

步骤一中移动机器人通过安装在自身周围的传感器检测附近邻域内的机器人。

步骤二中合力为机器人之间的排斥力与障碍物的排斥合力，大小与机器人之间的距离和机器人到障碍物的距离成比例。

本发明的有益效果：

本发明采用基于有限压缩范围的弹簧模型进行群移动机器人的密度控制，不采用固定的机器人队形，通过引入拥挤因子和虚拟力保证节点不至过于分散和过于拥挤，从而保证群移动机器人具有较为均匀的密度，使得群机器人具有较高的通讯和感知范围度。

本发明通过拥挤因子调节机器人过于分散的问题，通过可压缩范围的机器人弹簧模型调节机器人过于拥挤或与障碍物之间过于接近易发生碰撞的安全距离。采用本发明进行群机器人的运动控制，群移动机器人的队形不固定，可适应未知环境下的移动机器人密度保持，使得群移动机器人的通讯和感知范围得以有效保障，克服了单个机器人易发生掉队的现象。采用本发明的方法，使得群移动机器人具有自动化程度高，机器人密度可控，可根据运动环境进行任意队形组合，从而保证了未知环境下群移动机器人的密度等特点。

附图说明

图1移动机器人的可压缩弹簧模型

图2移动机器人的聚群行为示意图

图3任意队形的群移动机器人密度保持流程图

具体实施方式

所述的一种任意队形的群移动机器人密度控制方法中，移动机器人具有感知邻域内其它机器人和障碍物的能力，具有和其伙伴机器人通讯的能力。其模型如下：

首先，建立移动机器人的有限压缩弹簧模型。根据移动机器人的工作特点，采用有限压缩的弹簧模型(有限压缩范围为一个环形带区域)，建立移动机器人的作用场，原理如图1所示：

1)人为设定目标点位置后，对移动机器人施加一个目标吸引虚拟力，移动机器人受到目标点的吸引力大小与距离的关系成正比，方向为机器人与目标点连线的方向。

2)当移动机器人由于碰到避障物或其它原因导致移动机器人间的距离过于接近时，移动机器人与移动机器人之间或移动机器人与障碍物之间产生虚拟排斥力，以保证移动机器人运动时的安全距离。当机器人处于相互排斥的范围时，其所有排斥力范围内的移动机器人或障碍物的合斥力大小与距离成反比，方向为法线方向。

3)综合情形1)和2)，移动机器人在运动场中的作用合力为目标吸引虚拟力与虚拟排斥力的合成。