本发明属于机器人及导航技术领域，尤其涉及一种机器人集群编队定位方法及定位系统。
背景技术：
近年来，机器人学取得的进步使得利用大量廉价机器人合作完成任务成为可能，在一些任务中，相比智能化程度较高、较昂贵的单个机器人，利用多个廉价机器人可能更容易更便宜，并且有些任务也是单个机器人所难以完成的，必须通过多个机器人合作才能完成。由于多机器人合作完成任务的优势，人们对它越来越重视，它在各个领域的应用也越来越广泛，比如自动化生产线、海洋和太空探险、军事等。在多机器人系统中，协作是必不可少的，协作多机器人系统的研究主要集中在以下几个方面:群体结构、学习、资源冲突解决、协作的起源、几何问题。在研究中，为了使研究成果具有普遍意义，人们主要集中在对一些基本的标准问题的研究，比如搬运、编队、搜索、分类、围捕以及跟踪等。随着协作多机器人学开始活跃在机器人研究领域，编队技术得到了广泛重视。eikrnbahcei将多机器人编队定义为一组自主移动机器人协调一致去组成一定形状的队形并保持这个队形的过程。智能体的编队是非常有用的，在自然界中，鸟、鱼等动物都有能力组成一定形状的群体，以便于飞行、觅食或躲避天敌等行为；相似的，机器人编队使得多机器人系统的运动协调一致，完成任务更可靠、更有效率，在搜索与拯救、地雷排除、空间探索、卫星和无人车辆或飞行器的控制中都有广泛的应用。
然而，现有编队系统中，均需要获得机器人的绝对位置，而实际复杂环境中，机器人绝对坐标不可避免的存在获取误差，导致编队精度差。
技术实现要素：
本发明的目的在于提供一种机器人集群编队定位方法及定位系统，避免了使用每个机器人的绝对位置，通过激光测距传感器作为机器人相对位置的定位器件，且配合电磁铁以及霍尔传感器，可以在小范围内进行更高精度的定位。为实现上述目的，本发明采用如下技术方案：
一种机器人集群编队定位方法，包括以下步骤：
步骤1：将一原点机器人和一移动机器人共同置于一四周封闭的空间内；其中，原点机器人和移动机器人的结构相同；组成空间的空间壁为一平面壁，包括前壁、后壁、左壁和右壁；
步骤2：用户控制原点机器人，以开启原点机器人自身携带的激光测距传感器，激光测距传感器分别位于空间的四个方位上，每个激光测距传感器均发射激光并测量其相对于空间壁之间的第一距离，之后均实时将所有第一距离值传输至原点机器人，原点机器人根据第一距离值进行原地转动；
步骤3：当前壁、后壁对应的第一距离值之和达到最小且左、右壁对应的第一距离值之和均达到最小时，原点机器人自主停止转动并自主关闭原点机器人自身携带的所有激光测距传感器以实现原点机器人的位置调整；之后原点机器人自主开启其自身携带的电磁铁；同时，激光测距传感器将各个第一距离值的通过无线模块传输至移动机器人；
步骤4：用户控制移动机器人，以开启移动机器人自身携带的激光测距传感器，激光测距传感器分别位于空间的四个方位上，每个激光测距传感器均发射激光并测量其相对于空间壁之间的第二距离，之后均实时将第二距离值传输至移动机器人，移动机器人根据第二距离值进行原地转动；
步骤5：当前壁、后壁对应的第二距离值之和达到最小且左壁、右壁对应的第二距离值之和均达到最小时，移动机器人自主停止转动并自主关闭移动机器人自身携带的所有激光测距传感器以实现移动机器人的位置调整；
步骤6：移动机器人自主朝前壁移动，当移动机器人相对于前壁的第二距离值等于步骤3中原点机器人相对于前壁的第一距离值时，移动机器人自主沿垂直于前壁的方向移动，当移动机器人相对于左壁的第二距离值为零时，移动机器人自主停止移动，以完成编队。
优选地，在步骤6中，当移动机器人沿垂直于前壁的方向移动至预设距离时，移动机器人自主开启自身携带且靠近原点机器人一侧的电磁铁，通过移动机器人自身携带且靠近原点机器人一侧的霍尔传感器读取磁场强度变化，之后将磁场强度实时传输至移动机器人；当磁场强度最大时，移动机器人自主关闭移动机器人自身携带的电磁铁。
优选地，所述原点机器人的顶面为一正方形；所述顶面的四个边缘处均设置一电磁铁和一霍尔传感器。
优选地，所述原点机器人包括麦克纳姆轮。
优选地，所述空间由围墙组成。
一种机器人集群编队定位系统，包括原点机器人、移动机器人和无线模块；其中，所述无线模块用于连通原点机器人的主控模块和移动机器人的主控模块。
优选地，所述原点机器人还包括通信模块，用于与移动机器人通信。
与现有技术相比，本发明的优点为：
（1）通过激光测距传感器作为机器人相对位置的定位器件，避免了使用每个机器人的绝对位置，从而提高了编队精度。此外，激光测距传感器具有功耗低、精度高、技术成熟等优点。
（2）配合电磁铁以及霍尔传感器，可以在小范围内进行更高精度的定位。
（3）采用麦克纳姆轮作为运动部件，可实现机器人的全向移动和原地旋转，在保证运动精度的同时降低控制算法复杂度，提升机器人运动灵活性。
附图说明
图1为本发明一实施例的机器人集群编队定位方法的过程对比图；
图2为原点机器人处于初始位置的状态图；
图3为原点机器人停止后的状态图；
图4为移动机器人处于初始位置的状态图；
图5为移动机器人朝前壁移动之前的状态图；
图6为移动机器人停止后的状态图；
图7为本发明的原点机器人的控制原理图。
图8为本发明的原点机器人的俯视图。
其中，1-原点机器人，2-移动机器人，3-激光测距传感器，4-电磁铁，5-霍尔传感器。
具体实施方式
下面将结合示意图对本发明进行更详细的描述，其中表示了本发明的优选实施例，应该理解本领域技术人员可以修改在此描述的本发明，而仍然实现本发明的有利效果。因此，下列描述应当被理解为对于本领域技术人员的广泛知道，而并不作为对本发明的限制。
如图1~6所示，一种机器人集群编队定位方法，包括：
步骤1：将一原点机器人1和一移动机器人2共同置于一四周封闭的空间内，如图1所示。
其中，原点机器人1和移动机器人2的结构相同；空间由围墙组成；组成空间的空间壁为一平面壁，包括前壁、后壁、左壁和右壁。即前壁、后壁、左壁和右壁均为一平面。在本实施例中，以第一距离值x11对应的空间壁为前壁，即a处对应的空间壁为前壁。
步骤2：用户控制原点机器人1，以开启原点机器人1自身携带的激光测距传感器3，激光测距传感器3分别位于空间的四个方位上，每个激光测距传感器3均发射激光并测量其相对于空间壁之间的第一距离，之后均实时将第一距离值传输至原点机器人1，原点机器人1根据第一距离值进行原地转动。
具体的，如图2所示，原点机器人1通过分布在a、b、c、d四个方位处的激光测距传感器3分别发射激光，并获取前壁对应的第一距离值x11、后壁对应的第一距离值x12、右壁对应的第一距离值y11、左壁对应的第一距离值y12。
步骤3：当前壁、后壁对应的第一距离值之和达到最小且左、右壁对应的第一距离值之和均达到最小时，原点机器人1自主停止转动并自主关闭原点机器人1自身携带的所有激光测距传感器3以实现原点机器人1的位置调整。即前壁对应的第一距离值x11、后壁对应的第一距离值x12之和（x11 x12）最小；右壁对应的第一距离值y11、左壁对应的第一距离值y12之和（y11 y12）最小。当x11 x12最小时，a处的激光垂直于前壁，c处的激光垂直于后壁；当y11 y12最小时，b处的激光垂直于右壁，d处激光垂直于左壁，如图3所示。
之后原点机器人1自主开启其自身携带的电磁铁4；同时，激光测距传感器3将4个第一距离值通过无线模块传输至移动机器人2，以便于后续移动机器人2根据第一距离值规划移动路径。其中，原点机器人1上的电磁铁4，其作用是为移动机器人2上的电磁铁4提供磁场。
步骤4：用户控制移动机器人2，以开启移动机器人2自身携带的激光测距传感器3，激光测距传感器3分别位于空间的四个方位上，每个激光测距传感器3均发射激光并测量其相对于空间壁之间的第二距离，之后4个激光测距传感器3均实时将第二距离值传输至移动机器人2，移动机器人2根据第二距离值进行原地转动。
具体的，如图4所示，移动机器人2通过分布在a、b、c、d四个方位处的激光测距传感器3分别发射激光，并获取前壁对应的第二距离值x21、后壁对应的第二距离值x22、右壁对应的第二距离值y21、左壁对应的第二距离值y22。
步骤5：当前壁、后壁对应的第二距离值之和达到最小且左壁、右壁对应的第二距离值之和均达到最小时，移动机器人2自主停止转动并自主关闭移动机器人2自身携带的所有激光测距传感器3以实现移动机器人2的位置调整。即前壁对应的第二距离值x21、后壁对应的第二距离值x22之和（x21 x22）最小；右壁对应的第二距离值y21、左壁对应的第二距离值y22之和（y21 y22）最小。当x21 x22最小时，a处的激光垂直于前壁，c处的激光垂直于后壁；当y21 y22最小时，b处的激光垂直于右壁，d处激光垂直于左壁，如图5所示。其中，步骤4~5的作用是同步骤2~3的作用类似，即为了调整机器人至正上正下方向。此时，移动机器人2和原点机器人1平行。
步骤6：移动机器人2自主朝前壁移动，当移动机器人2相对于前壁的第二距离值（x21）等于步骤3中原点机器人1相对于前壁的第一距离值（x11）时，移动机器人2沿垂直于前壁的方向移动。
当移动机器人2沿垂直于前壁的方向移动至预设距离时，移动机器人2自主开启自身携带且靠近原点机器人1一侧的电磁铁4，通过移动机器人2自身携带且靠近原点机器人1一侧的霍尔传感器5读取磁场强度变化，之后将磁场强度实时传输至移动机器人2；当磁场强度最大时，移动机器人2自主关闭移动机器人2自身携带的电磁铁4。移动机器人2通过自身携带的电磁铁4，以完成对移动机器人2进行前后方向的微调，以保证移动机器人2在沿垂直于前壁的方向移动过程中，始终保持较高的编队精度，即始终于原点机器人1对齐。
当移动机器人2相对于左壁的第二距离值（y22）为零时，移动机器人2自主停止移动，以完成编队。此时，移动机器人2贴合原点机器人1，如图6所示。
在本实施例中，由于移动机器人2和原点机器人1的结构相同，当x21=x11时，x22=x12；当y22=0时，y21=y11-机器人直径d（宽度或长度）。
如图7~8所示，原点机器人1的顶面为一正方形；顶面的四个边缘处均设置一电磁铁4和一霍尔传感器5；原点机器人1包括麦克纳姆轮。
本实施例中，一种机器人集群编队定位系统，包括原点机器人1、移动机器人2、原点机器人自身携带的4个激光测距传感器和电磁铁、移动机器人自身携带的4个激光测距传感器和电磁铁、无线模块；其中，无线模块用于连通原点机器人1的主控模块和移动机器人2的主控模块。优选地，原点机器人1还包括通信模块，用于与移动机器人2通信。
上述仅为本发明的优选实施例而已，并不对本发明起到任何限制作用。任何所属技术领域的技术人员，在不脱离本发明的技术方案的范围内，对本发明揭露的技术方案和技术内容做任何形式的等同替换或修改等变动，均属未脱离本发明的技术方案的内容，仍属于本发明的保护范围之内。
1.一种机器人集群编队定位方法，其特征在于，包括以下步骤：
步骤1：将一原点机器人和一移动机器人共同置于一四周封闭的空间内；其中，原点机器人和移动机器人的结构相同；组成空间的空间壁为一平面壁，包括前壁、后壁、左壁和右壁；
步骤2：用户控制原点机器人，以开启原点机器人自身携带的激光测距传感器，激光测距传感器分别位于空间的四个方位上，每个激光测距传感器均发射激光并测量其相对于空间壁之间的第一距离，之后均实时将所有第一距离值传输至原点机器人，原点机器人根据第一距离值进行原地转动；
步骤3：当前壁、后壁对应的第一距离值之和达到最小且左、右壁对应的第一距离值之和均达到最小时，原点机器人自主停止转动并自主关闭原点机器人自身携带的所有激光测距传感器以实现原点机器人的位置调整；之后原点机器人自主开启其自身携带的电磁铁；同时，激光测距传感器将各个第一距离值的通过无线模块传输至移动机器人；
步骤4：用户控制移动机器人，以开启移动机器人自身携带的激光测距传感器，激光测距传感器分别位于空间的四个方位上，每个激光测距传感器均发射激光并测量其相对于空间壁之间的第二距离，之后均实时将第二距离值传输至移动机器人，移动机器人根据第二距离值进行原地转动；
步骤5：当前壁、后壁对应的第二距离值之和达到最小且左壁、右壁对应的第二距离值之和均达到最小时，移动机器人自主停止转动并自主关闭移动机器人自身携带的所有激光测距传感器以实现移动机器人的位置调整；
步骤6：移动机器人自主朝前壁移动，当移动机器人相对于前壁的第二距离值等于步骤3中原点机器人相对于前壁的第一距离值时，移动机器人自主沿垂直于前壁的方向移动，当移动机器人相对于左壁的第二距离值为零时，移动机器人自主停止移动，以完成编队。
2.根据权利要求1所述的机器人集群编队定位方法，其特征在于，在步骤6中，当移动机器人沿垂直于前壁的方向移动至预设距离时，移动机器人自主开启自身携带且靠近原点机器人一侧的电磁铁，通过移动机器人自身携带且靠近原点机器人一侧的霍尔传感器读取磁场强度变化，之后将磁场强度实时传输至移动机器人；当磁场强度最大时，移动机器人自主关闭移动机器人自身携带的电磁铁。
3.根据权利要求1所述的机器人集群编队定位方法，其特征在于，所述原点机器人的顶面为一正方形；所述顶面的四个边缘处均设置一电磁铁和一霍尔传感器。
4.根据权利要求1所述的机器人集群编队定位方法，其特征在于，所述原点机器人包括麦克纳姆轮。
5.根据权利要求1所述的机器人集群编队定位方法，其特征在于，所述空间由围墙组成。
6.一种机器人集群编队定位系统，其特征在于，包括原点机器人、移动机器人和无线模块；其中，所述无线模块用于连通原点机器人的主控模块和移动机器人的主控模块。
7.根据权利要求6所述的机器人集群编队定位系统，其特征在于，所述原点机器人还包括通信模块，用于与移动机器人通信。
技术总结