RFID技术在移动机器人同步定位中的应用

在室内移动机器人的导航中，机器人的定位与地图创建是机器人研究中一个基础且重要的问题。机器人只有实时明确自己当前的方位，才能快速准确地到达目的地。自从移动机器人诞生以来，已知环境地图的定位问题和已知定位的地图创建问题已经被广泛研究，提出了多种有效的解决途径。而当地图和机器人的位置都事先未知时，定位问题就变得更加复杂。

在这种情况下，要求机器人在一个完全未知的环境中从一个未知的位置出发，在递增地建立环境的导航地图同时，利用已建立的地图来同步刷新自身的位置，最终形成完整的环境地图并在此基础上提供准确的定位。在上述问题中，机器人位置和地图两者的估算是高度相关的，任何一方都无法独立获取。这样一种相辅相生，不断迭代的过程，被学术界简称为同步定位与地图创建( SLAM )问题。该问题可以表述为：机器人在未知环境中，从一个未知位置开始移动，在移动过程中根据位置估计和传感器进行自身定位，同时建立环境地图。目前使用的主要是模糊逻辑和概率的方法，如Bayes估计，Kalman滤波，扩展Kalman滤波和Markov推理等。

射频识别(RFID)技术是近年来兴起的一门自动识别技术。与传统的条形码系统、接触式卡等不同，射频识别系统是利用无线射频方式非接触供电，并进行非接触双向数据通信，以达到识别并交换数据的目的。识别工作无须人工干预，可工作于各种恶劣环境。将RFID技术应用于机器人中，可以更好地发挥其技术特点，使机器人更多地获取外在信息。

不少学者正在研究将RFID用于机器人定位系统中，把RFID作为机器人的一种传感器来进行数据采集和处理。标签为机器人的外部信息量，机器人通过阅读器来采集各个标签中的位置信息，通过获取的信息利用同步定位与地图创建算法来对机器人进行有效的定位，从而得到更准确地控制。本文的研究工作中提出了一种基于RFID 系统的有效SLAM 算法。该算法可以解决2维环境下的机器人定位问题。实验证明，通过已知的RFID数据，该算法能成功地在2维环境中实现移动机器人的跟踪定位。

1 RFID 环境设置

将RFID标签如图1所示均匀分布在地面上，标签的间距为0．5m。每个标签牛都存放该标签所在位置的绝对坐标数据。以便稍后为机器人提供外部位置信息。

将RFID 阅读器安装于机器人的底部，用于读取放置在地面上的标签中的信息。机器人在移动过程中进入标签范围时，标签进入阅读器的磁场范围，接收阅读器发出的射频信号，凭借感应电流所获得的能量发送出存储在标签中的坐标信息。实验中RFID阅读器的正面朝下读取地面的标签卡。

当移动机器人经过标签时，阅读器读取标签中的坐标信息并将其传回电脑存储，并读取阅读器的磁场范围的下一个标签．重复这一过程直到阅读器接收其射频场内所有标签信息。在本文的研究中，只考虑RFID阅读器一次只处理一个标签坐标信息的情况。

2 定位算法

上文已经描述了通过RFID系统获取机器人基本位置的方法。然而，同步定位的精度与RFID标签的间距以及硬件设备的性能密切相关。文中提出的基于RFID系统的同步定位与地图创建算法通过一些基本坐标信息来预测移动机器人的运动轨迹并定位。各国研究者已经提出了多种地图表示方法，大致可分为3类：栅格地图、几何特征地图和拓扑地图。本文使用几何特征地图，用几何特征表示传感器网络中的一个传感地标。地图中的地标和机器人的位置用直角坐标系表示。

当RFID标签进入阅读器的磁场范围时，阅读器读取其坐标数据X( x，y )，并根据该坐标值计算机器人到各个已知路标间的距离，已知路标用标签表示。

2．1 不确定性信息处理

作为SLAM 的信息来源，机器人本体的运动模型及其携带的传感器的准确性是决定地图精度的关键之一。实际上这些渠道获得的信息都带有不同程度的不确定性。在未知环境中，环境信息的不确定性尤为明显．感知信息的不确定必然导致地图和定位双方的不确定。研究人员已经提出了多种用来处理不确定性的度量方法，如模糊度量、概率度量、信任度量、可能性度量等。目前在SLAM 中使用较多的主要是模糊度量和概率度量的方法。本文采用概率度量来处理不确定性。用概率表示SLAM 中2个重要模型：观测模型和运动模型。

2．2 观测模型

观测模型P( x _t ，y _t )是已知t时刻机器人位置和路标位置集合M 的条件下求t时刻观察值五的条件概率。离散时间t=1，2，3，...；s = ( x _s , y _s )表示通过RFID获得的机器人位置；

表示t时刻得到的整个系统总观测值。

t 时刻机器人到某一路标的距离d是路标坐标f _i ( x _{f i} ，y _{f i} )与机器人位置坐标s_t ( x _s ，y_s )的函数，f _i ( x _{f i} ，y _{f i} )表示第i个路标的实际位置。模型中的噪声用q表示。观测模型可以表示为：



在定位算法中，信息标签对未知阅读器的位置都有影响力，标签到阅读器的距离越近，其影响力越大，对阅读器位置有更大决定权。本文中的阅读器放在移动机器人底部．所以阅读器的位置也是机器人的位置。如图2，阅读器收到了4个信息标签的信号，4个标签的坐标分别为( x₁，y₁)，(x₂，y₂)，( x₃，y₃)，( x₄，y₄)，它们到移动机器人的距离分别为d₁ ，d₂，d₃，d4。可以看出d1<d2 <d4 < d3。

因此Tagl的影响力最大，对阅读器的位置有最大决定权。Tag3的影响力最小，对阅读器位置的决定权最小。根据三角定位原理，只取影响力较大的3个信息标签来做定位计算。

根据Tagl，Tag2，Tag4到阅读器的距离d₁，d₂，d₄ 可求出待定位的机器人计算坐标S_t =(x_s，y_s )：