CN204115737U - 一种基于惯性制导和射频识别的室内定位装置 - Google Patents

Abstract

本实用新型涉及一种基于惯性制导和射频识别的室内定位装置,包括定位终端、射频发射模块和服务端，定位终端包括三维加速度计、三轴陀螺仪、射频信号接收器、无线通信模块、微处理器和外壳，三维加速度计与三轴陀螺仪固定在外壳内，外壳的Z轴垂直向上，三维加速度计的通信主线与微处理器相连，三轴陀螺仪与三维加速度计坐标系重合，三轴陀螺仪的通信主线与微处理器相连，射频信号接收器和无线通信模块分别固定在外壳内部两侧，其通信主线都与微处理器相连；本实用新型涉及的室内定位装置具有定位精度高，不受室内复杂的结构和电磁干扰影响以及成本低等优点。

Description

一种基于惯性制导和射频识别的室内定位装置

技术领域

本实用新型属于移动定位技术领域，涉及无GPS信号的室内环境目标定位，具体地说是一种基于惯性制导和射频识别的室内定位装置。

背景技术

随着数据业务和多媒体业务的快速增加，人们对定位的需求日益增大，尤其在复杂的室内环境，如机场大厅、展厅、超市、图书馆、地下停车场、矿井、灾难现场等环境中，移动终端或其持有者、设备及物品在室内的位置信息显得尤为重要。在开阔的室外环境中，全球定位***GPS提供了非常精确的定位信息，然而由于室内环境的特殊性，GPS信号难以覆盖室内，所以，当前应用于室外环境的算法和***很难移植到室内定位的应用中。室内目标定位存在重要的潜在应用，近年来引发大量的研究和关注。

现有室内定位的研究主要集中在两个方面，一是室内定位***的研究；二是室内算法的研究。上述位置信息的获取需要依靠定位***，室内定位技术容易受定位时间、定位精度以及复杂的室内环境的限制。当前室内定位技术主要有惯性制导、地磁制导、红外、超声波、蓝牙、超宽带、WIFI、和射频定位技术等。其中，红外线由于直线短距离传播，而且容易被灯光干扰，室内定位的效果很差；超声波定位虽然整体定位精度较高，但超声波受多径效应和非视距传播的影响很大，并需要投入大量的硬件设施，因此成本太高；蓝牙技术用作室内短距离定位时容易发现设备，且信号传播不受视距的影响，但它的不足之处在于价格昂贵，在复杂的室内空间环境中稳定性稍差，受噪声信号的干扰大；超宽带室内定位技术是一种全新的、与传统通信技术有较大差异的通信新技术，可应用于室内静止或移动物体以及人的定位跟踪和导航，且能提供非常精确的室内定位精度，但设备昂贵，无法大规模推广；基于WIFI的定位技术只能用于小范围的室内定位，而且很容易受到其他信号的干扰，精度较差，***的能耗也较高；地磁定位虽然能够准确的定位室内空间上的每一个点，但首先要建立地磁信息数据库，且地磁信息数据库必须及时更新，地磁及其容易受地质变化、天气变化、电网分布等外部信息的影响；惯性制导技术因为不受视距、地磁、噪音信号的影响，初始定位精度很高，但经过一段时间的使用后，由于误差累计效应，其精度会明显下降；射频识别定位存在着在复杂室内环境下定位精度不高的缺陷。

鉴于上述技术的不足，本申请人做了有益的设计，将惯性制导技术和射频识别技术相结合成为了优选的室内定位技术。下面将要介绍的技术方案便是在这种背景下产生的。

实用新型内容

本实用新型所要解决的技术问题是，克服现有技术的缺点，提供一种基于惯性制导和射频识别的室内定位装置，本实用新型涉及的室内定位装置具有定位精度高，不受室内复杂的结构和电磁干扰影响以及成本低等优点。

为了解决以上技术问题，本实用新型提供一种基于惯性制导和射频识别的室内定位装置，包括定位终端、射频发射模块和服务端，定位终端内部装有射频接收器，定位终端包括三维加速度计、三轴陀螺仪、射频信号接收器、无线通信模块、微处理器和外壳，三维加速度计与三轴陀螺仪固定在所述外壳内，外壳的Z轴垂直向上，三维加速度计的通信主线与微处理器相连，三轴陀螺仪与三维加速度计坐标系重合，三轴陀螺仪的通信主线与微处理器相连，射频信号接收器和无线通信模块分别固定在外壳内部两侧，其通信主线都与微处理器相连。

前述三维加速度计的型号为ADXL330，灵敏度达300mV/g；三轴陀螺仪的型号为MPU-3050，模块内置AD转换器，16位数字输出，灵敏度达131LSBs/dps；射频信号接收器的型号为AS3992，其具有-86dBm的超高接收器灵敏度；无线通信模块的型号为nRF24L01，采用Zigbee通信协议与服务端通信；射频发射模块采用UHF无源RFID标签，最大识别距离达到10米。

