一种多机器人防碰撞的方法及系统技术方案

本发明专利技术公开了一种多机器人防碰撞的方法及系统，属于多机器人协同控制技术领域，对于至少两台机器人，每台机器人上均安装有一组无线自组网通信设备；在机器人端进行计算，获取机器人自身目标速度，根据与网络内其它机器人的距离计算得到防碰撞速度，获取网络内其它机器人的目标速度并根据其距离确定各调节系数；将机器人自身目标速度、防碰撞速度、其它机器人调节速度矢量相加，计算得到该机器人的最终目标速度；网络内的各机器人计算出各自的最终目标速度，并按照各自的最终目标速度运行。本发明专利技术能够实现机器人之间信息快速有效的传输，方法简单可靠，能够适应各种复杂队形和任意数量的机器人。量的机器人。量的机器人。

【技术实现步骤摘要】
一种多机器人防碰撞的方法及系统


[0001]本专利技术涉及多机器人协同控制
，具体地说是一种多机器人防碰撞的方法及系统。

技术介绍

[0002]随着世界科技的进步，计算机、通信、自动化控制技术日新月异，机器人 (包括无人车、无人机等)技术实现了飞速的发展。机器人由于其独特的优势，现在已广泛应用到了军事、仓储、物流、航拍、测绘、植保、电力巡检、灾难救援等领域。而多机器人协同控制，可以在很大程度上提高任务的成功概率，提高任务完成的效率，也能够实现编队表演等，应用越来越广泛。
[0003]多机器人协同控制带来巨大优势的同时，也给机器人的运行安全带来了隐患。由于在同一片区域内同时有多台机器人，机器人之间发生碰撞的概率增大，特别是在多机器人编队运动以及协作执行搜索、货物运送等任务时，如何避免机器人之间发生碰撞，是阻碍多机器人协同控制技术发展的一个重大障碍。
[0004]针对多机器人防碰撞控制，目前通常是采用调度中心统一调度，通过控制编队整体移动，减少机器人运动路径出现交叉的情况，或对全部机器人分批次控制变换位置，避免机器人在移动时发生碰撞。此方式处理逻辑复杂，效率低，对复杂变换情况的处理效果差。

技术实现思路

