[发明专利]基于人类行为学的位置跟踪方法

说明书

技术领域

本发明涉及一种基于人类行为学的位置跟踪方法。

背景技术

现有的跟踪方法中使用较多的是滤波与地图匹配。滤波是通过对运动概率的分析得到运动趋势，从而对定位结果进行修正，而地图匹配是根据地图信息对定位结果不符合的点进行剔除。

滤波中应用较多的是粒子滤波，利用粒子集来表示概率，可以用在任何形式的状态空间模型上。其核心思想是通过从后验概率中抽取的随机状态粒子来表达其分布，是一种顺序重要性采样法。粒子滤波法是指通过寻找一组在状态空间传播的随机样本对概率密度函数进行近似，以样本均值代替积分运算，从而获得状态最小方差分布的过程。

但粒子滤波计算时需要用大量的样本数量才能很好地近似系统的后验概率密度。面临的环境越复杂，描述后验概率分布所需要的样本数量就越多，算法的复杂度就越高。较大的计算导致对于硬件的要求较高，因此不利于在实际中应用。地图匹配和滤波过程是各自独立的，又增加了额外计算量。

发明内容

本发明的目的是为了解决现有跟踪方法中使用粒子滤波计算时所需样本数量大，算法的复杂度高，导致的硬件要求高的缺点，而提出的一种基于人类行为学的位置跟踪方法。

一种基于人类行为学的位置跟踪方法，所述位置跟踪方法通过以下步骤实现：

步骤一、通过定位算法按小于传感器采集周期的定位间隔时间T获取运动终端的当前原始未修正定位结果；

步骤二、通过加速度传感器和方向传感器获取运动终端的运动参数；

步骤三、对步骤二获得的运动参数进行判断区分，以确定运动终端要进行的三种修正模式：

当加速度传感器获得的运动终端的三轴坐标参数值的平方和小于0.04时，判断运动终端的当前运动状态为静止状态，将上一次存储记录的最终定位结果作为前一时刻的最终定位结果，结合步骤一获取的运动终端的当前原始未修正定位结果进行静止修正模式的定位修正；或

当加速度传感器获得的运动终端的三轴坐标参数值的平方和大于0.16时，判断运动终端的当前运动状态为运动状态，将上一次存储记录的最终定位结果作为前一时刻的最终定位结果，结合步骤一获取的运动终端的当前原始未修正定位结果进行运动修正模式的定位修正；或

当方向传感器获得的运动终端的前后两次参数值的差值大于90时，判断运动终端的当前运动状态为转弯状态，将上一次存储记录的最终定位结果作为前一时刻的最终定位结果，结合步骤一获取的运动终端的当前原始未修正定位结果进行转弯修正模式的定位修正；

步骤四、输出步骤三中修正模式获得的修正后最终定位结果；

步骤五、存储记录步骤四输出的修正后最终定位结果。

本发明的有益效果：

本发明是在人类行为的基础上，将前一时刻记录的最终定位结果与通过传感器获得的运动终端的当前原始未修正定位结果相结合，完成三种定位修正静止过程，以达到：静止修正将定位结果限制在以前一次定位结果为圆心的圆中、运动修正将定位结果限制在以前一次定位结果为圆心的半圆中、转弯修正将转弯处位置进行校正，完成运动终端位置计算过程，实现精确的位置跟踪。并将每次修正之后的定位结果记录用于下一次的定位修正使用，实现连续位置确认。

本发明方法是在符合人类行为学的算法约束，具有将滤波与地图匹配一体化，提高定位精度、平滑定位轨迹，由静止修正模式的修正过程用公式一、运动修正模式具体修正过程用公式二以及转弯修正模式具体定位修正过程用公式三可知，在进行一次定位时，只需要进行36次加法运算和14次乘法运算，相较于粒子滤波来说系统计算量降低了50％以上，同时也降低了对硬件性能的要求，间接体现了降低运算成本的好处。

附图说明

图1为本发明涉及的计算流程示意图；

图2为利用本发明方法进行一次定位时的定位结果示意图；图中横坐标表示定位误差，单位为米，纵坐标表示定位误差所占百分比；

图3为本发明涉及的实施例一的定位结果示意图。

具体实施方式

具体实施方式一：本实施方式的基于人类行为学的位置跟踪方法，所述人类行为学主要体现为人行走时不倒退的特点，所述位置跟踪方法通过以下步骤实现：

步骤一、通过定位算法按小于传感器采集周期的定位间隔时间T获取运动终端的当前原始未修正定位结果；

步骤二、通过加速度传感器和方向传感器获取运动终端的运动参数；

步骤三、对步骤二获得的运动参数进行判断区分，以确定运动终端要进行的三种修正模式：