定位终端内的三维加速度计和三轴陀螺仪分别实时记录每一时刻三个坐标轴上的加速度和偏移标准坐标系的夹角，进而得到每一时刻的矢量速度，三维加速度计对加速度值的采集增加了去抖处理，将超出一定阈值的加速度值作为异常值予以剔除，采用滑动窗口滤波的方法对加速度值进行平滑滤波。

本实用新型采用惯性制导原理，通过定位终端内的三维加速度计和三轴陀螺仪分别实时记录每一时刻三个坐标轴上的加速度和偏移标准坐标系的夹角，进而可以得到每一时刻的矢量速度，从而对每一时刻的速度进行积分即可求出定位终端的移动路径和当前位置。

同时运用射频识别校正原理，由于惯性制导的累积误差随着移动的距离增加而变大，当经过相当距离后，惯性制导的效果会变差；所以，在室内特定的位置设置若干个射频发射模块，每个射频发射模块都有特有的序列号以及三维位置信息；定位终端内部装有射频接收器，每经过一个射频发射模块，射频接收器就会获得准确的位置信息，从而逐段消除了累积误差，大大提高了全程的定位精度。

本实用新型的算法部分还作了进一步的改进，首先，加速度值的采集增加了去抖处理，将超出一定阈值的加速度值作为异常值予以剔除，采用滑动窗口滤波的方法对加速度值进行平滑滤波；其次，优化了射频发射器的空间布局，在每个楼层采用蜂窝型式布置，在楼层之间的楼梯、电梯、过道采用线型布置，整个空间做到无缝覆盖；最后，服务端程序可以将定位终端按照组别划分，也可以定义每个定位终端的权限级别，还可以设定位置信息的共享范围。

本实用新型进一步限定的技术方案是：

前述基于惯性制导和射频识别的室内定位装置，其***工作流程包含以下步骤：

步骤一：将需要定位的室内场所的三维地图信息下载到定位终端，在需要定位的室内确定一个原点，以垂直地面向上为Z轴，以任意互相垂直的方向设置X、Y轴，建立三维直角坐标系，设置单位长度为分米；

步骤二：确定定位终端初始位置的坐标，设置定位终端初始点的坐标为(x0,y0,z0),且速度为零，加速度为零；

步骤三：使用者持定位终端在该室内场所移动，定位终端实时记录三维加速度和偏角，终端内的三轴陀螺仪实时记录X’轴与X轴的夹角α(以X轴逆时针方向为正)，Z’轴与Z轴的夹角β(以Z轴逆时针方向为正，范围为正负180度)，定位终端内的三维加速度计记录下三个坐标轴方向的加速的a_x′,a_y′,a_z′并计算出实时的三维坐标；

步骤四：在特定的位置设置若干个射频发射器，使其周期性的广播自身位置信息，当定位终端经过时，定位终端上的射频接收器将会接收到该射频发射器广播的位置信息，用以对自身的位置进行校正；

步骤五：定位终端将实时的三维坐标发送到服务端，服务端通过数据处理，将得到场所内所有定位终端的位置信息，并根据组别、权限设置发布给相应的定位终端。

其中，步骤三中实时三维坐标的计算方法为：

首先，算出按原有X、Y、Z轴方向的加速度分量a_x，a_y，a_z：

