CN106441302B - 大型开放式区域内的室内定位方法 - Google Patents

大型开放式区域内的室内定位方法 Download PDF

Info

Publication number
CN106441302B
CN106441302B CN201610848830.9A CN201610848830A CN106441302B CN 106441302 B CN106441302 B CN 106441302B CN 201610848830 A CN201610848830 A CN 201610848830A CN 106441302 B CN106441302 B CN 106441302B
Authority
CN
China
Prior art keywords
user
mobile phone
particles
particle
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.)
Active
Application number
CN201610848830.9A
Other languages
English (en)
Other versions
CN106441302A (zh
Inventor
吴旭东
邢宇程
贾日恒
傅洛伊
田晓华
王新兵
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shanghai Jiaotong University
Original Assignee
Shanghai Jiaotong University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Shanghai Jiaotong University filed Critical Shanghai Jiaotong University
Priority to CN201610848830.9A priority Critical patent/CN106441302B/zh
Publication of CN106441302A publication Critical patent/CN106441302A/zh
Application granted granted Critical
Publication of CN106441302B publication Critical patent/CN106441302B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations
    • G01C21/206Instruments for performing navigational calculations specially adapted for indoor navigation
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/005Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/165Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S5/00Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/02Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
    • G01S5/0257Hybrid positioning
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S5/00Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/02Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
    • G01S5/10Position of receiver fixed by co-ordinating a plurality of position lines defined by path-difference measurements, e.g. omega or decca systems
    • HELECTRICITY
    • H04ELECTRIC COMMUNICATION TECHNIQUE
    • H04WWIRELESS COMMUNICATION NETWORKS
    • H04W4/00Services specially adapted for wireless communication networks; Facilities therefor
    • H04W4/02Services making use of location information
    • H04W4/029Location-based management or tracking services

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Signal Processing (AREA)
  • Navigation (AREA)
  • Position Fixing By Use Of Radio Waves (AREA)

Abstract

本发明提供了一种大型开放式区域内的室内定位方法,包括步骤:第一步,根据部署在定位区域内的多个蓝牙节点,采用三角定位法确定用户的初始位置;第二步,根据用户手机惯性传感器的输出值确定用户的近似位移距离与位移方向;第三步,由于惯性传感器的测量误差,采用改进型粒子滤波算法,在用户新位置的可能范围内采样产生粒子;第四步:基于粒子的两个属性(步长和转角)的分布以及手机采集到的磁场强度,联合确定粒子的权重,采用加权平均算法确定用户的新位置。本发明基于手机内置传感器,通过改进型粒子滤波算法和关键位置部署的蓝牙节点,实现了用户在大型开放式区域内的精确定位。

Description

大型开放式区域内的室内定位方法
技术领域
本发明涉及移动计算领域,具体地,涉及一种大型开放式区域内的室内定位方法。
背景技术
高精度的室内定位系统是基于位置的商业服务(Location Based Services,LBS)的关键技术,LBS系统在现代商业模式中具有很高的价值。LBS系统的应用包括,在机场火车站等区域的导航,在商场和博物馆等场景中的广告推送等,在这些应用当中,用户需要在陌生的场景中知道自己的准确位置,而服务的提供商需要基于用户的位置来提供个性化的服务。
传统的室内定位技术包括WiFi指纹定位技术和航位推测算法定位技术,但这两种技术在大型开放式区域的定位精度都较低。因为在例如火车站,商场和博物馆等场景中,由于多径效应,信道动态条件以及路由器的功率控制技术,无线信号强度波动不可避免,而且WiFi信号扫描所带来的高能耗也是一个制约因素。由于在上述场景当中,用户的可行路径十分复杂,建筑平面图无法用来限制用户的可行路径,传感器的测量误差将会带来定位过程中的累积误差效应,而且手机的任意摆放姿势会给手机传感器带来很大的测量偏差,导致航位推测算法无法对用户定位。
对现有技术进行检索发现,Yuanchao Shu等在2015年IEEE Journal on SelectedAreas in Communications发表的Magicol:indoor localization using pervasivemagnetic field and opportunistic WiFi sensing(基于普遍存在的磁场和可获得的WiFi信号的室内定位技术)中提出了一种基于普遍磁信号强度和惯性传感器的室内定位系统,这种定位算法采用的是将磁场强度作为指纹,因为在室内环境中磁场强度比无线信号强度更稳定,但是在火车站、商场等场景中,由于用户所携带的金属设备和电子设备,磁场强度仍然会在很多区域产生较大波动,导致该算法在此类场景中无法精确定位。HongweiXie等在2015年IEEE Transactions on Mobile Computing上发表的A Reliability-Augmented Particle Filter for Magnetic Fingerprinting Based IndoorLocalization on Smartphone(一种在基于磁信号指纹的室内定位系统中的可靠分段粒子滤波算法)中提出了类似的算法,但是该算法在大型开放式区域中,无法用建筑平面图来限制用户的可行路线,从而导致该算法无法克服累积误差效应。
发明内容
针对现有技术中的缺陷,本发明的目的是提出一种在大型开放式区域内的室内定位方法,通过采用磁场强度,改进型粒子滤波算法和蓝牙节点技术,实现用户在此类场景中的精确定位。
根据本发明提供的一种大型开放式区域内的室内定位方法,包括:
步骤1,根据蓝牙信号强度,定位确定用户手机的初始位置,并且在初始位置的定位过程中周期性地校正用户手机的惯性传感器噪声导致的定位累积误差;
步骤2,由所述初始位置,根据用户手机的惯性传感器的输出值估计出用户的行走距离和用户的转动角度,得到用户手机的新位置;
步骤3,在用户手机的新位置的可能范围内采样产生粒子,其中,粒子具有步长属性和转角属性;
步骤4,基于粒子的步长属性、转角属性的分布以及用户手机采集到的磁场强度,联合确定粒子的权重,确定用户的新位置。
优选地,在所述步骤1中,在定位区域内的多个位置分别布置蓝牙节点,将用户手机检测到的蓝牙信号强度换算成用户手机与多个蓝牙节点之间的距离,通过三角定位算法,确定蓝牙节点的定位范围中用户手机的初始位置;其中,在初始位置的定位过程中,当用户手机再次进入蓝牙节点的定位范围中时,通过三角定位算法校正用户手机的位置,从而在定位过程中校正用户手机的惯性传感器噪声带来的定位累积误差。
优选地,所述惯性传感器包括加速度计和陀螺仪;
在所述步骤2中,当用户手机离开蓝牙节点的定位范围后,以多个粒子代表用户手机的可能位置,根据用户手机的加速度计的输出值估计用户的行走距离,并根据用户手机的陀螺仪的输出值估计用户的转动角度,从而确定粒子更新后得到的新粒子的位置,即:
Figure BDA0001119898850000021
其中,
Figure BDA0001119898850000031
为采样前的第i个粒子的位置坐标,θi为采样前的第i个粒子的方向,lij为根据采样前的第i个粒子重采样的第j个粒子的步长,
Figure BDA0001119898850000032
为根据采样前的第i个粒子重采样的第j个粒子的位置坐标。
优选地,在所述步骤3中,根据用户的步长l、转角θ的概率分布,确定用户手机的新位置的可能范围,在用户手机的新位置的可能范围内采样产生粒子;
用户的步长l、转角θ的概率分布f(l)、f(θ)分别为:
Figure BDA0001119898850000033
Figure BDA0001119898850000034
其中,
Figure BDA0001119898850000035
为预设的人的平均步长,概率分布f(l)的方差为
Figure BDA0001119898850000036
Figure BDA0001119898850000037
为作为惯性传感器的陀螺仪测量到的转动角度。
优选地,在用户手机的新位置的可能范围内采用改进型粒子滤波算法来采样产生粒子,其中,改进型粒子滤波算法具体为:
在步长l的80%置信区间当中采样产生粒子,长度的采样区间为以
Figure BDA0001119898850000038
为极点、极轴的极坐标下,极径
Figure BDA0001119898850000039
的范围内;
在转角θ的70%置信区间当中采样产生粒子,角度的采样区间为以
Figure BDA00011198988500000310
为极点、极轴的极坐标下,极角
Figure BDA00011198988500000311
的范围内;
其中,
Figure BDA00011198988500000312
表示标准正态分布函数。
优选地,在所述步骤4中,根据粒子的权重,采用加权平均算法确定用户的新位置,其中,每个粒子的权重由以下三个参数w1、w2、w3确定:
粒子步长的归一化概率w1
Figure BDA0001119898850000041
其中,li表示第i个粒子的步长,lk表示粒子集合中第k个粒子的步长,pk表示粒子集合中的第k个粒子,V表示当前所有粒子组成的粒子集合;
粒子转动角度的归一化概率w2
Figure BDA0001119898850000042
其中,θi表示第i个粒子的转角,θk表示粒子集合中第k个粒子的转角;
粒子对应位置在磁场强度数据库中的取值与用户手机实时采集到的磁场强度值的相似度w3
Figure BDA0001119898850000043
其中,si表示第i个粒子对应位置在磁场强度数据库中的取值与用户手机实时采集到的磁场强度值的相似度,δ表示当前环境下的磁场强度波动,sk表示粒子集合中第k个粒子对应位置在磁场强度数据库中的取值与用户手机实时采集到的磁场强度值的相似度;
粒子的权重w为w=w1·w2·w3
优选地,用户的步长l、转角θ可以是指人在大型开放式区域内正常行走状态下的步长l、转角θ。
与现有技术相比,本发明具有如下的有益效果:
1、在基于磁场的室内定位系统中,通过设计的改进型粒子滤波算法,使得定位系统可以有效抑制磁场波动带来的定位误差。
2、在应用于大型开放式区域的室内定位系统当中,针对用户可行路径负责的问题,采用蓝牙节点辅助校正定位中的累积误差。
附图说明
通过阅读参照以下附图对非限制性实施例所作的详细描述,本发明的其它特征、目的和优点将会变得更明显:
图1为本发明的工作流程图;
图2、图3为本发明步骤3(即第三步)中的采样区间示意图;
图4是本发明具体实施中的定位误差与行走距离的关系图;
图5是本发明应用于不同用户时的误差大小累积分布图。
图5中的H表示身高。
具体实施方式
下面结合具体实施例对本发明进行详细说明。以下实施例将有助于本领域的技术人员进一步理解本发明,但不以任何形式限制本发明。应当指出的是,对本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变化和改进。这些都属于本发明的保护范围。
本发明利用用户携带智能手机上的传感器,结合定位区域中磁场强度和部署在关键位置的蓝牙节点,实现了用户在大型开放式区域的精确室内定位。
传统的基于无线信号定位技术和新兴的基于磁场强度和粒子滤波的室内定位技术应用到诸如火车站,商场和博物馆等场景当中时,存在着如下缺陷:第一,在上述场景中人流量较大,且人员大多会携带金属或电子设备,这使得无线传输信道的状态存在着很大的动态性和随机性,加上无线路由器的自动功率调整机制,使得在上述场景中无线信号和磁场强度会产生较大的波动,从而导致基于它们的室内定位技术在此类场景中无法取得较高的定位精度。
其次,由于在大型开放式区域中,用户的可行路径十分复杂,建筑平面图无法用来限制用户的可行路径。因此在此类场景中,手机惯性传感器的噪声以及无线信号和磁场强度波动引起的定位误差无法通过匹配定位区域中用户的可行路径来消除。在粒子滤波的重采样过程中,由于之前定位的误差未被校正,误差会在重采样的过程中不断累积,导致基于粒子滤波的定位技术在此类场景中无法取得较高的定位精度。
在本发明中,采用以下技术克服上述两点困难:在粒子滤波算法上,本发明设计了一种改进型粒子权重算法,将粒子步长和转动角度的归一化概率与磁信号的相似度协同确定粒子的权重,有效地抑制了磁场波动对于定位精度的影响。在定位范围的关键区域部署蓝牙节点,在蓝牙节点的精确定位范围内通过三角定位法可以校正用户的位置,可以确定用户在定位过程中的起始位置,并且可以周期性地校正在定位过程中的累积误差,使得粒子步长和转动角度的归一化概率可以始终有效地反映用户位置的分布。
根据本发明提供的大型开放式区域内的室内定位方法,包括如下步骤:
第一步,根据部署在定位区域内的多个蓝牙节点,采用三角定位法确定用户的初始位置;第二步,根据用户手机惯性传感器的输出值确定用户的近似位移距离与位移方向;第三步,由于惯性传感器的测量误差,采用改进型粒子滤波算法,在用户新位置的可能范围内采样产生粒子;第四步:基于粒子的两个属性(步长和转角)的分布以及手机采集到的磁场强度,联合确定粒子的权重,采用加权平均算法确定用户的新位置。
所述第一步中,在定位区域内的关键位置布置蓝牙节点,将手机检测到的蓝牙信号强度换算成用户与多个蓝牙节点之间的距离,通过三角定位算法在蓝牙节点的精确定位范围内确定用户的初始位置。在定位过程中,当用户再次进入蓝牙节点精确定位的范围中时,采用上述方法校正用户的位置,从而可以在定位过程中校正手机惯性传感器噪声带来的定位累积误差。
所述第二步中,当用户离开蓝牙节点的精确定位区域后,由于用户位置的不确定性,以多个粒子代表用户的可能位置,根据手机加速度计的输出值估计用户的行走距离和陀螺仪的输出值估计用户的转动角度,从而确定粒子更新后的位置,即
Figure BDA0001119898850000061
其中
Figure BDA0001119898850000062
为原粒子的位置坐标,θi为粒子的方向,lij为重采样粒子的步长,
Figure BDA0001119898850000063
为重采样后新粒子的位置坐标。
所述第三步中,由于手机惯性传感器的测量误差,根据步长l和转角θ的概率分布,
Figure BDA0001119898850000064
Figure BDA0001119898850000065
为人的平均步长,该分布的方差为
Figure BDA0001119898850000066
Figure BDA0001119898850000071
Figure BDA0001119898850000072
为陀螺仪测量到的转动角度,确定用户新位置的可能范围,并按照改进型粒子滤波算法,在该范围内对粒子进行重采样。
所述第三步中,为了应对惯性传感器的误差以及人的步长的波动所带来的位置的不确定性,若用户沿直线行走则需要步长的80%置信区间当中对粒子进行重采样,采样区间为
Figure BDA0001119898850000073
示意图见附图3;若用户在行走过程中转动了方向,则需要在转角的70%置信区间当中对粒子的方向进行重采样,角度的采样区间为
Figure BDA0001119898850000074
因此采样区间成为一个扇形二维区域,该扇形区域见附图3。
所述第四步中,由于在火车站、飞机场和商场等场中,用户所携带的电子设备和金属设备会使得磁场在部分区域当中产生较大的变动,之前的研究中仅采用磁信号的相似度作为粒子权重的相似度作为确定权重的参数,会使得磁场的波动带来较大的定位误差,并且这种误差会随着定位过程的突进不断地累积。因此本发明当中,为了克服磁场的波动带来的定位误差,每个粒子的权重由以下三个参数确定:
(1)粒子步长的归一化概率,
Figure BDA0001119898850000075
(2)粒子转动角度的归一化概率,
Figure BDA0001119898850000076
(3)粒子对应位置在磁场强度数据库中的取值与用户实时采集到的磁场强度值的相似度,
Figure BDA0001119898850000081
由于本发明中采样蓝牙节点精确定位的方式周期性地校正定位过程当中的累积误差,因此参数w1和参数w2可以有效地反映用户位置的概率分布,从而达到抑制磁场波动带来的定位误差的目的。粒子的权重由这三个归一化参数的积确定,即w=w1·w2·w3,对粒子的权重进行归一化后,对粒子的位置进行求加权平均,计算得到用户的新位置。
所述第一步中,由于手机惯性传感器的噪声无法避免,并且在大型开放式区域当中,用户的可行路径十分复杂,建筑平面图无法通过限制用户的可行路径来减少定位误差,因此定位过程中的误差会累积增长。针对上述问题,本发明当中,当用户再次进入蓝牙节点的精确定位范围中时,通过手机接收到的蓝牙节点的信号通过第一步中的定位方法,校正自己所在的位置,从而周期性地矫正了在定位过程中产生的累积误差。
所述第一步中,由于在定位过程中需要不断地进行重采样,粒子的数目会逐步增多,从而导致系统的计算复杂度上升。针对上述问题,在本发明中,当用户再次进入蓝牙节点的精确定位范围中时,通过对位置的校正,从而将偏离的粒子消除,大幅减少了下一阶段定位系统的计算复杂度。
下面对本发明进行更为具体的说明。
在本发明中,有三种角色,一是用户所持智能手机,即用户手机,通过手机上的惯性传感器推测用户可能地行走距离和行走方向,并且实时采集磁场强度。二是磁场强度,在室内环境中,磁场强度随在不同位置呈现出稳定的变化特征,预先采集定位范围中各个位置的磁场强度,用户实时采集的磁场强度与数据库中的磁场强度的相似度可以反映各个粒子的可靠性。三是蓝牙节点,在蓝牙节点的精确定位范围内通过三角定位法可以在定位过程中校正用户的位置。
参见附图1,下面更详细地将本发明的实施过程进行阐述。
第一步,在定位区域内的关键位置布置蓝牙节点,将手机检测到的蓝牙信号强度换算成用户手机所代表的用户与多个蓝牙节点之间的距离,通过三角定位算法在蓝牙节点的精确定位范围内确定用户的初始位置。在定位过程中,当用户再次进入蓝牙节点精确定位的范围中时,采用上述三角定位算法校正用户的位置,从而可以在定位过程中校正手机惯性传感器噪声带来的定位累积误差。
第二步,当用户离开蓝牙节点的精确定位区域后,由于用户位置的不确定性,以多个粒子代表用户的可能位置,根据手机加速度计的输出值估计用户的行走距离和陀螺仪的输出值估计用户的转动角度,从而确定粒子更新后的位置,即
Figure BDA0001119898850000091
其中
Figure BDA0001119898850000092
为原粒子的位置坐标,θi为粒子的方向,lij为重采样粒子的步长,
Figure BDA0001119898850000093
为重采样后新粒子的位置坐标。
第三步,由于手机惯性传感器的测量误差,根据步长l和转角θ的概率分布,f(l),和f(θ),
Figure BDA0001119898850000094
为陀螺仪测量到的转动角度,确定用户新位置的可能范围,并按照改进型粒子滤波算法,在该范围内对粒子进行重采样。为了应对惯性传感器的误差以及人的步长的波动所带来的位置的不确定性,若用户沿直线行走则需要步长的80%置信区间当中对粒子进行重采样;采样区间为
Figure BDA0001119898850000095
若用户在行走过程中转动了方向,则需要在转角的70%置信区间当中对粒子的方向进行重采样,角度的采样区间为
Figure BDA0001119898850000096
第四步,为了克服磁场的波动带来的定位误差,每个粒子的权重由以下三个参数确定:(1)粒子步长的归一化概率w1;(2)粒子转动角度的归一化概率w2;(3)粒子对应位置在磁场强度数据库中的取值与用户实时采集到的磁场强度值的相似度w3。由于本发明中采样蓝牙节点精确定位的方式周期性地校正定位过程当中的累积误差,因此参数w1和参数w2可以有效地反映用户位置的概率分布,从而达到抑制磁场波动带来的定位误差的目的。粒子的权重由这三个归一化参数的积确定,即w=w1·w2·w3,对粒子的权重进行归一化后,对粒子的位置求加权平均,计算得到用户的新位置。
当用户再次进入蓝牙节点精确定位的范围内时,通过接收到的蓝牙信号通过三角定位法校正用户的位置,再进入第二步依次循环,使得定位误差始终在保持在可接收的范围内。
下面通过一个实例具体地展示系统的工作流程和实际效果。
本实例的实验范围为:交通大学闵行校区图书大楼一楼服务大厅(约1800平方米)。
本实施包括两个实验阶段,第一阶段,磁场强度指纹采集与蓝牙节点布置。采集了整个实验区域的磁场强度,将采集到的磁场强度与位置坐标一一映射。在两个关键位置,服务大厅的门口和转盘拐角处布置蓝牙节点,用于校正用户位置。
第二阶段,模拟用户使用本系统定位的情况,实验按发明内容各个步骤进行。当用户离开蓝牙节点精确定位范围后,按照所述的第二步和第三步,根据惯性传感器估计用户的行走距离与行走方向,在相应的采样区间里对粒子进行重采样。按照所述第四步中的权重计算方法,计算各个粒子的权重,在计算w3时,是用户采集到的近5个磁场强度值组成观测向量,粒子最近的5个位置在数据库中的5个取值组成粒子向量,粒子向量与观测向量间的欧式距离为w3计算表达式中的s变量。当用户进入转盘拐角区域时,通过接收到的蓝牙信号对位置进行矫正,之后再从所述第二步循环进行。附图4是实验中定位误差与行走距离的关系,附图5是实验应用于不同用户时的误差大小累积分布图。
以上对本发明的具体实施例进行了描述。需要理解的是,本发明并不局限于上述特定实施方式,本领域技术人员可以在权利要求的范围内做出各种变化或修改,这并不影响本发明的实质内容。在不冲突的情况下,本申请的实施例和实施例中的特征可以任意相互组合。

Claims (4)

1.一种大型开放式区域内的室内定位方法,其特征在于,包括:
步骤1,根据蓝牙信号强度,定位确定用户手机的初始位置,并且在初始位置的定位过程中周期性地校正用户手机的惯性传感器噪声导致的定位累积误差;
步骤2,由所述初始位置,根据用户手机的惯性传感器的输出值估计出用户的行走距离和用户的转动角度,得到用户手机的新位置;
步骤3,在用户手机的新位置的可能范围内采样产生粒子,其中,粒子具有步长属性和转角属性;
步骤4,基于粒子的步长属性、转角属性的概率分布以及用户手机采集到的磁场强度,联合确定粒子的权重,确定用户的新位置;
在所述步骤3中,根据用户的步长l、转角θ的概率分布,确定用户手机的新位置的可能范围,在用户手机的新位置的可能范围内采样产生粒子;
用户的步长l、转角θ的概率分布f(l)、f(θ)分别为:
Figure FDA0002383017980000011
Figure FDA0002383017980000012
其中,
Figure FDA0002383017980000013
为预设的人的平均步长,概率分布f(l)的方差为
Figure FDA0002383017980000014
Figure FDA0002383017980000015
为作为惯性传感器的陀螺仪测量到的转动角度;
在用户手机的新位置的可能范围内采用改进型粒子滤波算法来采样产生粒子,其中,改进型粒子滤波算法具体为:
在步长l的80%置信区间当中采样产生粒子,长度的采样区间为以
Figure FDA0002383017980000016
为极点、极轴的极坐标下,极径
Figure FDA0002383017980000017
的范围内;
在转角θ的70%置信区间当中采样产生粒子,角度的采样区间为以
Figure FDA0002383017980000018
为极点、极轴的极坐标下,极角
Figure FDA0002383017980000019
的范围内;
其中,
Figure FDA00023830179800000110
表示标准正态分布函数。
2.根据权利要求1所述的大型开放式区域内的室内定位方法,其特征在于,在所述步骤1中,在定位区域内的多个位置分别布置蓝牙节点,将用户手机检测到的蓝牙信号强度换算成用户手机与多个蓝牙节点之间的距离,通过三角定位算法,确定蓝牙节点的定位范围中用户手机的初始位置;其中,在初始位置的定位过程中,当用户手机再次进入蓝牙节点的定位范围中时,通过三角定位算法校正用户手机的位置,从而在定位过程中校正用户手机的惯性传感器噪声带来的定位累积误差。
3.根据权利要求1所述的大型开放式区域内的室内定位方法,其特征在于,所述惯性传感器包括加速度计和陀螺仪;
在所述步骤2中,当用户手机离开蓝牙节点的定位范围后,以多个粒子代表用户手机的可能位置,根据用户手机的加速度计的输出值估计用户的行走距离,并根据用户手机的陀螺仪的输出值估计用户的转动角度,从而确定粒子更新后得到的新粒子的位置,即:
Figure FDA0002383017980000021
其中,
Figure FDA0002383017980000022
为采样前的第i个粒子的位置坐标,θi为采样前的第i个粒子的方向,lij为根据采样前的第i个粒子重采样的第j个粒子的步长,
Figure FDA0002383017980000023
为根据采样前的第i个粒子重采样的第j个粒子的位置坐标。
4.根据权利要求1所述的大型开放式区域内的室内定位方法,其特征在于,在所述步骤4中,根据粒子的权重,采用加权平均算法确定用户的新位置,其中,每个粒子的权重由以下三个参数w1、w2、w3确定:
粒子步长的归一化概率w1
Figure FDA0002383017980000024
其中,li表示第i个粒子的步长,lk表示粒子集合中第k个粒子的步长,pk表示粒子集合中的第k个粒子,V表示当前所有粒子组成的粒子集合;
粒子转动角度的归一化概率w2
Figure FDA0002383017980000031
其中,θi表示第i个粒子的转角,θk表示粒子集合中第k个粒子的转角;
粒子对应位置在磁场强度数据库中的取值与用户手机实时采集到的磁场强度值的相似度w3
Figure FDA0002383017980000032
其中,si表示第i个粒子对应位置在磁场强度数据库中的取值与用户手机实时采集到的磁场强度值的相似度,δ表示当前环境下的磁场强度波动,sk表示粒子集合中第k个粒子对应位置在磁场强度数据库中的取值与用户手机实时采集到的磁场强度值的相似度;
粒子的权重w为w=w1·w2·w3
CN201610848830.9A 2016-09-23 2016-09-23 大型开放式区域内的室内定位方法 Active CN106441302B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610848830.9A CN106441302B (zh) 2016-09-23 2016-09-23 大型开放式区域内的室内定位方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610848830.9A CN106441302B (zh) 2016-09-23 2016-09-23 大型开放式区域内的室内定位方法

Publications (2)

Publication Number Publication Date
CN106441302A CN106441302A (zh) 2017-02-22
CN106441302B true CN106441302B (zh) 2020-06-12

Family

ID=58167318

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610848830.9A Active CN106441302B (zh) 2016-09-23 2016-09-23 大型开放式区域内的室内定位方法

Country Status (1)

Country Link
CN (1) CN106441302B (zh)

Families Citing this family (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102017204941A1 (de) * 2017-03-23 2018-09-27 Continental Automotive Gmbh Verfahren zum Erkennen eines Sonderbetriebszustands eines Kraftfahrzeugs, mobile Vorrichtung, Computerprogrammprodukt und Referenzgeräuschsammlung
CN107396321B (zh) * 2017-08-02 2020-08-21 江南大学 基于手机传感器和iBeacon的无监督式室内定位方法
CN107632966B (zh) * 2017-09-08 2021-10-19 歌尔科技有限公司 运动轨迹确定方法及电子设备
US11169280B2 (en) 2018-11-13 2021-11-09 Pointr Limited Systems and methods for direction estimation in indoor and outdoor locations
US10324197B1 (en) 2018-11-13 2019-06-18 Pointr Limited Systems and methods for estimating initial heading at start-up of navigation
EP3680618A1 (en) 2019-01-10 2020-07-15 Technische Universität München Method and system for tracking a mobile device
CN111665470A (zh) * 2019-03-07 2020-09-15 阿里巴巴集团控股有限公司 一种定位方法及装置和机器人
CN110567441B (zh) * 2019-07-29 2021-09-28 广东星舆科技有限公司 基于粒子滤波的定位方法、定位装置、建图及定位的方法
CN112461223B (zh) * 2020-11-10 2021-08-03 武汉大学 一种磁力计零偏无关的磁场指纹库生成方法
CN117824627A (zh) * 2023-12-29 2024-04-05 哈尔滨工业大学(威海) 一种基于粒子滤波的差速机器人地磁辅助定位系统

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103983266A (zh) * 2014-05-28 2014-08-13 北京天地方元科技有限公司 基于地磁信息的室内定位方法及系统
CN104215238A (zh) * 2014-08-21 2014-12-17 北京空间飞行器总体设计部 一种智能手机室内定位方法
CN104796866A (zh) * 2015-05-06 2015-07-22 北京我联科技有限公司 室内定位方法和装置
CN105022055A (zh) * 2015-07-05 2015-11-04 吉林大学 一种imu室内定位方法
CN105547298A (zh) * 2015-12-25 2016-05-04 北京京元智慧应急技术有限公司 智能手机内置传感器与Wi-Fi融合的室内动态连续定位方法
CN105737826A (zh) * 2016-02-24 2016-07-06 中国地质大学(武汉) 行人室内定位方法
CN105910601A (zh) * 2016-05-31 2016-08-31 天津大学 一种基于隐马尔科夫模型的室内地磁定位方法

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103983266A (zh) * 2014-05-28 2014-08-13 北京天地方元科技有限公司 基于地磁信息的室内定位方法及系统
CN104215238A (zh) * 2014-08-21 2014-12-17 北京空间飞行器总体设计部 一种智能手机室内定位方法
CN104796866A (zh) * 2015-05-06 2015-07-22 北京我联科技有限公司 室内定位方法和装置
CN105022055A (zh) * 2015-07-05 2015-11-04 吉林大学 一种imu室内定位方法
CN105547298A (zh) * 2015-12-25 2016-05-04 北京京元智慧应急技术有限公司 智能手机内置传感器与Wi-Fi融合的室内动态连续定位方法
CN105737826A (zh) * 2016-02-24 2016-07-06 中国地质大学(武汉) 行人室内定位方法
CN105910601A (zh) * 2016-05-31 2016-08-31 天津大学 一种基于隐马尔科夫模型的室内地磁定位方法

Also Published As

Publication number Publication date
CN106441302A (zh) 2017-02-22

Similar Documents

Publication Publication Date Title
CN106441302B (zh) 大型开放式区域内的室内定位方法
CN105424030B (zh) 基于无线指纹和mems传感器的融合导航装置和方法
CN110118549B (zh) 一种多源信息融合定位方法和装置
CN107094319B (zh) 一种高精度室内外融合定位系统和方法
Zhou et al. Activity sequence-based indoor pedestrian localization using smartphones
US20180245927A1 (en) Navigate, track, and position mobile devices in gps-denied or gps-inaccurate areas with automatic map generation
CN111829516B (zh) 一种基于智能手机的自主式行人定位方法
CN106525031B (zh) 一种组合的室内定位方法
Chen et al. Indoor localization using smartphone sensors and iBeacons
CN109525935A (zh) 一种针对普适室内环境的智能楼层感知方法及控制系统
CN106028447B (zh) 一种基于气压指纹的室内楼层定位方法
CN112729301A (zh) 一种基于多源数据融合的室内定位方法
Li et al. An indoor localization system by fusing smartphone inertial sensors and bluetooth low energy beacons
Wang et al. Deep neural network‐based Wi‐Fi/pedestrian dead reckoning indoor positioning system using adaptive robust factor graph model
Yu et al. Floor positioning method indoors with smartphone’s barometer
Song et al. Improved indoor position estimation algorithm based on geo-magnetism intensity
Kong et al. Hybrid indoor positioning method of BLE and PDR based on adaptive feedback EKF with low BLE deployment density
Wang A study of WiFi-aided magnetic matching indoor positioning algorithm
Zhou et al. Wi-fi RTT/encoder/INS-based robot indoor localization using smartphones
Zhuang et al. Autonomous WLAN heading and position for smartphones
Li et al. A modularized real-time indoor navigation algorithm on smartphones
CN107105404B (zh) 一种基于步长匹配的行人室内定位方法
Qi et al. Precise 3D foot-mounted indoor localization system using commercial sensors and map matching approach
Han et al. An indoor positioning algorithm based on Wi-Fi fingerprint and inertial navigation system
Huang et al. Indoor positioning system based on improved PDR and magnetic calibration using smartphone

Legal Events

Date Code Title Description
C06 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