CN110274592A - 一种腰部脚部惯性测量单元信息融合的零速区间确定方法 - Google Patents
一种腰部脚部惯性测量单元信息融合的零速区间确定方法 Download PDFInfo
- Publication number
- CN110274592A CN110274592A CN201910648844.XA CN201910648844A CN110274592A CN 110274592 A CN110274592 A CN 110274592A CN 201910648844 A CN201910648844 A CN 201910648844A CN 110274592 A CN110274592 A CN 110274592A
- Authority
- CN
- China
- Prior art keywords
- zero
- foot
- waist
- speed section
- imu
- 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
- 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
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
Abstract
一种腰部脚部惯性测量单元(Inertial Measurement Unit,IMU)信息融合的零速区间确定方法,该方法综合考虑了腰部与脚部运动时的规律,利用规律的互补性进行信息融合,从而准确的确定行走过程中脚部落地的零速时间段。首先,由于脚部在行进过程中存在静止与摆动阶段,并且分界点为脚跟落地时的脉冲点,所以可以通过对脚部IMU数据的脉冲点的识别确定零速区间窗口的起始位置;然后利用腰部的数据确定每一步的周期,取半个周期为窗口长度,准确的确定零速区间段的位置及大小,从而对惯导解算的误差进行修正。本发明有效的避免了通过阈值设定判断零速区间的个体差异性,能够应用于不同的人不同的运动状态。
Description
技术领域
本发明涉及一种腰部脚部惯性测量单元信息融合的零速区间确定方法,用于在脚部惯性导航+卡尔曼滤波+零速修正(INS+KALMAN+ZUPT,IEZ)算法中的零速时间段的确定。特别适用于无线信号受遮挡的室内行人导航领域。
背景技术
很多导航的方式在当今科技发达的时代应运而生,但每一种导航都有各自的局限性。卫星导航被更多的应用于人们的日常生活中,但由于卫星导航受信号影响严重,很难在信号被遮挡的区域,如室内、森林,地下广场,大型商场、大型医院等地方使用。因此,如何不依赖外界信息,能够在任何地方实现自主导航是目前亟需解决的一个问题。针对行人的自主导航,目前存在腰部行人航位推算(PDR)算法以及脚部IEZ算法。相比于腰部的PDR算法,因为脚部运动的规律性,可以在零速区间进行卡尔曼滤波修正,所以脚部的IEZ算法精度会更高。但由于脚部IEZ算法主要通过惯性导航对位置,速度,姿态等信息进行解算,由于惯导的特征,误差随时间发散,很难准确的对行人进行定位,所以其主要问题在于如何准确的识别零速区间,从而在零速区间内对误差更准确的修正,最大程度上抑制惯导误差的发散。
目前存在的主流技术为自适应阈值调整法,主要思路为根据不同行人的不同运动状态,设定不同的零速区间判定阈值,但由于每个人的行走习惯不同,行走的快慢不同,即使同一个人也存在不同的运动状态,所以自适应阈值法需要训练大量的样本从而建立阈值库,可以针对不同行人的不同运动状态进行修正,由于个体差异性太大导致实验过于复杂,工作量过大,因此,能够有效的减小工作量的同时,又能准确的对各种不同的人进行准确的定位很有必要。因此,本文主要研究了基于人体运动机理分析的零速区间确定方法。
发明内容
本发明的技术解决问题是:针对现有的自适应零速修正方法工作量太大以及个体差异性太大的问题,提出一种腰部脚部IMU信息融合的零速区间确定方法。该方法主要利用腰部及脚部的IMU输出的垂直加速度的信息,通过双窗口法进行波峰波谷的识别,从而利用脚部波谷确定零速窗口的起始位置,利用腰部波峰值确定零速区间窗口的大小,实现不依赖于行人以及行人的运动状态的零速区间的确定。
本发明的技术解决方案为:腰部脚部IMU信息融合的零速区间确定方法,其特点在于通过下列步骤实现:
(1)将IMU安装在脚部鞋带下方以及腰部后方正中间的位置,在行走或其他运动状态中采集行人的加速度以及角速度信息。
(2)由于在行人行走的过程中,腰部的IMU会晃动,因此通过切比雪夫滤波对腰部数据进行平滑处理。
(3)利用行人在行走前静止的一小段时间对陀螺仪的零偏进行标定。
(4)利用加速度计输出计算行人的初始姿态角并利用起步时刻的加计输出标定初始安装误差角。
(5)根据行人行走过程中的垂直方向的腰部加速度计输出,利用双窗口法检测出正弦数据的波峰值及波峰值对应的时刻。
(6)根据行人行走过程中的垂直方向的脚部加速度计的输出,利用双窗口法检测出行人脚部迈步过程中脚跟落地,与地面碰撞时刻的瞬时脉冲值在时间序列中的位置。
(7)进行惯导位置,速度,姿态计算并进行误差修正。
发明原理:
当行人在行走时,由脚部采集到的数据具有一定的规律性,其规律为从脚跟落地开始出现一个向下的脉冲值,所以,利用双窗口法,即可确定每一步出现向下的脉冲值的具体时刻,记作δ:设行人行走的当前时刻为t时刻,双窗口的长度为L,所以,可以计算窗口1记作W1也就是t-2L时刻到t-L时刻以及窗口2记作W2也就是t-L时刻到t时刻的最小值,当两个最小值相等,等于S且同时出现在t-L时刻时,那么t-L时刻即为检测到的瞬时向下脉冲,即
min(W1)=W1(t-L)=S
min(W2)=W2(t-L)=S
当出现脚跟落地脉冲时,脚部并非零速时刻,因为真正的脚部零速时刻为全脚掌落地的时刻,而从脚跟着地到全脚掌着地是有一小段时间的,根据人体运动学规律,这一小段时间最多为0.2个行走周期,所以将脚跟着地时刻的序列加上0.2个周期即可以当作零速区间的起始点。可以同理利用双窗口法计算出腰部两峰值,记作M1和M2,其对应的时刻记作T1和T2,因此可以得到相邻两个峰值间的周期,也就是上面说的行走周期,记作T,
T=T1-T2
由于腰部运动的规律性,行人的一条腿迈出一步即为一个周期,而在缓慢行走的状态下,当一条腿在向前迈出一步的同时,另一只脚是在地面上保持零速状态的,所以零速区间的长度为T,而在快速行走或者跑步状态下,支撑脚只有从全脚着地到另一只脚迈到中间位置使得两条腿呈站立状时,也就是腰部传感器测量到的垂向加速度达到波谷时为零速时间,因此,为了适应所有的运动状态,选取0.5个周期为零速时间的终点,将窗口的起始点位置记作Wleft,终止点记作Wright,有
Wleft=δ+0.2T
Wright=δ+0.5T
确定零速区间即可开始行人的惯导解算,根据(1)(2)两式可以计算出载体系到导航系的转换矩阵,在根据载体系下IMU测量的加速度以及角速度可以根据(3)(4)两式解算出行人的实时速度与位置。
随着惯导的解算,判断是否进入零速区间段,当进入到零速区间段时,利用卡尔曼滤波,选取三轴速度[Vx Vy Vz]作为量测,同时选取作为待估计的状态量,利用公式(5)可以求解出速度姿态位置误差,并反馈回惯导环节进行校正。
Xk=KkZk
Pk=(I-KkHk)Pk,k-1 (5)
本发明与现有技术相比的优点在于:
(1)采用双窗口法对脚部落地的脉冲值进行检测,能够准确定位出每一个零速区间的位置。
(2)通过检测腰部数据的波峰值确定每一步的周期,窗口长度更加准确。
(3)不需要训练大量的样本,人为调整相应的阈值,工作量大大减小。
附图说明
图1为本发明涉及一种腰部脚部IMU信息融合的零速区间确定方法流程图;
图2为本发明涉及脚部IMU绑定示意图;
图3为本发明涉及腰部IMU安装示意图。
具体实施方式
本发明技术解决方案的具体实施步骤如图1所示,腰部及脚部IMU安装示意图如图2及图3所示,具体实施步骤如下:
1.将IMU安装在脚部鞋带下方以及腰部后方正中间的位置,在行走或其他运动状态中采集行人的加速度以及角速度信息。由于行人的行走具有规律性,所以通过测量行人的加速度及角速度可以解算位置速度等信息并进行修正。
2.由于在行人行走的过程中,腰部的IMU会晃动,因此通过切比雪夫滤波对腰部数据进行平滑处理。如果不进行平滑处理,腰部采集到的数据并不是平滑的正弦信号,而是在一个周期内存在很多个峰值与谷值,所以进行平滑处理可以利于后面的周期计算。
3.利用行人在行走前静止的一小段时间对陀螺仪的零偏进行标定。陀螺仪存在固有误差,采集到的数据具有一个固定大小的误差,需要在实验前静止几秒钟的时间采集陀螺仪的数据,将这些数据的平均值作为这个陀螺仪零偏的大小进行标定。
4.利用加速度计输出计算行人的初始姿态角并利用起步时刻的加计输出标定初始安装误差角。IMU的安装本应该是航向与行人行走的方向一致的,但由于安装误差的原因,IMU的航向与行人的航向间存在夹角,需要采集加速度计的三轴数据对安装误差角进行标定。
5.根据行人行走过程中的垂直方向的腰部加速度计输出,利用双窗口法检测出正弦数据的波峰值及波峰值对应的时刻,相邻两个波峰值的时间差作为行走每一步的周期T,周期的一半作为零速区间窗口的终点Wright。
6.根据行人行走过程中的垂直方向的脚部加速度计的输出,利用双窗口法检测出行人脚部迈步过程中脚跟落地,与地面碰撞时刻的瞬时脉冲值在时间序列中的位置,加上0.2个周期即为窗口的起始位置Wleft。
7.进行惯导位置,速度,姿态计算,在相应的零速区间段利用卡尔曼滤波对惯导解算出的位置,速度,姿态信息进行校正,抑制误差的发散。
本发明说明书中未作详细描述的内容属于本领域专业技术人员公知的现有技术。
Claims (4)
1.一种腰部脚部惯性测量单元信息融合的零速区间确定方法,其特征在于包括以下步骤:
(1)将IMU安装在脚部鞋带下方以及腰部后方正中间的位置,在行走或其他运动状态中采集行人的加速度以及角速度信息。
(2)由于在行人行走的过程中,腰部的IMU会晃动,因此通过切比雪夫滤波对腰部数据进行平滑处理。
(3)利用行人在行走前静止的一小段时间对陀螺仪的零偏进行标定。
(4)利用加速度计输出计算行人的初始姿态角并利用起步时刻的加计输出标定初始安装误差角。
(5)根据行人行走过程中的垂直方向的腰部加速度计输出,利用双窗口法检测出正弦数据的波峰值及波峰值对应的时刻。
(6)根据行人行走过程中的垂直方向的脚部加速度计的输出,利用双窗口法检测出行人脚部迈步过程中脚跟落地,与地面碰撞时刻的瞬时脉冲值在时间序列中的位置。
(7)进行惯导位置,速度,姿态计算并进行误差修正。
2.根据权利要求1所述的一种腰部脚部IMU信息融合的零速区间确定方法,其特征在于:所述步骤(4)中,利用起步那一刻的加速度计的三轴输出进行比力分解求解IMU的初始安装误差角。
3.根据权利要求1所述的一种腰部脚部IMU信息融合的零速区间确定方法,其特征在于:所述步骤(5)中,利用双窗口法检测腰部IMU数据的每一个峰值并计算其周期,并将脚跟落地时的脉冲时刻加上半个周期作为零速区间的终止点。
4.根据权利要求1所述的一种腰部脚部IMU信息融合的零速区间确定方法,其特征在于:所述步骤(6)中,利用双窗口法检测脚部落地的瞬时脉冲值,脉冲值在采样点中的序列加上0.2个周期作为零速区间的起始点。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910648844.XA CN110274592B (zh) | 2019-07-18 | 2019-07-18 | 一种腰部脚部惯性测量单元信息融合的零速区间确定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910648844.XA CN110274592B (zh) | 2019-07-18 | 2019-07-18 | 一种腰部脚部惯性测量单元信息融合的零速区间确定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110274592A true CN110274592A (zh) | 2019-09-24 |
CN110274592B CN110274592B (zh) | 2021-07-27 |
Family
ID=67964746
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910648844.XA Active CN110274592B (zh) | 2019-07-18 | 2019-07-18 | 一种腰部脚部惯性测量单元信息融合的零速区间确定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110274592B (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111307148A (zh) * | 2020-04-03 | 2020-06-19 | 北京航空航天大学 | 一种基于惯性网络的行人定位方法 |
CN111337050A (zh) * | 2020-03-20 | 2020-06-26 | 深圳市汇泰科电子有限公司 | 一种基于多条件融合的零速判断条件及计步方法 |
CN111721288A (zh) * | 2020-06-19 | 2020-09-29 | 哈尔滨工业大学 | 一种mems器件零偏修正方法、装置及存储介质 |
CN112762944A (zh) * | 2020-12-25 | 2021-05-07 | 上海商汤临港智能科技有限公司 | 零速区间检测及零速更新方法 |
CN115956902A (zh) * | 2022-10-20 | 2023-04-14 | 国家体育总局体育科学研究所 | 一种以时间窗口进行比对同步的运动数据采集分析方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101694499A (zh) * | 2009-10-22 | 2010-04-14 | 浙江大学 | 基于行人步态检测的步速测量和传输的系统和方法 |
KR20120077423A (ko) * | 2010-12-30 | 2012-07-10 | 울산대학교 산학협력단 | 영속도 구간 검출 시스템 및 영속도 구간 검출 방법 |
CN104613964A (zh) * | 2015-01-30 | 2015-05-13 | 中国科学院上海高等研究院 | 一种跟踪脚部运动特征的步行者定位方法及系统 |
CN106153069A (zh) * | 2015-03-31 | 2016-11-23 | 日本电气株式会社 | 自主导航系统中的姿态修正装置和方法 |
CN106908060A (zh) * | 2017-02-15 | 2017-06-30 | 东南大学 | 一种基于mems惯性传感器的高精度室内定位方法 |
CN108007477A (zh) * | 2017-11-29 | 2018-05-08 | 哈尔滨工程大学 | 一种基于正反向滤波的惯性行人定位系统误差抑制方法 |
-
2019
- 2019-07-18 CN CN201910648844.XA patent/CN110274592B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101694499A (zh) * | 2009-10-22 | 2010-04-14 | 浙江大学 | 基于行人步态检测的步速测量和传输的系统和方法 |
KR20120077423A (ko) * | 2010-12-30 | 2012-07-10 | 울산대학교 산학협력단 | 영속도 구간 검출 시스템 및 영속도 구간 검출 방법 |
CN104613964A (zh) * | 2015-01-30 | 2015-05-13 | 中国科学院上海高等研究院 | 一种跟踪脚部运动特征的步行者定位方法及系统 |
CN106153069A (zh) * | 2015-03-31 | 2016-11-23 | 日本电气株式会社 | 自主导航系统中的姿态修正装置和方法 |
CN106908060A (zh) * | 2017-02-15 | 2017-06-30 | 东南大学 | 一种基于mems惯性传感器的高精度室内定位方法 |
CN108007477A (zh) * | 2017-11-29 | 2018-05-08 | 哈尔滨工程大学 | 一种基于正反向滤波的惯性行人定位系统误差抑制方法 |
Non-Patent Citations (8)
Title |
---|
ABDELMOUMEN NORRDINE等: "Step Detection for ZUPT-Aided Inertial Pedestrian Navigation System Using Foot-Mounted", 《IEEE SENSORS JOURNAL》 * |
SANG KYEONG PARK等: "A Zero Velocity Detection Algorithm Using Inertial Sensors for Pedestrian Navigation Systems", 《SENSORS》 * |
XIONG YUNQIANG等: "Research for Pedestrian Navigation Positioning Method Based on MEMS Sensors", 《PROCEEDINGS OF THE 34TH CHINESE CONTROL CONFERENCE》 * |
周路旸等: "带足距辅助的双惯导行人导航硬件系统设计", 《电子技术应用》 * |
张金亮等: "基于MEMS惯性技术的鞋式个人导航系统", 《中国惯性技术学报》 * |
王立兵等: "足部安装MEMS-IMU个人导航系统", 《中国惯性技术学报》 * |
费程羽等: "行人惯性导航零速检测算法", 《传感器与微系统》 * |
韩勇强等: "基于足部安装MIMU的行人导航系统设计", 《导航定位与授时》 * |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111337050A (zh) * | 2020-03-20 | 2020-06-26 | 深圳市汇泰科电子有限公司 | 一种基于多条件融合的零速判断条件及计步方法 |
CN111337050B (zh) * | 2020-03-20 | 2023-03-28 | 深圳市汇泰科电子有限公司 | 一种基于多条件融合的零速判断条件及计步方法 |
CN111307148A (zh) * | 2020-04-03 | 2020-06-19 | 北京航空航天大学 | 一种基于惯性网络的行人定位方法 |
CN111721288A (zh) * | 2020-06-19 | 2020-09-29 | 哈尔滨工业大学 | 一种mems器件零偏修正方法、装置及存储介质 |
CN112762944A (zh) * | 2020-12-25 | 2021-05-07 | 上海商汤临港智能科技有限公司 | 零速区间检测及零速更新方法 |
CN112762944B (zh) * | 2020-12-25 | 2024-03-22 | 上海商汤临港智能科技有限公司 | 零速区间检测及零速更新方法 |
CN115956902A (zh) * | 2022-10-20 | 2023-04-14 | 国家体育总局体育科学研究所 | 一种以时间窗口进行比对同步的运动数据采集分析方法 |
CN115956902B (zh) * | 2022-10-20 | 2024-04-26 | 国家体育总局体育科学研究所 | 一种以时间窗口进行比对同步的运动数据采集分析方法 |
Also Published As
Publication number | Publication date |
---|---|
CN110274592B (zh) | 2021-07-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110274592A (zh) | 一种腰部脚部惯性测量单元信息融合的零速区间确定方法 | |
CN106482733B (zh) | 行人导航中基于足底压力检测的零速修正方法 | |
AU781848B2 (en) | Pedestrian navigation method and apparatus operative in a dead reckoning mode | |
CN109827577B (zh) | 基于运动状态检测的高精度惯性导航定位算法 | |
CN104061934B (zh) | 基于惯性传感器的行人室内位置跟踪方法 | |
CN106767790B (zh) | 人体下肢运动模型与卡尔曼滤波融合估计行人移动跟踪的方法 | |
CN109827568B (zh) | 基于mems传感器的多层建筑中行人高度位置估计方法 | |
CN102353383B (zh) | 基于单轴陀螺仪的计步及里程推算方法 | |
EP2948735A1 (en) | Method and apparatus for improved navigation for cycling | |
CN113295158B (zh) | 一种融合惯性数据、地图信息以及行人运动状态的室内定位方法 | |
CN104897158B (zh) | 一种步行者室内双层定位方法及系统 | |
KR101522466B1 (ko) | 보행자 발의 영속도 상태 검지 장치 및 그 방법, 및 이를 이용한 보행자 관성항법시스템 | |
CN104613965B (zh) | 一种基于双向滤波平滑技术的步进式行人导航方法 | |
Brahms et al. | Stride length determination during overground running using a single foot-mounted inertial measurement unit | |
CN109646009B (zh) | 基于便携式步态分析系统的步态时空参数的计算方法 | |
Li et al. | A robust pedestrian navigation algorithm with low cost IMU | |
Li et al. | A pedestrian navigation system based on low cost IMU | |
CN110207704A (zh) | 一种基于建筑楼梯场景智能识别的行人导航方法 | |
EP2613124A2 (en) | Robust method for signal segmentation for motion classification in personal navigation | |
KR101642286B1 (ko) | 보행특성을 이용한 실내에서의 보행자 이동방향 추정 방법 | |
Ruppelt et al. | A novel finite state machine based step detection technique for pedestrian navigation systems | |
CN108592907A (zh) | 一种基于双向滤波平滑技术的准实时步进式行人导航方法 | |
CN112362057A (zh) | 基于零速修正与姿态自观测的惯性行人导航算法 | |
Cho et al. | Threshold-less zero-velocity detection algorithm for pedestrian dead reckoning | |
KR101674816B1 (ko) | 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 |