CN106997205A - 一种用于移动机器人对目标定位和跟踪的***及方法 - Google Patents
一种用于移动机器人对目标定位和跟踪的***及方法 Download PDFInfo
- Publication number
- CN106997205A CN106997205A CN201710289168.2A CN201710289168A CN106997205A CN 106997205 A CN106997205 A CN 106997205A CN 201710289168 A CN201710289168 A CN 201710289168A CN 106997205 A CN106997205 A CN 106997205A
- Authority
- CN
- China
- Prior art keywords
- rfid tag
- rfid
- particle
- target
- positioning
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims description 27
- 239000002245 particle Substances 0.000 claims abstract description 111
- 238000005259 measurement Methods 0.000 claims description 13
- 238000012952 Resampling Methods 0.000 claims description 12
- 238000012935 Averaging Methods 0.000 claims description 6
- 230000009977 dual effect Effects 0.000 claims description 5
- 238000012986 modification Methods 0.000 claims description 3
- 230000004048 modification Effects 0.000 claims description 3
- 230000003287 optical effect Effects 0.000 claims description 3
- 230000004927 fusion Effects 0.000 abstract description 3
- 238000001514 detection method Methods 0.000 description 4
- 238000005516 engineering process Methods 0.000 description 3
- 230000004888 barrier function Effects 0.000 description 2
- 238000006243 chemical reaction Methods 0.000 description 2
- 238000005315 distribution function Methods 0.000 description 2
- 230000000717 retained effect Effects 0.000 description 2
- 230000000007 visual effect Effects 0.000 description 2
- 238000009825 accumulation Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000007796 conventional method Methods 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 239000007788 liquid Substances 0.000 description 1
- 230000014759 maintenance of location Effects 0.000 description 1
- 239000002184 metal Substances 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0238—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
- G05D1/024—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
- G05D1/028—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using a RF signal
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Optics & Photonics (AREA)
- Electromagnetism (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Radar Systems Or Details Thereof (AREA)
Abstract
本发明公开了一种用于移动机器人对目标定位和跟踪的***,其包括设置在目标上的RFID标签,设置在移动机器人上的RFID天线,与RFID天线相连接的RFID阅读器,与RFID阅读器相连接的运动控制***,以及与运动控制***相连接的激光传感器。本发明利用RFID信号强度信息和相位信息对标签的位置和运动速度进行估算,同时移动机器人通过运动控制***,实现动态RFID标签的实时跟踪,并通过激光传感器进行避障。***通过粒子滤波器来实现相位信息和信号强度信息的融合从而实现动态RFID标签的快速追踪。
Description
技术领域
本发明涉及物联网机器人领域,具体涉及一种用于移动机器人对目标定位和跟踪的***及方法。
背景技术
随着物联网技术的发展,在互联网基础上,利用通信技术将传感设备、机器、人和物品连接起来,以实现智能化识别、定位、跟踪、监控和管理。射频识别(Radio FrequencyIdentification,RFID)使用无线射频信号进行对象识别,RFID阅读器不需要与标签建立机械或光学接触;RFID标签可附着在物体上用于货物自动识别和跟踪,可克服传统视觉必须在视野内进行识别的缺点。另外,RFID无源标签识别距离可达7-10米,价格低廉、体积小巧,广泛应用于超市、机场、物流、零售等方面。机器人领域一直是前沿高技术研究最活跃的一部分,而机器人作为一个移动智能体在某些环境中感知标签,可为人类提供帮助和导航等服务。
发明内容
针对现有技术中的上述不足,本发明提供的一种用于移动机器人对目标定位和跟踪的***提供了一种智能化识别、定位和跟踪目标的***。
为了达到上述发明目的,本发明采用的技术方案为:
提供一种用于移动机器人对目标定位和跟踪的***,其包括设置在目标上的RFID标签,设置在移动机器人上的RFID天线,与RFID天线相连接的RFID阅读器,与RFID阅读器相连接的运动控制***,以及与运动控制***相连接的激光传感器;
RFID标签,用于反射RFID天线所发送的无线射频信号;
RFID天线,用于发送无线射频信号并接收由RFID标签所反射的无线射频信号;
RFID阅读器,用于通过RFID天线获取RFID标签的信号强度和相位信息;
激光传感器,用于通过激光测得目标障碍物的距离;
运动控制***,用于通过粒子滤波器融合RFID标签的信号强度和相位信息,实现RFID标签的定位;同时根据RFID标签的相位信息估算RFID标签的运动速度,以及根据激光传感器测定的目标障碍物的距离,配合VFH+避障算法进行导航跟踪。
提供一种用于移动机器人对目标定位和跟踪的方法,其包括以下步骤:
S1、RFID天线发射无线射频信号并接收由设置在目标上的RFID标签所反射的信号,并将该反射信号发送至RFID阅读器;
S2、RFID阅读器根据该反射信号获取RFID标签的信号强度信息和相位信息,并将该信号强度信息和相位信息发送至运动控制***;
S3、运动控制***根据接收到的RFID标签的信号强度信息和相位信息,将每个RFID标签的位置用一个粒子滤波器表示,通过粒子滤波器融合RFID标签的信号强度和相位信息,当RFID标签的信号强度低于阈值时,返回步骤S1;RFID标签的信号强度大于或等于阈值时,实现RFID标签的定位;
同时,运动控制***通过RFID标签的相位信息估算RFID标签的运动速度,以及根据激光传感器测定的目标障碍物的距离,配合VFH+避障算法进行导航跟踪。
进一步地,步骤S3中运动控制***根据接收到的RFID标签的信号强度信息和相位信息,将每个RFID标签的位置用一个粒子滤波器表示,通过粒子滤波器融合RFID标签的信号强度和相位信息,实现RFID标签的定位的方法为:
(1)初始化粒子滤波器;
(2)根据RFID标签的相位信息估算RFID标签的速率;
(3)粒子滤波器利用相位估计的速率信息对粒子进行预测;
(4)利用RFID传感器模型更新每个粒子的权重;
(5)使用重采样算法对更新权重后的粒子进行重采样,根据“达尔文进化论”,保留权重大的粒子,去除权重小的粒子;
(6)对粒子进行扰动,并对扰动后的粒子求平均,以得到RFID标签的估算位置。
进一步地,粒子滤波器为双重粒子滤波器,根据公式:
使用速率信息对RFID标签的状态进行预测,避免追踪失败;
其中V为RFID标签的速度,π(Zt,Xt)=∫P(Zt|Xt)dXt,表示均值为方差为vt高斯模型,p(Zt|Xt)为传感器模型表示在Xt处阅读器得到标签测量数据Zt的概率,α为0至1之间的常数。
进一步地,RFID传感器模型为:
p(Z|(x,y))=p(d|(x,y))p(s|d,(x,y))
根据在某一给定位置上RFID的信号强度遵循均值为ux方差为σx的高斯分布,此位置RFID标签信号强度为s的概率为:
其中p(d|(x,y))表示在位置(x,y)处检测到RFID标签的概率大小,p(s|d,(x,y))表示在(x,y)处检测到RFID标签的信号强度为s的概率大小,π为常数。
进一步地,RFID传感器模型对粒子滤波器进行更新的方法为:
Wt=ηt·Wt-1·p(Zt|Xt)
其中Wt为粒子的权重,ηt为归一化参数,p(Zt|Xt)是在位置Xt处阅读器得到标签测量数据Zt的概率。
进一步地,对粒子进行重采样,对粒子进行扰动,并对扰动后的粒子求平均,以得到RFID标签的估算位置的方法为:根据公式
计算粒子的新位置,即RFID标签的位置;其中和来表示粒子滤波器的均值和协方差,ρ为常数,N为粒子数量,X(i)为粒子的位置。
本发明的有益效果为:
1、本发明利用RFID信号强度信息和相位信息对标签的位置和运动速度进行估算,同时移动机器人通过运动控制***,实现动态RFID标签的实时跟踪,并通过激光传感器进行避障。***通过粒子滤波器来实现相位信息和信号强度信息的融合从而实现动态RFID标签的快速追踪。
2、每个RFID标签提供唯一ID用于目标识别,因此RFID不需要复杂的目标分类识别算法,RFID使用无线射频信号与标签进行通信,无线信号可以穿透障碍物,使得本发明不需要与标签建立机械或光学接触,可以很好的解决视觉的遮挡和外界光线的影响问题。
具体实施方式
下面对本发明的具体实施方式进行描述,以便于本技术领域的技术人员理解本发明,但应该清楚,本发明不限于具体实施方式的范围,对本技术领域的普通技术人员来讲,只要各种变化在所附的权利要求限定和确定的本发明的精神和范围内,这些变化是显而易见的,一切利用本发明构思的发明创造均在保护之列。
该用于移动机器人对目标定位和跟踪的***包括设置在目标上的RFID标签,设置在移动机器人上的RFID天线,与RFID天线相连接的RFID阅读器,与RFID阅读器相连接的运动控制***,以及与运动控制***相连接的激光传感器;
RFID标签,用于反射RFID天线所发送的无线射频信号;
RFID天线,用于发送无线射频信号并接收由RFID标签所反射的无线射频信号;
RFID阅读器,用于通过RFID天线获取RFID标签的信号强度和相位信息;
激光传感器,用于通过激光测得目标障碍物的距离;
运动控制***,用于通过粒子滤波器融合RFID标签的信号强度和相位信息,实现RFID标签的定位;通过RFID标签的相位信息估算RFID标签的运动速度,以及激光传感器测定的目标障碍物的距离,配合VFH+避障算法进行导航跟踪。
该用于移动机器人对目标定位和跟踪的方法包括以下步骤:
S1、RFID天线发射无线射频信号并接收由设置在目标上的RFID标签所反射的信号,并将该反射信号发送至RFID阅读器;
S2、RFID阅读器根据该反射信号获取RFID标签的信号强度信息和相位信息,并将该信号强度信息和相位信息发送至运动控制***;
S3、运动控制***根据接收到的RFID标签的信号强度信息和相位信息,将每个RFID标签的位置用一个粒子滤波器表示,通过粒子滤波器融合RFID标签的信号强度和相位信息,当RFID标签的信号强度低于阈值时,返回步骤S1;RFID标签的信号强度大于或等于阈值时,实现RFID标签的定位;
同时,运动控制***通过RFID标签的相位信息估算RFID标签的运动速度,以及根据激光传感器测定的目标障碍物的距离,配合VFH+避障算法进行导航跟踪。
步骤S3中运动控制***根据接收到的RFID标签的信号强度信息和相位信息,通过粒子滤波器融合RFID标签的信号强度和相位信息,实现RFID标签的定位的方法为:
(1)初始化粒子滤波器;
(2)根据RFID标签的相位信息估算RFID标签的速率;
(3)粒子滤波器根据速率信息对粒子进行预测;
(4)粒子滤波器利用RFID传感器模型更新每个粒子的权重;
(5)使用重采样算法对更新权重后的粒子进行重采样,根据“达尔文进化论”,保留权重大的粒子,去除权重小的粒子;
(6)对粒子进行扰动,对扰动后的粒子求平均,以得到RFID标签的估算位置。此处粒子进行重采样的具体方法为对所有的粒子权重进行归一化,保证所有粒子权重加起来为1,用一个数组来表示粒子的累积权重和,然后随机产生0到1的均匀分布,判断这个随机数落在数组的哪个区间,然后这个区间对应的粒子就被保存下来,重复此过程,直到我们产生了N个粒子。假设我们有三个粒子(N=3),他们的权重分别为0.1,0.2,0.7,我们用如下数组来表示累计权重数组[0.1,0.3,1],我们产生三个随机数,如0.2,0.54,0.78,根据此随机数我们会选择第二个粒子(0.54)一次,第三个粒子(0.78)两次来构成新的粒子组合来进行位置的估算。
粒子滤波器为双重粒子滤波器,在每次获得到RFID信号强度后,***会根据当前的信号强度大小增加一定的随机粒子,并根据当前的概率分布函数赋予这些粒子一定的权重。使用双重粒子滤波器产生α粒子,剩下的粒子使用相位估计的速度v进行预测。但是新增加的这些粒子往往会破坏当前的粒子分布情况,这一问题根据当前的概率分布函数赋予这些粒子一定的权重:通过核函数来构造后验概率,然后决定粒子的权重大小。因为预先已经建立了一个非常精确的RFID传感器模型,因此在当前测量信号强度的基础上增加随机粒子是非常容易的。双重粒子滤波器产生α粒子,剩下的粒子根据相位信息得到的速度v进行预测,(0≤α≤1)根据公式:
使用速度信息对RFID标签的状态进行预测,并增加随机扰动的粒子,避免追踪失败;
其中π(Zt,Xt)=∫P(Zt|Xt)dXt,表示均值为方差为vt高斯模型,p(Zt|Xt)为传感器模型表示在Xt处阅读器得到标签测量数据Zt的概率。
RFID传感器模型描述了在某一位置(x,y)处RFID天线得到了标签测量数据z的概率大小,由于RFID天线可以提供是否检测到这个标签和相应的信号强度,RFID的传感器模型可以表述为:
p(Z|(x,y))=p(d|(x,y))p(s|d,(x,y))
根据在某一给定位置上RFID的信号强度遵循均值为ux方差为σx的高斯分布,此位置RFID标签信号强度为s的概率为:
其中p(d|(x,y))表示在位置(x,y)处检测到RFID标签的概率大小,p(s|d,(x,y))表示在(x,y)处检测到RFID标签的信号强度为s的概率大小,π为常数。
在本发明的一个实施例中,移动机器人安装了一个SICK S300型号的激光传感器(该激光测传感器具有240°的测量角度)。此外,移动机器人还携带有一个超高频射频识别读写器(Impinj speedway R1000),这个RFID阅读器提供最大识别范围可达10米。机器人在0.8米高度处安装2个与其前进方向成45°的圆极天线。
采用粒子滤波器融合RFID标签的相位信息和强度信息,将每个RFID标签的位置用一个粒子滤波器表示,每个粒子滤波器由若干个粒子组成,每个粒子包括一个位置假设以及相应的权重,根据公式
其中
即可得到RFID标签的径向速度v;
根据递归贝叶斯估计公式
p(Xt|Z1:t,v1:t)=ηt·p(Zt|Xt)·p(Xt|Xt-1,vt)·p(Xt-1|Z1:t-1,v1:t-1)
得到标签位置的后验概率,这个后验概率代表标签的估算位置;
根据公式
wt=ηt·wt-1·p(Zt|Xt)
RFID传感器模块对每一个粒子的权重进行更新,然后使用重采样算法对粒子进行重采样,根据“达尔文进化论”,保留权重大的粒子,去除权重小的粒子;
重采样之后根据公式
对粒子进行扰动,让粒子往RFID标签的真实位置进行汇聚,防止粒子发散,对扰动后的粒子求平均得到RFID标签的估算位置,ρ为常数,其取值区间为0.95至0.98,取值越小,表示扰动越大;
其中λ为波长,f为载波频率,c为光速,t0和t1分别为在相邻时间同一RFID标签被检测的时间,θ1和θ0分别为在相邻时间同一RFID标签被检测的相位,Xt是RFID标签在t时刻的位置,Z1:t是RFID标签在1:t时刻的RFID测量数据,v1:t是使用相位信息获取的RFID标签的速度信息,p(Zt|Xt)是在位置Xt处阅读器得到标签测量数据Zt的概率,p(Xt-1|Z1:t-1,v1:t-1)为RFID标签在时刻t-1的状态,wt为当前粒子的权重,ηt为归一化参数,和分别为粒子滤波器的均值和协方差,N为粒子数量。
传统方法对RFID标签的定位需要建立一个比较精确的传感器模型。这个模型可以预测机器人在不同位置检测到标签概率以及相应的信号强度。由于RFID读写特性受环境的影响很大,尤其是RFID信号对金属和液体反应比较敏感。所以本发明通过融合多传感器的信息来提高标签的定位精度通过粒子滤波器融合不同的运动信息来实现动态RFID标签的快速追踪。
构建RFID传感器模型的方法为:
在环境中安装若干已知位置的RFID标签,移动机器人移动并搜集环境中的RFID的信号强度信息,在这一阶段中RFID的信号强度和机器人本身的位置数据被记录了下来,然后通过以下两个步骤自动构建传感器模型:
a.数据预处理:
在每一个记录数据的时间点,通过机器人和天线的坐标关系得到标签和天线的之间的相对位置。这样每个测量数据相对每个标签产生一个测量样本,这个样本包括标签相对与天线的位置和标签的测量数据(是否检测到标签以及标签信号强度的大小)。假设RFID天线的最大测量距离为D,将传感器模型的范围限制在[0:D,-D/2:D/2]。y坐标的范围是对称的,因为RFID阅读器的信号传播特性是对称的。
b.构建模型:
使用上一阶段产生的样本来计算传感器模型p(z|x),这个模型给出了在RFID天线的坐标系下X位置得到一个测量值z的概率。这个传感器模型将会被用于粒子滤波器的粒子权重的更新。使用二维栅格来表示传感器模型,整个模型空间被离散化二维栅格,对于每一个栅格,根据公式:
得到RFID标签在每个栅格内被检测的概率,并得到RFID标签的平均信号强度和方差,将其保存并用于RFID标签的定位和追踪;其中为落在每一个栅格内的正检测个数,为落在每一个栅格内的负检测个数;如果在某一时刻检测到某一标签,我们定义为正检测,否则为负检测。本模型可以预测移动机器人在不同位置处检测到RFID标签的概率以及相应的信号强度。
本发明在具体实施过程中,由于移动机器人仅在二维中移动,移动机器人在时间t时刻的状态可以表示为Xt=(xt,yt,θt)。其中xt和yt是机器人相对于世界坐标系的坐标,θt是机器人的旋转角度。移动机器人的运动被看做是在2D空间中的转换,机器人在时间t的平移为Δdt,旋转为Δθt。机器人的运动模型可表示为:
θt+1=θt+Δθt
本发明使用的差速驱动机器人进行运动控制,机器人主体两侧配备有两个独立运行的车轮和电机。机器人前端安装一个额外万向轮来平衡机器人。电机编码器能提供关于机器人电机的运动的信息,可以被转换成车轮的速度或车轮行进的距离。机器人旋转的中心点被称为瞬时曲率中心(ICC)。这一点在短时间内几乎没有速度。机器人的运动通过改变两个电机的速度来实现。如果两个轮子以相同的速度和相同的方向旋转,机器人将直线移动。否则,根据两个车轮的速度的大小,机器人会进行相应的运动。
由于左右轮围绕ICC的旋转速度w相同,因此:
vl=w(R-L/2) vr=w(R-L/2)
其中L表示两个车轮之间的距离,这是已知参数;vl和vl分别是左右轮的速度,R是从瞬时曲率中心点(ICC)到机器人中心的距离。在任何时间间隔Δt处,机器人移动的距离Δd和方向Δθ可以表示为:
这意味着机器人的运动可以完全由两个车轮的速度决定。
综上所述,本发明提出了一种基于移动机器人和RFID结合的动态标签定位和追踪方法。该发明利用RFID信号强度信息和相位信息对标签的位置和运动速度进行估算,同时移动机器人通过运动控制***,实现动态RFID标签的实时跟踪,并通过激光传感器进行避障。***通过粒子滤波器来实现相位信息和信号强度信息的融合从而实现动态RFID标签的快速追踪。
Claims (7)
1.一种用于移动机器人对目标定位和跟踪的***,其特征在于:包括设置在目标上的RFID标签,设置在移动机器人上的RFID天线,与所述RFID天线相连接的RFID阅读器,与所述RFID阅读器相连接的运动控制***,以及与所述运动控制***相连接的激光传感器;
所述RFID标签,用于反射RFID天线所发送的无线射频信号;
所述RFID天线,用于发送无线射频信号并接收由RFID标签所反射的无线射频信号;
所述RFID阅读器,用于通过RFID天线获取RFID标签的信号强度和相位信息;
所述激光传感器,用于通过激光测得目标障碍物的距离;
所述运动控制***,用于通过粒子滤波器融合RFID标签的信号强度和相位信息,实现RFID标签的定位;同时根据RFID标签的相位信息估算RFID标签的运动速度,以及根据激光传感器测定的目标障碍物的距离,配合VFH+避障算法进行导航跟踪。
2.一种用于移动机器人对目标定位和跟踪的方法,其特征在于:包括以下步骤:
S1、RFID天线发射无线射频信号并接收由设置在目标上的RFID标签所反射的信号,并将该反射信号发送至RFID阅读器;
S2、RFID阅读器根据该反射信号获取RFID标签的信号强度信息和相位信息,并将该信号强度信息和相位信息发送至运动控制***;
S3、运动控制***根据接收到的RFID标签的信号强度信息和相位信息,将每个RFID标签的位置用一个粒子滤波器表示,通过粒子滤波器融合RFID标签的信号强度和相位信息,当RFID标签的信号强度低于阈值时,返回步骤S1;RFID标签的信号强度大于或等于阈值时,实现RFID标签的定位;
同时,运动控制***根据RFID标签的相位信息估算RFID标签的运动速度,以及根据激光传感器测定的目标障碍物的距离,配合VFH+避障算法进行导航跟踪。
3.根据权利要求2所述的用于移动机器人对目标定位和跟踪的方法,其特征在于,步骤S3中运动控制***根据接收到的RFID标签的信号强度信息和相位信息,将每个RFID标签的位置用一个粒子滤波器表示,通过粒子滤波器融合RFID标签的信号强度和相位信息,实现RFID标签的定位的方法为:
(1)初始化粒子滤波器;
(2)根据RFID标签的相位信息估算RFID标签的速率;
(3)粒子滤波器利用相位估计的速率信息对粒子进行预测;
(4)利用RFID传感器模型更新每个粒子的权重;
(5)使用重采样算法对更新权重后的粒子进行重采样,根据“达尔文进化论”,保留权重大的粒子,去除权重小的粒子;
(6)对粒子进行扰动,并对扰动后的粒子求平均,以得到RFID标签的估算位置。
4.根据权利要求3所述的用于移动机器人对目标定位和跟踪的方法,其特征在于:粒子滤波器为双重粒子滤波器,根据公式:
使用速率信息对RFID标签的状态进行预测,避免追踪失败;
其中V为RFID标签的速度,π(Zt,Xt)=∫P(Zt|Xt)dXt,表示均值为方差为vt高斯模型,p(Zt|Xt)为传感器模型表示在Xt处阅读器得到标签测量数据Zt的概率,α为0至1之间的常数。
5.根据权利要求3所述的用于移动机器人对目标定位和跟踪的方法,其特征在于:RFID传感器模型为:
p(Z|(x,y))=p(d|(x,y))p(s|d,(x,y))
根据在某一给定位置上RFID的信号强度遵循均值为ux方差为σx的高斯分布,此位置RFID标签信号强度为s的概率为:
其中p(d|(x,y))表示在位置(x,y)处检测到RFID标签的概率大小,p(s|d,(x,y))表示在(x,y)处检测到RFID标签的信号强度为s的概率大小,π为常数。
6.根据权利要求3所述的用于移动机器人对目标定位和跟踪的方法,其特征在于,RFID传感器模型对粒子滤波器进行更新的方法为:
Wt=ηt·Wt-1·p(Zt|Xt)
其中Wt为粒子的权重,ηt为归一化参数,p(Zt|Xt)是在位置Xt处阅读器得到标签测量数据Zt的概率。
7.根据权利要求3所述的用于移动机器人对目标定位和跟踪的方法,其特征在于,对粒子进行重采样,对粒子进行扰动,并对扰动后的粒子求平均,以得到RFID标签的估算位置的方法为:根据公式
计算粒子的新位置,即RFID标签的位置;其中和来表示粒子滤波器的均值和协方差,ρ为常数,N为粒子数量,X(i)为粒子的位置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710289168.2A CN106997205B (zh) | 2017-04-27 | 2017-04-27 | 一种用于移动机器人对目标定位和跟踪的***及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710289168.2A CN106997205B (zh) | 2017-04-27 | 2017-04-27 | 一种用于移动机器人对目标定位和跟踪的***及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106997205A true CN106997205A (zh) | 2017-08-01 |
CN106997205B CN106997205B (zh) | 2019-10-01 |
Family
ID=59434829
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710289168.2A Expired - Fee Related CN106997205B (zh) | 2017-04-27 | 2017-04-27 | 一种用于移动机器人对目标定位和跟踪的***及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106997205B (zh) |
Cited By (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108414972A (zh) * | 2018-04-26 | 2018-08-17 | 华中科技大学 | 一种基于相位特征的移动机器人rfid定位方法 |
CN108490390A (zh) * | 2018-02-28 | 2018-09-04 | 北京理工大学 | 一种移动磁源定位装置 |
CN108614980A (zh) * | 2018-04-16 | 2018-10-02 | 西南科技大学 | 一种融合rfid和激光信息的动态目标定位***及方法 |
CN108828572A (zh) * | 2018-08-24 | 2018-11-16 | 杭州物必连科技有限公司 | 一种物联网机器人、仓库货物定位***及定位方法 |
CN109426246A (zh) * | 2017-08-21 | 2019-03-05 | 铨宝工业股份有限公司 | 自动追踪装置 |
CN110132273A (zh) * | 2019-04-17 | 2019-08-16 | 华中科技大学 | 一种基于rfid伺服技术的移动机器人导航方法 |
US20190263396A1 (en) * | 2019-05-10 | 2019-08-29 | Arnouse Digital Devices Corporation | Artificial intelligence based collision avoidance system and method |
CN110361017A (zh) * | 2019-07-19 | 2019-10-22 | 西南科技大学 | 一种基于栅格法的扫地机器人全遍历路径规划方法 |
CN110442014A (zh) * | 2019-07-30 | 2019-11-12 | 华中科技大学 | 一种基于位置的移动机器人rfid伺服方法 |
CN110443546A (zh) * | 2019-07-18 | 2019-11-12 | 国网江西省电力有限公司鹰潭供电分公司 | 一种基于rfid的物品定位搜索***及方法 |
CN111324116A (zh) * | 2020-02-14 | 2020-06-23 | 南京航空航天大学 | 基于粒子滤波的机器人定位方法 |
CN111459192A (zh) * | 2020-03-26 | 2020-07-28 | 华中科技大学 | 一种基于rfid的移动机器人动态目标跟踪方法 |
CN112367887A (zh) * | 2018-05-04 | 2021-02-12 | Lg电子株式会社 | 多个机器人清洁器及其控制方法 |
CN112367888A (zh) * | 2018-05-04 | 2021-02-12 | Lg电子株式会社 | 多个机器人清洁器及其控制方法 |
CN113468899A (zh) * | 2021-06-30 | 2021-10-01 | 中国科学技术大学 | 一种基于rfid的不携带标签的目标追踪方法 |
US11150668B2 (en) | 2018-05-04 | 2021-10-19 | Lg Electronics Inc. | Plurality of robot cleaner and a controlling method for the same |
US11148290B2 (en) | 2018-05-04 | 2021-10-19 | Lg Electronics Inc. | Plurality of robot cleaner and a controlling method for the same |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102156476A (zh) * | 2011-04-14 | 2011-08-17 | 山东大学 | 智能空间与护士机器人多传感器***及其信息融合方法 |
CN102880179A (zh) * | 2012-09-19 | 2013-01-16 | 山东康威通信技术股份有限公司 | 一种电力隧道内多功能智能化巡检机器人 |
CN103969623A (zh) * | 2014-05-23 | 2014-08-06 | 中山达华智能科技股份有限公司 | 基于pso的rfid的室内定位方法 |
CN104581770A (zh) * | 2015-01-28 | 2015-04-29 | 北京理工大学 | 基于高效能射频网络的目标定位和跟踪方法 |
WO2016123746A1 (en) * | 2015-02-03 | 2016-08-11 | SZ DJI Technology Co., Ltd. | System and method for detecting aerial vehicle position and velocity via sound |
US20160259032A1 (en) * | 2015-03-07 | 2016-09-08 | Verity Studios Ag | Distributed localization systems and methods and self-localizing apparatus |
CN106249198A (zh) * | 2016-07-15 | 2016-12-21 | 西安电子科技大学 | 基于多点rfid结合超声波的室内机器人定位方法 |
CN106526535A (zh) * | 2016-11-08 | 2017-03-22 | 北京创想智控科技有限公司 | 一种室内机器人定位方法及装置 |
CN106597360A (zh) * | 2016-12-16 | 2017-04-26 | 西安电子科技大学 | 基于rfid的机器人对室内目标实时动态定位监控方法 |
-
2017
- 2017-04-27 CN CN201710289168.2A patent/CN106997205B/zh not_active Expired - Fee Related
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102156476A (zh) * | 2011-04-14 | 2011-08-17 | 山东大学 | 智能空间与护士机器人多传感器***及其信息融合方法 |
CN102880179A (zh) * | 2012-09-19 | 2013-01-16 | 山东康威通信技术股份有限公司 | 一种电力隧道内多功能智能化巡检机器人 |
CN103969623A (zh) * | 2014-05-23 | 2014-08-06 | 中山达华智能科技股份有限公司 | 基于pso的rfid的室内定位方法 |
CN104581770A (zh) * | 2015-01-28 | 2015-04-29 | 北京理工大学 | 基于高效能射频网络的目标定位和跟踪方法 |
WO2016123746A1 (en) * | 2015-02-03 | 2016-08-11 | SZ DJI Technology Co., Ltd. | System and method for detecting aerial vehicle position and velocity via sound |
US20160259032A1 (en) * | 2015-03-07 | 2016-09-08 | Verity Studios Ag | Distributed localization systems and methods and self-localizing apparatus |
CN106249198A (zh) * | 2016-07-15 | 2016-12-21 | 西安电子科技大学 | 基于多点rfid结合超声波的室内机器人定位方法 |
CN106526535A (zh) * | 2016-11-08 | 2017-03-22 | 北京创想智控科技有限公司 | 一种室内机器人定位方法及装置 |
CN106597360A (zh) * | 2016-12-16 | 2017-04-26 | 西安电子科技大学 | 基于rfid的机器人对室内目标实时动态定位监控方法 |
Non-Patent Citations (1)
Title |
---|
石雪军: "基于RFID的室内无线定位控制方法研究", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
Cited By (28)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109426246A (zh) * | 2017-08-21 | 2019-03-05 | 铨宝工业股份有限公司 | 自动追踪装置 |
CN108490390A (zh) * | 2018-02-28 | 2018-09-04 | 北京理工大学 | 一种移动磁源定位装置 |
CN108490390B (zh) * | 2018-02-28 | 2022-05-17 | 北京理工大学 | 一种移动磁源定位装置 |
CN108614980A (zh) * | 2018-04-16 | 2018-10-02 | 西南科技大学 | 一种融合rfid和激光信息的动态目标定位***及方法 |
CN108414972B (zh) * | 2018-04-26 | 2020-05-19 | 华中科技大学 | 一种基于相位特征的移动机器人rfid定位方法 |
CN108414972A (zh) * | 2018-04-26 | 2018-08-17 | 华中科技大学 | 一种基于相位特征的移动机器人rfid定位方法 |
US11148290B2 (en) | 2018-05-04 | 2021-10-19 | Lg Electronics Inc. | Plurality of robot cleaner and a controlling method for the same |
CN112367887B (zh) * | 2018-05-04 | 2022-11-25 | Lg电子株式会社 | 多个机器人清洁器及其控制方法 |
CN112367888B (zh) * | 2018-05-04 | 2022-04-08 | Lg电子株式会社 | 多个机器人清洁器及其控制方法 |
US11150668B2 (en) | 2018-05-04 | 2021-10-19 | Lg Electronics Inc. | Plurality of robot cleaner and a controlling method for the same |
US11934200B2 (en) | 2018-05-04 | 2024-03-19 | Lg Electronics Inc. | Plurality of robot cleaner and a controlling method for the same |
CN112367888A (zh) * | 2018-05-04 | 2021-02-12 | Lg电子株式会社 | 多个机器人清洁器及其控制方法 |
CN112367887A (zh) * | 2018-05-04 | 2021-02-12 | Lg电子株式会社 | 多个机器人清洁器及其控制方法 |
CN108828572A (zh) * | 2018-08-24 | 2018-11-16 | 杭州物必连科技有限公司 | 一种物联网机器人、仓库货物定位***及定位方法 |
CN110132273A (zh) * | 2019-04-17 | 2019-08-16 | 华中科技大学 | 一种基于rfid伺服技术的移动机器人导航方法 |
US10933867B2 (en) * | 2019-05-10 | 2021-03-02 | Arnouse Digital Devices Corporation | Artificial intelligence based collision avoidance system and method |
US20190263396A1 (en) * | 2019-05-10 | 2019-08-29 | Arnouse Digital Devices Corporation | Artificial intelligence based collision avoidance system and method |
CN110443546A (zh) * | 2019-07-18 | 2019-11-12 | 国网江西省电力有限公司鹰潭供电分公司 | 一种基于rfid的物品定位搜索***及方法 |
CN110361017A (zh) * | 2019-07-19 | 2019-10-22 | 西南科技大学 | 一种基于栅格法的扫地机器人全遍历路径规划方法 |
CN110361017B (zh) * | 2019-07-19 | 2022-02-11 | 西南科技大学 | 一种基于栅格法的扫地机器人全遍历路径规划方法 |
CN110442014B (zh) * | 2019-07-30 | 2020-08-04 | 华中科技大学 | 一种基于位置的移动机器人rfid伺服方法 |
CN110442014A (zh) * | 2019-07-30 | 2019-11-12 | 华中科技大学 | 一种基于位置的移动机器人rfid伺服方法 |
CN111324116A (zh) * | 2020-02-14 | 2020-06-23 | 南京航空航天大学 | 基于粒子滤波的机器人定位方法 |
CN111324116B (zh) * | 2020-02-14 | 2021-09-21 | 南京航空航天大学 | 基于粒子滤波的机器人定位方法 |
CN111459192A (zh) * | 2020-03-26 | 2020-07-28 | 华中科技大学 | 一种基于rfid的移动机器人动态目标跟踪方法 |
CN111459192B (zh) * | 2020-03-26 | 2021-08-03 | 华中科技大学 | 一种基于rfid的移动机器人动态目标跟踪方法 |
CN113468899A (zh) * | 2021-06-30 | 2021-10-01 | 中国科学技术大学 | 一种基于rfid的不携带标签的目标追踪方法 |
CN113468899B (zh) * | 2021-06-30 | 2023-06-16 | 中国科学技术大学 | 一种基于rfid的不携带标签的目标追踪方法 |
Also Published As
Publication number | Publication date |
---|---|
CN106997205B (zh) | 2019-10-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106997205B (zh) | 一种用于移动机器人对目标定位和跟踪的***及方法 | |
US10902227B2 (en) | Utilization of motion and spatial identification in RFID systems | |
Park et al. | Self-recognition of vehicle position using UHF passive RFID tags | |
Zhang et al. | BFVP: A probabilistic UHF RFID tag localization algorithm using Bayesian filter and a variable power RFID model | |
Ma et al. | Fusion of RSS and phase shift using the Kalman filter for RFID tracking | |
US8446253B2 (en) | Localization using virtual antenna arrays in modulated backscatter RFID systems | |
Zhang et al. | Robust RFID based 6-DoF localization for unmanned aerial vehicles | |
Motroni et al. | SAR-based indoor localization of UHF-RFID tags via mobile robot | |
CN109725636B (zh) | 自动驾驶车辆自动跟随前方物体的***和方法、跟踪*** | |
Errington et al. | Initial position estimation using RFID tags: A least-squares approach | |
Dobrev et al. | Steady delivery: Wireless local positioning systems for tracking and autonomous navigation of transport vehicles and mobile robots | |
CN108614980A (zh) | 一种融合rfid和激光信息的动态目标定位***及方法 | |
EP1463959B1 (en) | Method and apparatus for determining location of objects based on range reading from mulitiple sensors | |
CN101023373A (zh) | 传感环境属性与实体的自主相关的方法和*** | |
JP2015534640A (ja) | 無線周波数信号を用いた測位システム | |
US9047522B1 (en) | Utilization of motion and spatial identification in mobile RFID interrogator | |
Mi et al. | Performance analysis of mobile robot self-localization based on different configurations of RFID system | |
Motroni et al. | An RFID tracking system for Agricultural Safety | |
Nepa et al. | I-READ 4.0: Internet-of-READers for an efficient asset management in large warehouses with high stock rotation index | |
EP2778713A1 (en) | Utilization of motion and spatial identification in rfid systems | |
Nick et al. | Comparison of extended and unscented Kalman filter for localization of passive UHF RFID labels | |
Liu et al. | Mapping UHF RFID tags with a mobile robot using a 3D sensor model | |
CN211263763U (zh) | 基于uwb测距和gps定位的流动机械防撞定位装置 | |
EP3841514B1 (en) | Rfid reader and method for reading out rfid tags | |
Motroni et al. | Self-locating RFID robot for tag localization in retails |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20191001 |
|
CF01 | Termination of patent right due to non-payment of annual fee |