CN108537101B - 一种基于状态识别的行人定位方法 - Google Patents

一种基于状态识别的行人定位方法 Download PDF

Info

Publication number
CN108537101B
CN108537101B CN201810010536.XA CN201810010536A CN108537101B CN 108537101 B CN108537101 B CN 108537101B CN 201810010536 A CN201810010536 A CN 201810010536A CN 108537101 B CN108537101 B CN 108537101B
Authority
CN
China
Prior art keywords
data
state
pedestrian
data segment
new
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
CN201810010536.XA
Other languages
English (en)
Other versions
CN108537101A (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.)
Zhejiang University ZJU
Original Assignee
Zhejiang University ZJU
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 Zhejiang University ZJU filed Critical Zhejiang University ZJU
Priority to CN201810010536.XA priority Critical patent/CN108537101B/zh
Publication of CN108537101A publication Critical patent/CN108537101A/zh
Application granted granted Critical
Publication of CN108537101B publication Critical patent/CN108537101B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06VIMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V40/00Recognition of biometric, human-related or animal-related patterns in image or video data
    • G06V40/20Movements or behaviour, e.g. gesture recognition
    • 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/18Stabilised platforms, e.g. by gyroscope
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F18/00Pattern recognition
    • G06F18/20Analysing
    • G06F18/24Classification techniques

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Remote Sensing (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Theoretical Computer Science (AREA)
  • General Physics & Mathematics (AREA)
  • Data Mining & Analysis (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • General Engineering & Computer Science (AREA)
  • Psychiatry (AREA)
  • Evolutionary Biology (AREA)
  • Bioinformatics & Computational Biology (AREA)
  • Bioinformatics & Cheminformatics (AREA)
  • Health & Medical Sciences (AREA)
  • General Health & Medical Sciences (AREA)
  • Evolutionary Computation (AREA)
  • Social Psychology (AREA)
  • Human Computer Interaction (AREA)
  • Multimedia (AREA)
  • Artificial Intelligence (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Automation & Control Theory (AREA)
  • Navigation (AREA)

Abstract

一种基于状态识别的行人定位方法,包括以下步骤:步骤1,行人执行多状态的运动,通过移动设备内置传感器采集多状态的原始数据,训练多状态分类器C;步骤2,行人执行待定位的运动,通过移动设备内置传感器采集待定位的原始数据;步骤3,对移动设备内置传感器采集的待定位的原始数据进行数据分割、数据预处理,获得数据段;步骤4,利用多状态分类器C,识别出该数据段的状态A;步骤5,在该数据段内,基于识别的状态A,采用合适的航位推算模型,更新行人的三维定位。本发明提供了一种稳定性较好、定位精度较高的基于状态识别的行人定位方法。

Description

一种基于状态识别的行人定位方法
技术领域
本发明涉及导航定位技术领域,具体来说涉及一种基于状态识别的行人定位方法。
背景技术
行人定位技术主要用于在室内外环境中,利用或不利用基础设施帮助行人进行定位,能够在诸如老人小孩的安全监测、地震火灾中救援人员的准确定位、大型建筑如医院机场内的导航、基于位置的社交服务等领域提供技术支持,因此具有重要的应用价值和研究意义。
在室外环境中,全球定位系统(Global Positioning System,GPS)是一种主要的定位设备,但在室内环境和部分室外城市环境中,受建筑物遮挡的影响,GPS信号会受到干扰甚至阻断,无法提供稳定、准确的定位。
行人航位推算是一种基于已知的初始位置,通过步伐检测、步长估计、方位估计,逐步更新定位的技术。实际情况中,地面条件较为复杂,除平地外,楼梯、斜坡也很常见。相关研究表明,在不同的地面条件下,行人的运动姿势具有较大的差异性。因此当不区别状态采用同一种行人航位推算模型时,会导致定位精度较低。
发明内容
为了克服已有行人定位方法在多场景下定位精度较低的不足,本发明提供了一种适应多场景的定位精度较高的基于状态识别的行人定位方法,能够识别行人运动的状态,包括平地行走、上坡、下坡、上楼梯、下楼梯、站立等状态,根据状态采用合适的航位推算模型,获得定位,以得到室内外均适用的高精度的行人定位技术。
本发明解决其技术问题所采用的技术方案是:
一种基于状态识别的行人定位方法,包括以下步骤:
步骤1,行人执行多状态的运动,通过移动设备内置传感器采集多状态的原始数据,训练多状态分类器C;
步骤2,行人执行待定位的运动,通过移动设备内置传感器采集待定位的原始数据;
步骤3,对移动设备内置传感器采集的待定位的原始数据进行数据分割、数据预处理,获得数据段;
步骤4,利用多状态分类器C,识别出该数据段的状态A;
步骤5,在该数据段内,基于识别的状态A,采用合适的航位推算模型,更新行人的三维定位。
进一步,在所述步骤1中,多状态分类器的训练步骤如下:
步骤1-1,将移动设备放置于裤子前侧口袋,利用移动设备内置的加速度计、重力计、陀螺仪和磁力计,分别采集平地行走、上坡、下坡、上楼梯、下楼梯、站立状态下的传感器数据,得到训练集原始数据的集合
Figure BDA0001540138210000021
采样点数为Nraw,并标记真实的状态,其中,ax,ay,az分别为加速度在设备坐标系x,y,z轴上的分量,gx,gy,gz分别为重力加速度在设备坐标系x,y,z轴上的分量,
Figure BDA0001540138210000022
分别为移动设备的俯仰角、偏航角、滚转角,
Figure BDA0001540138210000023
为移动设备磁力计读取的方位角;
步骤1-2,将训练集原始数据的集合
Figure BDA0001540138210000024
中的数据,利用基于步频的滑动窗口做数据分割,窗口长度为取决于行人步频的介于一个周期和两个周期之间的采样点数Nwin,相邻窗口的覆盖率为77,则每类新数据被分割成M个数据段:
Figure BDA0001540138210000025
得到训练集原始数据的数据段集合
Figure BDA0001540138210000031
步骤1-3,对训练集原始数据的数据段集合
Figure BDA0001540138210000032
中的数据段进行预处理,得到预处理数据的数据段,预处理数据包括设备坐标系中加速度的模、世界坐标系中的垂直加速度和水平加速度、腿部张角4类数据,预处理方式如下:
设备坐标系中加速度的模aN
Figure BDA0001540138210000033
为了获得世界坐标系中的垂直加速度和水平加速度,首先,定义四元数:
Figure BDA0001540138210000034
标准化的四元数:
Figure BDA0001540138210000035
由标准化的四元数计算从设备坐标系到世界坐标系的旋转矩阵R:
Figure BDA0001540138210000036
从而得到加速度在世界坐标系x,y,z轴上的分量
Figure BDA0001540138210000037
Figure BDA0001540138210000038
则在世界坐标系中的垂直加速度aV
Figure BDA0001540138210000039
在世界坐标系中的水平加速度aH
Figure BDA00015401382100000310
腿部张角θ:
Figure BDA0001540138210000041
预处理数据的数据段与原始数据的数据段共同构成训练集新数据段的集合
Figure BDA0001540138210000042
步骤1-4,对训练集新数据段的集合
Figure BDA0001540138210000043
内的每个数据段进行特征提取,获得所有数据段对应的M×N的特征矩阵Ft=[f1,f2,...,fN],其中,N为特征的种类数,fi,(i=1,2,...,N)表示第i种特征的M×1的列向量;
步骤1-5,通过主成分分析法,得到特征矩阵Ft从高维到低维映射的转移矩阵T,进而低维特征矩阵
Figure BDA0001540138210000044
Figure BDA0001540138210000045
得到主成分表示的M×N′的低维特征矩阵
Figure BDA0001540138210000046
其中,N′为低维特征的种类数,f′i,(i=1,2,...,N′)表示第i种低维特征的M×1的列向量;
步骤1-6,把低维特征矩阵
Figure BDA0001540138210000047
中列向量f′i,(i=1,2,...,N′)的数值属性作为标准化参数P,如最大值和最小值,或均值和方差等,将f′i,(i=1,2,...,N′)标准化到区间[a,b],得到标准化的特征矩阵
Figure BDA0001540138210000048
其中,f′i,(i=1,2,...,N′)表示第i种标准化的低维特征的M×1的列向量;
步骤1-7,将标准化的特征矩阵
Figure BDA0001540138210000049
及真实的状态作为输入,利用多状态支持向量机算法,将多状态分类器拆分成一系列二元分类器,利用序列最小最优化算法计算二元分类器的最优解,训练得到多状态分类器C={C1,C2,...CI},I表示二元分类器的个数。
再进一步,在所述步骤2中,行人执行待定位的运动,将移动设备放置于裤子前侧口袋,采集移动设备内置的加速度计、重力计、陀螺仪和磁力计传感器的数据,得到待定位的原始数据的集合
Figure BDA00015401382100000410
更进一步,在所述步骤3中,对移动设备内置传感器采集的待定位的原始数据进行数据分割、数据预处理,获得数据段的步骤如下:
步骤3-1,当待定位的原始数据的集合Sraw中的每类数据达到Nwin个采样点,利用长度为Nwin的滑动窗口截断,得到待定位的原始数据的数据段Swin;否则,回到步骤2;
步骤3-2,对待定位的原始数据的数据段Swin执行步骤1-3,得到待定位的新数据段Snew
在所述步骤4中,利用多状态分类器C识别出该数据段的状态A的步骤如下:
步骤4-1,对步骤3获得的待定位的新数据段Snew,执行步骤1-4,得到特征矩阵F;
步骤4-2,利用步骤1-5中的转移矩阵T对特征矩阵F进行降维,得到低维的特征矩阵Fpca
Fpca=F×T;
步骤4-3,利用步骤1-6中的标准化参数P,对Fpca进行标准化,得到标准化的特征矩阵Fnorm
步骤4-4,利用步骤1-7得到的多状态分类器C,输入标准化的特征矩阵Fnorm,输出该数据段的状态A。
在所述步骤5中,在该数据段内,基于识别的状态A,采用航位推算模型,更新行人的三维定位的步骤如下:
步骤5-1,该步骤实现步伐检测,在待定位的新数据段Snew内,从未被定位过的采样点开始遍历,对腿部张角θ进行极值检测,获得极值
Figure BDA0001540138210000051
及其采样点索引
Figure BDA0001540138210000052
j表示当前极值的序号,利用极大值阈值TMAX、极小值阈值TMIN和最小间隔ΔN排除不符合要求的极值,获得有效极值
Figure BDA0001540138210000053
及其采样点索引
Figure BDA0001540138210000054
s表示当前有效极值的序号:当
Figure BDA0001540138210000061
大于TMAX且距离最近一个有效极值
Figure BDA0001540138210000062
的采样点间隔大于ΔN,则
Figure BDA0001540138210000063
视为有效极大值,或当
Figure BDA0001540138210000064
小于TMIN且距离最近一个有效极值
Figure BDA0001540138210000065
的采样点间隔大于ΔN,则
Figure BDA0001540138210000066
视为有效极小值,此时更新有效极值
Figure BDA0001540138210000067
及其采样点索引
Figure BDA0001540138210000068
当检测到一个腿部张角θ的有效极值时,即检测到一个步伐,新数据段Snew内的步数Nstep=Nstep+1;直到新数据段Snew内的采样点遍历结束,若检测到有效极值
Figure BDA0001540138210000069
及其采样点索引
Figure BDA00015401382100000610
(s=1,2,...,Nstep)时,执行步骤5-2,否则,执行步骤5-6;
步骤5-2,该步骤实现步长估计,在新数据段Snew内,选择适用于状态A的步长模型估计步长:当A={平地行走、上坡、下坡}时,利用行人腿长l、第s个有效极值
Figure BDA00015401382100000611
和上一个有效极值
Figure BDA00015401382100000612
及该步对应的地面坡度αs估计步长;当A={上楼梯、下楼梯}时,利用台阶的宽度wstair估计步长;当A={站立}时,步长为零;则第s步步长Ls
Figure BDA00015401382100000613
,(s=1,2,...,Nstep)
其中,αs=0表示平地,αs>0表不上坡,αs<0表示下坡;
步骤5-3,该步骤实现步高估计,在新数据段Snew内,选择适用于识别状态A的步高模型估计高度:当A={平地行走、上坡、下坡}时,利用第s步对应的地面坡度αs、步长Ls估计步高;当A={上楼梯、下楼梯}时,利用台阶的高度hstair估计步高,上楼梯时为正,下楼梯时为负;当A={站立}时,步高为零;则第s步步高Hs
Figure BDA00015401382100000614
步骤5-4,该步骤实现方位角估计,在新数据段Snew内,结合陀螺仪和磁力计确定方位,利用初始时刻磁力计获取的方位角
Figure BDA0001540138210000071
和磁偏角
Figure BDA0001540138210000072
校正陀螺仪的偏航角
Figure BDA0001540138210000073
得到在世界坐标系中相对于真北方向的绝对方位
Figure BDA0001540138210000074
Figure BDA0001540138210000075
第s步的方位角
Figure BDA0001540138210000076
取有效极值前后
Figure BDA0001540138210000077
个采样点的绝对方位
Figure BDA0001540138210000078
的均值:
Figure BDA0001540138210000079
步骤5-5,该步骤实现行人定位的更新,选择适用于识别状态A的三维位置更新模型,在世界坐标系中,基于位置更新前的行人定位(x0,y0,z0),新数据段Snew最终更新的位置
Figure BDA00015401382100000712
即为当前行人的定位:
Figure BDA00015401382100000710
其中,系数ks
Figure BDA00015401382100000711
步骤5-6,为了更新行人在下一个时刻的定位,保留原始数据的数据段Sraw中在采样点[Nwin×(1-η),Nwin]之间的原始数据,作为与下一个时刻的原始数据的数据段重合的部分,回到步骤2。
所述步骤1-6中,所述数值属性为最大值和最小值或均值和方差。
本发明的有益效果主要表现在:能够识别行人运动的状态,包括平地行走、上坡、下坡、上楼梯、下楼梯、站立等状态,根据状态采用航位推算模型,获得定位,以得到室内外均适用的高精度的行人定位技术。
附图说明
图1为本发明的训练多状态分类器的流程图;
图2为本发明的基于状态识别的行人定位方法的流程图;
图3为本发明实施例中室内的实验结果。
图4为本发明实施例中室外的实验结果。
具体实施方式
下面结合附图对本发明作进一步描述。
实施例1
参照图1~图4,一种基于状态识别的行人定位方法,包括以下步骤:
步骤1,行人执行多状态的运动,通过移动设备内置传感器采集多状态的原始数据,训练多状态分类器C;
步骤2,行人执行待定位的运动,通过移动设备内置传感器采集待定位的原始数据;
步骤3,对移动设备内置传感器采集的待定位的原始数据进行数据分割、数据预处理,获得数据段;
步骤4,利用多状态分类器C,识别出该数据段的状态A;
步骤5,在该数据段内,基于识别的状态A,采用合适的航位推算模型,更新行人的三维定位。
其中,所述步骤1的流程图如图1所示,多状态分类器的训练步骤如下:
步骤1-1,将移动设备放置于裤子前侧口袋,利用移动设备内置的加速度计、重力计、陀螺仪、磁力计等,分别采集平地行走、上坡、下坡、上楼梯、下楼梯、站立等状态下的传感器数据,得到训练集原始数据的集合
Figure BDA0001540138210000081
Figure BDA0001540138210000082
采样点数为Nraw,并标记真实的状态,其中,ax,ay,az分别为加速度在设备坐标系x,y,z轴上的分量,gx,gy,gz分别为重力加速度在设备坐标系x,y,z轴上的分量,
Figure BDA0001540138210000083
分别为移动设备的俯仰角、偏航角、滚转角,
Figure BDA0001540138210000091
为移动设备磁力计读取的方位角;
步骤1-2,将训练集原始数据的集合
Figure BDA0001540138210000092
中的数据,利用基于步频的滑动窗口做数据分割,窗口长度为取决于行人步频的介于一个周期和两个周期之间的采样点数Nwin,本实施例中,对于快速、正常、慢速三种步频的运动,Nw分别等于50、70、90,相邻窗口的覆盖率为η=50%,则每类新数据被分割成M个数据段:
Figure BDA0001540138210000093
得到训练集原始数据的数据段集合
Figure BDA0001540138210000094
步骤1-3,对训练集原始数据的数据段集合
Figure BDA0001540138210000095
中的数据段进行预处理,得到预处理数据的数据段,预处理数据包括设备坐标系中加速度的模、世界坐标系中的垂直加速度和水平加速度、腿部张角等4类数据,具体预处理方式如下:
设备坐标系中加速度的模aN
Figure BDA0001540138210000096
为了获得世界坐标系中的垂直加速度和水平加速度,首先,定义四元数:
Figure BDA0001540138210000097
标准化的四元数:
Figure BDA0001540138210000098
由标准化的四元数计算从设备坐标系到世界坐标系的旋转矩阵R:
Figure BDA0001540138210000099
从而得到加速度在世界坐标系x,y,z轴上的分量
Figure BDA00015401382100000910
Figure BDA0001540138210000101
则在世界坐标系中的垂直加速度aV
Figure BDA0001540138210000102
世界坐标系中的水平加速度aH
Figure BDA0001540138210000103
腿部张角θ:
Figure BDA0001540138210000104
预处理数据的数据段与原始数据的数据段共同构成训练集新数据段的集合
Figure BDA0001540138210000105
步骤1-4,对训练集新数据段的集合
Figure BDA0001540138210000106
内的每个数据段进行特征提取,本实施例中,对预处理数据的数据段提取时域上极大值、极小值、均值、方差、能量值,及频域上快速傅立叶变换后的主频率幅度,对原始数据的数据段提取加速度运动单元aAU
Figure BDA0001540138210000107
其中,
Figure BDA0001540138210000108
分别表示原始数据的数据段内第i个采样点的加速度在设备坐标系x,y,z轴上的分量,
Figure BDA0001540138210000109
分别表示原始数据的数据段内加速度在设备坐标系x,y,z轴上的分量的均值;
从而获得所有数据段对应的M×N的特征矩阵Ft=[f1,f2,...,fN],其中,N为特征的种类数,本实施例中N=25,fi,(i=1,2,...,N)表示第i种特征的M×1的列向量;
步骤1-5,通过主成分分析法,得到特征矩阵Ft从高维到低维映射的转移矩阵T,进而低维特征矩阵
Figure BDA00015401382100001010
Figure BDA00015401382100001011
得到主成分表示的M×N′的低维特征矩阵
Figure BDA0001540138210000111
其中,N′为低维特征的种类数,f′i,(i=1,2,...,N′)表示第i种低维特征的M×1的列向量,本实施例中取N′=10;
步骤1-6,将低维特征矩阵
Figure BDA0001540138210000112
中列向量f′i,(i=1,2,...,N′)的数值属性作为标准化参数P,本实施例采用f′i,(i=1,2,...,N′)的最大值fmaxi和最小值fmini,使f′i,(i=1,2,...,N′)标准化到区间[a,b],
Figure BDA0001540138210000113
取a=0,b=1,得到标准化的特征矩阵
Figure BDA0001540138210000114
其中,f′i,(i=1, 2,...,N′)表示第i种标准化的低维特征的M×1的列向量;
步骤1-7,将标准化的特征矩阵
Figure BDA0001540138210000115
及真实的状态作为输入,利用多状态支持向量机算法,将多状态分类器拆分成一系列二元分类器,本实施例采用一对一的方法,即任意两两状态之间构建一个二元分类器,六个状态共构建15个二元分类器,利用序列最小最优化算法计算二元分类器的最优解,训练得到多状态分类器C={C1,C2,...CI},I=15表示二元分类器的个数。
步骤2至步骤5的流程图如图2所示:
在所述步骤2中,行人执行待定位的运动,将移动设备放置于裤子前侧口袋,采集移动设备内置的加速度计、重力计、陀螺仪、磁力计等传感器的数据,得到待定位的原始数据的集合
Figure BDA0001540138210000116
更进一步,在所述步骤3中,对移动设备内置传感器采集的待定位的原始数据进行数据分割、数据预处理,获得数据段的步骤如下:
步骤3-1,当待定位的原始数据的集合Sraw中的每类数据达到Nwin个采样点,利用长度为Nwin的滑动窗口截断,得到待定位的原始数据的数据段Swin;否则,回到步骤2;
步骤3-2,对待定位的原始数据的数据段Swin执行步骤1-3,得到待定位的新数据段Snew
在步骤4中,利用多状态分类器C识别出该数据段的状态A的步骤如下:
步骤4-1,对步骤3获得的待定位的新数据段Snew,执行步骤1-4,得到特征矩阵F;
步骤4-2,利用步骤1-5中的转移矩阵T对特征矩阵F进行降维,得到低维的特征矩阵Fpca
Fpca=F×T;
步骤4-3,利用步骤1-6中的标准化参数P,本实施例中为fmaxi,fmini,(i=1,2,...,N′),对Fpca进行标准化,得到标准化的特征矩阵Fnorm
步骤4-4,利用步骤1-7得到的多状态分类器C,输入标准化的特征矩阵Fnorm,输出该数据段的状态A。
在所述步骤5中,在该数据段内,基于识别的状态A,采用航位推算模型,更新行人的三维定位的步骤如下:
步骤5-1,该步骤实现步伐检测,在待定位的新数据段Snew内,从未被定位过的采样点开始遍历,对腿部张角θ进行极值检测,获得极值
Figure BDA0001540138210000121
及其采样点索引
Figure BDA0001540138210000122
j表示当前极值的序号,利用极大值阈值TMAX、极小值阈值TMIN和最小间隔ΔN排除不符合要求的极值,获得有效极值
Figure BDA0001540138210000123
及其采样点索引
Figure BDA0001540138210000124
s表示当前有效极值的序号:当
Figure BDA0001540138210000125
大于TMAX且距离最近一个有效极值
Figure BDA0001540138210000126
的采样点间隔大于ΔN,则
Figure BDA0001540138210000127
视为有效极大值,或当
Figure BDA0001540138210000128
小于TMIN且距离最近一个有效极值
Figure BDA0001540138210000129
的采样点间隔大于ΔN,则
Figure BDA00015401382100001210
视为有效极小值,此时更新有效极值
Figure BDA00015401382100001211
及其采样点索引
Figure BDA00015401382100001212
当检测到一个腿部张角θ的有效极值时,即检测到一个步伐,新数据段Snew内的步数Nstep=Nstep+1;直到新数据段Snew内的采样点遍历结束,若检测到有效极值
Figure BDA0001540138210000131
及其采样点索引
Figure BDA0001540138210000132
(s=1,2,...,Nstep)时,执行步骤5-2,否则,执行步骤5-6。
步骤5-2,该步骤实现步长估计,在新数据段Snew内,选择适用于状态A的步长模型估计步长:当A={平地行走、上坡、下坡}时,利用行人腿长l、第s个有效极值
Figure BDA0001540138210000133
和上一个有效极值
Figure BDA0001540138210000134
及该步对应的地面坡度αs估计步长;当A={上楼梯、下楼梯}时,利用台阶的宽度wstair估计步长;当A={站立}时,步长为零;则第s步步长Ls
Figure BDA0001540138210000135
,(s=1,2,...,Nstep)
其中,αs=0表示平地,αs>0表示上坡,αs<0表示下坡;
步骤5-3,该步骤实现步高估计,在新数据段Snew内,选择适用于识别状态A的步高模型估计高度:当A={平地行走、上坡、下坡}时,利用第s步对应的地面坡度αs、步长Ls估计步高;当A={上楼梯、下楼梯}时,利用台阶的高度hstair估计步高,上楼梯时为正,下楼梯时为负;当A={站立}时,步高为零;则第s步步高Hs
Figure BDA0001540138210000136
步骤5-4,该步骤实现方位角估计,在新数据段Snew内,结合陀螺仪和磁力计确定方位,利用初始时刻磁力计获取的方位角
Figure BDA0001540138210000137
和磁偏角
Figure BDA0001540138210000138
校正陀螺仪的偏航角
Figure BDA0001540138210000139
得到在世界坐标系中相对于真北方向的绝对方位
Figure BDA00015401382100001310
Figure BDA00015401382100001311
第s步的方位角
Figure BDA00015401382100001312
取有效极值前后
Figure BDA00015401382100001313
个采样点的绝对方位
Figure BDA00015401382100001314
的均值:
Figure BDA0001540138210000141
步骤5-5,该步骤实现行人定位的更新,选择适用于识别状态A的三维位置更新模型,在世界坐标系中,基于位置更新前的行人定位(x0,y0,z0),新数据段Snew最终更新的位置
Figure BDA0001540138210000142
即为当前行人的定位:
Figure BDA0001540138210000143
其中,系数ks
Figure BDA0001540138210000144
步骤5-6,为了更新行人在下一个时刻的定位,保留原始数据的数据段Sraw中在采样点[Nwin×(1-η),Nwin]之间的原始数据,作为与下一个时刻的原始数据的数据段重合的部分,回到步骤2。
实施例2
为了评估“基于状态识别的行人定位方法”在实际环境中的定位性能,基于实施例1中的技术流程,进行实验,使用设备为苹果公司的iPhone 6手机。利用基于iPhone 6开发的应用,采集手机内置的加速度计、重力计、陀螺仪、磁力计(GPS)的数据,采样频率为50Hz。
首先,验证多状态分类器。实验者按照正常、慢速、快速三种步频,分别进行平地行走、上坡、下坡、上楼梯、下楼梯、站立六种运动,标记真实的状态,组成训练集,用于训练多状态分类器;为了评估多状态分类器的性能,重复上述运动,标记真实的状态,组成测试集。利用训练出的多状态分类器,对测试集进行分类,将分类状态与真实状态进行比较,得到分类的准确度,如表1所示。
Figure BDA0001540138210000145
Figure BDA0001540138210000151
表1
其次,验证多状态的行人定位方法,实验环境包括室内和室外。室内实验在浙江大学某建筑内进行,测试长度为101.3米,一段完整的运动包含状态:上楼梯-平地-下坡-平地-上坡-平地-下楼梯-平地,涉及7次状态转换、3次180度转弯、1次90度转弯,起点与终点重合,视为原点。台阶宽度、高度、坡度均为测量多次取均值,分别为0.5米,0.06米,6.8度。基于本方法的实验路径和真实路径如图3所示。
室外实验在浙江大学某建筑外进行,测试长度为107.7米,一段完整的运动包含状态:上坡-平地-下楼梯-平地-下楼梯-平地,涉及5次状态转换,7次90度转弯,起点与终点重合,视为原点。台阶宽度、高度、坡度均为测量多次取均值,分别为0.35米,0.13米,5.1度。基于本方法的实验路径和真实路径如图4所示。
本实验利用步数误差、距离误差、终点误差来描述系统的误差,其中,终点误差表示估计终点到真实终点的欧氏距离与总路程的比值,其他的误差表示估计值与真实值的差的绝对值与真实值的比值。多次实验的平均结果,如表2所示,利用GPS的定位作为对比。
Figure BDA0001540138210000152
表2
从表2中结果可知,本技术方案在室内和室外环境,均能提供高精度的定位信息,具体来说,在室内环境中,本技术方案能够代替GPS进行定位,在室外且建筑物环绕的环境中,本技术方案优于GPS的定位结果。
以上对本发明所提供的一种基于状态识别的行人定位系统进行了详尽的介绍,实施例只是用于帮助阐述本发明的方法,对本发明的保护范围不构成任何限制,凡采用等同变化或者等效替换形成的技术方案,均落在本发明的权利保护范围之内。

Claims (6)

1.一种基于状态识别的行人定位方法,其特征在于:所述行人定位方法包括以下步骤:
步骤1,行人执行多状态的运动,通过移动设备内置传感器采集多状态的原始数据,训练多状态分类器C;
步骤2,行人执行待定位的运动,通过移动设备内置传感器采集待定位的原始数据;
步骤3,对移动设备内置传感器采集的待定位的原始数据进行数据分割、数据预处理,获得数据段;
步骤4,利用多状态分类器C,识别出该数据段的状态A;
步骤5,在该数据段内,基于识别的状态A,采用合适的航位推算模型,更新行人的三维定位;
在所述步骤1中,多状态分类器的训练步骤如下:
步骤1-1,将移动设备放置于裤子前侧口袋,利用移动设备内置的加速度计、重力计、陀螺仪和磁力计,分别采集平地行走、上坡、下坡、上楼梯、下楼梯、站立状态下的传感器数据,得到训练集原始数据的集合
Figure FDA0003341874530000011
Figure FDA0003341874530000012
采样点数为Nraw,并标记真实的状态,其中,ax,ay,az分别为加速度在设备坐标系x,y,z轴上的分量,gx,gy,gz分别为重力加速度在设备坐标系x,y,z轴上的分量,
Figure FDA0003341874530000013
分别为移动设备的俯仰角、偏航角、滚转角,
Figure FDA0003341874530000014
为移动设备磁力计读取的方位角;
步骤1-2,将训练集原始数据的集合
Figure FDA0003341874530000015
中的数据,利用基于步频的滑动窗口做数据分割,窗口长度为取决于行人步频的介于一个周期和两个周期之间的采样点数Nwin,相邻窗口的覆盖率为η,则每类新数据被分割成M个数据段:
Figure FDA0003341874530000016
得到训练集原始数据的数据段集合
Figure FDA0003341874530000017
步骤1-3,对训练集原始数据的数据段集合
Figure FDA0003341874530000018
中的数据段进行预处理,得到预处理数据的数据段,预处理数据包括设备坐标系中加速度的模、世界坐标系中的垂直加速度和水平加速度、腿部张角4类数据,预处理方式如下:
设备坐标系中加速度的模aN
Figure FDA0003341874530000019
为了获得世界坐标系中的垂直加速度和水平加速度,首先,定义四元数:
Figure FDA00033418745300000110
标准化的四元数:
Figure FDA00033418745300000111
由标准化的四元数计算从设备坐标系到世界坐标系的旋转矩阵R:
Figure FDA0003341874530000021
从而得到加速度在世界坐标系x,y,z轴上的分量
Figure FDA0003341874530000022
Figure FDA0003341874530000023
则在世界坐标系中的垂直加速度aV
Figure FDA0003341874530000024
在世界坐标系中的水平加速度aH
Figure FDA0003341874530000025
腿部张角θ:
Figure FDA0003341874530000026
预处理数据的数据段与原始数据的数据段共同构成训练集新数据段的集合
Figure FDA0003341874530000027
步骤1-4,对训练集新数据段的集合
Figure FDA0003341874530000028
内的每个数据段进行特征提取,获得所有数据段对应的M×N的特征矩阵Ft=[f1,f2,...,fN],其中,N为特征的种类数,fi,(i=1,2,...,N)表示第i种特征的M×1的列向量;
步骤1-5,通过主成分分析法,得到特征矩阵Ft从高维到低维映射的转移矩阵T,进而低维特征矩阵
Figure FDA0003341874530000029
Figure FDA00033418745300000210
得到主成分表示的M×N′的低维特征矩阵
Figure FDA00033418745300000211
其中,N′为低维特征的种类数,f′i,(i=1,2,...,N′)表示第i种低维特征的M×1的列向量;
步骤1-6,把低维特征矩阵
Figure FDA00033418745300000212
中列向量f′i,(i=1,2,...,N′)的数值属性作为标准化参数P,将f′i,(i=1,2,...,N′)标准化到区间[a,b],得到标准化的特征矩阵
Figure FDA00033418745300000213
其中,f″i,(i=1,2,...,N′)表示第i种标准化的低维特征的M×1的列向量;
步骤1-7,将标准化的特征矩阵
Figure FDA00033418745300000214
及真实的状态作为输入,利用多状态支持向量机算法,将多状态分类器拆分成一系列二元分类器,利用序列最小最优化算法计算二元分类器的最优解,训练得到多状态分类器C={C1,C2,...CI},I表示二元分类器的个数。
2.如权利要求1所述的一种基于状态识别的行人定位方法,其特征在于:在所述步骤2中,行人执行待定位的运动,将移动设备放置于裤子前侧口袋,采集移动设备内置的加速度计、重力计、陀螺仪和磁力计传感器的数据,得到待定位的原始数据的集合
Figure FDA00033418745300000215
3.如权利要求1所述的一种基于状态识别的行人定位方法,其特征在于:在所述步骤3中,对移动设备内置传感器采集的待定位的原始数据进行数据分割、数据预处理,获得数据段的步骤如下:
步骤3-1,当待定位的原始数据的集合Sraw中的每类数据达到Nwin个采样点,利用长度为Nwin的滑动窗口截断,得到待定位的原始数据的数据段Swin;否则,回到步骤2;
步骤3-2,对待定位的原始数据的数据段Swin执行步骤1-3,得到待定位的新数据段Snew
4.如权利要求1所述的一种基于状态识别的行人定位方法,其特征在于:在所述步骤4中,利用多状态分类器C识别出该数据段的状态A的步骤如下:
步骤4-1,对步骤3获得的待定位的新数据段Snew,执行步骤1-4,得到特征矩阵F;
步骤4-2,利用步骤1-5中的转移矩阵T对特征矩阵F进行降维,得到低维的特征矩阵Fpca
Fpca=F×T;
步骤4-3,利用步骤1-6中的标准化参数P,对Fpca进行标准化,得到标准化的特征矩阵Fnorm
步骤4-4,利用步骤1-7得到的多状态分类器C,输入标准化的特征矩阵Fnorm,输出该数据段的状态A。
5.如权利要求1所述的一种基于状态识别的行人定位方法,其特征在于:在所述步骤5中,在该数据段内,基于识别的状态A,采用航位推算模型,更新行人的三维定位的步骤如下:
步骤5-1,该步骤实现步伐检测,在待定位的新数据段Snew内,从未被定位过的采样点开始遍历,对腿部张角θ进行极值检测,获得极值
Figure FDA0003341874530000031
及其采样点索引
Figure FDA0003341874530000032
j表示当前极值的序号,利用极大值阈值TMAX、极小值阈值TMIN和最小间隔ΔN排除不符合要求的极值,获得有效极值
Figure FDA0003341874530000033
及其采样点索引
Figure FDA0003341874530000034
s表示当前有效极值的序号:当
Figure FDA0003341874530000035
大于TMAX且距离最近一个有效极值
Figure FDA0003341874530000036
的采样点间隔大于ΔN,则
Figure FDA0003341874530000037
视为有效极大值,或当
Figure FDA0003341874530000038
小于TMIN且距离最近一个有效极值
Figure FDA0003341874530000039
的采样点间隔大于ΔN,则
Figure FDA00033418745300000310
视为有效极小值,此时更新有效极值
Figure FDA00033418745300000311
及其采样点索引
Figure FDA00033418745300000312
当检测到一个腿部张角θ的有效极值时,即检测到一个步伐,新数据段Snew内的步数Nstep=Nstep+1;直到新数据段Snew内的采样点遍历结束,若检测到有效极值
Figure FDA00033418745300000313
及其采样点索引
Figure FDA00033418745300000314
时,执行步骤5-2,否则,执行步骤5-6;
步骤5-2,该步骤实现步长估计,在新数据段Snew内,选择适用于状态A的步长模型估计步长:当A={平地行走、上坡、下坡}时,利用行人腿长l、第s个有效极值
Figure FDA00033418745300000315
和上一个有效极值
Figure FDA00033418745300000316
及该步对应的地面坡度αs估计步长;当A={上楼梯、下楼梯}时,利用台阶的宽度wstair估计步长;当A={站立}时,步长为零;则第s步步长Ls
Figure FDA00033418745300000317
其中,αs=0表示平地,αs>0表示上坡,αs<0表示下坡;
步骤5-3,该步骤实现步高估计,在新数据段Snew内,选择适用于识别状态A的步高模型估计高度:当A={平地行走、上坡、下坡}时,利用第s步对应的地面坡度αs、步长Ls估计步高;当A={上楼梯、下楼梯}时,利用台阶的高度hstair估计步高,上楼梯时为正,下楼梯时为负;当A={站立}时,步高为零;则第s步步高Hs
Figure FDA0003341874530000041
步骤5-4,该步骤实现方位角估计,在新数据段Snew内,结合陀螺仪和磁力计确定方位,利用初始时刻磁力计获取的方位角
Figure FDA0003341874530000042
和磁偏角
Figure FDA0003341874530000043
校正陀螺仪的偏航角
Figure FDA0003341874530000044
得到在世界坐标系中相对于真北方向的绝对方位
Figure FDA0003341874530000045
Figure FDA0003341874530000046
第s步的方位角
Figure FDA0003341874530000047
取有效极值前后
Figure FDA0003341874530000048
个采样点的绝对方位
Figure FDA0003341874530000049
的均值:
Figure FDA00033418745300000410
步骤5-5,该步骤实现行人定位的更新,选择适用于识别状态A的三维位置更新模型,在世界坐标系中,基于位置更新前的行人定位(x0,y0,z0),新数据段Snew最终更新的位置
Figure FDA00033418745300000411
即为当前行人的定位:
Figure FDA00033418745300000412
其中,系数ks
Figure FDA00033418745300000413
步骤5-6,为了更新行人在下一个时刻的定位,保留原始数据的数据段Sraw中在采样点[Nwin×(1-η),Nwin]之间的原始数据,作为与下一个时刻的原始数据的数据段重合的部分,回到步骤2。
6.如权利要求1所述的一种基于状态识别的行人定位方法,其特征在于:所述步骤1-6中,所述数值属性为最大值和最小值或均值和方差。
CN201810010536.XA 2018-01-05 2018-01-05 一种基于状态识别的行人定位方法 Active CN108537101B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810010536.XA CN108537101B (zh) 2018-01-05 2018-01-05 一种基于状态识别的行人定位方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810010536.XA CN108537101B (zh) 2018-01-05 2018-01-05 一种基于状态识别的行人定位方法

Publications (2)

Publication Number Publication Date
CN108537101A CN108537101A (zh) 2018-09-14
CN108537101B true CN108537101B (zh) 2022-03-25

Family

ID=63489843

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810010536.XA Active CN108537101B (zh) 2018-01-05 2018-01-05 一种基于状态识别的行人定位方法

Country Status (1)

Country Link
CN (1) CN108537101B (zh)

Families Citing this family (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109597031A (zh) * 2018-11-19 2019-04-09 桂林电子科技大学 一种基于svm和步行者航位推算融合的室内定位方法
CN109827568B (zh) * 2019-01-29 2020-12-15 东北大学秦皇岛分校 基于mems传感器的多层建筑中行人高度位置估计方法
CN110132276B (zh) * 2019-04-30 2020-12-08 杭州电子科技大学 一种基于行人运动状态的自适应步长估计方法
CN110501008B (zh) * 2019-07-29 2021-03-26 西安电子科技大学 人体运动模型的自主进化方法
CN112833889B (zh) * 2019-11-22 2022-12-23 北京魔门塔科技有限公司 一种车辆的定位方法及装置
CN113709860B (zh) * 2021-08-12 2022-06-03 电子科技大学 一种层间过渡区域的室内定位装置和方法

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103471589A (zh) * 2013-09-25 2013-12-25 武汉大学 一种室内行人行走模式识别和轨迹追踪的方法
CN104215238A (zh) * 2014-08-21 2014-12-17 北京空间飞行器总体设计部 一种智能手机室内定位方法
CN104757976A (zh) * 2015-04-16 2015-07-08 大连理工大学 一种基于多传感器融合的人体步态分析方法和系统
CN104931049A (zh) * 2015-06-05 2015-09-23 北京信息科技大学 一种基于运动分类的行人自主定位方法
CN105547298A (zh) * 2015-12-25 2016-05-04 北京京元智慧应急技术有限公司 智能手机内置传感器与Wi-Fi融合的室内动态连续定位方法
US9565521B1 (en) * 2015-08-14 2017-02-07 Samsung Electronics Co., Ltd. Automatic semantic labeling based on activity recognition
CN106574838A (zh) * 2014-07-03 2017-04-19 德州仪器公司 行人导航装置及方法
CN106705968A (zh) * 2016-12-09 2017-05-24 北京工业大学 基于姿态识别和步长模型的室内惯性导航算法
CN106767810A (zh) * 2016-11-23 2017-05-31 武汉理工大学 一种基于移动终端的wifi和视觉信息的室内定位方法及系统

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
GB201500411D0 (en) * 2014-09-15 2015-02-25 Isis Innovation Determining the position of a mobile device in a geographical area

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103471589A (zh) * 2013-09-25 2013-12-25 武汉大学 一种室内行人行走模式识别和轨迹追踪的方法
CN106574838A (zh) * 2014-07-03 2017-04-19 德州仪器公司 行人导航装置及方法
CN104215238A (zh) * 2014-08-21 2014-12-17 北京空间飞行器总体设计部 一种智能手机室内定位方法
CN104757976A (zh) * 2015-04-16 2015-07-08 大连理工大学 一种基于多传感器融合的人体步态分析方法和系统
CN104931049A (zh) * 2015-06-05 2015-09-23 北京信息科技大学 一种基于运动分类的行人自主定位方法
US9565521B1 (en) * 2015-08-14 2017-02-07 Samsung Electronics Co., Ltd. Automatic semantic labeling based on activity recognition
CN105547298A (zh) * 2015-12-25 2016-05-04 北京京元智慧应急技术有限公司 智能手机内置传感器与Wi-Fi融合的室内动态连续定位方法
CN106767810A (zh) * 2016-11-23 2017-05-31 武汉理工大学 一种基于移动终端的wifi和视觉信息的室内定位方法及系统
CN106705968A (zh) * 2016-12-09 2017-05-24 北京工业大学 基于姿态识别和步长模型的室内惯性导航算法

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
A Multi-Mode Dead Reckoning System for Pedestrian Tracking Using Smartphones;Qinglin Tian等;《IEEE SENSORS JOURNAL》;20151218;第16卷(第7期);2079-2093 *
Activity Recognition and Semantic Description for Indoor Mobile Localization;Sheng Guo等;《Sensors (Basel)》;20170321;第17卷(第3期);1-25 *
基于移动终端的室内关键定位技术研究;韦丹;《中国优秀博硕士学位论文全文数据库(硕士) 信息科技辑》;20150815(第08期);I136-689 *
基于移动设备的多状态行人定位系统研究;张玲;《中国优秀博硕士学位论文全文数据库(硕士) 信息科技辑》;20180615(第06期);I140-214 *

Also Published As

Publication number Publication date
CN108537101A (zh) 2018-09-14

Similar Documents

Publication Publication Date Title
CN108537101B (zh) 一种基于状态识别的行人定位方法
Sun et al. Activity classification and dead reckoning for pedestrian navigation with wearable sensors
CN106705968A (zh) 基于姿态识别和步长模型的室内惯性导航算法
CN110553643B (zh) 一种基于神经网络的行人自适应零速更新点选取方法
CN107255474B (zh) 一种融合电子罗盘和陀螺仪的pdr航向角确定方法
CN108844533A (zh) 一种基于多传感器融合和姿态解算的自由姿态pdr定位方法
CN103968827A (zh) 一种可穿戴式人体步态检测的自主定位方法
CN106448431A (zh) 一种采用众包方式的基于手机传感器的室内平面图构建方法
CN106845392B (zh) 一种基于众包轨迹的室内转角地标的匹配及识别方法
CN110207704B (zh) 一种基于建筑楼梯场景智能识别的行人导航方法
CN109470238A (zh) 一种定位方法、装置和移动终端
CN109612463B (zh) 一种基于侧向速度约束优化的行人导航定位方法
CN107490378A (zh) 一种基于mpu6050与智能手机的室内定位与导航的方法
CN109459028A (zh) 一种基于梯度下降的自适应步长估计方法
CN110388926A (zh) 一种基于手机地磁和场景图像的室内定位方法
Wu et al. Indoor positioning system based on inertial MEMS sensors: Design and realization
CN108629295A (zh) 转角地标识别模型训练方法、转角地标识别方法及装置
CN109708631A (zh) 一种基于手机模态识别的行人导航航向修正方法
CN107702708B (zh) 一种二维地磁分布定位方法
CN107105404B (zh) 一种基于步长匹配的行人室内定位方法
CN109682372B (zh) 一种结合建筑物结构信息与rfid标定的改进型pdr方法
Chen et al. Pedestrian positioning with physical activity classification for indoors
CN107345814A (zh) 一种移动机器人视觉定位系统及定位方法
CN116448103A (zh) 基于uwb测距辅助的行人足绑式惯性导航系统误差修正方法
CN114674317A (zh) 基于活动识别和融合滤波的自校正航位推算系统及方法

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
GR01 Patent grant
GR01 Patent grant