CN109612463B - 一种基于侧向速度约束优化的行人导航定位方法 - Google Patents
一种基于侧向速度约束优化的行人导航定位方法 Download PDFInfo
- Publication number
- CN109612463B CN109612463B CN201811281938.XA CN201811281938A CN109612463B CN 109612463 B CN109612463 B CN 109612463B CN 201811281938 A CN201811281938 A CN 201811281938A CN 109612463 B CN109612463 B CN 109612463B
- Authority
- CN
- China
- Prior art keywords
- peak
- valley
- value
- pedestrian
- acceleration module
- 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
Links
Images
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/20—Instruments for performing navigational calculations
Abstract
本发明公开了一种基于侧向速度约束优化的行人导航定位方法,首先分析行人的运动特性,研究步态检测方法判断行人步态与零速区间。基于此,若判断出当前状态处于零速区间,则将速度置零,并提出一种基于神经网络的步长估计方法进行步长估计;反之,则进行速度推算,并提出一种基于侧向速度约束的滤波方法,减少行人导航定位的累积误差,提高行人导航定位的精度。本发明适用于行人导航,适用于行人多种运动状态,利用消费级的惯性传感器也可以较理想地解决定位精度下降的问题,具有极高的工程应用和商业价值。
Description
技术领域
本发明属于定位导航技术领域,具体涉及一种基于侧向速度约束优化的行人导航定位方法。
背景技术
随着人们生活水平的提高,国内外掀起了研究行人导航定位技术的热潮。在开阔的室外环境下,行人可以借助GPS进行定位导航,而在GPS信号据止的室内环境下,一方面可以基于UWB、WIFI、蓝牙等无线射频设备,成本较高且不够便捷;另一方面可基于惯性传感器进行航位推算或捷联解算,实现成本低但会形成累计误差,导致定位结果发散。
目前,针对基于惯性传感器的行人航位推算算法主要有步态检测、步长估计与航向推算三个方面,但传统的步长估计方法适用性较差,且存在航向累计误差,难以保证高精度的行人定位导航要求。
发明内容
发明目的:为了克服现有技术中存在的不足,本发明提供一种基于侧向速度约束优化的行人导航定位方法,准确检测行人步态并估计步长,有效估计行人导航结果误差与传感器误差,抑制了惯性导航系统的误差发散。
技术方案:为实现上述目的,本发明采用的技术方案为:
一种基于侧向速度约束优化的行人导航定位方法,将惯性传感器水平固定放置在行人手掌上,定位方法包括如下步骤:
步骤1)采集并分析行人运动时的运动特性并进行姿态解算,其中姿态解算采用四元数方法解算;所述运动特性包括行人步行时的加速度、角速度及线速度特性;姿态结算得出的数据结果为传感器的姿态角即横滚角、俯仰角及航向角;
步骤2)建立行人运动步态检测模型,其中模型利用经过递推平滑方法处理加速度模值作为检测步态的条件量;其中,所述加速度模值为三轴加速度平方求和再开方,常用在惯性导航技术领域。
步骤3)利用步态检测所得到步态特征量作为神经网络的输入,将每步步长作为输出,构建基于BP神经网络的步长估计模型,其中训练样本中的步长信息由高精度的差分GPS位置计算所得;
步骤4)建立基于侧向速度约束的滤波方法,其中利用卡尔曼滤波进行误差估计进而修正行人定位导航过程中的累积误差。
进一步的,所述步骤1)中:行人运动过程中人体存在与地面相对静止的区间,即零速区间,在此区间内行人理论运动速度为零;行人在行走或跑步状态下,不考虑侧向运动,即在垂直于行人运动方向的侧向方向上运动速度为0。
进一步的,所述步骤2)中建立行人运动步态检测模型的具体内容为:
首先对加速度模值进行递推平滑处理:
其中:fix、fiy、fiz为第i时刻加速度计采集得到的比力信息,fk为第k时刻加速度模值,n为滑动窗口大小;
采用检测加速度模值的谷值fk,valley与峰值fk,peak作为步态检测条件,模型具体如下:
1)检测加速度模值峰值:fk,peak>THpeak,状态标志位为1;
2)检测加速度模值谷值:fk,valley>THvalley,上一个峰值与此谷值时间差ΔTk,peak,valley满足ΔTk,peak,valley>THpeak,valley,状态标志位为2;
3)在2)的基础上,检测下一个加速度模值峰值,上一个谷值与此峰值时间差ΔTk,valley,peak满足ΔTk,valley,peak>THvalley,peak,状态标志位为3;
4)当状态标志位为3时,代表成功检测到一步,并将状态标志位为1;
其中,THpeak为检测峰值的阈值,THvalley为检测谷值的阈值,THpeak,valley为上一个峰值与此谷值时间差的阈值,THvalley,peak为上一个谷值与此峰值时间差的阈值;
在检测到峰值的基础上,继续寻找第一个小于静止状态下加速度模值的对应时刻,即零速时刻,令零速标志位为1。
进一步的,所述步骤3)中建立一种基于神经网络的步长估计方法模型为:
构建4输入1输出与12个隐藏节点的神经网络,4个输入为行人运动一步过程中的加速度模值峰值fk,peak、加速度模值谷值fk,valley、峰谷值之差fk,peak-fk,valley以及两相邻峰值之间的时间差ΔTk,peak,valley+ΔTk,valley,peak,1个输出为该步步长;
训练阶段:利用同步采集的加速度模值信息以及由差分GPS位置求得的对应的步长信息对该BP神经网络进行训练,形成神经网络;
测试阶段:输入实时加速度模值峰值fk,peak、加速度模值谷值fk,valley、峰谷值之差以及两相邻峰值之间的时间差,利用训练好的神经网络输出实时的估计步长。
进一步的,所述步骤4)中建立基于侧向速度约束的滤波方法为:
构建9维的卡尔曼滤波器状态量,具体如下:
其中,为航向误差角,[δVe;δVn]为东、北方向的速度误差;[δλ;δL]为水平位置误差;[εbz;εrz]为z轴陀螺仪的零偏与一阶马尔科夫过程随机误差;[▽rx;▽ry]为x轴与y轴加速度计一阶马尔科夫过程随机误差;X是状态量,T是采样周期;
量测方程为:Z=vce-vreal=HX+V,其中vreal为理论上行人的侧向速度,即为0;H为量测阵,V为量测噪声,Z是量测量。有益效果:本发明提供的一种基于侧向速度约束优化的行人导航定位方法,与现有技术相比,具有以下优势:本发明首先分析行人的运动特性,研究步态检测方法判断行人步态与零速区间。基于此,若判断出当前状态处于零速区间,则将速度置零,并提出一种基于神经网络的步长估计方法进行步长估计,提高了步长估计的精度;反之,则进行速度推算,并提出一种基于侧向速度约束的滤波方法,减少行人导航定位的累积误差,提高行人导航定位的精度。
本发明适用于行人导航,适用于行人多种运动状态,利用消费级的惯性传感器也可以较理想地解决定位精度下降的问题,具有极高的工程应用和商业价值。
附图说明
图1为本发明定位算法流程图。
图2为本发明与传统方法对比图。
具体实施方式
下面结合附图和实施例对本发明作更进一步的说明。
如图1所示,本发明一种基于侧向速度约束优化的行人导航定位方法包括如下步骤:
步骤1,采集并分析行人运动时的运动特性,行人运动过程中人体存在与地面相对静止的区间,即零速区间,在此区间内行人理论运动速度为零。另外,行人在行走或跑步状态下,一般不考虑侧向运动,即在垂直于行人运动方向的侧向方向上运动速度为0。将加速度计与陀螺仪输出进行预处理,即扣除加速度计与陀螺仪的零偏,并利用四元数方法进行姿态解算,可参考:刘建业.导航系统理论与应用[M].西北工业大学出版社,2010。
步骤2,建立行人运动步态检测模型,首先对加速度模值进行递推平滑处理:
其中:fix、fiy、fiz为第i时刻加速度计采集得到的比力信息,fk为第k时刻加速度模值,n为滑动窗口大小。
根据加速度模值变化趋势可知,行人运动周期性明显,本发明采用检测加速度模值的谷值fk,valley与峰值fk,peak作为步态检测条件,模型具体如下:
1)检测加速度模值峰值:fk,peak>THpeak,状态标志位为1;
2)检测加速度模值谷值:fk,valley>THvalley,上一个峰值与此谷值时间差ΔTk,peak,valley满足ΔTk,peak,valley>THpeak,valley,状态标志位为2;
3)在2)的基础上,检测下一个加速度模值峰值,上一个谷值与此峰值时间差ΔTk,valley,peak满足ΔTk,valley,peak>THvalley,peak,状态标志位为3;
4)当状态标志位为3时,代表成功检测到一步,并将状态标志位为1;
其中,THpeak为检测峰值的阈值,THvalley为检测谷值的阈值,THpeak,valley为上一个峰值与此谷值时间差的阈值,THvalley,peak为上一个谷值与此峰值时间差的阈值;
在检测到峰值的基础上,继续寻找第一个小于静止状态下加速度模值的对应时刻,即零速时刻,令零速标志位为1。
步骤3,判断步态是否处于零速时刻,若处于零速时刻则将速度置零,并建立一种基于神经网络的步长估计方法,具体为4输入1输出与12个隐藏节点的神经网络,4个输入为行人运动一步过程中的加速度模值峰值、加速度模值谷值、峰谷值之差以及两相邻峰值之间的时间差,1个输出为该步步长;
训练阶段:利用同步采集的加速度模值信息以及由差分GPS位置求得的对应的步长信息对该BP神经网络进行训练,形成神经网络;
测试阶段:输入实时加速度模值峰值、加速度模值谷值、峰谷值之差以及两相邻峰值之间的时间差,利用训练好的神经网络输出实时的估计步长。
在准确估计步长的基础上,则进行行人位置推算。
步骤4,若处于非零速时刻则将进行速度递推,并建立基于侧向速度约束的滤波方法,利用卡尔曼滤波进行误差估计进而修正行人定位导航过程中的累积误差。构建9维的卡尔曼滤波器状态量,具体如下:
其中,为航向误差角,[δVe;δVn]为东、北方向的速度误差;[δλ;δL]为水平位置误差;[εbz;εrz]为z轴陀螺仪的零偏与一阶马尔科夫过程随机误差;为x轴与y轴加速度计一阶马尔科夫过程随机误差;X是状态量,T是采样周期;
量测方程为:Z=vce-vreal=HX+V,其中vreal为理论上行人的侧向速度,即为0;H为量测阵,V为量测噪声;Z是量测量。
实施例
如图2所示,实验场景为实验楼内的走廊,路线为长度为54米的直线,利用传统的行人航位推算方法解算出来的结果如图虚线所示,终点误差为2.8米;利用本发明即一种基于侧向速度约束优化的行人导航定位方法解算出来的结果如图实线所示,终点误差为0.4米,且航向误差大大减小,提升了定位精度。
以上所述仅是本发明的优选实施方式,应当指出:对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。
Claims (4)
1.一种基于侧向速度约束优化的行人导航定位方法,其特征是,将惯性传感器水平固定放置在行人手掌上,定位方法包括如下步骤:
步骤1)采集并分析行人运动时的运动特性并进行姿态解算,其中姿态解算采用四元数方法解算;所述运动特性包括行人步行时的加速度、角速度及线速度特性;姿态结算得出的数据结果为传感器的姿态角即横滚角、俯仰角及航向角;
步骤2)建立行人运动步态检测模型,所述行人运动步态检测模型利用经过递推平滑方法处理加速度模值作为检测步态的条件量;
步骤3)利用步态检测所得到步态特征量作为神经网络的输入,将每步步长作为输出,构建基于BP神经网络的步长估计模型,其中训练样本中的步长信息由高精度的差分GPS位置计算所得;具体的建立一种基于BP神经网络的步长估计方法模型为:构建4个输入1个输出与12个隐藏节点的BP神经网络,4个输入为行人运动一步过程中的加速度模值峰值fk,peak、加速度模值谷值fk,valley、峰谷值之差fk,peak-fk,valley以及两相邻峰值之间的时间差ΔTk,peak,valley+ΔTk,valley,peak,ΔTk,peak,valley为上一个加速度模值峰值与加速度模值谷值时间差,ΔTk,valley,peak为上一个加速度模值谷值与加速度模值峰值时间差;1个输出为该步步长;
训练阶段:利用同步采集的加速度模值信息以及由差分GPS位置求得的对应的步长信息对该BP神经网络进行训练,形成神经网络;
测试阶段:输入实时加速度模值峰值fk,peak、加速度模值谷值fk,valley、峰谷值之差以及两相邻峰值之间的时间差,利用训练好的神经网络输出实时的估计步长;
步骤4)建立基于侧向速度约束的滤波方法,其中利用卡尔曼滤波进行误差估计进而修正行人定位导航过程中的累积误差。
2.根据权利要求1所述的一种基于侧向速度约束优化的行人导航定位方法,其特征是,所述步骤1)中:行人运动过程中人体存在与地面相对静止的区间,即零速区间,在此区间内行人理论运动速度为零;行人在行走或跑步状态下,不考虑侧向运动,即在垂直于行人运动方向的侧向方向上运动速度为0。
3.根据权利要求1所述的一种基于侧向速度约束优化的行人导航定位方法,其特征是,所述步骤2)中建立行人运动步态检测模型的具体内容为:
首先对加速度模值进行递推平滑处理:
其中:fix、fiy、fiz为第i时刻加速度计采集得到的比力信息,fk为第k时刻加速度模值,n为滑动窗口大小;
采用检测加速度模值谷值fk,valley与加速度模值峰值fk,peak作为步态检测条件,该行人运动步态检测模型具体如下:
2.1)检测加速度模值峰值:fk,peak>THpeak,状态标志位为1;
2.2)检测加速度模值谷值:fk,valley>THvalley,上一个加速度模值峰值与加速度模值谷值时间差ΔTk,peak,valley满足ΔTk,peak,valley>THpeak,valley,状态标志位为2;
2.3)在2.2)的基础上,检测下一个加速度模值峰值,上一个加速度模值谷值与加速度模值峰值时间差ΔTk,valley,peak满足ΔTk,valley,peak>THvalley,peak,状态标志位为3;
2.4)当状态标志位为3时,代表成功检测到一步,并将状态标志位为1;
其中,THpeak为检测峰值的阈值,THvalley为检测谷值的阈值,THpeak,valley为上一个加速度模值峰值与加速度模值谷值时间差的阈值,THvalley,peak为上一个加速度模值谷值与加速度模值峰值时间差的阈值;
在检测到加速度模值峰值的基础上,继续寻找第一个小于静止状态下加速度模值的对应时刻,即零速时刻,令零速标志位为1。
4.根据权利要求1所述的一种基于侧向速度约束优化的行人导航定位方法,其特征是,所述步骤4)中建立基于侧向速度约束的滤波方法为:
构建9维的卡尔曼滤波器状态量,具体如下:
其中,为航向误差角,[δVe;δVn]为东、北方向的速度误差;[δλ;δL]为水平位置误差;[εbz;εrz]为z轴陀螺仪的零偏与一阶马尔科夫过程随机误差;为x轴与y轴加速度计一阶马尔科夫过程随机误差;X是状态量,T是采样周期;
量测方程为:Z=vce-vreal=HX+V,其中vreal为理论上行人的侧向速度,即为0;H为量测阵,V为量测噪声,Z是量测量。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811281938.XA CN109612463B (zh) | 2018-10-31 | 2018-10-31 | 一种基于侧向速度约束优化的行人导航定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811281938.XA CN109612463B (zh) | 2018-10-31 | 2018-10-31 | 一种基于侧向速度约束优化的行人导航定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109612463A CN109612463A (zh) | 2019-04-12 |
CN109612463B true CN109612463B (zh) | 2020-07-07 |
Family
ID=66002140
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811281938.XA Active CN109612463B (zh) | 2018-10-31 | 2018-10-31 | 一种基于侧向速度约束优化的行人导航定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109612463B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110579212B (zh) * | 2019-08-13 | 2022-11-29 | 湘潭大学 | 室内定位方法及装置 |
CN110553643B (zh) * | 2019-09-17 | 2021-12-21 | 电子科技大学 | 一种基于神经网络的行人自适应零速更新点选取方法 |
CN110987004B (zh) * | 2019-12-02 | 2023-02-10 | 北京自动化控制设备研究所 | 基于零速匹配滤波的舰船用惯导对准方法 |
CN113203416B (zh) * | 2021-03-19 | 2022-07-12 | 电子科技大学 | 一种针对摆臂行人的行人航位推算方法 |
CN114459469B (zh) * | 2022-01-14 | 2023-05-23 | 北京信息科技大学 | 多运动状态导航方法、装置及智能可穿戴设备 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2017012526A1 (zh) * | 2015-07-21 | 2017-01-26 | 华为技术有限公司 | 记步方法、设备及终端 |
CN106908759A (zh) * | 2017-01-23 | 2017-06-30 | 南京航空航天大学 | 一种基于uwb技术的室内行人导航方法 |
CN107843256A (zh) * | 2017-10-11 | 2018-03-27 | 南京航空航天大学 | 基于mems传感器的自适应零速修正行人导航方法 |
CN108508462A (zh) * | 2018-01-29 | 2018-09-07 | 东南大学 | 基于速度约束的低成本接收机平滑rtd算法及其应用 |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20090087300A (ko) * | 2008-02-12 | 2009-08-17 | 삼성전자주식회사 | 추측 항법을 이용한 보행자용 네비게이션의 지도 정합 장치및 방법 |
CN104937377B (zh) * | 2013-01-17 | 2018-11-09 | 可信定位股份有限公司 | 用于处理无约束的便携式导航装置的垂直取向的方法和设备 |
CN103900581B (zh) * | 2014-04-04 | 2017-01-18 | 哈尔滨工程大学 | 基于增广拉格朗日条件的mimu与gps组合行人导航法 |
CN104296750B (zh) * | 2014-06-27 | 2017-05-03 | 大连理工大学 | 一种零速检测方法和装置以及行人导航方法和系统 |
CN105184260B (zh) * | 2015-09-10 | 2019-03-08 | 北京大学 | 一种图像特征提取方法及行人检测方法及装置 |
CN106767789B (zh) * | 2017-01-12 | 2019-12-24 | 南京航空航天大学 | 一种基于自适应卡尔曼滤波的行人航向最优融合方法 |
US9921068B2 (en) * | 2017-03-09 | 2018-03-20 | Thomas Danaher Harvey | Devices and methods to facilitate escape from a venue with a sudden hazard |
-
2018
- 2018-10-31 CN CN201811281938.XA patent/CN109612463B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2017012526A1 (zh) * | 2015-07-21 | 2017-01-26 | 华为技术有限公司 | 记步方法、设备及终端 |
CN106908759A (zh) * | 2017-01-23 | 2017-06-30 | 南京航空航天大学 | 一种基于uwb技术的室内行人导航方法 |
CN107843256A (zh) * | 2017-10-11 | 2018-03-27 | 南京航空航天大学 | 基于mems传感器的自适应零速修正行人导航方法 |
CN108508462A (zh) * | 2018-01-29 | 2018-09-07 | 东南大学 | 基于速度约束的低成本接收机平滑rtd算法及其应用 |
Non-Patent Citations (1)
Title |
---|
"基于MIMU的单兵室内导航算法研究";马晓龙;《中国优秀硕士学位论文数据库 信息科技辑》;20160415(第4期);正文第10-19、35-46页 * |
Also Published As
Publication number | Publication date |
---|---|
CN109612463A (zh) | 2019-04-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109612463B (zh) | 一种基于侧向速度约束优化的行人导航定位方法 | |
CN109827577B (zh) | 基于运动状态检测的高精度惯性导航定位算法 | |
CN107289941B (zh) | 一种基于惯导的室内定位方法与装置 | |
CN106705968B (zh) | 基于姿态识别和步长模型的室内惯性导航算法 | |
CN108225308B (zh) | 一种基于四元数的扩展卡尔曼滤波算法的姿态解算方法 | |
CN107396321B (zh) | 基于手机传感器和iBeacon的无监督式室内定位方法 | |
CN102538781B (zh) | 基于机器视觉和惯导融合的移动机器人运动姿态估计方法 | |
CN104180805A (zh) | 基于智能手机的室内行人定位与跟踪方法 | |
CN106123900B (zh) | 基于改进型互补滤波的室内行人导航磁航向解算方法 | |
CN104977006A (zh) | 一种基于模糊理论和多传感器融合的室内定位方法 | |
CN108957510B (zh) | 基于惯性/零速/gps的行人无缝组合导航定位方法 | |
CN108537101B (zh) | 一种基于状态识别的行人定位方法 | |
CN103471595A (zh) | 一种面向ins/wsn室内移动机器人紧组合导航的迭代扩展rts均值滤波方法 | |
CN109708632A (zh) | 一种面向移动机器人的激光雷达/ins/地标松组合导航系统及方法 | |
CN109855621A (zh) | 一种基于uwb与sins的组合室内行人导航系统及方法 | |
CN109959374B (zh) | 一种行人惯性导航全时全程逆向平滑滤波方法 | |
CN109459028A (zh) | 一种基于梯度下降的自适应步长估计方法 | |
CN112362057B (zh) | 基于零速修正与姿态自观测的惯性行人导航算法 | |
CN106643694A (zh) | 一种机器人室内定位方法 | |
CN112923931A (zh) | 一种基于固定路线下的特征地图匹配与gps定位信息融合方法 | |
CN112066980B (zh) | 一种基于人体四节点运动约束的行人导航定位方法 | |
CN106153069A (zh) | 自主导航系统中的姿态修正装置和方法 | |
CN104316058B (zh) | 一种采用交互多模型的移动机器人wsn/ins组合导航方法 | |
CN104197935A (zh) | 一种基于移动智能终端的室内定位方法 | |
CN111982102A (zh) | 一种复杂环境下基于bp-ekf的uwb-imu定位方法 |
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 |