室内人员自主定位系统的自适应静止检测方法技术方案

本发明专利技术公开了一种室内人员自主定位系统的自适应静止检测方法，包括步骤A.检测第一步的静止区间及运动区间；步骤B.检测第S步的静止区间及运动区间，其中S≥2，所述步骤B包括步骤：B1.计算第S-1步的运动区间内角速度的平均能量P；B2.取Th'＝Pr，若Th'＜E，则检测结果为静止，否则为运动；其中比例系数r的取值范围为(0，1)，r通过样本数据训练得到；E为第一步中采样时刻(n,n+W-1)到n+W-1的窗口内对应采样点角速度的平均能量值。本发明专利技术能够实现多步态运动模式下静止区间的检测，检测结果较精确。

【技术实现步骤摘要】

本专利技术属于室内人员自主定位
，特别涉及一种室内人员自主定位系统的 自适应静止检测方法，具体说是一种在各种步态情况下，稳健地探测脚步在地面静止时间 段的方法。
技术介绍
室内人员自主定位系统由惯性测量组件和手持处理终端组成，通过测量人员运动 的加速度及角速度等参数，对人员进行定位。由于其测量精度高，具有实时性，并且不需要 预装任何外部的设施，自主性强，因而具有巨大的军事应用意义和广泛的民用前景。室内人 员自主定位系统采用了MEMS(Micro-electromechanical Systems，微机电系统）的惯性测 量单元，因而具有成本低、体积小、功耗低等优点。 MEMS包括微型加速度计和微型陀螺仪，由于受制造工艺水平的限制，微型陀螺仪 在实际的应用中会产生漂移，而且漂移会随时间不断积累，导致定位误差不断增大。为抑制 陀螺漂移带来的定位误差，最常用的方法是采用基于扩展卡尔曼滤波的零速修正技术，该 方法的效果依赖于静止区间的检测精度。 目前常用的几种静止检测方法有加速度滑动方差检测法，加速度幅值检测法及角 速度能量检测法等，这些静止检测算法与零速修正算法结合，在人员走路步态下取得了较 好的修正效果。 由于现有的静止检测算法均采用固定的检测门限，因而将其应用于人员变步态行 走的模式时（如走跑交替进行等），会导致静止区间检测不准确，影响零速修正算法的效果 和定位的精度。
技术实现思路
由于采用固定的检测门限，现有的静止检测算法应用于变步态行走模式时，静止 区间检测不准确，进而影响零速修正算法的效果和定位的精度。本专利技术的目的在于，针对上 述现有技术的不足，提供一种。 为解决上述技术问题，本专利技术所采用的技术方案是： -种，包括步骤A.检测第一步的静 止区间及运动区间；步骤B.检测第S步的静止区间及运动区间，其中S3 2,所述步骤B包括步 骤： .计算第S-1步的运动区间内角速度的平均能量P; B2.取Th ' =Pr，若Th ' <E，则检测结果为静止，否则为运动；其中比例系数r的取值 范围为(〇，1)，r通过样本数据训练得到;E为第一步中采样时刻(η，η+W-l)到η+W-l的窗口内 对应采样点角速度的平均能量值。由于静止区间的能量残余与步态相关，而运动区间的角速度能量可以比较直观地 反映步态信息。因此可通过已有固定门限的静止检测算法检测出第一步的静止及运动区 间，然后计算第s-l步的运动区间内角速度的平均能量P，并将P乘以比例系数r作为第S步静 止检测的门限。 2 作为一种优选方式，所述步骤B i中？=士客|^||，其中k为采样点， w, =(<·<,n')）为第k个采样点陀螺仪的输出，Wk中三个元素分别表示 k时刻陀螺仪三个轴 向的角速度，1为第S-1步中运动区间的起点，m为第S-1步中运动区间的终点，N为第S-1步中 运动区间的长度，N=m-1+1。 作为一种优选方式，选取使静止检测误判率最低时对应的比例系数为r。 作为一种优选方式，所述步骤A包括步骤 Ai.采集陀螺仪第k个采样点的输出％=(?<)，概中三个元素分别表示1^时 刻陀螺仪三个轴向的角速度，取滑动窗口长度为W，为3~9之间的奇数； 1 n+W-i 4 Α2·求得:E=·^ ^ k~n A3.通过训练得到固定门限Th，将Th与E比较，若Th<E，则所检测的窗□为静止，反 之为运动； A4.窗口区间从(n，n+w-l)更新为(n+l，n+W)，计算更新后窗口角速度的平均能量 并与Th比较，若Th小于更新后窗口角速度的平均能量，则更新后的窗口为静止，反之为运 动； A5.重复步骤A4,直至判定结果出现变化，即，窗口状态由静止变为运动，或者由运 动变为静止;若上一个窗口判定结果为静止，而当前窗口结果为运动时，则当前窗口之前的 连续出现判定结果为静止的采样时刻构成的区间为静止区间;若上一个窗口判定结果为运 动，而当前窗口结果为静止时，则当前窗口之前的连续出现判定结果为运动的采样时刻构 成的区间称为运动区间。 与现有技术相比，本专利技术能够实现多步态运动模式下静止区间的检测，检测结果 较精确。【附图说明】图1为本专利技术一实施例处理流程示意图。图2为应用本专利技术的静止检测效果图。图3为本专利技术与现有采用固定门限静止检测算法的定位效果对比图。【具体实施方式】具体实施过程中，惯性测量传感器安装在鞋尖处，采样率为200Hz，实验沿着长边 为31m，短边为14m，宽2.3m的L型走廊行走一圈后再跑一圈。结合附图1，本专利技术包括如下步骤： 步骤1(包括步骤心~知）：检测第一步的静止及运动区间。 Αι采集陀螺仪第k个采样点的输出'^=(<,?>，《冲三个元素分别表示1^时 刻陀螺仪三个轴向的角速度，其变化范围在± 1200度/秒，取滑动窗口长度为W，为3~9之间 的奇数； A2.求得采样时刻(n，n+W-l)到η+W-l的窗口内对应采样点角速度的平均能量值E， 1 n-\-W -I - E=w Σ 1^-1; rr k-n A3.通过训练得到固定门限Th，取固定门限Th = 1 X 105，将Th与E比较，若Th <E，则 所检测的窗口为静止，反之为运动； A4.滑动窗向后移动一个采样点，即窗口区间从(n，n+w-l)更新为(n+l，n+W)，计算 更新后窗口角速度的平均能量并与Th比较，若Th小于更新后窗口角速度的平均能量，则更 新后的窗口为静止，反之为运动； A5 .重复步骤A4,直至判定结果出现变化，即，窗口状态由静止变为运动，或者由运 动变为静止;若上一个窗口判定结果为静止，而当前窗口结果为运动时，则当前窗口之前的 连续出现判定结果为静止的采样时刻构成的区间为静止区间;若上一个窗口判定结果为运 动，而当前窗口结果为静止时，则当前窗口之前的连续出现判定结果为运动的采样时刻构 成的区间称为运动区间。由此可获得第一步的静止及运动区间，如图2所示。 图2中横坐标为采样时刻，纵坐标为角速度幅度，单位为°/s。静止检测结果曲线中 幅度为200(此幅度仅为便于观察检测结果与角速度之间的关系，根据角速度的幅度曲线对 其进行调幅，无具体含义)表示静止，幅度为〇表示运动。从图2中可以看出，静止检测结果能 较好的反映出真实情况，没有出现真实状态为静止或运动，而检测结果与其相反，即没有出 现一段完整的运动或静止区间被误判点打断的情况。 步骤2:计算第一步运动区间角速度的平均能量。 利用步骤1获得的第一步的运动区间，计算运动区间内角速度的平均能量： P=H^||w』。由图2知，第一步的运动区间起点1 = 2956，第一步的运动区间终点m=3092， N=137〇 步骤3:由前一步的角速度平均能量对当前步的静止区间进行检测。 将步骤2获得的运动区间的平均能量P与比例系数r的乘积作为新的检测门限Th' 对当前步进行检测，即若Th'小于E，则检测结果为静止，否则为运动;其中比例系数r的取值 范围为(〇，l)，r通过样本数据训练得到，选取使静止检测误判率最低时对应的比例系数为 r〇 步骤4:重复步骤2和步骤3的过程，逐步对静止区间进行检测。已获得第s步的静止及运动区间（s>l)，计算第s步运动区间内角速度的平均能量，本文档来自技高网...

【技术保护点】
一种室内人员自主定位系统的自适应静止检测方法，包括步骤A.检测第一步的静止区间及运动区间；步骤B.检测第S步的静止区间及运动区间，其中S≥2，其特征在于，所述步骤B包括步骤：B1.计算第S‑1步的运动区间内角速度的平均能量P；B2.取Th'＝Pr，若Th'＜E，则检测结果为静止，否则为运动；其中比例系数r的取值范围为(0，1)，r通过样本数据训练得到；E为第一步中采样时刻(n,n+W‑1)到n+W‑1的窗口内对应采样点角速度的平均能量值。

【技术特征摘要】

【专利技术属性】
技术研发人员：王雅敏，
申请(专利权)人：长沙格致电子科技有限公司，
类型：发明
国别省市：湖南;43