CN107504968A - 一种基于pdr及移动目标进出点的轨迹追踪方法 - Google Patents
一种基于pdr及移动目标进出点的轨迹追踪方法 Download PDFInfo
- Publication number
- CN107504968A CN107504968A CN201710574518.XA CN201710574518A CN107504968A CN 107504968 A CN107504968 A CN 107504968A CN 201710574518 A CN201710574518 A CN 201710574518A CN 107504968 A CN107504968 A CN 107504968A
- Authority
- CN
- China
- Prior art keywords
- pdr
- mobile phone
- smart mobile
- wifi
- location
- 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/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; 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/16—Navigation; 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/165—Navigation; 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
-
- 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
-
- 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/003—Locating users or terminals or network equipment for network management purposes, e.g. mobility management locating network equipment
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Signal Processing (AREA)
- Telephone Function (AREA)
- Navigation (AREA)
Abstract
本发明公开一种基于PDR及移动目标进出点的轨迹追踪方法,包括PDR定位系统,所述PDR定位系统由智能手机、无线中继节点、WIFI路由、服务器、加速计,陀螺仪测量速度、角速度变化量组成,所述智能手机签由显示屏、带微控制器的蓝牙组成,所述无线中继节点由带微控制器的蓝牙和WIFI通信模块组成,所述服务器可通过WIFI路由和无线中继节点向智能手机发送信号功能,所述智能手机事先已安装定位导航APP软件,所述智能手机内部嵌入运动传感器、加速度传感器、方向传感器和地磁传感器,推测航迹通常认为行人运动为二维运动,基本原理是平面几何法。该发明定位准确,便于使用,易于实现。
Description
技术领域
本发明涉及定位技术领域,具体为一种基于PDR及移动目标进出点的轨迹追踪方法。
背景技术
快速精确搜寻定位目标是各行各业迫切需要解决的难题,高精度轨迹追踪是解决该问题的有效途径。然而,现有的定位技术种类繁多,稳定性差,成本高,成为该技术推广应用的一个瓶颈,说到定位服务,人们最多想到的是基于GPS系统的定位导航系统,然而GPS系统定位性能受遮蔽物的影响很大,而人们生活中大部分的时间生活在室内,当用户在室内活动时,比如说仓库管理,商场购物,还有医院医护,GPS就完全无法满足人们的需求。所以最近几年,室内定位由于其广阔的市场前景而吸引到国内外研究机构们的关注,那么如何发明出一种基于PDR及移动目标进出点的轨迹追踪方法,这成为我们需要解决的问题。
发明内容
本发明的目的在于提供一种基于PDR及移动目标进出点的轨迹追踪方法,解决了背景技术中所提出的问题。
为解决上述问题,本发明提供如下技术方案:一种基于PDR及移动目标进出点的轨迹追踪方法,包括PDR定位系统,所述PDR定位系统由智能手机、无线中继节点、WIFI路由、服务器、加速计,陀螺仪测量速度、角速度变化量组成,所述智能手机签由显示屏、带微控制器的蓝牙组成,所述无线中继节点由带微控制器的蓝牙和WIFI通信模块组成,所述服务器可通过WIFI路由和无线中继节点向智能手机发送信号功能,所述智能手机事先已安装定位导航APP软件,所述智能手机内部嵌入运动传感器、加速度传感器、方向传感器和地磁传感器,推测航迹通常认为行人运动为二维运动,基本原理是平面几何法,原理为,在采样时间很短的情况下,认为行人做直线运动,得知起始点的位置信息,就可以得到前一刻或下一刻精确的位置信息和采样时间内载体的位移量。
优选的,用户的初始位置P(x)={x(0),y(0)},由基于KWNN的Wi-Fi信号指纹定位算法得到,用户开始移动后,通过加速计,陀螺仪测量速度,角速度变化量,利用PDR定位算法估计每一步用户的坐标,直到用户前进预定步数m后,进行一次基于KWNN的Wi-Fi指纹定位,将Wi-Fi指纹定位结果作为用户当前结果,在随后的m步中,都基于上一次Wi-Fi指纹定位结果进行PDR定位计算即同时利用Wi-Fi指纹定位结果修正PDR算法定位误差,如此循环。
优选的,具体算法如下,向前推测,已知当前时刻的信息推算前一采样时刻的位置信息,假设已知第3个点的信息(x2,y2),推位计算第2个点(x1,y1)位置信息,可以得到第1个点的位置信息(x0,y0)。
优选的,利用Wi-Fi指纹定位结果修正PDR算法定位误差,能够有效约束误差的积累,其具体计算流程如下:
使用Pt表示用户时刻t所处的真实位置,Pt={xt,yt},Pt,PDR和Pt,WiFi分别表示在该时刻使用PDR定位算法和Wi-Fi指纹定位算法得到的结果;
假设t时刻位置Pt,WiFi已通过Wi-Fi信号指纹定位算法得到,在接下来的m步中,使用PDR定位算法进行位置估计;假设步长为l,得到:
角度定义如下:
其中,βt由传感器获得,表示运动方向变化量;在m步后,可以计算m步移动的距离与转角其中,“||||”表示欧几里得距离;使用下列方程更新用户步长,用于后续PDR定位:
PDR周期性的使用Wi-Fi定位进行修正能够有效约束误差的积累。
优选的,采用多线程同步和异步机制,主要有存储数据线程、定位算法线程、航迹绘制线程。每10ms采集传感器数据一次,进入存储数据线程,把采集的数据存储在本地磁盘,用于分析数据变化,采集的数据每60组进行一次定位,进入定位算法线程,进行本文前述的航位推测,当定位发生更新时,进入航迹绘制线程,在手持设备界面上进行航迹的绘制,高亮显示定位点。
与现有技术相比,本发明的有益效果如下:
本发明的定位方法采用无线信号强度测距、行人航位推测,通过WIFI路由和无线中继节点向智能手机,该定位法定位误差小,不会产生积累误差,信号稳定,定位准确,本发明计算过程中,不需要假设各类误差分布,也不需要对误差模型参数进行估计,适用范围较广。通过智能手机上的各种传感器,传输数据,通过数学模型进行计算,不需要修改现有信号指纹数据库,也不要需要频繁更新信号数据库,可用性较好。设备要求低,普通智能手机就包含了实现发明所需的所有传感器,现有Wi-Fi接入点就能作为信号发射装置使用,用户不需要购买特殊传感设备,容易推广。
附图说明
图1为本发明一种基于PDR及移动目标进出点的轨迹追踪方法数据偏差模型示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
请参阅图1,本实用发明提供一种技术方案:一种基于PDR及移动目标进出点的轨迹追踪方法,包括PDR定位系统,所述PDR定位系统由智能手机、无线中继节点、WIFI路由、服务器、加速计,陀螺仪测量速度、角速度变化量组成,所述智能手机签由显示屏、带微控制器的蓝牙组成,所述无线中继节点由带微控制器的蓝牙和WIFI通信模块组成,所述服务器可通过WIFI路由和无线中继节点向智能手机发送信号功能,所述智能手机事先已安装定位导航APP软件,所述智能手机内部嵌入运动传感器、加速度传感器、方向传感器和地磁传感器,推测航迹通常认为行人运动为二维运动,基本原理是平面几何法,原理为,在采样时间很短的情况下,认为行人做直线运动,得知起始点的位置信息,就可以得到前一刻或下一刻精确的位置信息和采样时间内载体的位移量
实例1
通过步行100米为实例,通过以下公式进行修订:使用Pt表示用户时刻t所处的真实位置,Pt={xt,yt},Pt,PDR和Pt,WiFi分别表示在该时刻使用PDR定位算法和Wi-Fi指纹定位算法得到的结果;
假设t时刻位置Pt,WiFi已通过Wi-Fi信号指纹定位算法得到,在接下来的m步中,使用PDR定位算法进行位置估计;假设步长为l,得到:
角度定义如下:
其中,βt由传感器获得,表示运动方向变化量;在m步后,可以计算m步移动的距离与转角其中,||||表示欧几里得距离;使用下列方程更新用户步长,用于后续PDR定位:
步行速度 | 误差 | 误差百分比 |
7km/h | -3.95m | 3.95% |
5km/h | 2.84m | 2.84% |
3.5km/h | -2.03m | 2.03% |
实例2
通过步行300米为实例,通过以下公式进行修订:使用Pt表示用户时刻t所处的真实位置,Pt={xt,yt},Pt,PDR和Pt,WiFi分别表示在该时刻使用PDR定位算法和Wi-Fi指纹定位算法得到的结果;
假设t时刻位置Pt,WiFi已通过Wi-Fi信号指纹定位算法得到,在接下来的m步中,使用PDR定位算法进行位置估计;假设步长为l,得到:
角度定义如下:
其中,βt由传感器获得,表示运动方向变化量;在m步后,可以计算m步移动的距离与转角其中,||||表示欧几里得距离;使用下列方程更新用户步长,用于后续PDR定位:
步行速度 | 误差 | 误差百分比 |
7km/h | 8.43m | 2.81% |
5km/h | -7.65m | 2.55% |
3.5km/h | -6.22m | 2.07% |
工作原理:需要说明的是,本发明的定位方法采用无线信号强度测距、行人航位推测,通过WIFI路由和无线中继节点向智能手机,该定位法定位误差小,不会产生积累误差,信号稳定,定位准确,本发明计算过程中,不需要假设各类误差分布,也不需要对误差模型参数进行估计,适用范围较广。通过智能手机上的各种传感器,传输数据,通过数学模型进行计算,不需要修改现有信号指纹数据库,也不要需要频繁更新信号数据库,可用性较好。设备要求低,普通智能手机就包含了实现发明所需的所有传感器,现有Wi-Fi接入点就能作为信号发射装置使用,用户不需要购买特殊传感设备,容易推广。
最后应说明的是:以上所述仅为本发明的优选实施例而已,并不用于限制本发明,尽管参照前述实施例对本发明进行了详细的说明,对于本领域的技术人员来说,其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (5)
1.一种基于PDR及移动目标进出点的轨迹追踪方法,包括PDR定位系统,其特征在于:所述PDR定位系统由智能手机、无线中继节点、WIFI路由、服务器、加速计,陀螺仪测量速度、角速度变化量组成,所述智能手机签由显示屏、带微控制器的蓝牙组成,所述无线中继节点由带微控制器的蓝牙和WIFI通信模块组成,所述服务器可通过WIFI路由和无线中继节点向智能手机发送信号功能,所述智能手机事先已安装定位导航APP软件,所述智能手机内部嵌入运动传感器、加速度传感器、方向传感器和地磁传感器,推测航迹通常认为行人运动为二维运动,基本原理是平面几何法,原理为,在采样时间很短的情况下,认为行人做直线运动,得知起始点的位置信息,就可以得到前一刻或下一刻精确的位置信息和采样时间内载体的位移量。
2.根据权利要求1所述的一种基于PDR及移动目标进出点的轨迹追踪方法,其特征在于:用户的初始位置P(x)={x(0),y(0)},由基于KWNN的Wi-Fi信号指纹定位算法得到,用户开始移动后,通过加速计,陀螺仪测量速度,角速度变化量,利用PDR定位算法估计每一步用户的坐标,直到用户前进预定步数m后,进行一次基于KWNN的Wi-Fi指纹定位,将Wi-Fi指纹定位结果作为用户当前结果,在随后的m步中,都基于上一次Wi-Fi指纹定位结果进行PDR定位计算即同时利用Wi-Fi指纹定位结果修正PDR算法定位误差,如此循环。
3.根据权利要求2所述的一种基于PDR及移动目标进出点的轨迹追踪方法,其特征在于:具体算法如下,向前推测,已知当前时刻的信息推算前一采样时刻的位置信息,假设已知第3个点的信息(x2,y2),推位计算第2个点(x1,y1)位置信息,可以得到第1个点的位置信息(x0,y0)。
4.根据权利要求3所述的一种基于PDR及移动目标进出点的轨迹追踪方法,其特征在于:利用Wi-Fi指纹定位结果修正PDR算法定位误差,能够有效约束误差的积累,其具体计算流程如下:
使用Pt表示用户时刻t所处的真实位置,Pt={xt,yt},Pt,PDR和Pt,WiFi分别表示在该时刻使用PDR定位算法和Wi-Fi指纹定位算法得到的结果;
假设t时刻位置Pt,WiFi已通过Wi-Fi信号指纹定位算法得到,在接下来的m步中,使用PDR定位算法进行位置估计;假设步长为l,得到:
角度定义如下:
其中,βt由传感器获得,表示运动方向变化量;在m步后,可以计算m步移动的距离与转角其中,“||||”表示欧几里得距离;使用下列方程更新用户步长,用于后续PDR定位:
PDR周期性的使用Wi-Fi定位进行修正能够有效约束误差的积累。
5.根据权利要求2、3和4所述的一种基于PDR及移动目标进出点的轨迹追踪方法,其特征在于:采用多线程同步和异步机制,主要有存储数据线程、定位算法线程、航迹绘制线程。每10ms采集传感器数据一次,进入存储数据线程,把采集的数据存储在本地磁盘,用于分析数据变化,采集的数据每60组进行一次定位,进入定位算法线程,进行本文前述的航位推测,当定位发生更新时,进入航迹绘制线程,在手持设备界面上进行航迹的绘制,高亮显示定位点。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710574518.XA CN107504968A (zh) | 2017-07-14 | 2017-07-14 | 一种基于pdr及移动目标进出点的轨迹追踪方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710574518.XA CN107504968A (zh) | 2017-07-14 | 2017-07-14 | 一种基于pdr及移动目标进出点的轨迹追踪方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN107504968A true CN107504968A (zh) | 2017-12-22 |
Family
ID=60679907
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710574518.XA Pending CN107504968A (zh) | 2017-07-14 | 2017-07-14 | 一种基于pdr及移动目标进出点的轨迹追踪方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107504968A (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108632761A (zh) * | 2018-04-20 | 2018-10-09 | 西安交通大学 | 一种基于粒子滤波算法的室内定位方法 |
CN110300385A (zh) * | 2019-07-09 | 2019-10-01 | 桂林理工大学 | 一种基于自适应粒子滤波的室内定位方法 |
CN111277946A (zh) * | 2018-12-04 | 2020-06-12 | 重庆邮电大学 | 一种蓝牙室内定位系统中指纹库自适应更新方法 |
CN113466789A (zh) * | 2021-09-06 | 2021-10-01 | 宏景科技股份有限公司 | 一种室内定位方法、系统、计算机设备及存储介质 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104655137A (zh) * | 2015-03-05 | 2015-05-27 | 中国人民解放军国防科学技术大学 | 行人航迹推测辅助的Wi-Fi信号指纹定位算法 |
CN105115487A (zh) * | 2015-05-18 | 2015-12-02 | 陈希 | 一种基于信息融合的超市内定位导航方法 |
-
2017
- 2017-07-14 CN CN201710574518.XA patent/CN107504968A/zh active Pending
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104655137A (zh) * | 2015-03-05 | 2015-05-27 | 中国人民解放军国防科学技术大学 | 行人航迹推测辅助的Wi-Fi信号指纹定位算法 |
CN105115487A (zh) * | 2015-05-18 | 2015-12-02 | 陈希 | 一种基于信息融合的超市内定位导航方法 |
Non-Patent Citations (1)
Title |
---|
宋敏,等: "室内定位航位推测算法的研究与实现", 《计算机工程》 * |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108632761A (zh) * | 2018-04-20 | 2018-10-09 | 西安交通大学 | 一种基于粒子滤波算法的室内定位方法 |
CN111277946A (zh) * | 2018-12-04 | 2020-06-12 | 重庆邮电大学 | 一种蓝牙室内定位系统中指纹库自适应更新方法 |
CN110300385A (zh) * | 2019-07-09 | 2019-10-01 | 桂林理工大学 | 一种基于自适应粒子滤波的室内定位方法 |
CN113466789A (zh) * | 2021-09-06 | 2021-10-01 | 宏景科技股份有限公司 | 一种室内定位方法、系统、计算机设备及存储介质 |
CN113466789B (zh) * | 2021-09-06 | 2021-11-26 | 宏景科技股份有限公司 | 一种室内定位方法、系统、计算机设备及存储介质 |
WO2023029576A1 (zh) * | 2021-09-06 | 2023-03-09 | 宏景科技股份有限公司 | 一种室内定位方法、系统、计算机设备及存储介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Zhou et al. | Activity sequence-based indoor pedestrian localization using smartphones | |
CN105115487B (zh) | 一种基于信息融合的超市内定位导航方法 | |
CN102419180B (zh) | 一种基于惯性导航系统和wifi的室内定位方法 | |
US9116000B2 (en) | Map-assisted sensor-based positioning of mobile devices | |
CN107504968A (zh) | 一种基于pdr及移动目标进出点的轨迹追踪方法 | |
CN107830862A (zh) | 一种基于智能手机的室内定位行人追踪的方法 | |
CN107179079A (zh) | 基于pdr与地磁融合的室内定位方法 | |
CN106370189A (zh) | 一种基于多传感器融合的室内导航装置及方法 | |
CN103884337A (zh) | 多姿态步距校正定位系统与方法 | |
CN104977003A (zh) | 基于共享轨迹的室内寻人方法、云端服务器及系统 | |
CN103561462A (zh) | 一种完全基于智能移动终端平台的室内定位系统和方法 | |
CN102879003A (zh) | 基于gps终端的面向车辆位置跟踪的地图匹配方法 | |
You et al. | Hybrid indoor positioning system for pedestrians with swinging arms based on smartphone IMU and RSSI of BLE | |
Bao et al. | An indoor dead-reckoning algorithm with map matching | |
Yu et al. | AZUPT: Adaptive zero velocity update based on neural networks for pedestrian tracking | |
CN103776442B (zh) | 区域无线定位及微捷联惯导组合系统的定位方法 | |
Huang et al. | Smartphone-based indoor position and orientation tracking fusing inertial and magnetic sensing | |
CN106606407A (zh) | 一种室内高精度盲人导航系统 | |
CN109708631A (zh) | 一种基于手机模态识别的行人导航航向修正方法 | |
CN104634345A (zh) | 一种自适应步长的室内轨迹追踪方法 | |
CN102721416B (zh) | 一种定位的方法和移动终端 | |
JP2014013202A (ja) | 慣性航法装置及びプログラム | |
Qian et al. | RPNOS: Reliable pedestrian navigation on a smartphone | |
CN106969772A (zh) | 一种基于手机平台的导盲犬方法 | |
Saadatzadeh et al. | An improvement in smartphone-based 3D indoor positioning using an effective map matching method |
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: 20171222 |