[0005]本专利技术的技术任务是针对以上不足之处，提供一种多机器人防碰撞的方法及系统，能够实现机器人之间信息快速有效的传输，方法简单可靠，能够适应各种复杂队形和任意数量的机器人。
[0006]本专利技术解决其技术问题所采用的技术方案是：
[0007]一种多机器人防碰撞的方法，对于至少两台机器人，每台机器人上均安装有一组无线自组网通信设备，该通信设备可将同一工作区域内的所有机器人加入到同一网络中，使网络内的任意一台机器人可与其他所有机器人进行通信，网络内的任意一台机器人均向其他机器人广播自身的速度与位置信息；
[0008]在机器人端进行计算，获取机器人自身目标速度，根据与网络内其它机器人的距离计算得到防碰撞速度，获取网络内其它机器人的目标速度并根据其距离确定各目标速度的调节系数，形成调节速度；将机器人自身目标速度、防碰撞速度、其它机器人调节速度矢量相加，计算得到该机器人的最终目标速度；
[0009]网络内的各机器人计算出各自的最终目标速度，并按照各自的最终目标速度运行。
[0010]其中，机器人自身目标速度能使机器人向目标点移动；防碰撞速度使机器人在与其他机器人距离较近时远离其他机器人，避免碰撞；其它机器人调节速度则使机器人能够根据其他机器人的运动做超前调节。
[0011]本方法利用无线自组网技术结合机器人的计算处理能力，设计一种适应性强、处理速度快的多机器人防碰撞方法，无线自组网使得任意一台机器人能够及时有效的获取系统中其他机器人的信息；通过在机器人端对数据进行简单快速的处理即可得到最终结果，无需通过调度中心的复杂计算和转发；无需考虑各种情况下的队形变换逻辑，能够适应各种复杂队形情况和任意机器人数量的系统。
[0012]进一步的，设定安全距离S，即当两台机器人之间的距离大于S时认为此两台机器人不会有发生碰撞的可能；对于大于安全距离S的机器人数据不作处理，对于在安全距离内的机器人，在接收到其它机器人的位置和速度信息后，各自计算其最终目标速度。
[0013]优选的，所述安全距离S根据机器人的最大移动速度和加速度确定：
[0014]S＝Vmax2/2a+L，
[0015]其中，Vmax为机器人可以达到的最大速度，a为机器人可以达到的最大加速度，L为机器人的最大直径。
[0016]优选的，设其中一台机器人为A，A自身目标速度为V1；
[0017]有机器人B、C、D在A的安全距离内，A与B、C、D的距离分别为Sab、Sac、 Sad，则根据Sab、Sac、Sad和机器人A的最大运动速度，分别计算出防碰撞速度量Vab、Vac、Vad，其中Vab、Vac、Vad的大小分别与Sab、Sac、Sad成反比； Vab、Vac、Vad的方向分别由B、C、D指向A；计算Vab、Vac、Vad的矢量和，即为防碰撞速度，以V2表示，则V2＝Vab+Vac+Vad；
[0018]机器人B、C、D当前的实际移动速度分别为Vb、Vc、Vd，根据Sab、Sac、 Sad确定Vb、Vc、Vd的系数，所述速度乘以其系数即为其调节速度，各调节速度相加称为超前调节速度，以V3表示；
[0019]则机器人A的最终目标速度为：V＝V1+V2+V3。
[0020]优选的，所述防碰撞速度量Vab、Vac、Vad的具体计算公式如下：
[0021]Vab＝3
×
Vmax
×
(S
‑
Sab)/Sab，
[0022]Vac＝3
×
Vmax
×
(S
‑
Sac)/Sac，
[0023]Vad＝3
×
Vmax
×
(S
‑
Sad)/Sad，
[0024]其中Vmax为机器人A可以达到的最大运动速度。
[0025]优选的，所述超前调节速度V3＝KbVb+KcVc+KdVd，其中系数Kb、Kc、Kd的大小分别与Sab、Sac、Sad成反比。
[0026]优选的，所述机器人A与机器人机器人B、C、D之间的距离为二维空间距离，各机器人向网络内其他机器人发送其二维坐标位置；所述V1、Vb、Vc、Vd 以及Vab、Vac、Vad均为二维向量。
[0027]优选的，所述机器人A与机器人机器人B、C、D之间的距离为欧氏距离，各机器人向网络内其他机器人发送其三维坐标位置；所述所述V1、Vb、Vc、Vd 以及Vab、Vac、Vad均为三维向量。
[0028]本专利技术还要求保护一种多机器人防碰撞的系统，该系统中具有至少两台机器人，每台机器人上均安装有一组无线自组网通信设备，通过所述的无线自组网通信设备，任意一台机器人可与其他所有机器人进行通信；
[0029]系统中各机器人根据上述的多机器人防碰撞的方法计算出各自的最终目标速度，并按照各自的最终目标速度运行。
[0030]优选的，各机器人内置处理器进行所述自身目标速度、防碰撞速度、超前调节速度以及最终目标速度的计算。
[0031]本专利技术的一种多机器人防碰撞的方法及系统与现有技术相比，具有以下有益效果：
[0032]本方法基于无线自组网技术，可实现信息快速有效的传输，提高效率；
[0033]采用将机器人自身目标速度、防碰撞速度、其他机器人速度矢量相加的方式计算机器人最终目标速度，方法简单可靠，能够适应各种复杂队形和任意数量机器人；
[0034]在机器人端进行计算，无需通过调度中心，提高了调节的实时性。所有机器人可同时运动，极大的缩短了机器人位置调整的时间。
附图说明
[0035]图1是本专利技术实施例提供的多机器人防碰撞的方法的实现过程图。
具体实施方式
本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种多机器人防碰撞的方法，其特征在于，对于至少两台机器人，每台机器人上均安装有一组无线自组网通信设备，该通信设备可将同一工作区域内的所有机器人加入到同一网络中，使网络内的任意一台机器人可与其他所有机器人进行通信，网络内的任意一台机器人均向其他机器人广播自身的速度与位置信息；在机器人端进行计算，获取机器人自身目标速度，根据与网络内其它机器人的距离计算得到防碰撞速度，获取网络内其它机器人的目标速度并根据其距离确定各目标速度的调节系数，形成调节速度；将机器人自身目标速度、防碰撞速度、其它机器人调节速度矢量相加，计算得到该机器人的最终目标速度；网络内的各机器人计算出各自的最终目标速度，并按照各自的最终目标速度运行。2.根据权利要求1所述的一种多机器人防碰撞的方法，其特征在于，设定安全距离S，即当两台机器人之间的距离大于S时认为此两台机器人不会有发生碰撞的可能；对于大于安全距离S的机器人数据不作处理，对于在安全距离内的机器人，在接收到其它机器人的位置和速度信息后，各自计算其最终目标速度。3.根据权利要求2所述的一种多机器人防碰撞的方法，其特征在于，所述安全距离S根据机器人的最大移动速度和加速度确定：S＝Vmax2/2a+L，其中，Vmax为机器人可以达到的最大速度，a为机器人可以达到的最大加速度，L为机器人的最大直径。4.根据权利要求2或3所述的一种多机器人防碰撞的方法，其特征在于，设其中一台机器人为A，A自身目标速度为V1；有机器人B、C、D在A的安全距离内，A与B、C、D的距离分别为Sab、Sac、Sad，则根据Sab、Sac、Sad和机器人A的最大运动速度，分别计算出防碰撞速度量Vab、Vac、Vad，其中Vab、Vac、Vad的大小分别与Sab、Sac、Sad成反比；Vab、Vac、Vad的方向分别由B、C、D指向A；计算Vab、Vac、Vad的矢量和，即为防碰撞速度，以V2表示，则V2＝Vab+Vac+Vad；机器人B、C、D当前的实际移动速度分别为Vb、Vc、Vd，根据Sab、Sac、Sad确定Vb、Vc、Vd的系数，所述速度乘以其系数即为其调节速度，各调节速度相...

【专利技术属性】
技术研发人员：刘祥勇，高明，马辰，
申请(专利权)人：山东新一代信息产业技术研究院有限公司，
类型：发明
国别省市：