微型机器人集群的相对定位方法技术

一种微型机器人集群的相对定位方法，集群中每一微型机器人均安装有信号发送器和接收器以及角度测量器，集群中任一微型机器人Ri通过自身发送信号被邻居机器人Rj接收到，从而搜索到邻居机器人Rj，并通过调整自身方向至邻居机器人Rj接收到的信号最强；然后微行机器人Ri保持原地不动，邻居机器人Rj重复微型机器人Ri前述的动作；当微型机器人Ri和邻居机器人Rj互相搜索到对方且均调整至彼此接收到的信号最强的位置，此时，通过读取两个微型机器人Ri、Rj的接收器上的值获得彼此之间的距离，通过读取角度测量器获得彼此的方向角，完成定位。该方法针对微型机器人的特点进行定位，精度高、没有积累误差、分布式、快速和可扩展等。

【技术实现步骤摘要】

本专利技术涉及一种微型机器人集群，更具体的说，涉及一种微型机器人集群相对定位的方法。
技术介绍
随着微机电系统(MEMS)技术、计算机技术、无线通信等技术的进步，尤其是MEMS 技术的发展，推动着微型机器人发展和应用。但机器人微型化以后，个体移动微型机器人执行复杂任务的能力大大降低，人们受到自然界生物如蜜蜂、蚂蚁等群体的启发，为保证微型移动机器人具有执行复杂任务的能力，可以采用微型机器人集群共同完成复杂的任务。由于集群机器人个体成员的空间分布性，要求集群机器人在协作执行特定任务时对社会成员同时进行定位。从个体层面上说，机器人不仅要具备完备的关于自身的位置知识，而且要求具备关于时变集群邻居机器人的位置信息即邻居机器人之间的相对定位。具有相对定位能力对集群机器人完成一些任务是必须的，例如机器人共同搬运一个物体、搜索营救、覆盖任务等。对微型集群机器人而言，相对定位方法是其关键技术之一。对现有技术的文献检索发现，当前存在很少的集群机器人相对定位方法，文献Jim Puge 等人在 IEEE TRANSACTIONS ON MECHATRONICS (IEEE 的机械会刊杂志)2009 年发表的《A Fast Onboard Relative Positioning Module for Multirobot Systems》(一禾中快速多机器人板上相对定位系统)和Rivard等人在Robotics and Automation, 2008. ICRA 2008. IEEE International Conference on Digital Object Identifier (机器人和自动化、IEEE2008关于数字目标识别会议)发表的《Ultrasonic Relative Positioning for Multi-Robot Systems))(多机器人的超声相对定位系统)。以上两文所涉及的对象都是相对比较大机器人集群，所采用的是多个尺寸比较大红外传感定位和超声定位方法都很难应用到尺寸在数十个立方厘米之内的微型机器人机器上。
技术实现思路
本专利技术针对现有技术存在的上述不足，提供一种。该方法针对微型机器人的特点进行定位，精度高、没有积累误差、分布式、快速和可扩展寸。本专利技术是通过如下技术方案实现的一种，其特征在于集群中每一微型机器人均安装有信号发送器和接收器以及角度测量器，集群中任一微型机器人Ri通过自身发送信号被邻居机器人Rj接收到，从而搜索到邻居机器人Rj，并通过调整自身方向至邻居机器人Rj接收到的信号最强；然后微型机器人Ri保持原地不动，邻居机器人Rj重复微型机器人Ri前述的动作；当微型机器人Ri和邻居机器人Rj互相搜索到对方且均调整至彼此接收到的信号最强的位置，此时，通过读取两个微型机器人Ri、Rj的接收器上的值获得彼此之间的距离， 通过读取角度测量器获得彼此的方向角，完成定位。所述信号为红外信号，所述信号发送器和接收器为红外传感器，其中红外接收传感器安装在微型机器人的旋转中心以防止在微型机器人旋转过程中发生移位。所述角度测量器是采用双轴磁阻传感器，所述双轴磁阻传感器的Y方向与所述红外发送传感器的中心轴以及所述红外接收传感器的中心轴位于同一直线上。所述微型机器人Ri通过在原地士 180°自身旋转去搜索微型机器人Rj，直到微型机器人Rj接收到了微型机器人Ri的红外发送信号。通过读取两个微型机器人Ri、Rj上的接收器的最大信号强度值，并对照信号强度值与距离表，得到两个微型机器人Ri、Rj各自测量的彼此之间的相对距离，然后取该两个相对距离的平均值，即得到两个微型机器人Ri、Rj之间的距离。两个微型机器人Ri、Rj分别读取各自磁阻传感器上的值，其中，微型机器人Ri上的磁阻传感器的值是微型机器人Rj相对于微型机器人Ri的方向，微型机器人Rj上的磁阻传感器的值是微型机器人Ri相对于微型机器人Rj的方向。所述磁阻传感器在测量之前需进行校验，排除干扰磁场的存在，提高测量精度。与现有技术相比，本专利技术具有如下有益效果1、没有积累误差，微型机器人没有利用存储的历史信息来定位；2、定位是分布的，微型机器人依靠自身上的传感器定位，在机器人系统外不存在集中的单元；3、精度高，只是传感器本身测量存在的绝对误差；4、复杂度低，只需很少量的数据处理，复杂度很低；5、可扩展性，增大集群机器人数量并不影响机器人之间的相对的定位。附图说明图1为本专利技术所公开的红外传感器与磁阻传感器在微型机器人本体上的位置排列示意图2为定位开始阶段所处状态示意图3为定位搜索阶段和调整阶段所处状态示意图4为测距阶段、计算阶段以及修正阶段所处状态示意图。具体实施例方式下面结合附图对本专利技术的实施例作详细说明本实施例在以本专利技术技术方案为前提下进行实施，给出了详细的实施方式和具体的操作过程，但本专利技术的保护范围不限于下述的实施例。本专利技术实施例采用红外传感器和磁阻传感器相配合的相对定位方法，我们假设微型机器人在平面内作业，尺寸在数十个立方厘米之内，传感器的安装位置示意图如图1所示。为了适应更小尺寸的机器人，我们只选用一个红外发送传感器1和一个全向红外接收传感器2，此红外接收传感器2放置在了微型机器人的旋转中心，以防止在微型机器人旋转过程中移动。双轴磁阻传感器3的Y方向与红外发送传感器1的中心轴对齐且三者的中心轴在同一条直线上。本实施例采用两个微型机器人RI、R2相互定位，其开始阶段状态如图2所示。两者实现定位的过程和具体步骤如下 第一步搜索阶段微型机器人Rl想确定邻居机器人R2相对于自己位置的方向和距离。首先微型机器人Rl通过在原地士 180°自身旋转去搜索微型机器人R2，直到微型机器人R2接收到了微型机器人Rl发出的红外发送信号。如图2所示。第二步调整阶段微型机器人Rl在原地调整自己的方向，直到微型机器人R2接收到了微型机器人 Rl最大的信号强度。因为红外发送传感器有红外发送角且在0° (即光轴方向的光)是最强的，可确保我们定位精度很高，误差很小。如图3所示。第三步测距阶段微型机器人R2在原地调整自己的方向，直到微型机器人Rl接收到了微型机器人 R2最大的信号强度。微型机器人Rl记录接收到微型机器人R2最大的信号强度值，通过查找信号强度值与距离表，可得到微型机器人Rl和微型机器人R2之间的相对距离。如图4 所示。第四步计算阶段测距结束后，微型机器人Rl和微型机器人R2分别读取各自磁阻传感器的的值， 微型机器人Rl的值是微型机器人R2相对于微型机器人Rl的方向，微型机器人R2的值是微型机器人Rl相对于微型机器人R2的方向。由于磁阻传感器周围存在磁干扰，使得所测的当地磁场是当地的地磁场和当地的干扰磁场的矢量和。为了提取所要测量的当地的地磁场，在测量之前需要做校验工作。这样可以提高其测量精度。第五步修正阶段微型机器人Rl和微型机器人R2相互发送各自测量的彼此之间的距离，即rl和r2， 然后取两者的平均值r，即微型机器人Rl和微型机器人R2间的距离。本实施例中，红外发送传感器采用的是BPW17N，此传感器的半角为12°、直径为 5mm，红外接收传感器为SH1203P，半角为75°，磁阻传感器为MMC2120MG。在实际的测试中对该两个微型机器人相互定位，角度误差均值为本文档来自技高网...

【技术保护点】
１．一种微型机器人集群的相对定位方法，其特征在于：集群中每一微型机器人均安装有信号发送器和接收器以及角度测量器，集群中任一微型机器人Ｒｉ通过自身发送信号被邻居机器人Ｒｊ接收到，从而搜索到邻居机器人Ｒｊ，并通过调整自身方向至邻居机器人Ｒｊ接收到的信号最强；然后微行机器人Ｒｉ保持原地不动，邻居机器人Ｒｊ重复微型机器人Ｒｉ前述的动作；当微型机器人Ｒｉ和邻居机器人Ｒｊ互相搜索到对方且均调整至彼此接收到的信号最强的位置，此时，通过读取两个微型机器人Ｒｉ、Ｒｊ的接收器上的值获得彼此之间的距离，通过读取角度测量器获得彼此的方向角，完成定位。

【技术特征摘要】

【专利技术属性】
技术研发人员：陈佳品，毛玲，张大伟，李振波，
申请(专利权)人：上海交通大学，
类型：发明
国别省市：31