一种针对UHF-RFID系统的多假设UKF目标跟踪方法技术方案

一种针对UHF‑RFID系统的多假设UKF目标跟踪方法，包括以下步骤：步骤1)利用VIRE方法估计得到移动机器人的初始位置，确定机器人初始位置所在的标签区域，在区域内均匀布置粒子，并通过这些粒子来描述移动机器人的初始状态；步骤2)收集各超高频天线的量测信息，生成移动机器人的位置估计作为观测输入，然后应用无迹卡尔曼滤波方法分别对各粒子状态进行预测和更新，并计算各粒子的权值；步骤3)根据粒子的权值，对其进行筛选，再对其进行重采样；步骤4)融合筛选之后的粒子得到移动机器人的当前状态估计，重复执行步骤1)—4)，以实现UHF‑RFID环境下的移动机器人跟踪。本发明专利技术具有更好的定位精度和收敛速度。

A method for tracking multiple hypothesis UKF targeting UHF RFID system

A method for tracking multiple hypothesis UKF targeting UHF RFID system, which comprises the following steps: 1) estimate the initial position of the mobile robot using VIRE method, to determine the initial position of the robot label area, uniform arrangement of particles in the region, and through these particles to describe the initial state of the mobile robot; step 2) collect the UHF antenna measurement information, generation of mobile robot position estimation as observation input, and then apply the unscented Calman filtering method to predict and update on the state of each particle, and calculate the weights of particles; step 3) according to the weights of particles, on the screen, then carries on the re sampling; step 4) fusion screening after particle mobile robot's current state estimation, repeat step 1) - 4), in order to achieve UHF RFID environment shift Mobile robot tracking. The invention has better positioning accuracy and convergence speed.