$\left\{\begin{array}{c}{a}_x=a_{x^{\′}}\cos \mathrm{\β}\cos \mathrm{\α}-a_{y^{\′}}\cos \mathrm{\β}\cos \mathrm{\α}+\frac{\mathrm{\β}}{\left|\mathrm{\β}\right|}{a}_{z^{\′}}\cos \mathrm{\α}\cos \mathrm{\β}\\ a_y=a_{x^{\′}}\cos \mathrm{\β}\sin \mathrm{\α}+a_{y^{\′}}\cos \mathrm{\β}\cos \mathrm{\α}-\frac{\mathrm{\β}}{\left|\mathrm{\β}\right|}{a}_{z^{\′}}\sin \mathrm{\α}\cos \mathrm{\β}\\ a_z=a_{z^{\′}}\sin \mathrm{\β}\frac{\cos \mathrm{\β}}{\left|\cos \mathrm{\β}\right|}+a_{x^{\′}}\sin \mathrm{\β}+a_{y^{\′}}\sin \mathrm{\β}\end{array}\right.$

然后，根据每一时刻的加速度计算每一时刻的速度分量v_x′，v_y′，v_z′：

$\left\{\begin{array}{c}{v}_{x^{\′}}=v_x+a_x\mathrm{dt}\\ v_{y^{\′}}=v_y+a_y\mathrm{dt}\\ v_{z^{\′}}=v_z+a_z\mathrm{dt}\end{array}\right.$

最后，根据速度分量计算定位终端现在的坐标:

$\left\{\begin{array}{c}{x}^{\′}=\∫v_{x^{\′}}\mathrm{dt}+x\\ y^{\′}=\∫v_{y^{\′}}+y\\ y^{\′}=\∫v_{z^{\′}}\mathrm{dt}+z\end{array}\right.$

前述步骤四中定位终端上的射频接收器接收所述射频发射器广播的位置信息时，从信号强度达到阀值时开始校正，当信号强度达到峰值并开始下降时，将此处的三维坐标同步为该射频发射器的坐标。

本实用新型的有益效果是：

本实用新型应用了惯性制导技术进行定位，消除了传统室内定位利用无线定位时产生的定位精度低，稳定性差，受复杂的空间格局影响大，易受电磁噪音干扰等缺点。同时又利用了射频识别技术，在每个节点对定位终端的三维坐标进行校正，从根本上解决了惯性制导初始定位精度高，但误差会逐步累积的缺点。此外，本实用新型使用的定位终端利用惯性及射频定位，***结构简单，成本低廉，能耗低，十分适合大范围使用。

附图说明

图1为本实用新型的定位终端模型示意图；

其中，201-外壳，202-三维加速度计，203-三轴陀螺仪，204-射频信号接收器，205-无线通信模块，206-微处理器。

具体实施方式

实施例1

本实施例提供一种基于惯性制导和射频识别的室内定位装置，结构如图1所示，包括定位终端、射频发射模块和服务端，射频发射模块具有特有的序列号以及三维位置信息，定位终端内部装有射频接收器，定位终端每经过一个射频发射模块，射频接收器即可获得准确的位置信息，定位终端包括三维加速度计202、三轴陀螺仪203、射频信号接收器204、无线通信模块205、微处理器206和外壳201，三维加速度计202与三轴陀螺仪203固定在外壳201内，外壳201的Z轴垂直向上，三维加速度计202的通信主线与微处理器206相连，三轴陀螺仪203与三维加速度计202坐标系重合，三轴陀螺仪203的通信主线与微处理器206相连，射频信号接收器204和无线通信模块205分别固定在外壳201内部两侧，其通信主线都与微处理器206相连。

前述三维加速度计的型号为ADXL330，灵敏度达300mV/g；三轴陀螺仪的型号为MPU-3050，模块内置AD转换器，16位数字输出，灵敏度达131LSBs/dps；射频信号接收器的型号为AS3992，其具有-86dBm的超高接收器灵敏度；无线通信模块的型号为nRF24L01，采用Zigbee通信协议与服务端通信；射频发射模块采用UHF无源RFID标签，最大识别距离达到10米。

前述定位终端内的三维加速度计202和三轴陀螺仪203分别实时记录每一时刻三个坐标轴上的加速度和偏移标准坐标系的夹角，进而得到每一时刻的矢量速度，三维加速度计202对加速度值的采集增加了去抖处理，将超出一定阈值的加速度值作为异常值予以剔除，采用滑动窗口滤波的方法对加速度值进行平滑滤波；射频发射模块在每个楼层采用蜂窝型式布置，在楼层之间的楼梯、电梯、过道采用线型布置，整个空间做到无缝覆盖；服务端将定位终端按照组别划分，同时定义每个所述定位终端的权限级别，并设定位置信息的共享范围。

以上实施例仅为说明本实用新型的技术思想，不能以此限定本实用新型的保护范围，凡是按照本实用新型提出的技术思想，在技术方案基础上所做的任何改动，均落入本实用新型保护范围之内。

Claims (6)

1.一种基于惯性制导和射频识别的室内定位装置，包括定位终端、射频发射模块和服务端，所述定位终端内部装有射频接收器，其特征在于，所述定位终端包括三维加速度计（202）、三轴陀螺仪（203）、射频信号接收器（204）、无线通信模块（205）、微处理器（206）和外壳（201），所述三维加速度计（202）与三轴陀螺仪（203）固定在所述外壳（201）内，所述外壳（201）的Z轴垂直向上，所述三维加速度计（202）的通信主线与所述微处理器（206）相连，所述三轴陀螺仪（203）与所述三维加速度计（202）坐标系重合，三轴陀螺仪（203）的通信主线与所述微处理器（206）相连，所述射频信号接收器（204）和所述无线通信模块（205）分别固定在外壳（201）内部两侧，其通信主线都与所述微处理器（206）相连。

2.根据权利要求1所述的基于惯性制导和射频识别的室内定位装置，其特征在于，所述三维加速度计（202）的型号为ADXL330，灵敏度达300mV/g。

3.根据权利要求1所述的基于惯性制导和射频识别的室内定位装置，其特征在于，所述三轴陀螺仪（203）的型号为MPU-3050，模块内置AD转换器，16位数字输出，灵敏度达131 LSBs/dps。

4.根据权利要求1所述的基于惯性制导和射频识别的室内定位装置，其特征在于，所述射频信号接收器（204）的型号为AS3992，其具有-86dBm的超高接收器灵敏度。

5.根据权利要求1所述的基于惯性制导和射频识别的室内定位装置，其特征在于，所述无线通信模块（205）的型号为nRF24L01，采用Zigbee通信协议与服务端通信。

6.根据权利要求1所述的基于惯性制导和射频识别的室内定位装置，其特征在于，所述射频发射模块采用UHF无源RFID标签，最大识别距离达到10米。