CN108645406A - 一种基于分数域行人运动感知的室内自主定位方法 - Google Patents
一种基于分数域行人运动感知的室内自主定位方法 Download PDFInfo
- Publication number
- CN108645406A CN108645406A CN201810351686.7A CN201810351686A CN108645406A CN 108645406 A CN108645406 A CN 108645406A CN 201810351686 A CN201810351686 A CN 201810351686A CN 108645406 A CN108645406 A CN 108645406A
- Authority
- CN
- China
- Prior art keywords
- score field
- pedestrian
- indoor
- positioning method
- motion
- 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.)
- Pending
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/20—Instruments for performing navigational calculations
- G01C21/206—Instruments for performing navigational calculations specially adapted for indoor 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/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
- G01C21/18—Stabilised platforms, e.g. by gyroscope
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manufacturing & Machinery (AREA)
- Navigation (AREA)
Abstract
一种基于分数域行人运动感知的室内自主定位方法,包括:(1)针对室内行人的多运动行为,对穿戴在腰部并已标定补偿好的惯性测量单元,进行惯性数据采集、滤波平滑处理并输出;(2)利用处理后敏感轴加速度计输出信号在时域的周期性变化进行划分,并在每个划分的周期内进行分数域的多种运动特征的提取;(3)根据明显的特征分类,便可用最简化的分类器进行机器学习后的分类;(4)利用改进的航向修正、运动状态过渡和楼层约束辅助航位修正算法,在捷联解算的基础上进行误差校正;(5)通过行人运动过程中航向估计、步长估计和步数统计关键三要素推算出其位置信息。该发明在面向室内定位方面,从便捷度和精准度两个角度都提供了有力支持。
Description
技术领域
本发明属于导航定位技术领域,特别是涉及一种基于分数域行人运动感知 的室内自主定位方法。
背景技术
近些年,随着谷歌、Facebook、BAT等互联网巨头的参与促进,位置服务 LBS(Location Based Services)有了空前的市场规模和发展前景。瑞典市场研究 公司BergInsight发布最新报告预测,全球LBS市场规模将以22.5%的复合年增 长率从2014年的103亿欧元,增加至2020年的248亿欧元。尚普咨询发布的 《2014-2018年中国LBS行业深度研究及前景预测报告》预测2018年我国LBS 行业市场规模将突破1100亿元。在其LBS市场划分的8个垂直领域内,家庭及 人员定位服务便是一块极大的服务应用群体。在行人导航与定位领域内,室外 的卫星定位技术可以说已经发展得十分成熟且精度、可靠度甚好,但在室内楼 宇、隧道、地下等密闭环境下,由于卫星信号的强度减弱,搜星效果不理想甚 至无信号,那么,此种手段将无用武之地。
针对这一现象,当前室内定位普遍采取的定位方法主要分为两类:有信标 和无信标。一般通过WIFI、UWB以及RFID等预置节点手段进行定位的成为有 信标定位方式,主要应用于大型商场、机场、医院等可以随建筑物施工期间的 同时,进行合理分布安装并可后期投入到使用当中。但随之而来的弊端就是当 遭遇突发灾难、停电、硬件失灵等情况时,人员室内定位的功能便丧失甚至错 误导航定位,严重的话会给个人和国家带来极大的损失。相比之下,对于无需 提前布置节点的无信标自主定位手段,通常采用惯性传感器进行行人的位置推 算,无需依赖外界的任何辅助,自主性极强,可以很好地解决上述面临的问题。 但微机电系统-惯性测量单元MEMS-IMU(Micro-Electro-Mechanical System-Inertialmeasurement unit)的传感器的主要缺点就是,由器件本身特性所 带来的漂移现象:其随着时间的推移,会相应地累计误差,使输出的惯性数据 精度越来越差,解算的结果也会慢慢发散开来不会收敛。
针对将惯性测量单元佩戴在行人身体上进行正常运动时,众所周知,腰部 的运动不像脚部会与地面形成20ms左右的零速时刻,故脚部安置定位装置所应 用的那一套传统的零速修正定位算法架构并不适用于佩戴在腰部定位这一范 畴。该领域的一些专家学者便提出了行人航位推算方法(PDR,Pedestrian Dead Reckoning),其本质便是提取PDR模型的三个关键点:步数,步长以及航向, 从而以推算的方式,每步为单位,最终得到行人的行进轨迹。这其中的重中之 重环节则是识别感知出行人的具体行为模式:有些学者所提出的是在时域本身, 来进行对运动行人惯性信号的处理与识别,但这样所需的训练样本很大,特征 分类重叠性高,效率低,分类器设计相对复杂;同时,也有些专家是将其变换 至频域进行分类识别,但是庞大的计算量以及对训练过程所需硬件的要求过高 都是该方向的一个瓶颈;因而也不难想到,之后就有说将上述二者方法融合进 行分类的思想,但是虽然该过程保留了二者的优势,但与此同时双方的缺点均 得到累加放大,信息的冗余量也瞬间陡增,致使整套系统显得托大而笨拙。
而本发明的思想则是源于如何找到一座桥梁介于上述时、频双域之间,有 所联系但不是单纯地累加,相反是行之有效地使得感知识别系统相对“减负”。 故而想到了利用在“线性调频类信号”领域里应用的分数域理论,即时频平面 经旋转变换后的一种中间态,并通过本专利首次引入惯性导航领域中,来处理 惯性器件的输出信号。本发明所需的训练样本量很小,并且可以有效地选取合 理变换后的特征向量,进而尽量大地拉开了鉴别“距离”,减小冗余覆盖的部分, 从而提高分类的精度和效率。同时也因此,对于分类器的设计要求也大大地降 低,简化了系统难度。
综上便是本发明的研究背景技术以及相较同领域研究的一些优点和创造 性。可以说,在某种程度上本发明从高效性、可靠性、复杂性以及精确性等角 度都给予了其它相关研究所不具备或不同时具备的先进性、新颖性和创造性。
发明内容
本发明的主要目的在于:面向室内定位,在无卫星定位且将可穿戴定位装 置(MEMS-IMU)安装在腰部:无明显零速时刻的情况下,通过采集行人该部 位惯导的数据并且对其敏感轴加速度计进行运动周期划分和相对应的分数域变 换。根据不同行为运动:目前暂面向研究的是行人室内的走、跑、跳、上下楼 走、上下楼跑这7种基本运动。收集其不同的特征向量,进行训练、学习与分 类。同时配以改进的HDE航向修正算法,多运动切换之间的运动状态过渡修正 算法以及楼层约束算法进行辅助校正。根据“航向”、“步长”以及“步数”三 要素推算出准确的行人室内的位置信息。
为了实现上述目的,本发明采用如下技术方案:
一种基于分数域行人运动感知的室内自主定位方法,包括以下步骤:
步骤1,针对在特定的应用背景下人体的多运动行为,对其穿戴在腰部并已 标定补偿好的惯性测量单元,进行惯性数据的采集、滤波平滑处理并输出;
步骤2,利用处理后敏感轴加速度计输出信号在时域的周期性变化进行划 分,并在每个划分的周期内进行分数域的多种运动特征的提取;
步骤3,根据明显的特征分类,便可用最简化的分类器进行机器学习后的分 类;
步骤4,用改进的航向修正、运动状态过渡和楼层约束辅助航位修正算法, 在捷联解算的基础上进行误差校正;
步骤5,通过行人定位推算过程中航向估计、步长估计和步数统计关键三要 素得出行人的推算水平位置信息(空间位置信息由“压强相对高度差(每一步 的阶梯高度)”和“楼层约束”部分解出)。
进一步的,所述步骤1中,将其标定补偿后的惯性测量单元数据输出,用 于其它环节的解算过程。并单独将敏感轴,即垂直于地面方向的加速度计数据, 进行巴特沃斯滤波平滑过程,输出近似幅值、等频的“正弦波”信号。
进一步的,所述步骤2中,利用上述步骤1中滤波平滑后的敏感轴加速度 计值,进行运动周期的划分。并在每段运动周期内将其敏感轴加速度计信号进 行分数域变换,得到各种运动区分度较大的一些变换后特征,组成特征向量。 经反复地筛选考量,为降低特征的覆盖、冗余性,最终组成用于区分多运动的 特征向量的特征包括如下几条:(1)分数域变换后输出的均值;(2)分数域变 换后输出的标准差;(3)分数域变换后输出的四分位差;(4)分数域变换后输 出的幅值差;(5)时域中压强计输出的相对高度差(用于鉴别有高度变化的运 动)。
进一步的,所述的步骤3中,由于特征向量选取的合理,区分效果度明显, 故通过训练学习,后期可送入最简化的分类器中进行有效分类,验证感知运动 模式阶段。这样不仅提高了分类精度而且无需设计复杂繁琐的分类器进行工作, 大大地提升了整个系统的效率。
进一步的,所述的步骤4中,通过改进的HDE航向修正算法,多运动切换 之间的运动状态过渡修正算法以及楼层约束算法这三个针对特定环境下应用的 辅助航位修正方法,有效地解决了纯惯性导航由于长时累积误差、高度通道发 散,致使所捷联解算的空间位置信息发散不准确这一固有特性。
进一步的,所述的步骤5中,根据校正过的航向、步长,以及通过周期划 分统计出的步数这三个行人定位的关键三要素,最终推算出精确的行人水平位 置信息(空间位置信息由“压强相对高度差(每一步的阶梯高度)”和“楼层约 束”部分解出)。
与现有技术相比,本发明的有益效果是:
(1)本发明找到一座桥梁介于上述时、频双域之间,有所联系但不是单纯地 累加,相反是行之有效地使得感知识别系统相对“减负”。故而想到了利用在“线 性调频类信号”领域里应用的分数域理论,即时频平面经旋转变换后的一种中 间态,并通过本专利首次引入惯性导航领域中,来处理惯性器件的输出信号。 本发明所需的训练样本量很小,并且可以有效地选取合理变换后的特征向量, 进而尽量大地拉开了鉴别“距离”,减小冗余覆盖的部分,从而提高分类的精度 和效率。同时也因此,对于分类器的设计要求也大大地降低,简化了系统难度;
(2)本发明相较已有的那些有线或设立预知节点等相关的室内定位方法,其 可靠性相对更高,而且无需预先知道当地的室内结构及布局,使用灵活性也较 好;
(3)本发明通过改进的HDE航向修正算法,多运动切换之间的运动状态过 渡修正算法以及楼层约束算法作为辅助校正方法,有效地在室内这个特定的应 用背景下,得到更高精度,轨迹效果更好的定位结果;
(4)本发明的定位终端具有可穿戴的特点,使用户操作起来更加便捷,且无 需进行复杂的预先设置以及背负较大的定位装备,真正实现了小巧便捷、灵活 好用的技术效果。并真正解决了佩戴其在腰部,在无明显零速时刻可进行零速 修正的情况下,依旧可以推算出较好的行人室内的定位结果。
附图说明
图1为基于分数域行人运动感知的室内自主定位方法流程图;
图2为巴特沃斯低通滤波信号处理图;
图3为分数域变换:(t,ω)平面旋转α角到(u,v)平面图;
图4为室内行人7种基本运动形式图;
图5为同一种运动不同变换阶次的效果图;
图6为同一种变换阶次不同运动的效果图;
图7为两种运动形式特征向量对比示意图;
图8为改进的HDE航向修正效果图;
图9为运动切换过渡带示意图。
图10为压强计相对高度最小二乘拟合线性标定化效果图。
图11为行人上楼梯时每个运动周期即每阶楼梯高度分辨能力图。
图12为楼层约束技术流程图。
具体实施方式
本发明提供的一种基于分数域行人运动感知的室内自主定位方法的流程如 图1所示:
在无或弱卫星信号的室内环境中进行行人自主定位。将可穿戴的定位装置 安装在腰部:在无明显零速时刻的情况下,通过采集行人该部位惯导的数据并 且对其敏感轴加速度计进行运动周期划分和相对应的分数域变换。根据不同行 为运动:目前暂面向研究的是行人室内的走、跑、跳、上下楼走、上下楼跑这7 种基本运动。收集其不同的特征向量,进行训练,学习和分类。同时配以改进 的HDE航向修正算法,多运动切换之间的运动状态过渡修正算法以及楼层约束 算法进行辅助,根据“航向”、“步长”以及“步数”三要素推算出准确的行人 室内的位置信息。
具体步骤如下:
步骤1,针对在特定的应用背景下人体的多运动行为,对其穿戴在腰部并已 标定补偿好的惯性测量单元,进行惯性数据的采集、滤波平滑处理并输出;
从惯性器件层面研究系统误差,对系统误差进行分析、建模及补偿标定, 以消除MEMS-IMU系统的确定性误差,提高之后输出数据的测量精度。系统误 差标定的方法为建立精确的系统误差模型,设计完整的标定试验并使用精密测 试设备对相关系数进行辨识,最后对系统输出进行软件补偿。该方法主要用于 消除系统的确定性误差,包括刻度因数误差、交叉耦合误差、安装误差等,是 提高惯性测量系统精度的重要手段。
综上MEMS-IMU惯性器件的误差可分为4类:零位误差、比例系数误差、 交叉耦合误差和随机误差。而在MEMS-IMU模块导航定位解算过程中,陀螺输 出的精度和稳定性起着更为关键性的作用。加速度计的标定补偿可同陀螺仪标 定原理进行类似处理,但一般只进行零位误差、比例系数误差补偿即可在本专 利中使用。因此,此处仅以陀螺标定描述为例,其误差模型可描述为:
其中,Aq为陀螺原始输出值向量;N表示陀螺角速率零位输出值向量,N1为 粗标定零位输出,N(T)为温度相关零位输出,N(a)为加速度相关零位输出;SF 表示比例系数矩阵,SF1为粗标定比例系数,SF2(Ω)为对应输入角速率的比例系 数;CR表示交叉偶合系数矩阵;v(t)为随机噪声信号;为误差补偿后的角速 率输出向量。
将式(1)表示的误差模型可以展开为:
式中,
Aq=[ωx ωy ωz]T为三轴陀螺仪的原始数字量输出;
为误差补偿后的角速率输出向量;
N=[Nx Ny Nz]T为与陀螺仪的零位误差;
为相对温度的最小二乘拟合系数;T为陀螺 仪的温度项,Ai,Bi,Ci为相对温度的最小二乘拟合系数;
为加速度相关零位输出;a为陀螺仪所受的 加速度,Di,Ei,Fi为相对加速度值拟合的最小二乘系数;
kx,ky,kz分别为粗标定比例系数;
KΩx,KΩy,KΩz分别为三轴陀螺对应输入角速率的比例系数;
为陀螺组合交叉耦合系数矩阵;
vx,vy,vz分别为三轴陀螺仪的随机噪声信号。
利用精密三轴位置速率转台、高低温试验箱、离心机等设备对陀螺惯性组 合系统进行试验,辨识误差模型中的各项系数,代入误差模型即可实现系统误 差补偿。
行人在运动时,腰部垂直方向的加速度,即敏感轴方向,呈现周期性变化 较为明显,因此只选择垂直方向上的加速度进行处理与分析。首先对采集到的 垂直方向加速度数据,进行采样率Fs=1000,截止频率为50Hz,归一化频率 Wc=2*50/Fs,滤波器阶数n=10的低通巴特沃斯滤波处理。滤波后的效果如图2 所示。
步骤2,利用处理后敏感轴加速度计输出信号在时域的周期性变化进行划 分,并在每个划分的周期内进行分数域的多种运动特征的提取;
垂直方向上的加速度周期信号每一个周期即代表一步前进动作(-9.8m/s2至 下一个-9.8m/s2为1步的运动周期),因此可以通过提取每一个周期内该信号的 相关特征来对行人进行实时的运动感知。
传统的Fourier变换在信号处理方面是一个十分成熟且应用广泛的数学工 具。从广义的角度出发,如果将其传统的Fourier线性算子看作从时间轴逆时针 旋转π/2到频率轴、可旋转任意角度α的算子得到新的信号表达,这便是分数阶 Fourier变换的本质,如图3所示。并且它将保留传统Fourier变换的性质和特点, 又添加了其它特有的新优势。可以说分数域是一座时域、频域分析之间一座独 特而新颖实用的桥梁。
分数阶Fourier变换的定义有多种,且都是相互等价可推的。通常的定义理 解如下:
基本定义:定义在u′域的函数f(u′)的p阶分数阶Fourier变换是一个线性 积分运算。
其中Kp(u,u′)=Aαexp[jπ(u2cotα-2uu′cscα+u′2cotα)],成为分数阶Fourier 变换的核函数,p≠2n,n是整数。
当p=4n(α=2nπ)时Kp(u,u′)≡δ(u-u′);当p=4n±2(α=(2n±1)π) 时Kp(u,u′)≡δ(u+u′)。经变量代换,fp(u)可以表示为:
注意到F4n和F4n±2分别相当于恒等算子τ和奇偶算子P。对p=1,有 Aα=1,且
可见,f1(u)就是f(u′)的普通Fourier变换,函数的零阶变换被定义为等于 该函数本身:由于仅出现在三角函数的参数位置上,所以以p(或α)为 参数的定义是以4(或2π)为周期的。因此只需考察区间p∈(-2,2](或α∈(-π,π]) 即可。
至于选择分数域变换来提取特征向量的原因,除了上述的一些对比时域、 频域的原因以外,从理论上的时宽-带宽积的推导角度看,其意义更为强烈:
由分数域采样定理可知,分数域带宽Bu与频域带宽B的关系为:
Bu=Bsinα (6)
其中α为分数域旋转角度,α=p·π/2。
分数域新号的时宽、带宽定义如下:
其中,ua为分数域频率,x(ua)为信号x(t)的分数域变换。
由信号频域的不定原理知:
即
其中,△t为信号的时宽,而△u为信号的带宽。
由(7),(8),(9)三个公式可推导出分数域的不确定原理:
即
由Parseval知,信号在时域的能量与分数域的能量相同:
E=Eα (11)
E为时域总能量,Eα为分数域总能量。
而,
结合(10),(11),(12)公式可知,信号的时域幅度平均与分数域的 幅度呈现非线性的变化关系。且与分数域变化的角度有关。
因此,我们可以通过选择合适的α角度,利用这一非线性的转换,使得在 时域幅度差不明显的一序列值转化为幅值差明显的分数域序列,从而可有效地 区分各类运动特征信号,达到使用该方法的目的。
特征值提取过程概述如下:
a)均值
式中,ai为敏感轴加速度计经过低通滤波后,第i个采样点的输出加速度值,n为单周期数据的个数,Frftp(*)为p阶分数域变化并取信号(虚数)模值一过 程,ave为单周期内敏感轴加速度经p阶分数域变换后,输出幅值的均值。
b)标准差
式中,σ为单周期内加速度计输出经p阶分数域变换后的标准差。
c)四分位差
四分位差为第3四分位数和第1四分位数之间的差。p阶分数变换后的加 速度数据Frftp(ai)由小到大排序为bi,i=1,2,3…n,四分位数的位置为 pj=1+(n-1)·j/4,j=1,2,3,kj为pj的整数部分,rj为pj的小数部分,四分位 数Qj和四分位差IQR分别为:
IQR=Q3-Q1 (16)
d)幅值差
在分割后的单个周期中,Frftp(ai)的最大值与最小值之差d,亦作为一个分 类特征,如下式表达:
d=max(Frftp(a1)…Frftp(an))-min(Frftp(a1)…Frftp(an)) (17)
e)压强计相对高度差
考虑到行人在上下楼梯时高度变化会产生压强的变化,因此用压强计在时 域直接引入压强信息,然后将压强转换为高度信息,并将之最小二乘线性拟合 化。再选取单周期内的高度变化作为一项特征:单周期内,用周期高度终值与 周期高度初值做差,得到相对高度差H,如下所示:
H=Hn-H1 (18)
若H为正,表明高度在变大,行人在上楼梯;若为负,表明高度在减小, 行人在下楼梯。
综上,可构成整体的特征向量,如下表示:
feature_vector=[ave,σ,IQR,d,H] (19)
步骤3,根据明显的特征分类,便可用最简化的分类器进行机器学习后的分 类;
本发明针对室内行人的7种基本运动形式,如图4所示;
根据步骤2中,分数域变换,同种运动不同变换阶次的效果图,如图5所示;
根据步骤2中,分数域变换,同种变换阶次对应不同运动形式的效果图, 如图6所示;
根据公式(12)所收集的特征值,此处以走和走-上楼为例进行对比,如图7 所示。
不难发现,所用于区分不同运动形式的“分类距离”较大,可用于的机器 的训练与学习过程。故因而可选用最简单的分类器便可完成高识别率、高效率 的分类结果。
步骤4,用改进的航向修正、运动状态过渡和楼层约束辅助航位修正算法, 在捷联解算的基础上进行误差校正;
a)改进的航向修正技术
基于室内环境多为直线的事实,当行人走直线时,航向角变化较小,利用 航向角偏差去修正陀螺仪输出,从而抑制陀螺仪的漂移。HDE算法对陀螺仪修 正后,利用角速率积分得到航向角,但积分会再次引入角度误差。本发明在HDE 算法思想的基础上,直接利用航向角偏差来修正捷联解算出的航向角,而不对 陀螺仪的角速率输出进行操作,从而避免因角速率积分而引入的误差。
利用HDE算法修正航向,首先需要判定行人的运动轨迹是否为直线,通常 是利用当前航向与历史航向的变化幅值来判断,如下式所示:
如果△ψk<th,则表示航向变化不明显,行人在沿直线行进,可以使用该算 法对航向进行修正。
确定行人在走直线轨迹后,采用下式对航向进行直接修正:
式中,为校正后的航向,a,b为经验常数,△αk为当前航向与主方向的 偏差。
行人初始的主方向为0,沿顺时针方向依次分为45、90、135、180、225、 270、315,共8个主方向,角度间隔δ为45度,当前航向与主航向的偏差可以 用下式进行计算:
式中,INT(x)为取整函数,ψk为当前航向角。
修正效果如图8所示。
b)运动状态过渡修正技术
众所周知,当行人运动的过程中,总会有运动状态切换这一过程,与此同 时若按照局部单一化无衔接过程直接推算,便会带来或多或少的定位误差量。
定位误差来源,简单来说即:运动切换的过渡过程,示意如图9所示,误差 大小取决于运动状态切换的频率以及不同行人的自身运动控制能力。特别是在 室内,这种特殊的环境下,由于运动惯性带来的误差,主要发生在“跑”的切 换前后阶段。因而,过渡带的定义和修正点也需要分情况讨论。
同一楼层的走-跑切换:根据前后切换的运动状态,找到切换点,再根据行 人个体的运动习惯,以切换点为中心前后留出适当的n个运动周期作为过渡带, 从新推算此阶段:以n个周期的前一时刻为起点,由于误差来源于加速或降速 的过程,过渡带根据原有跑步的步长模型(步骤5中体现),适当改变其系数, 从而推算出合理的因运动惯性带来的过渡带距离,从而减小推算误差,直至与 n+1的状态衔接上并开始其自己的行位推算过程。
跑与上、下楼梯走的组合:由于此种运动状态的特殊性(压强值的变化), 此处爬楼过程便不给予过渡带的分配,只在跑的阶段分配恰当的加速与降速运 动周期作为过渡带,同上修改步长重新推算。
上、下楼梯跑到走的组合:同理,只在走的阶段分配恰当的降速运动周期 作为过渡带,同上修改步长重新推算。
跑与跳的组合:由于跳运动状态的特殊性(位移不变),此处跳跃过程便不 给予过渡带的分配,只在跑的阶段分配恰当的加速与降速运动周期作为过渡带, 同上修改步长重新推算。
c)楼层约束技术
惯性导航定位中,本身就存在捷联解算高度通道发散的特性。故此,配以 惯性器件压强计所输出相对高度的差值进行垂直距离的约束,是一个行之有效 的办法。但其采集的原始数据如下图10所示,只有趋势却并不恒定,并无法使 我们将之数值化为我们所用,故采用最小二乘拟合的方法将其线性标定化,效 果图如图10所示。
将行人运动每迈的一步,划分为一个运动周期,并将上述爬楼过程局部放 大,如图11所示,可以看出行人每一步即每走一阶楼梯的高度,基本恒定在台 阶高度15cm左右,垂直距离分辨效果还是十分理想的。
接下来进入楼层约束方法:根据行为识别出上下楼时刻的结束点,即上下楼后 的第一个其他运动形式,且检测到了下一运动状态,届时的压强相对高度值约 等于楼层高度乘以某一层数差(阈值限定)的结果时,下一时刻开始的垂直高 度,就人为地将其拉至此楼层且固定不变,直至再次检测到上下楼状态,再次 改变高度值。这样便有效地提升三维空间的定位推算精度,同层运动的高度得 以限制,轨迹线型得到完善,同时也避免了惯导捷联解算高度通道的发散问题。 技术理论流程图如图12所示。
步骤5,通过行人定位推算过程中航向估计、步长估计和步数统计关键三要 素得出行人的推算水平位置信息(空间位置信息由“压强相对高度差(每一步 的阶梯高度)”和“楼层约束”部分解出)。
MEMS-IMU惯性行人室内定位的思想是行人航位推算(PDR):即在已知初 始点的情况下,结合行人的步长和航向这两个信息,从而推算出下一个位置点, 实现公式如下所示:
其中,Lk与分别表示行人的第k步的步长和航向;当k=1时,E0,N0表 示行人东向和北向的初始位置坐标。
由于每一步的PDR推算中,需要的两种导航信息:步长与航向。因此其每 一步最终的定位精度也是由这两个因素所决定。其中航向估计以及步数统计分 别可以通过步骤4改进的HDE航向修正算法以及步骤1中敏感轴加速度计周期 划分乘以2可以得到。步长则需要建立准确的步长模型进行步长估计,而且对 于不同的运动形式,运动之间的步长差异性较大,因此为了提高步长估计的精 度,在运动感知的基础上,对于不同的运动形式,分别采用不同的步长模型来 估计步长。至于步长模型的建立阐述如下:
a)行走
行走,是行人运动状态中最为常见也是较为平缓的运动形态。因此采用线 性的步长模型来估计步长较为理想,如下式:
SLwalk=A+B×SF+C×SV (24)
其中,SLwalk为行走步长,SF为步频,SV为每一步的加速度方差,A,B, C为不同行人的经验系数。
b)跑步
相较行走而言,跑步状态则是更为剧烈的一种运动形态。故采用非线性步 长模型进行估计,如下式所示:
其中,SLrun为跑步步长,Amax与Amin为每一步加速度值的最大值与最小值, K亦为针对不同行人的经验相关系数。
c)上、下楼梯
上、下楼梯可以看作是上述状况行人行进的进阶版。其不仅是在二维平面 上的位置移动,其还存在高度上的变化,因此需要在平面位移的基础上,加上 高度的变化,如下式所示:
其中,SLstairs为爬楼运动的水平步长,SH为每一步的高度变化,ρwalk与ρrun分别为台阶前移的适应参数,△H为压强计的高度变化,ρ亦为高度方向的不同 行人的经验相关系数。
d)跳
原地蹦跳运动,可近似看作行人没有空间上的位移,步长模型可直接近似 为零,且航向基本保持不变。
e)与跑相关的过渡带
根据运动状态过渡修正技术小节中的描述,视不同的情况,调整步长系数 进行新的推算。ρ′walk,ρ′run为调整后新系数,过渡带步长表达式如下:
由上述五步,便可完成这种基于分数域行人运动感知的室内自主定位方法 的设计发明。
本发明提供的这种基于分数域行人运动感知的室内自主定位方法,不仅提 高了惯性器件的定位精度,解决了腰部无明显零速时刻修正位置信息的瓶颈, 并且还利用其可穿戴的特点,降低了用户使用其定位服务时的条件与难度,提 升了其便捷度。
以上仅是本发明的具体应用范例,对本发明的保护范围不构成任何限制。 凡采用等同变换或者等效替换而形成的技术方案,均落在本发明的权利保护范 围之内。
Claims (6)
1.一种基于分数域行人运动感知的室内自主定位方法,其特征在于:包括以下步骤:
步骤1,针对在特定的应用背景下人体的多运动行为,对其穿戴在腰部并已标定补偿好的惯性测量单元,进行惯性数据的采集、滤波平滑处理并输出;
步骤2,利用处理后敏感轴加速度计输出信号在时域的周期性变化进行划分,并在每个划分的周期内进行分数域的多种运动特征的提取;
步骤3,根据明显的特征分类,便可用最简化的分类器进行机器学习后的分类;
步骤4,用改进的航向修正、运动状态过渡和楼层约束辅助航位修正算法,在捷联解算的基础上进行误差校正;
步骤5,通过行人定位推算过程中航向估计、步长估计和步数统计关键三要素得出行人的推算水平位置信息(空间位置信息由“压强相对高度差(每一步的阶梯高度)”和“楼层约束”部分解出)。
2.根据权利要求1所述的基于分数域行人运动感知的室内自主定位方法,其特征在于:所述步骤1中,将其标定补偿后的惯性测量单元数据输出,用于其它环节的解算过程。并单独将敏感轴,即垂直于地面方向的加速度计数据,进行巴特沃斯滤波平滑过程,输出近似幅值、等频的“正弦波”信号。
3.根据权利要求1所述的基于分数域行人运动感知的室内自主定位方法,其特征在于:所述步骤2中,利用上述步骤1中滤波平滑后的敏感轴加速度计值,进行运动周期的划分。并在每段运动周期内将其敏感轴加速度计信号进行分数域变换,得到各种运动区分度较大的一些变换后特征,组成特征向量。经反复地筛选考量,为降低特征的覆盖、冗余性,最终组成用于区分多运动的特征向量的特征包括如下几条:
(1)分数域变换后输出的均值;
(2)分数域变换后输出的标准差;
(3)分数域变换后输出的四分位差;
(4)分数域变换后输出的幅值差;
(5)时域中压强计输出的相对高度差(用于鉴别有高度变化的运动)。
4.根据权利要求1所述的基于分数域行人运动感知的室内自主定位方法,其特征在于:所述的步骤3中,由于特征向量选取的合理,区分效果度明显,故通过训练学习,后期可送入最简化的分类器中进行有效分类,验证感知运动模式阶段。这样不仅提高了分类精度而且无需设计复杂繁琐的分类器进行工作,大大地提升了整个系统的效率。
5.根据权利要求1所述的基于分数域行人运动感知的室内自主定位方法,其特征在于:所述的步骤4中,通过改进的HDE航向修正算法,多运动切换之间的运动状态过渡修正算法以及楼层约束算法这三个针对特定环境下应用的辅助航位修正方法,有效地解决了纯惯性导航由于长时累积误差、高度通道发散,致使所捷联解算的空间位置信息发散不准确这一固有特性。
6.根据权利要求1所述的基于分数域行人运动感知的室内自主定位方法,其特征在于:所述的步骤5中,根据校正过的航向、步长,以及通过周期划分统计出的步数这三个行人定位的关键三要素,最终推算出精确的行人水平位置信息(空间位置信息由“压强相对高度差(每一步的阶梯高度)”和“楼层约束”部分解出)。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810351686.7A CN108645406A (zh) | 2018-04-19 | 2018-04-19 | 一种基于分数域行人运动感知的室内自主定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810351686.7A CN108645406A (zh) | 2018-04-19 | 2018-04-19 | 一种基于分数域行人运动感知的室内自主定位方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN108645406A true CN108645406A (zh) | 2018-10-12 |
Family
ID=63746782
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810351686.7A Pending CN108645406A (zh) | 2018-04-19 | 2018-04-19 | 一种基于分数域行人运动感知的室内自主定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108645406A (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109682372A (zh) * | 2018-12-17 | 2019-04-26 | 重庆邮电大学 | 一种结合建筑物结构信息与rfid标定的改进型pdr方法 |
CN109855620A (zh) * | 2018-12-26 | 2019-06-07 | 北京壹氢科技有限公司 | 一种基于自回溯算法的室内行人导航方法 |
CN111586577A (zh) * | 2020-04-16 | 2020-08-25 | 北京小米移动软件有限公司 | 定位方法及装置、移动终端及存储介质 |
CN113790722A (zh) * | 2021-08-20 | 2021-12-14 | 北京自动化控制设备研究所 | 一种基于惯性数据时频域特征提取的行人步长建模方法 |
CN114459469A (zh) * | 2022-01-14 | 2022-05-10 | 北京信息科技大学 | 多运动状态导航方法、装置及智能可穿戴设备 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104156996A (zh) * | 2014-08-30 | 2014-11-19 | 长安大学 | 实时可控步长的人体腿部连续直线走动的运动生成方法 |
CN104931049A (zh) * | 2015-06-05 | 2015-09-23 | 北京信息科技大学 | 一种基于运动分类的行人自主定位方法 |
CN105403873A (zh) * | 2015-12-11 | 2016-03-16 | 西安电子科技大学 | 基于分数阶傅里叶变换的目标特征提取方法 |
CN106595633A (zh) * | 2016-11-25 | 2017-04-26 | 北京邮电大学 | 室内定位方法及装置 |
WO2017142082A1 (ja) * | 2016-02-19 | 2017-08-24 | Cyberdyne株式会社 | 装着式歩容検知装置、歩行能力改善システム及び装着式歩容検知システム |
-
2018
- 2018-04-19 CN CN201810351686.7A patent/CN108645406A/zh active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104156996A (zh) * | 2014-08-30 | 2014-11-19 | 长安大学 | 实时可控步长的人体腿部连续直线走动的运动生成方法 |
CN104931049A (zh) * | 2015-06-05 | 2015-09-23 | 北京信息科技大学 | 一种基于运动分类的行人自主定位方法 |
CN105403873A (zh) * | 2015-12-11 | 2016-03-16 | 西安电子科技大学 | 基于分数阶傅里叶变换的目标特征提取方法 |
WO2017142082A1 (ja) * | 2016-02-19 | 2017-08-24 | Cyberdyne株式会社 | 装着式歩容検知装置、歩行能力改善システム及び装着式歩容検知システム |
CN106595633A (zh) * | 2016-11-25 | 2017-04-26 | 北京邮电大学 | 室内定位方法及装置 |
Non-Patent Citations (4)
Title |
---|
SHENGHENG LIU 等,: ""Automatic human fall detection in fractional Fourier domain for assisted living"", 《2016 IEEE INTERNATIONAL CONFERENCE ON ACOUSTICS, SPEECH AND SIGNAL PROCESSING (ICASSP)》 * |
张军,: ""基于分数阶傅里叶变换步态特征提取"", 《北京理工大学学报》 * |
赵辉 等,: ""修正建筑物内三维定位误差的运动感知方法研究"", 《计算机应用研究》 * |
赵辉 等,: ""多运动形式下的行人三维定位方法研究"", 《北京信息科技大学学报》 * |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109682372A (zh) * | 2018-12-17 | 2019-04-26 | 重庆邮电大学 | 一种结合建筑物结构信息与rfid标定的改进型pdr方法 |
CN109855620A (zh) * | 2018-12-26 | 2019-06-07 | 北京壹氢科技有限公司 | 一种基于自回溯算法的室内行人导航方法 |
CN111586577A (zh) * | 2020-04-16 | 2020-08-25 | 北京小米移动软件有限公司 | 定位方法及装置、移动终端及存储介质 |
CN111586577B (zh) * | 2020-04-16 | 2022-09-02 | 北京小米移动软件有限公司 | 定位方法及装置、移动终端及存储介质 |
CN113790722A (zh) * | 2021-08-20 | 2021-12-14 | 北京自动化控制设备研究所 | 一种基于惯性数据时频域特征提取的行人步长建模方法 |
CN113790722B (zh) * | 2021-08-20 | 2023-09-12 | 北京自动化控制设备研究所 | 一种基于惯性数据时频域特征提取的行人步长建模方法 |
CN114459469A (zh) * | 2022-01-14 | 2022-05-10 | 北京信息科技大学 | 多运动状态导航方法、装置及智能可穿戴设备 |
CN114459469B (zh) * | 2022-01-14 | 2023-05-23 | 北京信息科技大学 | 多运动状态导航方法、装置及智能可穿戴设备 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108645406A (zh) | 一种基于分数域行人运动感知的室内自主定位方法 | |
CN103968827B (zh) | 一种可穿戴式人体步态检测的自主定位方法 | |
CN104061934B (zh) | 基于惯性传感器的行人室内位置跟踪方法 | |
CN104713554B (zh) | 一种基于mems惯性器件与安卓智能手机融合的室内定位方法 | |
CN104296750A (zh) | 一种零速检测方法和装置以及行人导航方法和系统 | |
CN106705968A (zh) | 基于姿态识别和步长模型的室内惯性导航算法 | |
Ju et al. | A pedestrian dead-reckoning system that considers the heel-strike and toe-off phases when using a foot-mounted IMU | |
US20150362330A1 (en) | Method and System for Varying Step Length Estimation Using Nonlinear System Identification | |
CN107218938A (zh) | 基于人体运动模型辅助的穿戴式行人导航定位方法和设备 | |
CN108362282A (zh) | 一种基于自适应零速区间调整的惯性行人定位方法 | |
Ladetto et al. | Combining gyroscopes, magnetic compass and GPS for pedestrian navigation | |
CN105865450A (zh) | 一种基于步态的零速更新方法及系统 | |
CN107490378B (zh) | 一种基于mpu6050与智能手机的室内定位与导航的方法 | |
CN104613965B (zh) | 一种基于双向滤波平滑技术的步进式行人导航方法 | |
CN102937449A (zh) | 惯性导航系统中跨音速段气压高度计和gps信息两步融合方法 | |
CN109323695A (zh) | 一种基于自适应无迹卡尔曼滤波的室内定位方法 | |
Chen et al. | Sensing strides using EMG signal for pedestrian navigation | |
KR20130059344A (ko) | 물체의 제로 속도 상태를 검출하는 방법 및 시스템 | |
CN108537101B (zh) | 一种基于状态识别的行人定位方法 | |
Wu et al. | A pedestrian dead-reckoning system for walking and marking time mixed movement using an SHSs scheme and a foot-mounted IMU | |
CN103674064B (zh) | 捷联惯性导航系统的初始标定方法 | |
CN107702712A (zh) | 基于惯性测量双层wlan指纹库的室内行人组合定位方法 | |
CN104864873A (zh) | 一种利用人体运动特征辅助地图定位的方法 | |
Wu et al. | Indoor positioning system based on inertial MEMS sensors: Design and realization | |
Sun et al. | Zero velocity interval detection based on a continuous hidden Markov model in micro inertial pedestrian navigation |
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 | ||
WD01 | Invention patent application deemed withdrawn after publication | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20181012 |