【技术实现步骤摘要】
一种针对UHF-RFID系统的多假设UKF目标跟踪方法
本专利技术涉及的是移动机器人定位领域，尤其是一种UHF-RFID环境下移动机器人定位的方法。
技术介绍
无线定位是军事活动和保障人类正常的交通安全的必要手段。对于经济发展迅速的中国，无线定位对社会发挥着越来越重要的作用，如机场大厅、展厅、仓库、超市、图书馆、地下停车场、矿井、航空的安全航行和交通管制、车辆的运输调度、空间飞行器的定位和测控、搜索救援、移动通信等领域都要用到无线定位。定位是指确定物体在某一参考坐标系中的位置。因此存在重要的应用价值。常用的无线定位技术有红外线，超声波，WIFI，蓝牙，UWB，ZIGBEE，RFID等，其中，RFID因其抗干扰能力强，可在恶劣环境下进行工作，鉴于其非视距和非接触的优点，将其运用于定位能实现高精度的定位需求。基于场景识别的LANDMARC经典定位系统，通过对定位场景的训练和现场的信息采集，并将所得的信息进行分析以后存入数据库，利用相近性原理来以实现移动目标的跟踪。然而，在该情景下要提高定位精度，则需要增加参考标签的数量。VIRE方法就是在不增加额外的参考标签情况下，有效地提高了系统的定位精度。如果VIRE方法阈值的选取不准确，将造成某区域中没有产生共同的选择标签集合，从而造成方法的发散。特别地，在模糊地图的契合度不满足要求的情况下，将导致整个定位系统的崩溃。目前在UHF-RFID定位系统中，还没有技术能够通过融合虚拟参考标签和内部传感器(如里程计，陀螺仪，加速度计等)实现移动机器人位姿估计，从而提高整个定位系统的定位精度。
技术实现思路
为了克服现有方法误差大且易发散、以及对插值所产生的虚拟信号强度值依赖性过强导致定位发散的问题的不足，本专利技术提供了一种在保证对环境的适应性以及定位的实时性前提下，能有效提高定位精度和鲁棒性的基于多假设UKF的UHF-RFID全局定位方法，更适合室内复杂环境下对移动机器人的定位。本专利技术解决技术问题所采用的技术方案是：一种针对UHF-RFID系统的多假设UKF目标跟踪方法，所述方法包括以下步骤：步骤1)利用VIRE方法估计得到移动机器人的初始位置S(x0,y0)，确定机器人初始位置所在的标签区域，在区域内均匀布置粒子，并通过这些粒子来描述移动机器人的初始状态；步骤2)收集各超高频天线的量测信息，通过VIRE方法生成移动机器人的位置估计作为观测输入，然后，应用无迹卡尔曼滤波方法UKF分别对各粒子状态进行预测和更新，并计算各粒子的权值；步骤3)根据粒子的权值，对其进行筛选，再对其进行重采样；步骤4)融合筛选之后的粒子得到移动机器人的当前状态估计，重复执行步骤1)—4)，以实现UHF-RFID环境下的移动机器人跟踪。进一步，所述步骤1)中，初始位置所在的区域表示成Ω，然后在Ω内均匀选取M个粒子，给定这些粒子初始状态为其中为随机产生的，把这些粒子状态作为移动机器人的初始状态。再进一步，所述步骤2)中，所述的量测信息为应用VIRE算法对移动目标位置的估计结果，初始粒子均匀采样，粒子i初始状态分量x,y由VIRE方法估计出，给定任意航向角初始协方差矩阵为权值利用获得2n+1个sigma点。所述步骤2)中，系统的观测为zk＝[xp,kyp,k]T，则得由卡方分布概率密度函数，得每个粒子在各个时刻的权值其中，χ2(2)表示自由度为2的卡方分布，xp,k+1，yp,k+1分别为k+1时刻系统观测量zk+1在x方向和y方向上的坐标分量，和分别为粒子i在k时刻预测观测量在x方向和y方向上的分量，分别为k+1时刻粒子在x方向和y方向上观测协方差矩阵。所述步骤3)中，当粒子权值舍去该粒子；反之，则称该粒子有效并保留，有效粒子数记为nc；同时将对粒子进行重新采样，当有效粒子数nc＜η，保留的粒子，并在方差为σ2范围内进行重新采样，使有效粒子数始终保持在η；反之，则跳过重采样阶段。所述步骤4)中，对筛选、重采样后的粒子进行归一化处理，通过采用加权平均的方法融合筛选后的粒子，从而得到移动机器人状态估计。本专利技术的有益效果主要表现在：在初始位姿未知情况下，实现了UHF-RFID环境下的移动机器人定位。传统采用VIRE方法对移动机器人进行定位时，并未有效地移动机器人内部传感器信息(如里程计，陀螺仪等)。定位精度很大程度上依赖于UHF-RFID所处的定位环境，且该算法无法对移动机器人姿态角进行估计。针对这个问题，本专利技术提供了一种基于多假设UKF的移动机器人定位方法，充分利用了UHF-RFID与机器人内部传感器的信息，有效地克服了单一UKF滤波器不稳定和易发散的缺点。该方法首先通过VIRE算法将非线性观测转化为线性观测，然后采用多假设UKF方法实现移动机器人的定位。该方法相比于现有的VIRE目标定位方法，该方法可以有效提高系统的定位精度，并对移动机器人姿态角进行跟踪，同时，相对于传统UKF方法，具有更好的定位精度和收敛速度。附图说明图1超高频定位系统的场景布置示意图。图2采用带里程计移动小车移动状态分析图。图3无线传感器网络的目标定位系统示意图。图4单假设状态估计流程图。图5针对UHF-RFID系统的多假设UKF目标跟踪系统流程图。具体实施方式下面结合附图对本专利技术作进一步描述。参照图1～图5，一种针对UHF-RFID系统的多假设UKF目标跟踪方法，所述方法包含以下步骤：图1中描述了UHF-RFID下移动机器人的定位环境。图中1代表超高频天线，2代表参考标签，3代表移动机器人。该定位区域为8*8，区域内含有四个超高频天线分布于待定位区域边界，16个参考标签，参考标签如图1中均匀布置在监视区域内。其中，四个天线通过轮询方式采集各参考标签的RSSI数据。移动机器人携带里程计、移动便签。结合图2所示，移动机器人运动学模型可描述为如下的状态空间模型：xk+1＝f(xk,uk)+wk+1(10)zk＝Hxk+vk(11)其中，k为离散时间，系统状态xk＝[xp,k,yp,k,θk]T。xp,k、yp,k分别为k时刻机器人在x轴和y轴上的坐标，θk为姿态角，为状态转移矩阵。uk系统输入矩阵，状态观测zk＝[xp,kyp,k]T,观测矩阵wk为过程噪声，服从零均值、方差阵为Q的高斯分布，vk为系统观测噪声，服从零均值方差为R的高斯分布。nX为系统状态的维数,nZ为观测向量的维数.假设移动机器人初始位姿和初始方差分别为x0|0和P0|0,且x0|0与wk，vk统计意义上不相关。如图4所示，计算粒子一步预测状态和方差，其中粒子数i＝1,2,...M,。更新结合图4，式(13)中，为粒子i在k时刻取的Sigma点集，是粒子i取的Sigma点在k+1的状态预测值。缩放比例参数λ＝a2(n+κ)-n，用来降低总得预测误差，a的选取控制了采样点的分布状态，κ为待选参数，其具体取值没有界限，通常要确保矩阵半正定。通过式(14)-(16)加权求均值，得到系统状态预测值和状态预测协方差矩阵。式(17)获得粒子i的观测预测值。是粒子在k+1时刻的状态预测值，分别为Sigma点计算均值和方差的权值。为第i个粒子在k时刻状态预测方差矩阵，Q为系统的过程噪声方差矩阵。结合式(18)-(20)可求得粒子i的估计值。结合图5，在更新过程中，zk+1为k+1时本文档来自技高网...

