[发明专利]微型机器人集群的相对定位方法

说明书

技术领域

本发明涉及一种微型机器人集群，更具体的说，涉及一种微型机器人集群相对定位的方法。 

背景技术

随着微机电系统（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、复杂度低，只需很少量的数据处理，复杂度很低；