CN104197932A - 基于人类行为学的位置跟踪方法 - Google Patents
基于人类行为学的位置跟踪方法 Download PDFInfo
- Publication number
- CN104197932A CN104197932A CN201410503291.6A CN201410503291A CN104197932A CN 104197932 A CN104197932 A CN 104197932A CN 201410503291 A CN201410503291 A CN 201410503291A CN 104197932 A CN104197932 A CN 104197932A
- Authority
- CN
- China
- Prior art keywords
- motion
- positioning result
- epsiv
- terminals
- final 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.)
- Granted
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
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar Systems Or Details Thereof (AREA)
- Feedback Control In General (AREA)
Abstract
本发明涉及一种基于人类行为学的位置跟踪方法。现有跟踪方法中使用粒子滤波计算时所需样本数量大,算法的复杂度高,导致的硬件要求高的缺点。本发明组成包括:通过定位算法按小于传感器采集周期的定位间隔时间T获取运动终端的当前原始未修正定位结果;通过加速度传感器和方向传感器获取运动终端的运动参数;对获得的运动参数进行判断区分,以确定运动终端要进行的三种修正模式:再将上一次存储记录的最终定位结果作为前一时刻的最终定位结果,结合获取的运动终端的当前原始未修正定位结果进行静止修正模式的定位修正、运动修正模式的定位修正或转弯修正模式的定位修正;输出修正模式获得的修正后最终定位结果;存储记录输出的修正后最终定位结果。本发明用于运动终端位置跟踪。
Description
技术领域
本发明涉及一种基于人类行为学的位置跟踪方法。
背景技术
现有的跟踪方法中使用较多的是滤波与地图匹配。滤波是通过对运动概率的分析得到运动趋势,从而对定位结果进行修正,而地图匹配是根据地图信息对定位结果不符合的点进行剔除。
滤波中应用较多的是粒子滤波,利用粒子集来表示概率,可以用在任何形式的状态空间模型上。其核心思想是通过从后验概率中抽取的随机状态粒子来表达其分布,是一种顺序重要性采样法。粒子滤波法是指通过寻找一组在状态空间传播的随机样本对概率密度函数进行近似,以样本均值代替积分运算,从而获得状态最小方差分布的过程。
但粒子滤波计算时需要用大量的样本数量才能很好地近似系统的后验概率密度。面临的环境越复杂,描述后验概率分布所需要的样本数量就越多,算法的复杂度就越高。较大的计算导致对于硬件的要求较高,因此不利于在实际中应用。地图匹配和滤波过程是各自独立的,又增加了额外计算量。
发明内容
本发明的目的是为了解决现有跟踪方法中使用粒子滤波计算时所需样本数量大,算法的复杂度高,导致的硬件要求高的缺点,而提出的一种基于人类行为学的位置跟踪方法。
一种基于人类行为学的位置跟踪方法,所述位置跟踪方法通过以下步骤实现:
步骤一、通过定位算法按小于传感器采集周期的定位间隔时间T获取运动终端的当前原始未修正定位结果;
步骤二、通过加速度传感器和方向传感器获取运动终端的运动参数;
步骤三、对步骤二获得的运动参数进行判断区分,以确定运动终端要进行的三种修正模式:
当加速度传感器获得的运动终端的三轴坐标参数值的平方和小于0.04时,判断运动终端的当前运动状态为静止状态,将上一次存储记录的最终定位结果作为前一时刻的最终定位结果,结合步骤一获取的运动终端的当前原始未修正定位结果进行静止修正模式的定位修正;或
当加速度传感器获得的运动终端的三轴坐标参数值的平方和大于0.16时,判断运动终端的当前运动状态为运动状态,将上一次存储记录的最终定位结果作为前一时刻的最终定位结果,结合步骤一获取的运动终端的当前原始未修正定位结果进行运动修正模式的定位修正;或
当方向传感器获得的运动终端的前后两次参数值的差值大于90时,判断运动终端的当前运动状态为转弯状态,将上一次存储记录的最终定位结果作为前一时刻的最终定位结果,结合步骤一获取的运动终端的当前原始未修正定位结果进行转弯修正模式的定位修正;
步骤四、输出步骤三中修正模式获得的修正后最终定位结果;
步骤五、存储记录步骤四输出的修正后最终定位结果。
本发明的有益效果:
本发明是在人类行为的基础上,将前一时刻记录的最终定位结果与通过传感器获得的运动终端的当前原始未修正定位结果相结合,完成三种定位修正静止过程,以达到:静止修正将定位结果限制在以前一次定位结果为圆心的圆中、运动修正将定位结果限制在以前一次定位结果为圆心的半圆中、转弯修正将转弯处位置进行校正,完成运动终端位置计算过程,实现精确的位置跟踪。并将每次修正之后的定位结果记录用于下一次的定位修正使用,实现连续位置确认。
本发明方法是在符合人类行为学的算法约束,具有将滤波与地图匹配一体化,提高定位精度、平滑定位轨迹,由静止修正模式的修正过程用公式一、运动修正模式具体修正过程用公式二以及转弯修正模式具体定位修正过程用公式三可知,在进行一次定位时,只需要进行36次加法运算和14次乘法运算,相较于粒子滤波来说系统计算量降低了50%以上,同时也降低了对硬件性能的要求,间接体现了降低运算成本的好处。
附图说明
图1为本发明涉及的计算流程示意图;
图2为利用本发明方法进行一次定位时的定位结果示意图;图中横坐标表示定位误差,单位为米,纵坐标表示定位误差所占百分比;
图3为本发明涉及的实施例一的定位结果示意图。
具体实施方式
具体实施方式一:本实施方式的基于人类行为学的位置跟踪方法,所述人类行为学主要体现为人行走时不倒退的特点,所述位置跟踪方法通过以下步骤实现:
步骤一、通过定位算法按小于传感器采集周期的定位间隔时间T获取运动终端的当前原始未修正定位结果;
步骤二、通过加速度传感器和方向传感器获取运动终端的运动参数;
步骤三、对步骤二获得的运动参数进行判断区分,以确定运动终端要进行的三种修正模式:
当加速度传感器获得的运动终端的三轴坐标参数值的平方和小于0.04时,判断运动终端的当前运动状态为静止状态,将上一次存储记录的最终定位结果作为前一时刻的最终定位结果,结合步骤一获取的运动终端的当前原始未修正定位结果进行静止修正模式的定位修正;或
当加速度传感器获得的运动终端的三轴坐标参数值的平方和大于0.16时,判断运动终端的当前运动状态为运动状态,将上一次存储记录的最终定位结果作为前一时刻的最终定位结果,结合步骤一获取的运动终端的当前原始未修正定位结果进行运动修正模式的定位修正;或
当方向传感器获得的运动终端的前后两次参数值的差值大于90时,判断运动终端的当前运动状态为转弯状态,将上一次存储记录的最终定位结果作为前一时刻的最终定位结果,结合步骤一获取的运动终端的当前原始未修正定位结果进行转弯修正模式的定位修正;
步骤四、输出步骤三中修正模式获得的修正后最终定位结果;
步骤五、存储记录步骤四输出的修正后最终定位结果。
其中转弯修正的优先级高于其他两种修正。
具体实施方式二:
与具体实施方式一不同的是,本实施方式的基于人类行为学的位置跟踪方法,步骤三中所述静止修正模式具体定位修正过程为:在测试场区建立二维坐标系,其坐标轴分别为X轴和Y轴,
当运动终端处于静止状态,由加速度传感器参数判断是否静止,其当前原始未修正定位结果应与前一时刻的最终定位结果基本吻合,为弥补前一时刻的最终定位结果可能存在的误差,因此对当前原始未修正定位结果进行具有余量的静止修正模式的修正过程;令前一时刻的最终定位结果为Xn-1,Yn-1,令当前原始未修正定位结果为x,y,通过公式一:
具体实施方式三:
与具体实施方式一或二不同的是,本实施方式的基于人类行为学的位置跟踪方法,步骤三中所述运动修正模式具体修正过程为:在测试场区建立二维坐标系中,其坐标轴分别为X轴和Y轴,
当运动终端处于运动状态,其当前原始未修正定位结果应在前一时刻的最终定位结果的运动方向的前方,基于人类行为的平均移动速度因素,令前一时刻的最终定位结果为Xn-1,Yn-1,令当前原始未修正定位结果为x,y,当运动终端沿X轴方向或Y轴方向运动时通过公式二:
具体实施方式四:
与具体实施方式三不同的是,本实施方式的基于人类行为学的位置跟踪方法,步骤三中所述转弯修正模式具体定位修正过程为:在测试场区建立二维坐标系中,其坐标轴分别为X轴和Y轴,
当运动终端处于转弯状态,根据数组ak,bk中存储记录的所有路口转弯点的坐标,令前一时刻的最终定位结果为Xn-1,Yn-1,令当前原始未修正定位结果为x,y,利用公式三:
具体实施方式五:
与具体实施方式一、二或四不同的是,本实施方式的基于人类行为学的位置跟踪方法,还需获得所述运动终端的行进速度,所述行进速度包括低速运动模式和高速运动模式;所述低速运动模式包括人步行或者人静止;所述高速运动模式为车载运动。
结合上述公式一、公式二、公式三可知,在进行一次定位时进行了36次加法运算和14次乘法运算,具体定位结果如图2所示,其中实线为运动终端于低速运动模式时的定位精度CDF图,虚线为运动终端于高速运动模式时的定位精度CDF图。
具体实施方式六:
与具体实施方式一、二或四不同的是,本实施方式的基于人类行为学的位置跟踪方法,步骤一所述定位间隔时间T为1秒。
具体实施方式七:
根据权利要求1、2、4或6所述基于人类行为学的位置跟踪方法,其特征在于:步骤一所述定位间隔时间T为1秒。
具体实施方式八:
根据权利要求7所述基于人类行为学的位置跟踪方法,其特征在于:步骤一所述定位算法为KNN定位方法或者三角定位方法。
实施例一:
以基于安卓手机终端的WLAN指纹定位系统为例,按运动终端的行进速度将定位分为高速运动模式和低速运动模式两种模式,低速运动模式是指人步行或者静止,高速运动模式是指车载运动。根据运动终端的行进速度模式不同,设置不同限制参数。设定手机的定位间隔时间T为1秒,设手机每次返回的定位结果间隔为1秒,低速运动模式下,令ε1=3m,ε2=0,ε3=5m,ε4=1m,ε5=10m;高速运动模式下,令ε1=5m,ε2=5m,ε3=15m,ε4=2m,ε5=10m,结合
静止修正模式的修正过程用公式一:
运动修正模式具体修正过程用公式二: 以及
转弯修正模式具体定位修正过程用公式三: 按照符合人类行为模型的方式,即不倒退走或横向移动,计算沿着道路运动的运动终端的位置,得定位结果如图3所示,其中黑色点为低速运动模式模式,白色点为高速运动模式模式。
Claims (8)
1.一种基于人类行为学的位置跟踪方法,其特征在于:所述位置跟踪方法通过以下步骤实现:
步骤一、通过定位算法按小于传感器采集周期的定位间隔时间T获取运动终端的当前原始未修正定位结果;
步骤二、通过加速度传感器和方向传感器获取运动终端的运动参数;
步骤三、对步骤二获得的运动参数进行判断区分,以确定运动终端要进行的三种修正模式:
当加速度传感器获得的运动终端的三轴坐标参数值的平方和小于0.04时,判断运动终端的当前运动状态为静止状态,将上一次存储记录的最终定位结果作为前一时刻的最终定位结果,结合步骤一获取的运动终端的当前原始未修正定位结果进行静止修正模式的定位修正;或
当加速度传感器获得的运动终端的三轴坐标参数值的平方和大于0.16时,判断运动终端的当前运动状态为运动状态,将上一次存储记录的最终定位结果作为前一时刻的最终定位结果,结合步骤一获取的运动终端的当前原始未修正定位结果进行运动修正模式的定位修正;或
当方向传感器获得的运动终端的前后两次参数值的差值大于90时,判断运动终端的当前运动状态为转弯状态,将上一次存储记录的最终定位结果作为前一时刻的最终定位结果,结合步骤一获取的运动终端的当前原始未修正定位结果进行转弯修正模式的定位修正;
步骤四、输出步骤三中修正模式获得的修正后最终定位结果;
步骤五、存储记录步骤四输出的修正后最终定位结果。
2.根据权利要求1所述基于人类行为学的位置跟踪方法,其特征在于:步骤三中所述静止修正模式具体定位修正过程为:在测试场区建立二维坐标系中,其坐标轴分别为X轴和Y轴,
当运动终端处于静止状态,其当前原始未修正定位结果应与前一时刻的最终定位结果基本吻合,为弥补前一时刻的最终定位结果可能存在的误差,因此对当前原始未修正定位结果进行具有余量的静止修正模式的修正过程;令前一时刻的最终定位结果为Xn-1,Yn-1,令当前原始未修正定位结果为x,y,通过公式一:
3.根据权利要求1或2所述基于人类行为学的位置跟踪方法,其特征在于:步骤三中所述运动修正模式具体修正过程为:在测试场区建立二维坐标系中,其坐标轴分别为X轴和Y轴,
当运动终端处于运动状态,其当前原始未修正定位结果应在前一时刻的最终定位结果的运动方向的前方,基于人类行为的平均移动速度因素,令前一时刻的最终定位结果为Xn-1,Yn-1,令当前原始未修正定位结果为x,y,当运动终端沿X轴方向或Y轴方向运动时通过公式二:
4.根据权利要求3所述基于人类行为学的位置跟踪方法,其特征在于:步骤三中所述转弯修正模式具体定位修正过程为:在测试场区建立二维坐标系中,其坐标轴分别为X轴和Y轴,
当运动终端处于转弯状态,根据数组ak,bk中存储记录的所有路口转弯点的坐标,令前一时刻的最终定位结果为Xn-1,Yn-1,令当前原始未修正定位结果为x,y,利用公式三: 进行定位修正获得修正后最终定位结果Xn,Yn;其中,k为转弯点的个数,ε5为限制参数五,限制参数五的大小由运动终端种类及运动速度决定,主要起修正作用。
5.根据权利要求1、2或4所述基于人类行为学的位置跟踪方法,其特征在于:还需获得所述运动终端的行进速度,所述行进速度包括低速运动模式和高速运动模式;所述低速运动模式包括人步行或者人静止;所述高速运动模式为车载运动。
6.根据权利要求5所述基于人类行为学的位置跟踪方法,其特征在于:步骤一所述定位间隔时间T为0.5-1.5秒。
7.根据权利要求1、2、4或6所述基于人类行为学的位置跟踪方法,其特征在于:步骤一所述定位间隔时间T为1秒。
8.根据权利要求7所述基于人类行为学的位置跟踪方法,其特征在于:步骤一所述定位算法为KNN定位方法或者三角定位方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410503291.6A CN104197932B (zh) | 2014-09-26 | 2014-09-26 | 基于人类行为学的位置跟踪方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410503291.6A CN104197932B (zh) | 2014-09-26 | 2014-09-26 | 基于人类行为学的位置跟踪方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104197932A true CN104197932A (zh) | 2014-12-10 |
CN104197932B CN104197932B (zh) | 2017-02-15 |
Family
ID=52083260
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410503291.6A Active CN104197932B (zh) | 2014-09-26 | 2014-09-26 | 基于人类行为学的位置跟踪方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104197932B (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104613964A (zh) * | 2015-01-30 | 2015-05-13 | 中国科学院上海高等研究院 | 一种跟踪脚部运动特征的步行者定位方法及系统 |
WO2017173977A1 (zh) * | 2016-04-05 | 2017-10-12 | 中兴通讯股份有限公司 | 一种移动终端目标跟踪方法、装置和移动终端 |
CN109031192A (zh) * | 2018-06-26 | 2018-12-18 | 北京永安信通科技股份有限公司 | 对象定位方法、对象定位装置和电子设备 |
CN109959379A (zh) * | 2019-02-13 | 2019-07-02 | 歌尔科技有限公司 | 定位方法及电子设备 |
CN110381910A (zh) * | 2017-03-29 | 2019-10-25 | 本田技研工业株式会社 | 步行支援系统、步行支援方法及步行支援程序 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101867943A (zh) * | 2010-06-23 | 2010-10-20 | 哈尔滨工业大学 | 基于粒子滤波算法的wlan室内跟踪方法 |
CN101977436A (zh) * | 2010-11-01 | 2011-02-16 | 哈尔滨工业大学 | 基于wlan室内定位的移动用户位置坐标修正方法 |
CN102798877A (zh) * | 2011-05-25 | 2012-11-28 | Csr科技控股公司 | 确定移动设备在人身上的位置的分层状况检测方法 |
US20130151146A1 (en) * | 2011-12-08 | 2013-06-13 | Csr Technology Inc. | Mini-Map-Matching for Navigation Systems |
-
2014
- 2014-09-26 CN CN201410503291.6A patent/CN104197932B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101867943A (zh) * | 2010-06-23 | 2010-10-20 | 哈尔滨工业大学 | 基于粒子滤波算法的wlan室内跟踪方法 |
CN101977436A (zh) * | 2010-11-01 | 2011-02-16 | 哈尔滨工业大学 | 基于wlan室内定位的移动用户位置坐标修正方法 |
CN102798877A (zh) * | 2011-05-25 | 2012-11-28 | Csr科技控股公司 | 确定移动设备在人身上的位置的分层状况检测方法 |
US20130151146A1 (en) * | 2011-12-08 | 2013-06-13 | Csr Technology Inc. | Mini-Map-Matching for Navigation Systems |
Non-Patent Citations (3)
Title |
---|
DOMINIK GUSENBAUER 等: "Self-Contained Indoor Positioning on Off-The-Shelf Mobile Devices", 《2010 INTERNATIONAL CONFERENCE ON INDOOR POSITIONING AND INDOOR NAVIGATION (IPIN)》 * |
周宝定 等: "用户行为感知辅助的室内行人定位", 《武汉大学学报 信息科学版》 * |
张世哲: "基于惯性传感器和WiFi的室内定位系统的设计与实现", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104613964A (zh) * | 2015-01-30 | 2015-05-13 | 中国科学院上海高等研究院 | 一种跟踪脚部运动特征的步行者定位方法及系统 |
WO2017173977A1 (zh) * | 2016-04-05 | 2017-10-12 | 中兴通讯股份有限公司 | 一种移动终端目标跟踪方法、装置和移动终端 |
CN110381910A (zh) * | 2017-03-29 | 2019-10-25 | 本田技研工业株式会社 | 步行支援系统、步行支援方法及步行支援程序 |
CN110381910B (zh) * | 2017-03-29 | 2021-08-10 | 本田技研工业株式会社 | 步行支援系统、步行支援方法及存储有步行支援程序的存储介质 |
US11571141B2 (en) | 2017-03-29 | 2023-02-07 | Honda Motor Co., Ltd. | Walking support system, walking support method, and walking support program |
CN109031192A (zh) * | 2018-06-26 | 2018-12-18 | 北京永安信通科技股份有限公司 | 对象定位方法、对象定位装置和电子设备 |
CN109959379A (zh) * | 2019-02-13 | 2019-07-02 | 歌尔科技有限公司 | 定位方法及电子设备 |
Also Published As
Publication number | Publication date |
---|---|
CN104197932B (zh) | 2017-02-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111009153B (zh) | 一种轨迹预测模型的训练方法、装置和设备 | |
CN104197932A (zh) | 基于人类行为学的位置跟踪方法 | |
CN111340797A (zh) | 一种激光雷达与双目相机数据融合检测方法及系统 | |
CN110345951B (zh) | 一种adas高精度地图的生成方法及装置 | |
CN111027430B (zh) | 一种面向无人车智能评估的交通场景复杂度计算方法 | |
CN111046767B (zh) | 一种基于单目图像的3d目标检测方法 | |
CN110378210A (zh) | 一种基于轻量化YOLOv3的车辆和车牌检测及长短焦融合测距方法 | |
CN110082779A (zh) | 一种基于3d激光雷达的车辆位姿定位方法及系统 | |
CN102063625B (zh) | 一种用于多视角下多目标追踪的改进型粒子滤波方法 | |
CN103227888A (zh) | 一种基于经验模式分解和多种评价准则的视频去抖动方法 | |
CN112578419B (zh) | 一种基于gru网络和卡尔曼滤波的gps数据重构方法 | |
CN104748735A (zh) | 基于智能终端的室内定位方法和设备 | |
CN113777952A (zh) | 一种实车与虚拟车交互映射的自动驾驶仿真测试方法 | |
EP4239596A1 (en) | Method and apparatus for detecting drivable area, mobile device and storage medium | |
CN109919051A (zh) | 一种用于视频图像处理的卷积神经网络加速方法 | |
CN117876397B (zh) | 一种基于多视角数据融合的桥梁构件三维点云分割方法 | |
CN107103136B (zh) | 一种基于距离场的轨道车辆轮轨接触点计算方法 | |
CN107504979A (zh) | 运动距离计算方法及装置及可穿戴设备 | |
CN103076023A (zh) | 一种步长计算方法和装置 | |
CN109916494B (zh) | 称重设备标定方法及装置 | |
CN114201890A (zh) | 一种高速公路异常事件场景库构建方法 | |
CN114444284A (zh) | 一种车端实时仿真场景道路底图生成方法及系统 | |
CN112287557A (zh) | 辅助驾驶仿真测试的雷达点云数据在环回放方法及系统 | |
CN116524758A (zh) | 一种自动驾驶中道路和场景的仿真测试方法及装置 | |
CN111723672A (zh) | 一种视频识别行车轨迹获取方法、装置及存储介质 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
TR01 | Transfer of patent right | ||
TR01 | Transfer of patent right |
Effective date of registration: 20200330 Address after: 150001 No. 118 West straight street, Nangang District, Heilongjiang, Harbin Patentee after: Harbin University of technology high tech Development Corporation Address before: 150001 Harbin, Nangang, West District, large straight street, No. 92 Patentee before: HARBIN INSTITUTE OF TECHNOLOGY |