【技术保护点】
一种针对UHF‑RFID系统的多假设UKF目标跟踪方法，其特征在于：所述方法包括以下步骤：步骤1)利用VIRE方法估计得到移动机器人的初始位置S(x

【技术特征摘要】
1.一种针对UHF-RFID系统的多假设UKF目标跟踪方法，其特征在于：所述方法包括以下步骤：步骤1)利用VIRE方法估计得到移动机器人的初始位置S(x0,y0)，确定机器人初始位置所在的标签区域，在区域内均匀布置粒子，并通过这些粒子来描述移动机器人的初始状态；步骤2)收集各超高频天线的量测信息，通过VIRE方法生成移动机器人的位置估计作为观测输入，然后，应用无迹卡尔曼滤波方法UKF分别对各粒子状态进行预测和更新，并计算各粒子的权值；步骤3)根据粒子的权值，对其进行筛选，再对其进行重采样；步骤4)融合筛选之后的粒子得到移动机器人的当前状态估计，重复执行步骤1)—4)，以实现UHF-RFID环境下的移动机器人跟踪。2.如权利要求1所述的针对UHF-RFID系统的多假设UKF目标跟踪方法，其特征在于：所述步骤1)中，初始位置所在的区域表示成Ω，然后在Ω内均匀选取M个粒子，给定这些粒子初始状态为其中为随机产生的，把这些粒子状态作为移动机器人的初始状态，初始给定状态变量为二维或多维参数。3.如权利要求1或2所述的针对UHF-RFID系统的多假设UKF目标跟踪方法，其特征在于：所述步骤2)中，所述的量测信息为应用VIRE算法对移动目标位置的估计结果，初始粒子均匀采样，粒子i...

【专利技术属性】
技术研发人员：张文安，陈元橼，杨旭升，陈国庆，
申请(专利权)人：浙江工业大学，
类型：发明
国别省市：浙江,33