《基于ADHOC网络和LEADERFOLLOWER算法的多机器人编队方法.pdf》由会员分享，可在线阅读，更多相关《基于ADHOC网络和LEADERFOLLOWER算法的多机器人编队方法.pdf（12页珍藏版）》请在专利查询网上搜索。
1、10申请公布号CN102096415A43申请公布日20110615CN102096415ACN102096415A21申请号201010618568122申请日20101231G05D3/0020060171申请人重庆邮电大学地址400065重庆市南岸区黄桷垭崇文路2号72发明人张毅李敏李嫄源罗元谢颖蔡军林海波吕霞付李学勤唐贤伦彭向华曾莉74专利代理机构重庆华科专利事务所50123代理人康海燕54发明名称基于ADHOC网络和LEADERFOLLOWER算法的多机器人编队方法57摘要本发明请求保护一种多机器人编队方法，属于智能控制领域。本发明以LEADER运动轨迹控制整个编队运动轨迹，首先确定。
2、LEADER的运动学模型，由斥力与引力合力确定LEADER运动方向；建立FOLLOWER跟踪LEADER运动模型，FOLLOWER根据一定的距离与角度跟踪LEADER，根据人工势场法建立的运动模型确定FOLLOWER运动轨迹；在LEADER与FOLLOWER之间引入ADHOC网络，建立信息反馈，确保FOLLOWER对LEADER的跟踪过程无丢失。采用本发明可以使多机器人系统在完成任务的过程中，顺利避开障碍物，到达目标点，并能在整个过程中保持初始队形，能实现多机器人的实时的队形控制，更好的完成一些需要多个机器人同时完成任务的场合（如搬运，救援等）。51INTCL19中华人民共和国国家知识产权局1。
3、2发明专利申请权利要求书4页说明书5页附图2页CN102096424A1/4页21一种基于ADHOC网络和LEADERFOLLOWER算法的多机器人编队方法，其特征在于，所述方法是在多机器人组成的群体中，一个或多个机器人被指定为领航者LEADER，其余机器人作为跟随者FOLLOWER，在LEADERFOLLOWER算法基础上利用人工势场法进行避障处理，由FOLLOWERS以一定的距离跟踪LEADER的位置和方向，使其达到预先设定的值，从而控制FOLLOWER跟踪LEADER的轨迹以实现队形控制，并引入ADHOC网络在LEADER与FOLLOWER之间建立信息反馈；所述方法分以下几步首先建立LE。
4、ADER的运动学模型，以LEADER为参考点，来确定其他FOLLOWER的位置，由斥力与引力合力确定LEADER运动方向；所述建立LEADER的运动学模型是采用控制方法来保持队形，即通过控制两个机器人之间的相对距离和相对角度，使之达到一个恒定值（），从而形成和保持一个良好的编队队形；然后采用人工势场法建立FOLLOWER跟踪LEADER运动模型，其基本思想是构造目标位置引力场和障碍物周围斥力场共同作用的人工势场，搜索势函数的下降方向来寻找无碰撞路径，FOLLOWER根据一定的距离与角度跟踪LEADER，根据运动模型确定FOLLOWER运动轨迹；最后在LEADER与FOLLOWER之间引入ADH。
5、OC网络，在编队过程中，将隐式通信与显示通信相结合，建立信息反馈，确保FOLLOWER对LEADER的跟踪过程无丢失。2根据权利要求1所述的多机器人编队方法，其特征在于，所述建立LEADER的运动学模型的步骤为，在环境空间中，建立势场设势场函数为，目标点产生吸引力为，障碍物产生斥力为，LEADER所受到的合力为目标点对机器人的引力及障碍物对它的斥力之和，即，合力决定了机器人的运动方向。3根据权利要求2所述的多机器人编队方法，其特征在于，采用人工势场法建立FOLLOWER跟踪LEADER运动模型是以LEADERFOLLOWER的方法建立全局队形，内部各自按照自己的方式建立模型，形成一个统一的整体。
6、；其是当多机器人队形编好后，根据LEADER和离LEADER最远的一个FOLLOWER的距离确定一个圆形区域，即以LEADER机器人为中心为半径的圆形区域，即避障区域；当障碍物在避障区域以外的时，整个机器人队伍中的成员将不会与障碍物发生碰撞，则障碍物不对领航机器人产生斥力；当障碍物在避障区域之内时，表示整个队伍不能顺利通过障碍物，障碍物对领航机器人产生斥力；其具体实现过程如下机器人ROBOT1，即领航机器人在运动过程中受到的总的势场力是由目标点引力和避障区域内障碍物产生的斥力两部分组成；计算目标引力，为目标位置，代表机器人位置，代表机器人与目标之间的权利要求书CN102096415ACN102。
7、096424A2/4页3距离，则目标产生的引力势场和相应的目标引力为为（1）（2）（3）其中为正比例因子；障碍物OBSTACLE1对它产生斥力，障碍物OBSTACLE2对机器人产生的斥力为零，表示在避障区域内的第个障碍物的位置，表示区域内第个障碍物和机器人之间的距离，则斥力的势场函数为其中是正比例因子，因此相应的斥力函数为（6）领航机器人在避障区域内绕开障碍物，保证整个机器人队伍在避开障碍物的情况下，（4）（5）权利要求书CN102096415ACN102096424A3/4页4向目标位置前进。4根据权利要求1所述的多机器人编队方法，其特征在于，在建立LEADER的运动学模型的步骤中，使两个机。
8、器人保持一定的队形，控制的需要达到的最终目标为,其中为预先设定的两机器人之间的保持一定队形需要达到的距离与角度；在控制方法中，只要给定参考机器人的角速度、速度、位置和航向，该机器人就可以在保证向着与参考机器人相对距离为和相对方向为的位置移动，实现队形的保持，达到最终目标，并不需要刻意的注意，但是存在一定的缺陷，没有涉及到避障的问题，对动态环境适应力不强，所以引入下一步的人工势场法进行改进。5根据权利要求1所述的多机器人编队方法，其特征在于，所述在LEADER与FOLLOWER之间引入ADHOC网络是，引入ADHOC网络作为信息反馈，当FOLLOWER丢失时，主动发出跟踪失败消息，LEADER在。
9、收到消息后，向所有的FOLLOWER发送数据包，包括LEADER的坐标位置及当前位置与X轴的夹角。6根据权利要求5所述的多机器人编队方法，其特征在于，在LEADER与FOLLOWER之间引入ADHOC网络，建立信息反馈的方法如下（1）领航机器人LEADER了解全局信息，接收任务，记为T，根据任务规划其初始运动方向；初始时刻，由领航机器人LEADER发送开始命令，所有的FOLLOWER在收到命令后开始跟随LEADER运动；在运动过程中，用领航机器人用自身携带的传感器检测障碍物，并在一定范围内避开障碍物，再继续向目标前进；（2）跟随机器人的任务则为跟随领航机器人，它们将采用人工势场法建立的模型，用。
10、自身携带传感器检测跟踪领航机器人，与LEADER之间保持一定的角度和距离来保持队伍队形，并在运动的同时监听来自LEADER的消息；（3）在正常情况下，LEADER与FOLLOWER之间不进行通信，FOLLOWER依靠自身所配备的传感器来检测LEADER，进行跟踪；在前进过程中，一旦FOLLOWER发现无法检测到LEADER，FOLLOWER会主动发出跟踪失败信息，记为S，表示跟踪失败，LEADER在收到信息后，首先会向所有的FOLLOWER发送停止前进的命令，然后通过广播方式向所有FOLLOWER发送包括位置信息在内的数据包，记为P，所有的FOLLOWER会根据收到的信息来调整自己当前的位置，。
11、而丢失的FOLLOWER则会根据收到的信息来确定自己下一步的位置，在丢失的FOLLOWER跟上整个队伍后，才继续前进；（4）在整个通信过程中，领队（LEADER）机器人以打包的形式向其他机器人发送数据包，缩写为P，在整个机器人队伍中，LEADER与FOLLOWER都有自己唯一的ID，在网络环境中有唯一的IP地址与之对应；跟随机器人以领航机器人为参考点，以决定其下一步的位置，因此在领航机器人发送的信息发送的数据包包括五个元素，其中权利要求书CN102096415ACN102096424A4/4页5表示机器人的IP地址；表示机器人是否为领航机器人，0为领航机器人，1为跟随者；分别表示机器人所在位置。
12、的X，Y轴坐标；表示当前位置与X轴的夹角。权利要求书CN102096415ACN102096424A1/5页6基于ADHOC网络和LEADERFOLLOWER算法的多机器人编队方法技术领域0001本发明属于智能控制领域，具体涉及多机器人编队方法。背景技术0002自从20世纪50年代第一台工业机器人诞生以来，随着通信、计算机、传感、电子、控制等技术以及人工智能技术的快速发展，集多种先进技术为一体的机器人技术在市场需求的牵引下已经取得了很大的发展。单个的移动机器人所能获得的信息有限，能够完成的任务以及对信息的搜集能力也是有限的。随着研究的深入，单个移动机器人在某些应用上，显得力不从心，为了解决这类。
13、问题，人们考虑在目前的机器人技术水平条件下，采用多个机器人相互协作以弥补单个机器人能力的不足，多机器人系统MULTIROBOTSYSTEM的研究在此需求下应运而生。随着机器人的研究和应用领域的不断扩大，应用的需求也对多机器人系统的研究提出了更高的要求，为了更好地完成任务，多个机器人协作完成任务也逐渐成为研究的热点。编队控制则是一个具有典型性和通用性的多机器人协调问题，是多机器人协调问题的基础。0003自1990年以来基于队形控制的多机器人系统受到众多研究者的广泛关注，美国研究机构对队形控制的研究比较早，GEORGIATECHMOBILEROBOTLAB结合DARPA的UGVUNMANNEDGR。
14、OUNDVEHICLEDEMO2研究了基于行为的队形控制方法。UNIVERSITYOFSOUTHERNCALIFORNIA的ROBOTICSRESEARCHLAB利用局部传感信息和交互进行队形控制。BRIGHAMYOUNGUNIVERSITY的MAGICC实验室在AIRFORCEOFFICEOFSCIENTIFICRESEARCH的协助下,对UAVUNMANNEDAERIALVEHICLE的队形作了深入研究。美国航空航天局NASA采用ENHANCEDFORMATIONFLYINGEFF技术控制多个卫星,使得航天编队飞行及空间虚拟探测成为可能。但是，上述技术不能解决队形的实时控制问题，对于一些需。
15、要多个机器人同时完成任务的场合（如搬运，救援等）就不能很好的发挥多机器人的优势。发明内容0004本发明所要解决的技术问题是，针对现有技术中，经过编队的多机器人在遇到障碍物时，很难保持实时队形控制的上述缺陷，提出一种实时控制队形的方法。0005本发明实现多机器人队形的实时控制方法所采用的技术方案是，在多机器人组成的群体中，一个或多个机器人被指定为领航者（LEADER），其余机器人作为跟随者（FOLLOWER），以LEADER为参考点，来确定其他FOLLOWER的位置，这样将队形控制问题转化为FOLLOWER跟踪LEADER的位置和方向的问题，以此建立队形保持的模型。而LEADER则采用人工势场法。
16、建立运动模型，目标点或建议经过的区域对LEADER产生引力，而有障碍物的区域或不期望经过的区域对LEADER产生斥力，再根据LEADER与最远FOLLOWER之间的距离的约束，设定避障区域，以此保证整个机器人队伍在避开障碍物的情况下，向目标位置前进。本发明还提出在LEADER与FOLLOWER之间引入ADHOC网络，在编队过程中，将隐式通说明书CN102096415ACN102096424A2/5页7信与显示通信相结合，克服了LEADER与FOLLOWER之间无反馈信息，导致机器人容易丢失的问题。0006简洁地说，本发明是在多机器人组成的群体中，一个或多个机器人被指定为领航者LEADER，其余。
17、机器人作为跟随者FOLLOWER，在LEADERFOLLOWER算法基础上利用人工势场法进行避障处理，由FOLLOWERS以一定的距离跟踪LEADER的位置和方向，使其达到预先设定的值，从而控制FOLLOWER跟踪LEADER的轨迹以实现队形控制，并引入ADHOC网络在LEADER与FOLLOWER之间建立信息反馈。所述方法分以下几步首先建立LEADER的运动学模型（采用控制方法来保持队形，即通过控制两个机器人之间的相对距离和相对角度，使之达到一个恒定值（），从而形成和保持一个良好的编队队形），以LEADER为参考点，来确定其他FOLLOWER的位置，由斥力与引力合力确定LEADER运动方向；。
18、然后采用人工势场法建立FOLLOWER跟踪LEADER运动模型（基本思想是构造目标位置引力场和障碍物周围斥力场共同作用的人工势场，搜索势函数的下降方向来寻找无碰撞路径），FOLLOWER根据一定的距离与角度跟踪LEADER，根据运动模型确定FOLLOWER运动轨迹；最后在LEADER与FOLLOWER之间引入ADHOC网络，在编队过程中，将隐式通信与显示通信相结合，建立信息反馈，确保FOLLOWER对LEADER的跟踪过程无丢失。0007本发明的有益效果本发明是多机器人队形控制技术的研究，将LEADERFOLLOWER算法与人工势场法相结合，解决了LEADERFOLLOWER算法对动态环境的适。
19、应能力不强，不能很好的避开障碍物的问题。并引入ADHOC网络建立机器人之间的显示通信，实现了多机器人的实时队形控制，并且使多机器人系统能灵活的应对各种环境，使在一些需要多个机器人同时完成任务的场合（如搬运，救援等）能很好完成任务。附图说明0008图1本发明采用LEADERFOLLOWER算法和人工势场场法相结合的多机器人编队；图2本发明反馈控制结构图；图3本发明引入ADHOC网络编队策略流程图。具体实施方式0009LEADERFOLLOWER方法是将队形中的机器人划分为两个互补的角色LEADER和FOLLOWER，群体中的某一个或某几个机器人被指定为领航者（LEADER）,其余作为它或它们的跟。
20、随者（FOLLOWERS），该方法的基本思想是，由FOLLOWERS以一定的距离跟踪LEADER的位置和方向，使其达到预先设定的值，从而控制FOLLOWER跟踪LEADER的轨迹以实现队形控制。这样该编队控制算法就可以用控制理论的知识来分析处理，并能稳定跟踪误差。该方法控制简单，整个运动过程中，只有领航者知道任务信息，只需给定其行为或轨迹就可以控制整个机器人群体的行为，队形的运动轨迹完全由LEADER决定；但LEADER与FOLLOWER之间相对独立，没有信息反馈，LEADER得不到FOLLOWER的跟踪误差或丢失消息而且对动态环境的适应能力不强，机器人的避碰等问题没有得到很好的解决。0010。
21、人工势场法它实际上是对机器人运动环境的一种抽象描述，其基本思想是借鉴物说明书CN102096415ACN102096424A3/5页8理学方面的概念,假设机器人在一个虚拟的力场环境中运动，环境中的障碍物对机器人产生排斥力，且斥力随机器人与障碍物的距离减少而增大，目标点对机器人产生吸引力,引力随机器人与目标点的接近而变小，从而构造出斥力和引力共同作用的人工势场，在势场力的作用下机器人沿最小化势能的方向运动。人工势场法主要是通过设计人工势场和势场函数来表示环境对队形中各机器人约束,并在此基础进行分析和控制；该方法计算简单,便于实现实时控制，尤其对处理障碍物空间的避障问题比较有效。以LEADERFO。
22、LLOWER方法建立队形，采用人工势场法控制LEADER，在LEADERFOLLOWER保持队形的基础上结合人工势场法避障特性，克服了LEADERFOLLOWER算法的避障问题。0011ADHOC网络是一种没有基础设施的对等无线通信网络，网络中没有中央控制设备，不需要固定设施如基站的支持，各节点自由接入，自动组网，没有固定的网络拓扑，且由于节点的移动性，拓扑结构处于动态变化中。同时，ADHOC网络是一个多跳网络，节点覆盖范围无须直接包含目的节点，而是借助于中间节点进行转发。ADHOC网络可以单独组网，也可以通过网关或接口与其他网络相连。ADHOC网络由于其自身的特点成为多机器人系统通信首选。将。
23、ADHOC网络引入LEADERFOLLOWER方法中，克服了LEADERFOLLOWER算法无信息反馈，跟随机器人容易丢失的缺陷。0012以下针对附图和具体实例对本发明作具体描述如图1为本发明基于LEADERFOLLOWER算法与人工势场法的队形。当多机器人队形编好后，根据LEADER和离LEADER最远的一个FOLLOWER的距离确定一个圆形区域，如图中以LEADER机器人为中心为半径的圆形区域，即避障区域。当障碍物在避障区域以外的时，整个机器人队伍中的成员将不会与障碍物发生碰撞，则障碍物不对领航机器人产生斥力。当障碍物在避障区域之内时，表示整个队伍不能顺利通过障碍物，障碍物对领航机器人产生。
24、斥力。其具体实现过程如下机器人ROBOT1（即领航机器人）在运动过程中受到的总的势场力是由目标点引力和避障区域内障碍物产生的斥力两部分组成。计算目标引力，为目标位置，代表机器人位置，代表机器人与目标之间的距离，则目标产生的引力势场和相应的目标引力为为（1）（2）说明书CN102096415ACN102096424A4/5页9（3）其中为正比例因子。显然，目标引力的大小与距离成线性关系，机器人到达目标位置后其目标引力大小为零。0013如图1所示，障碍物OBSTACLE1对它产生斥力。障碍物OBSTACLE2对机器人产生的斥力为零。，表示在避障区域内的第个障碍物的位置。表示区域内第个障碍物和机器人。
25、之间的距离，则斥力的势场函数为（4）其中是正比例因子。因此相应的斥力函数为（5）（6）领航机器人在避障区域内绕开障碍物，保证了整个机器人队伍在避开障碍物的情况下，向目标位置前进。0014以下是针对上述模型引入ADHOC网络的详细描述，如图2为本发明的反馈控制示意图，具体的编队策略如下（1）领航机器人LEADER了解全局信息，接收任务（记为T），根据任务规划其初始运动方向。初始时刻，由LEADER发送开始命令，所有的FOLLOWER在收到命令后开始跟随LEADER运动。在运动过程中，用领航机器人用自身携带的传感器检测障碍物，并在一定范围说明书CN102096415ACN102096424A5/5。
26、页10内避开障碍物，再继续向目标前进。0015（2）跟随机器人的任务则为跟随领航机器人，它们将采用所提的队形模型（如三角形，正方形等模型），用自身携带传感器检测跟踪领航机器人，与LEADER之间保持一定的角度和距离来保持队伍队形，并在运动的同时监听来自LEADER的消息。0016（3）在正常情况下，LEADER与FOLLOWER之间不进行通信，FOLLOWER依靠自身所配备的传感器来检测LEADER，进行跟踪。在前进过程中，一旦FOLLOWER发现无法检测到LEADER，FOLLOWER会主动发出跟踪失败信息（记为S），表示跟踪失败，LEADER在收到信息后，首先会向所有的FOLLOWER发送。
27、停止前进的命令，然后通过广播方式向所有FOLLOWER发送包括位置信息在内的数据包（记为P），所有的FOLLOWER会根据收到的信息来调整自己当前的位置，而丢失的FOLLOWER则会根据收到的信息来确定自己下一步的位置，在丢失的FOLLOWER跟上整个队伍后，才继续前进。0017（4）由于ADHOC网络的通信距离有限，一旦机器人超出通信范围，机器人将无法收到来自LEADER的信息，而成为一个孤立的节点，为了保证所有机器人都在通信范围内，而且使FOLLOWER能使用其传感器尽可能的检测到LEADER，我们将整个队伍设定为较小速度200MM/S运动。0018在整个通信过程中，机器人以打包的形式向其。
28、他机器人发送数据包PACK，在整个机器人队伍中，LEADER与FOLLOWER都有自己唯一的ID，在网络环境中有唯一的IP地址与之对应。跟随机器人以领航机器人为参考点，以决定其下一步的位置，因此在领航机器人发送的信息发送的数据包包括五个元素，其中表示机器人的IP地址；表示机器人是否为领航机器人，0为领航机器人，1为跟随者；分别表示机器人所在位置的X，Y轴坐标；表示当前位置与X轴的夹角。0019本发明在LEADERFOLLOWER算法基础上利用人工势场法进行避障处理，并引入ADHOC网络在LEADER与FOLLOWER之间建立信息反馈，实验表明，该方法有效可行，对于多机器人系统完成在复杂环境下完成任务也取得了较好效果。说明书CN102096415ACN102096424A1/2页11图1图2说明书附图CN102096415ACN102096424A2/2页12图3说明书附图CN102096415A。