CN106767828A - 一种手机室内定位解决方法 - Google Patents
一种手机室内定位解决方法 Download PDFInfo
- Publication number
- CN106767828A CN106767828A CN201611245793.9A CN201611245793A CN106767828A CN 106767828 A CN106767828 A CN 106767828A CN 201611245793 A CN201611245793 A CN 201611245793A CN 106767828 A CN106767828 A CN 106767828A
- Authority
- CN
- China
- Prior art keywords
- particle
- mobile phone
- positioning
- indoor
- resampling
- 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.)
- Pending
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
- G01C21/206—Instruments for performing navigational calculations specially adapted for indoor navigation
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/04—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means
- G01C21/08—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means involving use of the magnetic field of the earth
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W64/00—Locating users or terminals or network equipment for network management purposes, e.g. mobility management
- H04W64/006—Locating users or terminals or network equipment for network management purposes, e.g. mobility management with additional information processing, e.g. for direction or speed determination
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02D—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN INFORMATION AND COMMUNICATION TECHNOLOGIES [ICT], I.E. INFORMATION AND COMMUNICATION TECHNOLOGIES AIMING AT THE REDUCTION OF THEIR OWN ENERGY USE
- Y02D30/00—Reducing energy consumption in communication networks
- Y02D30/70—Reducing energy consumption in communication networks in wireless communication networks
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- Geology (AREA)
- General Life Sciences & Earth Sciences (AREA)
- Environmental & Geological Engineering (AREA)
- Life Sciences & Earth Sciences (AREA)
- Computer Networks & Wireless Communication (AREA)
- Signal Processing (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种手机室内定位解决方法,包括以下步骤:S1:在定位目标周围分布多个粒子,形成粒子集,利用粒子滤波算法和室内地磁场地图,根据自所述智能手机的监测传感器接收的方向和磁场分量,确定所述粒子集中各粒子的位姿和归一化权重;S2:根据所述智能手机传感器检测的地磁分量对地磁地图进行Kring插值;S3:当系统检测到定位目标失败时,采用自适应重采样策略,当系统检测到正确定位目标后,恢复之前的重采样过程;S4:根据所述重采样粒子集中各粒子的位姿和归一化权重,确定定位目标在所述室内地磁图中的估计位置。本发明可以实现室内定位精度较高,平均为1‑2米。此外,与WiFi室内定位技术相比,本发明耗能小,可靠性高,成本低。
Description
技术领域
本发明属于室内定位导航技术领域,尤其涉及一种基于智能手机平台的室内定位方法及定位系统。
背景技术
近年来,随着物联网与无线通信的快速发展,基于位置的服务(Location BasedService,LBS)得到越来越多的重视。如GPS提供的LBS服务广泛应用于汽车导航,医疗救护等应用中。但是当GPS接收机在室内工作时,信号受到建筑物的阻碍,定位精度远远达不到应用需求,因此,高精度的室内定位技术的研究成为近些年的研究热点。
常见的室内定位技术有室内无线定位技术和基于地磁定位技术的研究。室内无线定位技术主要包括Wi-Fi技术、蓝牙技术、红外线室内定位技术、射频识别技术以及新型的超宽带技术等。但是这些技术均需要预先大量铺设AP或蓝牙基站,成本较高且定位精度对信号稳定性依赖较大。受到鸽子等生物可以利用地球磁场进行定位的启发,产生了基于地磁场实现室内定位的技术。其主要依据是建筑物的钢筋混凝土结构及室内装修设备等使其产生密度不同的地磁场,该特性可以将地磁场看作位置指纹实现室内定位。同理,无线定位技术中也有一种方法是将信号的强度看作位置指纹实现定位,相比较而言,基于地磁场的室内定位技术有更多优势,它不需要铺设任何基础设施,且信号更稳定,随着智能手机的快速发展和普及,使得利用智能手机磁强计实现LBS的研究更有前景。Haverinen等人发表的《Global indoor self-localization based on the ambient magnetic field》(Robotics and Autonomous Systems 57,1028-1035)提出利用粒子滤波算法融合地磁场实现室内定位的方法,但是只适用于一维空间的室内场景。Chung等人发表的《Indoorlocation sensing using geo-magnetism》(Mobisys,ACM.pp.141-154)使用一组磁强计实现二维空间的室内定位,平均精度4.7米,但是它需要对每个位置点旋转360度采集所有朝向的磁场特征,信息采集工作量非常大。
发明内容
本发明要解决的技术问题是提高室内定位的精度以及传统WiFi室内定位技术存在的耗能大、可靠性低和成本高的缺陷。
为此,本发明提出的技术方案为一种手机室内定位解决方法,包括以下步骤:
S1:在定位目标周围分布多个粒子,形成粒子集,利用粒子滤波算法和室内地磁场地图,根据自所述智能手机的监测传感器接收的方向和磁场分量,确定所述粒子集中各粒子的位姿和归一化权重;
S2:根据所述智能手机传感器检测的地磁分量对地磁地图进行Kring插值;
S3:当系统检测到定位目标失败时,采用自适应重采样策略,当系统检测到正确定位目标后,恢复之前的重采样过程;
S4:根据所述重采样粒子集中各粒子的位姿和归一化权重,确定定位目标在所述室内地磁图中的估计位置。
进一步,在粒子滤波算法中是根据传感器检测的数据确定所述粒子集中各粒子的位姿和归一化权重,该数据包括:抽取地磁水平方向和垂直方向的分量形成新的HV位置指纹,使用该二维指纹与地磁库匹配,采用磁场的变化率来克服不同的智能手机可能存在的读数偏差问题;采用指数函数加权粒子来估计定位目标的姿态分布。
上述室内地磁地图为网格地图,所述Kring插值方法是以粒子滤波算法得到的估计位置为中心,对周围10*10的小方格进行插值。
当系统检测到定位目标失败时,采用自适应重采样策略,当系统检测到正确定位目标后,恢复之前的重采样过程包括:所述粒子集中各粒子均含有一个标志位,每当粒子的位置与定位目标的估计位置超出规定值时,标志位置0,粒子的位置与定位目标的估计位置在规定值之内时,标志位置1,当系统检测到标志位为1的粒子数小于设定的门限值时,系统就采用自适应重采样策略,当系统检测到粒子的标志位为1的粒子数目大于门限值时,就恢复之前的重采样过程。
上述自适应重采样方法包括:在重采样过程中,以定位目标的估计位置为中心,以一个较大的距离为半径,在此空间随机一些随机粒子,并在全局空间重采样一部分粒子。
该方法中根据智能手机传感器所检测到的信息估计行人的运动步长,包括:
通过下式(1)和(2)更新粒子集,粒子集中包含正确跟踪行人的粒子,
xt=xt-1+T sinθt+N(0,δ) (1)
yt=yt-1+T cosθt+N(0,δ) (2)
其中,(xt-1,yt-1)为粒子在t-1时刻的位置,T为估计的用户移动的步长均值,θt表示t时刻智能手机检测到的相对正北方向的角度,N(0,δ)表示均值为0,方差为δ的高斯变量。
该方法中根据智能手机传感器所检测到的信息计算粒子的归一化权重,包括:
通过下式(3)和(4)计算所述粒子集中每个粒子的权重,
其中,ΔBH,ΔBV分别为传感器t时刻测得的水平和垂直方向上的地磁较上一时刻的变化率,分别表示t时刻的第i个粒子的所在磁场地图位置的水平和垂直方向的磁场较上一时刻的变化率,λ表示指数函数的变化情况,即权重取值的灵敏度。
本发明还进一步包括一种利用上述手机室内定位解决方法进行基于地磁场的室内定位的智能手机平台系统,包括:
粒子集生成模块,用于在定位目标周围分布多个粒子,形成粒子集,利用粒子滤波器和室内地磁图,根据自所述定位目标的监测传感器接收的方向和磁场值,确定所述粒子集中各粒子的位姿和归一化权重;
重采样模块,用于从所述粒子集中选取多个粒子组成重采样粒子集;
Kring插值模块,用于更新地磁场地图;
自适应重采样模块,用于在跟踪定位目标错误时,重新寻找定位目标,正确估计定位目标;
位置确定模块,用于根据所述重采样粒子集中各粒子的位姿和归一化权重,确定定位目标在所述室内地磁图中的估计位置。
上述室内地磁图为网格地图,在开始定位之前需要加载事先采集训练的地磁数据库,在完成对目标的定位之后,关闭系统时更新上传新的地磁数据库。
上述重采样模块用于:按归一化权重由大到小的顺序,从所述粒子集中选取多个粒子组成重采样粒子集。
与现有技术相比,本发明的有益效果在于:
1,提出了一种完整,低成本的室内定位技术,本发明不需要外部安装无线节点、发射器等硬件设施的支持,在断电、没有无线网络、充满浓烟等恶劣的环境下可以继续工作,实现室内定位精度较高,平均为1-2米。
2,如遇到发生定位错误的情况,即定位误差较大超出可接受范围时,系统会自动检索矫正,更新到正确位置。此外,与WiFi室内定位技术相比,本发明耗能小,可靠性高,成本低。
附图说明
图1为本发明实施例提供的一种室内定位方法的的流程图;
图2为本发明实施例提供的另一种室内定位方法的的流程图;
图3为系统建立的运动模型坐标系;
图4为实验测试场地的室内平面图;
图5为采集的室内磁场图;
图6为根据本发明实施例提供的室内定位方法对定位目标进行定位的一次测试图;
图7为根据现有技术提供的方法对定位目标在不同路径下行走进行定位的测试图;
图8为本发明实施例在改变步长的情况下测试结果图;
图9为本发明实施例中粒子数目对定位误差的影响测试图。
图10为本发明实施例提供的一种室内定位设备的结构示意图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
显而易见地,下面描述中的附图是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
第一方面,本发明实施例提供一种室内定位方法,包括:
在定位目标周围分布多个粒子,形成粒子集,利用粒子滤波算法和室内地磁场地图,根据自所述智能手机的监测传感器接收的方向和磁场分量,确定所述粒子集中各粒子的位姿和归一化权重;
根据所述智能手机传感器检测的地磁分量对地磁地图进行Kring插值;
当系统检测到定位目标失败时,采用自适应重采样策略,当系统检测到正确定位目标后,恢复之前的重采样过程;
根据所述重采样粒子集中各粒子的位姿和归一化权重,确定定位目标在所述室内地磁图中的估计位置。
第二方面,本发明实施例还提供了一种室内定位系统,包括:
粒子集生成模块,用于在定位目标周围分布多个粒子,形成粒子集,利用粒子滤波器和室内地磁图,根据自所述定位目标的监测传感器接收的方向和磁场值,确定所述粒子集中各粒子的位姿和归一化权重;
重采样模块,用于从所述粒子集中选取多个粒子组成重采样粒子集;
Kring插值模块,用于更新地磁场地图;
自适应重采样模块,用于在跟踪定位目标错误时,重新寻找定位目标,正确估计定位目标;
位置确定模块,用于根据所述重采样粒子集中各粒子的位姿和归一化权重,确定定位目标在所述室内地磁图中的估计位置。
第三方面,本发明实施例提供了一种非易失性计算机存储介质,存储有计算机可执行指令,所述计算机可执行指令用于执行本申请上述任一项室内定位方法。
第四方面,本发明实施例还提供了一种室内定位设备,包括:
安卓手机软件;其中,
所述安卓手机软件用于存储室内地磁图和可被所述处理器执行的指令,所述指令被所述安卓手机软件执行,以使所述安卓手机软件能够:
在定位目标周围分布多个粒子,形成粒子集,利用粒子滤波算法和室内地磁场地图,根据自所述智能手机的监测传感器接收的方向和磁场分量,确定所述粒子集中各粒子的位姿和归一化权重;
根据所述智能手机传感器检测的地磁分量对地磁地图进行Kring插值;
当系统检测到定位目标失败时,采用自适应重采样策略,当系统检测到正确定位目标后,恢复之前的重采样过程;
根据所述重采样粒子集中各粒子的位姿和归一化权重,确定定位目标在所述室内地磁图中的估计位置。
假设用户位姿为状态矢量xt,环境磁场特征为m,其中xt与m相互独立。定义zt为传感器测得的观测序列,ut为用户的控制变量。实现室内定位就是估计位姿和和环境磁场特征的联合后验概率:
p(xt,m|zt,ut)=p(xt|zt,ut)*p(m|zt,ut) (5)
其中p(xt|zt,ut)可由xt-1与ut求得,满足
xt~p(xt|ut,xt-1) (6)
用粒子滤波器实现(5)式的主要过程为:初始化N个粒子,根据运行模型(6)更新每个粒子,计算每个粒子的权重,依据权重实现粒子重采样。算法步骤如下:
初始化
本发明中假设已知用户的初始位置,在室内均匀分布N个粒子来表示机器人的可能位姿,其中每个粒子权重为权值初始化为1/N。
重要性采样
通过传感器检测到行人的控制变量μt,对粒子集合从状态根据公式(6)进行更新得到状态在新位置周围随机采样N个粒子,作为当前时刻对用户位姿概率分布的估计。由于每个人的步长是不同的,且同一个人在不同的情况下步长也可能不同,所以进行了更新,如下:
xt=xt-1+T sinθt+N(0,δ) (1)
yt=yt-1+T cosθt+N(0,δ) (2)
添加一个高斯变量,这样更新后每个粒子的步长就不完全相同,就会存在更接近真实状态的粒子。
计算权重
和手机地磁传感器读取的地磁强度Bp进行比较可以评估每个粒子的权重,其中地磁传感器的读数是三维向量Bp=<Bx,By,Bz>,分别代表基于手机坐标系三个轴方向上的磁场强度分量。若直接使用Bp,则需要在每个位置采集360度朝向不同的磁场分量,这使得采集和存储信息变得不可能。一种可行的方法是使用||Bp||,但是这样会将位置指纹信息从三维降到了一维,使得指纹唯一性变差,定位精度不高。本发明在试验中采用HV指纹实现基于地磁场的室内定位。考虑到不同智能手机安装的地磁传感器型号可能不同,因此准确性存在一定的差别,就一种型号的传感器而言,在同一地点的读数也可能存在差别,一般情况下需要添加传感器校准操作。本发明经过对不同智能手机对地磁的检测实验发现,不同手机对磁场强度读数的偏差是恒定的,因此本文采用磁场变化率来实现室内定位。
对更新后的粒子进行权重计算,本文重要性概率分布函数选用指数分布形式,指数分布的计算复杂度是O(N),而传统的高斯分布计算复杂度是O(N2),这样可以降低粒子滤波的运算复杂度。粒子权重为
其中ΔBH,ΔBV分别为传感器t时刻测得的水平和垂直方向上的地磁较上一时刻的变化率,分别表示t时刻的第i个粒子的所在磁场地图位置的水平和垂直方向的磁场较上一时刻的变化率,λ表示指数函数的变化情况,即权重取值的灵敏度。λ值由实验选出最佳值,本实验选取为2。
归一化权重
计算有效的粒子数
通过公式计算粒子t时刻第k步的位姿,若还要计算下一时刻的位姿,则转到重要性采样步骤;否则结束定位。
根据本发明实施例提供的一种室内定位方法,如图1所示,包括:
步骤S101:在定位目标周围分布多个粒子,形成粒子集,调用智能手机的传感器检测移动方向和当前位置磁场分量;
步骤S102:在粒子滤波算法中,根据建立的合理运动模型动态估计用户的实时步长,采用HV指纹匹配模型和指数函数加权粒子来估计定位目标的姿态分布;
步骤S103:利用Kriging插值算法来插值更新磁场地图;
步骤S104:系统检测到估计位置周围粒子数小于规定门限值时,说明粒子处于发散状态,在大的空间注入一些随机粒子,并在整个空间采样一部分粒子,当检测到估计位置周围粒子数大于规定门限值时,说明粒子群处于收敛状态,粒子正确跟踪定位目标;
根据本发明实施例提供的一种室内定位方法,如图2所示,包括:
步骤S201:在定位目标周围分布多个粒子,形成粒子集。
假设已知用户的初始位置,在室内均匀分布N个粒子来表示机器人的可能位姿,其中每个粒子权重为权值初始化为1/N。
步骤S202:根据智能手机传感器检测到的信息,计算粒子的位姿和归一化权重。
在本发明实施例中,室内地磁图是对平面图进行网格初始化,通过对目标所处的室内进行实地测量获得,具体过程为利用智能手机地磁传感器,每隔一段距离测得一组磁场数据,组成地磁数据库。然后将所有的磁场数据导入数据库中,形成L*L个网格的室内地磁图。在地磁传感器测量过程中,分别测量水平面上纵向、横向和重力方向上的磁场分量。
在本发明实施例中,定位目标是手执智能手机的行人。
智能手机的监测传感器可以包括陀螺仪、加速度计和地磁传感器。
在本发明实施例中,步骤S102的具体实现为:
重要性采样:和手机地磁传感器读取的地磁强度Bp进行比较可以评估每个粒子的权重,其中地磁传感器的读数是三维向量Bp=<Bx,By,Bz>,分别代表基于手机坐标系三个轴方向上的磁场强度分量。若直接使用Bp,则需要在每个位置采集360度朝向不同的磁场分量,这使得采集和存储信息变得不可能。一种可行的方法是使用||Bp||,但是这样会将位置指纹信息从三维降到了一维,使得指纹唯一性变差,定位精度不高。本发明抽取水平方向和垂直方向分量形成新的二维向量<BH,BV>,即HV指纹。本发明在试验中采用HV指纹实现基于地磁场的室内定位。考虑到不同智能手机安装的地磁传感器型号可能不同,因此准确性存在一定的差别,就一种型号的传感器而言,在同一地点的读数也可能存在差别,一般情况下需要添加传感器校准操作。本发明经过对不同智能手机对地磁的检测实验发现,不同手机对磁场强度读数的偏差是恒定的,因此本文采用磁场变化率来实现室内定位。
对更新后的粒子进行权重计算,本文重要性概率分布函数选用指数分布形式,指数分布的计算复杂度是O(N),而传统的高斯分布计算复杂度是O(N2),这样可以降低粒子滤波的运算复杂度。粒子权重为
其中ΔBH,ΔBV分别为传感器t时刻测得的水平和垂直方向上的地磁较上一时刻的变化率,分别表示t时刻的第i个粒子的所在磁场地图位置的水平和垂直方向的磁场较上一时刻的变化率,λ表示指数函数的变化情况,即权重取值的灵敏度。λ值由实验选出最佳值,本实验选取为2。
步骤S203:本发明采用Kring算法对采集的地磁信息进行插值,根据周围已知位置点的地磁信息进行加权操作估计未知点的地磁信息,如下:
其中S0为预测位置,Si为预测位置周围的随机位置点,λ为第i个位置点的权重。用Si(ai,bi)表示位置点,S0(a0,b0)表示预测位置,然后求位置点之间的距离:
把距离按照大小排序,合成距离组,求出半变异分布形状。发明中用球形半变异拟合模型求得S0处的地磁场预测值。
步骤S204:所述粒子集中各粒子均含有一个标志位,每当粒子的位置与定位目标的估计位置超出规定值时,标志位置0,粒子的位置与定位目标的估计位置在规定值之内时,标志位置1,当系统检测到标志位为1的粒子数小于设定的门限值时,系统就采用自适应重采样策略,当系统检测到粒子的标志位为1的粒子数目大于门限值时,就恢复之前的重采样过程。在重采样过程中,以定位目标的估计位置为中心,以一个较大的距离为半径,在此空间随机一些随机粒子,并在全局空间重采样一部分粒子。
步骤S205:根据所述重采样粒子集中各粒子的位姿和归一化权重,确定定位目标在所述室内地磁图中的估计位置。
在本发明实施例中,将重采样粒子集中各粒子的位姿及归一化权重相乘,累加得到的乘积,估计定位目标在所述室内地磁图中的位置。
若定位目标继续行走,则返回到步骤S102进行下一次定位,若定位目标停止行走则定位结束。
根据本发明实施例提供的室内定位方法,在图4的平面图中选取10米*10米的环境进行室内定位实验。首先需要调用智能手机的地磁传感器,先由南向北,再由西向东,每隔0.5米采集一组地磁数据<a1,a2,a3>,在测量过程中,手机水平放置,手机的方位与正北方向尽量保持平行,读数即为水平面上纵向、横向和重力三个方向上的分量值,本文实验测得的实验室内地磁图图5所示,其中西边有充电设备,故数值较大。
本发明在图4所示的室内进行了大量实验,在每组实验中,通过比较系统的定位结果和实验人员的真实位置来计算系统的定位精度。具体实验过程为,在实验环境内先设定几条路线,实验人员手持智能手机沿着事先设定的某一条路线前进,最后根据设定路线上的真实位置坐标与手机定位的坐标进行比较。其中根据每条路线都会测试很多次系统性能,图6为沿某一条设定路线的一次性能测试结果,终点误差为0.839米,图7为不同路径测测试误差结果,其中路径A和路径B为环形路径,路径C和路径D含有较多直线路径。
本发明又针对行人的可能运动情况做了一些测试,如图7所示,当测试者固定步长在室内进行移动时,传统的运动模型与文中的运动模型不存在较大区别,平均误差都在1米左右,当测试者以不恒定的步长进行实验测试时,测试结果定位误差较大,平均在3米左右,为图中绿色实线,文中采用的运动模型测试结果为蓝色虚线,定位误差在局部存在较大值,但整体得到明显改善。
本发明对粒子数目对定位误差的影响进行了大量的仿真实验,总结粒子对定位误差的影响如图9所示。本发明基于地磁场实现室内定位的智能手机平台解决方案可以采用较少的粒子达到较高的定位要求,同时采用较少的粒子数可以减少计算复杂度及粒子收敛时间,提高定位实时性。
图10是本发明实施例提供的一种室内定位系统1000,如图10所示,该系统包括:
粒子集生成模块1010,用于在定位目标周围分布多个粒子,形成粒子集,利用粒子滤波器和室内地磁图,根据自所述定位目标的监测传感器接收的方向和磁场值,确定所述粒子集中各粒子的位姿和归一化权重;
重采样模块1020,用于从所述粒子集中选取多个粒子组成重采样粒子集;
Kring插值模块1030,用于更新地磁场地图;
自适应重采样模块1040,用于在跟踪定位目标错误时,重新寻找定位目标,正确估计定位目标;
位置确定模块1050,用于根据所述重采样粒子集中各粒子的位姿和归一化权重,确定定位目标在所述室内地磁图中的估计位置。
该室内定位系统可执行指令可执行上述任意方法实施例中的室内定位方法,并能达到与所述室内定位方法同样的效果。
本发明实施例还提供了一种非易失性计算机存储介质,所述计算机存储介质存储有计算机可执行指令,该计算机可执行指令可执行上述任意方法实施例中的室内定位方法。
本发明实施例的电子设备以多种形式存在,包括但不限于:
(1)移动通信设备:这类设备的特点是具备移动通信功能,并且以提供话音、数据通信为主要目标。这类终端包括:智能手机(例如iPhone)、多媒体手机、功能性手机,以及低端手机等。
(2)超移动个人计算机设备:这类设备属于个人计算机的范畴,有计算和处理功能,一般也具备移动上网特性。这类终端包括:PDA、MID和UMPC设备等,例如iPad。
以上所描述的装置实施例仅仅是示意性的,其中所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部模块来实现本实施例方案的目的。本领域普通技术人员在不付出创造性的劳动的情况下,即可以理解并实施。
通过以上的实施方式的描述,本领域的技术人员可以清楚地了解到各实施方式可借助软件加必需的通用硬件平台的方式来实现,当然也可以通过硬件。基于这样的理解,上述技术方案本质上或者说对现有技术做出贡献的部分可以以软件产品的形式体现出来,该计算机软件产品可以存储在计算机可读存储介质中,如ROM/RAM、磁碟、光盘等,包括若干指令用以使得一台计算机设备(可以是个人计算机,存储模块,或者网络设备等)执行各个实施例或者实施例的某些部分所述的方法。
最后应说明的是:以上实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。
Claims (10)
1.一种手机室内定位解决方法,其特征在于包括以下步骤:
S1:在定位目标周围分布多个粒子,形成粒子集,利用粒子滤波算法和室内地磁场地图,根据自所述智能手机的监测传感器接收的方向和磁场分量,确定所述粒子集中各粒子的位姿和归一化权重;
S2:根据所述智能手机传感器检测的地磁分量对地磁地图进行Kring插值;
S3:当系统检测到定位目标失败时,采用自适应重采样策略,当系统检测到正确定位目标后,恢复之前的重采样过程;
S4:根据所述重采样粒子集中各粒子的位姿和归一化权重,确定定位目标在所述室内地磁图中的估计位置。
2.根据权利要求1所述的手机室内定位解决方法,其特征在于在粒子滤波算法中是根据传感器检测的数据确定所述粒子集中各粒子的位姿和归一化权重,该数据包括:抽取地磁水平方向和垂直方向的分量形成新的HV位置指纹,使用该二维指纹与地磁库匹配,采用磁场的变化率来克服不同的智能手机可能存在的读数偏差问题;采用指数函数加权粒子来估计定位目标的姿态分布。
3.根据权利要求1所述的手机室内定位解决方法,其特征在于所述室内地磁地图为网格地图,所述Kring插值方法是以粒子滤波算法得到的估计位置为中心,对周围10*10的小方格进行插值。
4.根据权利要求1所述的手机室内定位解决方法,其特征在于当系统检测到定位目标失败时,采用自适应重采样策略,当系统检测到正确定位目标后,恢复之前的重采样过程包括:所述粒子集中各粒子均含有一个标志位,每当粒子的位置与定位目标的估计位置超出规定值时,标志位置0,粒子的位置与定位目标的估计位置在规定值之内时,标志位置1,当系统检测到标志位为1的粒子数小于设定的门限值时,系统就采用自适应重采样策略,当系统检测到粒子的标志位为1的粒子数目大于门限值时,就恢复之前的重采样过程。
5.根据权利要求1或4所述的手机室内定位解决方法,其特征在于所述自适应重采样方法包括:在重采样过程中,以定位目标的估计位置为中心,以一个较大的距离为半径,在此空间随机一些随机粒子,并在全局空间重采样一部分粒子。
6.根据权利要求1所述的手机室内定位解决方法,其特征在于该方法中根据智能手机传感器所检测到的信息估计行人的运动步长,包括:
通过下式(1)和(2)更新粒子集,粒子集中包含正确跟踪行人的粒子,
xt=xt-1+Tsinθt+N(0,δ) (1)
yt=yt-1+Tcosθt+N(0,δ) (2)
其中,(xt-1,yt-1)为粒子在t-1时刻的位置,T为估计的用户移动的步长均值,θt表示t时刻智能手机检测到的相对正北方向的角度,N(0,δ)表示均值为0,方差为δ的高斯变量。
7.根据权利要求1所述的手机室内定位解决方法,其特征在于该方法中根据智能手机传感器所检测到的信息计算粒子的归一化权重,包括:
通过下式(3)和(4)计算所述粒子集中每个粒子的权重,
其中,ΔBH,ΔBV分别为传感器t时刻测得的水平和垂直方向上的地磁较上一时刻的变化率,分别表示t时刻的第i个粒子的所在磁场地图位置的水平和垂直方向的磁场较上一时刻的变化率,λ表示指数函数的变化情况,即权重取值的灵敏度。
8.一种利用权利要求1所述的手机室内定位解决方法进行基于地磁场的室内定位的智能手机平台系统,其特征在于包括:
粒子集生成模块,用于在定位目标周围分布多个粒子,形成粒子集,利用粒子滤波器和室内地磁图,根据自所述定位目标的监测传感器接收的方向和磁场值,确定所述粒子集中各粒子的位姿和归一化权重;
重采样模块,用于从所述粒子集中选取多个粒子组成重采样粒子集;
Kring插值模块,用于更新地磁场地图;
自适应重采样模块,用于在跟踪定位目标错误时,重新寻找定位目标,正确估计定位目标;
位置确定模块,用于根据所述重采样粒子集中各粒子的位姿和归一化权重,确定定位目标在所述室内地磁图中的估计位置。
9.根据权利要求8所述的基于地磁场的室内定位的智能手机平台系统,其特征在于所述室内地磁图为网格地图,在开始定位之前需要加载事先采集训练的地磁数据库,在完成对目标的定位之后,关闭系统时更新上传新的地磁数据库。
10.根据权利要求8所述的基于地磁场的室内定位的智能手机平台系统,其特征在于所述重采样模块用于:按归一化权重由大到小的顺序,从所述粒子集中选取多个粒子组成重采样粒子集。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611245793.9A CN106767828A (zh) | 2016-12-29 | 2016-12-29 | 一种手机室内定位解决方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611245793.9A CN106767828A (zh) | 2016-12-29 | 2016-12-29 | 一种手机室内定位解决方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN106767828A true CN106767828A (zh) | 2017-05-31 |
Family
ID=58929083
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201611245793.9A Pending CN106767828A (zh) | 2016-12-29 | 2016-12-29 | 一种手机室内定位解决方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106767828A (zh) |
Cited By (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107462247A (zh) * | 2017-07-18 | 2017-12-12 | 深圳天珑无线科技有限公司 | 一种室内定位方法、装置及计算机可读存储介质 |
CN107504971A (zh) * | 2017-07-05 | 2017-12-22 | 桂林电子科技大学 | 一种基于pdr和地磁的室内定位方法及系统 |
CN107883948A (zh) * | 2017-10-23 | 2018-04-06 | 石家庄铁道大学 | 变步长iccp地磁匹配方法 |
CN107979817A (zh) * | 2017-11-24 | 2018-05-01 | 王红军 | 一种移动终端二维指纹定位方法 |
CN108120436A (zh) * | 2017-12-18 | 2018-06-05 | 北京工业大学 | 一种iBeacon辅助地磁室内实景导航方法 |
CN108592914A (zh) * | 2018-04-08 | 2018-09-28 | 河南科技学院 | 无gps情况下的复杂区域巡视机器人定位、导航及授时方法 |
CN109459030A (zh) * | 2018-11-27 | 2019-03-12 | 北京方位捷讯科技有限公司 | 一种基于地标的行人定位修正方法及系统 |
CN109556600A (zh) * | 2017-09-27 | 2019-04-02 | 腾讯科技(深圳)有限公司 | 一种特定空间定位方法、装置及存储设备 |
CN109870716A (zh) * | 2017-12-01 | 2019-06-11 | 北京京东尚科信息技术有限公司 | 定位方法和定位装置及计算机可读存储介质 |
CN110941004A (zh) * | 2019-12-04 | 2020-03-31 | 南京航空航天大学 | 一种基于gnss/uwb的移动机器人室内外联合定位方法及装置 |
CN110967013A (zh) * | 2018-10-01 | 2020-04-07 | 刘佳兴 | 一种基于室内地磁场信息和智能手机的室内区域定位系统 |
CN111721292A (zh) * | 2019-03-20 | 2020-09-29 | 北京智慧图科技有限责任公司 | 一种利用地磁的室内定位方法 |
CN113688258A (zh) * | 2021-08-20 | 2021-11-23 | 广东工业大学 | 一种基于柔性多维聚类的信息推荐方法及系统 |
CN113701759A (zh) * | 2021-08-27 | 2021-11-26 | 杭州腓腓科技有限公司 | 基于可重构超材料的室内同步定位与地图构建方法与系统 |
US11885900B2 (en) | 2019-01-10 | 2024-01-30 | Technische Universität München | Method and system for tracking a mobile device |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103925923A (zh) * | 2014-05-07 | 2014-07-16 | 南京大学 | 一种基于自适应粒子滤波器算法的地磁室内定位系统 |
CN104019813A (zh) * | 2014-06-19 | 2014-09-03 | 无锡知谷网络科技有限公司 | 目标即时定位和构建地图的方法与系统 |
CN104375117A (zh) * | 2013-08-12 | 2015-02-25 | 无锡知谷网络科技有限公司 | 目标定位方法及系统 |
CN105676172A (zh) * | 2016-01-11 | 2016-06-15 | 无锡知谷网络科技有限公司 | 簇式磁场定位的方法、装置和系统 |
CN105716604A (zh) * | 2016-02-25 | 2016-06-29 | 华南理工大学 | 基于地磁序列的移动机器人室内定位方法及系统 |
CN106123897A (zh) * | 2016-06-14 | 2016-11-16 | 中山大学 | 基于多特征的室内融合定位方法 |
-
2016
- 2016-12-29 CN CN201611245793.9A patent/CN106767828A/zh active Pending
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104375117A (zh) * | 2013-08-12 | 2015-02-25 | 无锡知谷网络科技有限公司 | 目标定位方法及系统 |
CN103925923A (zh) * | 2014-05-07 | 2014-07-16 | 南京大学 | 一种基于自适应粒子滤波器算法的地磁室内定位系统 |
CN104019813A (zh) * | 2014-06-19 | 2014-09-03 | 无锡知谷网络科技有限公司 | 目标即时定位和构建地图的方法与系统 |
CN105676172A (zh) * | 2016-01-11 | 2016-06-15 | 无锡知谷网络科技有限公司 | 簇式磁场定位的方法、装置和系统 |
CN105716604A (zh) * | 2016-02-25 | 2016-06-29 | 华南理工大学 | 基于地磁序列的移动机器人室内定位方法及系统 |
CN106123897A (zh) * | 2016-06-14 | 2016-11-16 | 中山大学 | 基于多特征的室内融合定位方法 |
Non-Patent Citations (1)
Title |
---|
张聪聪 等: "基于地磁场的室内定位和地图构建", 《仪器仪表学报》 * |
Cited By (20)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107504971A (zh) * | 2017-07-05 | 2017-12-22 | 桂林电子科技大学 | 一种基于pdr和地磁的室内定位方法及系统 |
CN107462247A (zh) * | 2017-07-18 | 2017-12-12 | 深圳天珑无线科技有限公司 | 一种室内定位方法、装置及计算机可读存储介质 |
CN109556600B (zh) * | 2017-09-27 | 2022-02-25 | 腾讯科技(深圳)有限公司 | 一种特定空间定位方法、装置及存储设备 |
CN109556600A (zh) * | 2017-09-27 | 2019-04-02 | 腾讯科技(深圳)有限公司 | 一种特定空间定位方法、装置及存储设备 |
CN107883948A (zh) * | 2017-10-23 | 2018-04-06 | 石家庄铁道大学 | 变步长iccp地磁匹配方法 |
CN107883948B (zh) * | 2017-10-23 | 2021-03-23 | 石家庄铁道大学 | 变步长iccp地磁匹配方法 |
CN107979817A (zh) * | 2017-11-24 | 2018-05-01 | 王红军 | 一种移动终端二维指纹定位方法 |
CN109870716A (zh) * | 2017-12-01 | 2019-06-11 | 北京京东尚科信息技术有限公司 | 定位方法和定位装置及计算机可读存储介质 |
CN108120436A (zh) * | 2017-12-18 | 2018-06-05 | 北京工业大学 | 一种iBeacon辅助地磁室内实景导航方法 |
CN108592914A (zh) * | 2018-04-08 | 2018-09-28 | 河南科技学院 | 无gps情况下的复杂区域巡视机器人定位、导航及授时方法 |
CN110967013A (zh) * | 2018-10-01 | 2020-04-07 | 刘佳兴 | 一种基于室内地磁场信息和智能手机的室内区域定位系统 |
CN109459030B (zh) * | 2018-11-27 | 2021-01-29 | 北京方位捷讯科技有限公司 | 一种基于地标的行人定位修正方法及系统 |
CN109459030A (zh) * | 2018-11-27 | 2019-03-12 | 北京方位捷讯科技有限公司 | 一种基于地标的行人定位修正方法及系统 |
US11885900B2 (en) | 2019-01-10 | 2024-01-30 | Technische Universität München | Method and system for tracking a mobile device |
CN111721292A (zh) * | 2019-03-20 | 2020-09-29 | 北京智慧图科技有限责任公司 | 一种利用地磁的室内定位方法 |
CN111721292B (zh) * | 2019-03-20 | 2023-06-16 | 北京智慧图科技有限责任公司 | 一种利用地磁的室内定位方法 |
CN110941004A (zh) * | 2019-12-04 | 2020-03-31 | 南京航空航天大学 | 一种基于gnss/uwb的移动机器人室内外联合定位方法及装置 |
CN113688258A (zh) * | 2021-08-20 | 2021-11-23 | 广东工业大学 | 一种基于柔性多维聚类的信息推荐方法及系统 |
CN113701759A (zh) * | 2021-08-27 | 2021-11-26 | 杭州腓腓科技有限公司 | 基于可重构超材料的室内同步定位与地图构建方法与系统 |
CN113701759B (zh) * | 2021-08-27 | 2024-05-03 | 杭州腓腓科技有限公司 | 基于可重构超材料的室内同步定位与地图构建方法与系统 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106767828A (zh) | 一种手机室内定位解决方法 | |
CN105588566B (zh) | 一种基于蓝牙与mems融合的室内定位系统及方法 | |
WO2018018994A1 (zh) | 室内定位方法及定位系统 | |
CN110118549B (zh) | 一种多源信息融合定位方法和装置 | |
CN103363988B (zh) | 一种利用智能手机传感器实现地磁室内定位导航的方法 | |
Kim et al. | Indoor positioning system using geomagnetic anomalies for smartphones | |
Zhao et al. | Learning-based bias correction for time difference of arrival ultra-wideband localization of resource-constrained mobile robots | |
CN105043380A (zh) | 基于微机电传感器、WiFi定位、磁场匹配的室内导航方法 | |
CN107830862A (zh) | 一种基于智能手机的室内定位行人追踪的方法 | |
CN105589064A (zh) | Wlan位置指纹数据库快速建立和动态更新系统及方法 | |
CN108709557B (zh) | 基于多用户轨迹拟合的室内地图生成方法 | |
CN105445776A (zh) | 一种室内外无缝定位系统 | |
CN106597363A (zh) | 一种室内wlan环境下的行人定位方法 | |
US10557711B2 (en) | Apparatus for inferring pedestrian position based on pedestrian movement detection, and method therefor | |
CN104215238A (zh) | 一种智能手机室内定位方法 | |
CN108632761A (zh) | 一种基于粒子滤波算法的室内定位方法 | |
CN111698774B (zh) | 基于多源信息融合的室内定位方法及装置 | |
CN105101090B (zh) | 一种环境监测无线传感网的节点定位方法 | |
CN112729301A (zh) | 一种基于多源数据融合的室内定位方法 | |
Huang et al. | An improved particle filter algorithm for geomagnetic indoor positioning | |
Huang et al. | Smartphone-based indoor position and orientation tracking fusing inertial and magnetic sensing | |
CN108955669A (zh) | 一种重磁场组合导航算法 | |
Xu et al. | An indoor pedestrian localization algorithm based on multi-sensor information fusion | |
CN106197418B (zh) | 一种基于滑动窗口的指纹法与传感器融合的室内定位方法 | |
Ding et al. | OGI-SLAM2: A hybrid map SLAM framework grounded in inertial-based SLAM |
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 | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20170531 |