一种行人导航的二维人体里程计及里程计算方法技术

本发明专利技术提供了一种行人导航的二维人体里程计及里程计算方法，解决行人在完成非常规步态下定位精度差的问题，能够得到行人精确的行进距离，实现高精度定位。本发明专利技术所述的二维人体里程计及方法，基于惯性导航解算与人体步态特征，对步态进行精确划分，针对每一种步态建立参考步长，并在参考步长基础上增加修正因子得到刻度因子，利用刻度因子作为人体行进的刻度标识，利用刻度因子实现精确的单步步长估计，解决行人在完成非约束、非等间隔或非平稳的非常规步态下定位精度差的问题，并结合步频信息得到精确的行进距离，提高定位精度。

【技术实现步骤摘要】
一种行人导航的二维人体里程计及里程计算方法
本专利技术属于行人导航
，具体涉及一种行人导航二维人体里程计及里程计算方法。
技术介绍
随着人们对室内位置服务的需求迅速增加，利用微惯性导航系统对行人进行航位推算成为室内定位主流技术之一。在个人航位推算系统中，步长估计方法主要有两种：一是基于惯性导航原理对加速度进行二次积分，但消费级MEMS惯性器件的温度漂移及线性度等性能指标不高，数分钟内的积分误差将达到一个地球半径；二是利用人员行进特性对其特定动作下的行进距离进行建模，现有基于模型的步长估计方法将步长视为与步频、身高、加速度等相关的量，但人体运动具有复杂性和任意性，受外界环境和情绪等因素影响，行人在某种步态下的单步步长可能不同，一种步态对应单一的单步步长误差很大，另外行人在完成匍匐、侧行、跳跃等非常规步态时，普通步长建模方法不适用，模型精度无法满足实际需求。
技术实现思路
有鉴于此，本专利技术提供了一种行人导航的二维人体里程计及里程计算方法，解决行人在完成非常规步态下定位精度差的问题，能够得到行人精确的行进距离，实现高精度定位。本专利技术提供了一种行人导航的人体里程计，包括惯性测量模块、导航解算模块和数据处理模块；其中，以行进运动起始点处的人体重心为坐标原点，前后方向为X轴，左右方向为Y轴，上下方向为Z轴；惯性测量模块用于采集实时的X轴、Y轴以及Z轴方向上的运动加速度与运动角速度并识别出相应的步态，将运动加速度与运动角速度发送至导航解算模块，将步态发送至数据处理模块；导航解算模块基于惯性测量模块发送的运动加速度与运动角速度进行惯性导航解算，得到解算步长、运动步频以及步长差与方位角差，并发送至数据处理模块；数据处理模块根据惯性测量模块发送的当前时刻的步态，选择对应步态的参考步长模型，将导航解算模块发送的运动步频代入参考步长模型获得参考步长；并根据导航解算模块发送的步长差和方位角差对参考步长进行修正；将修正后的参考步长与运动步频相乘得到人体位移增量并累加输出；所述参考步长模型为：S＝[h·(ax·fstep+bx)+cx](1)其中，S为参考步长，fstep为运动步频，h为人的身高，ax、bx和cx为与步态相关的参考步长系数，ax、bx和cx数值由实验可知。其中，所述参考步长系数与步态对应，参考步长系数的获得方式为：利用导航解算模块对各步态下的加速度和角速度进行导航解算，得到各步态下的实时解算步长及运动步频，将解算步长与对应步态的步长经验值进行融合，得到实时融合步长，以运动步频为公式(1)的自变量fstep，以对应的融合步长为公式(1)的因变量S，利用同一步态下多个时刻的运动步频及其对应的融合步长，对公式(1)进行拟合，得到该步态下的参考步长系数ax、bx和cx的估计值；将估计值代入参考步长模型，得到对应步态的参考步长模型。其中，采用递推最小二乘法对公式(1)进行拟合，得到参考步长系数的估计值。其中，所述参考步长的修正方法为：当步长差和方位角差均小于各自对应的阈值时，不对参考步长进行修正；当只有步长差小于步长差阈值时，通过方位角差以及方位角差的权重因子对参考步长进行修正；当只有方位角差小于方位角差阈值时，通过步长差以及步长差的权重因子对参考步长进行修正；当步长差和方位角差均不小于各自对应的阈值时，通过方位角差、方位角差的权重因子、步长差以及步长差的权重因子对参考步长进行修正；其中步长差和方位角差的权重因子大小与步态复杂度有关，复杂度越高的步态权重因子越大。其中，对参考步长进行修正的修正因子为δKx：δKx＝p·(ΔS/M1)+q·(Δψ/M2)；其中，p为步长差的权重因子，q为方位角差的权重因子，ΔS为步长差，Δψ为方位角差，M1为步长差阈值，M2为方位角差阈值。其中，所述修正后的参考步长为Sx：Sx＝(1+δKx)[h·(ax·fstep+bx)+cx]。其中，所述惯性测量模块为微惯性测量器件。其中，所述惯性测量模块置于人体脚部、腰部或胫骨。本专利技术还提供了一种行人导航的里程计算方法，采用本专利技术的行人导航的人体里程计进行里程计算，包括如下步骤：步骤1，采集行进运动的运动加速度与运动角速度并识别出相应的步态；步骤2，利用惯性导航解算方式对步骤1得到的运动加速度与运动角速度进行导航解算，得到运动步频以及步长差与方位角差；步骤3，根据当前时刻的步态，选择对应步态的参考步长模型，将当前运动步频代入参考步长模型获得参考步长；根据步长差和方位角差对参考步长进行修正；步骤4，将修正后的参考步长与运动步频相乘得到人体位移增量，并累加输出，完成里程计算。有益效果：本专利技术所述的二维人体里程计及方法，基于惯性导航解算与人体步态特征，对步态进行精确划分，针对每一种步态建立参考步长，并在参考步长基础上增加修正因子得到刻度因子，利用刻度因子作为人体行进的刻度标识，利用刻度因子实现精确的单步步长估计，解决行人在完成非约束、非等间隔或非平稳的非常规步态下定位精度差的问题，并结合步频信息得到精确的行进距离，提高定位精度。附图说明图1为本专利技术的一种行人导航的人体里程计示意图。具体实施方式下面结合附图并举实施例，对本专利技术进行详细描述。本专利技术提供了一种行人导航的人体里程计及里程计算方法，结合人体步态特征，对步态进行精确划分，针对每一种步态建立自适应单步步长模型，作为人体行进的刻度标识，解决行人在完成非约束、非等间隔或非平稳的非常规步态下定位精度差的问题，并结合步频信息得到精确的行进距离，提高定位精度。本专利技术所述的一种行人导航的人体里程计包括惯性测量模块、导航解算模块和数据处理模块；其中以行进运动起始点处的人体重心为坐标原点，前后方向为X轴，左右方向为Y轴，上下方向为Z轴；建立的XYZ轴坐标系符合右手定则；惯性测量模块用于采集实时的X轴、Y轴以及Z轴方向上的运动加速度与运动角速度并识别出相应的步态，同时将采集到的运动加速度与运动角速度发送至导航解算模块，将步态发送至数据处理模块；其中，通过微惯性测量器件(MIMU)获得X轴、Y轴以及Z轴的运动加速度与运动角速度。微惯性测量器件(MIMU)还可以置于人体腰部或胫骨等部位，微惯性测量器件(MIMU)在不同位置时，人体里程计刻度因子中的参数值要相应调整。导航解算模块基于惯性测量模块发送的运动加速度与运动角速度进行惯性导航解算，得到X轴和Y轴方向上的解算步长、运动步频以及相邻时刻的步长差与方位角差，并发送至数据处理模块；数据处理模块根据惯性测量模块发送的当前时刻的步态，选择对应步态的参考步长模型，将导航解算模块发送的运动步频代入参考步长模型获得参考步长；并根据导航解算模块发送的步长差和方位角差对参考步长进行修正；将修正后的参考步长与运动步频相乘得到人体位移增量并累加输出；如图1所示，修正后的参考步长即为刻度因子，也就是人体里程计的单步步长，运动步频为人体里程计的脉冲计数，位移增量为人体里程计的输出信息。所述参考步长模型为：S＝[h·(ax·fstep+bx)+cx]其中，S为参考步长，fstep为运动步频，h为人的身高，ax、bx和cx为与步态相关的参考步长系数，ax、bx和cx数值由实验可知。所述参考步长系数与步态对应，参考步长系数的获得方式为：利用导航解算模块对各步态下的加速度和角速度进行导航解算，得本文档来自技高网...

【技术保护点】
一种行人导航的人体里程计，其特征在于，包括惯性测量模块、导航解算模块和数据处理模块；其中，以行进运动起始点处的人体重心为坐标原点，前后方向为X轴，左右方向为Y轴，上下方向为Z轴；惯性测量模块用于采集实时的X轴、Y轴以及Z轴方向上的运动加速度与运动角速度并识别出相应的步态，将运动加速度与运动角速度发送至导航解算模块，将步态发送至数据处理模块；导航解算模块基于惯性测量模块发送的运动加速度与运动角速度进行惯性导航解算，得到解算步长、运动步频以及步长差与方位角差，并发送至数据处理模块；数据处理模块根据惯性测量模块发送的当前时刻的步态，选择对应步态的参考步长模型，将导航解算模块发送的运动步频代入参考步长模型获得参考步长；并根据导航解算模块发送的步长差和方位角差对参考步长进行修正；将修正后的参考步长与运动步频相乘得到人体位移增量并累加输出；所述参考步长模型为：S＝[h·(ax·fstep+bx)+cx]    (1)其中，S为参考步长，fstep为运动步频，h为人的身高，ax、bx和cx为与步态相关的参考步长系数，ax、bx和cx数值由实验可知。

【技术特征摘要】
1.一种行人导航的人体里程计，其特征在于，包括惯性测量模块、导航解算模块和数据处理模块；其中，以行进运动起始点处的人体重心为坐标原点，前后方向为X轴，左右方向为Y轴，上下方向为Z轴；惯性测量模块用于采集实时的X轴、Y轴以及Z轴方向上的运动加速度与运动角速度并识别出相应的步态，将运动加速度与运动角速度发送至导航解算模块，将步态发送至数据处理模块；导航解算模块基于惯性测量模块发送的运动加速度与运动角速度进行惯性导航解算，得到解算步长、运动步频以及步长差与方位角差，并发送至数据处理模块；数据处理模块根据惯性测量模块发送的当前时刻的步态，选择对应步态的参考步长模型，将导航解算模块发送的运动步频代入参考步长模型获得参考步长；并根据导航解算模块发送的步长差和方位角差对参考步长进行修正；将修正后的参考步长与运动步频相乘得到人体位移增量并累加输出；所述参考步长模型为：S＝[h·(ax·fstep+bx)+cx](1)其中，S为参考步长，fstep为运动步频，h为人的身高，ax、bx和cx为与步态相关的参考步长系数，ax、bx和cx数值由实验可知。2.如权利要求1所述的一种行人导航的人体里程计，其特征在于，所述参考步长系数与步态对应，参考步长系数的获得方式为：利用导航解算模块对各步态下的加速度和角速度进行导航解算，得到各步态下的实时解算步长及运动步频，将解算步长与对应步态的步长经验值进行融合，得到实时融合步长，以运动步频为公式(1)的自变量fstep，以对应的融合步长为公式(1)的因变量S，利用同一步态下多个时刻的运动步频及其对应的融合步长，对公式(1)进行拟合，得到该步态下的参考步长系数ax、bx和cx的估计值；将估计值代入参考步长模型，得到对应步态的参考步长模型。3.如权利要求2所述的一种行人导航的人体里程计，其特征在于，采用递推最小二乘法对公式(1)进行拟合，得到参考步长系数的估计值。4.如权利要求1所述的一种行人导...

【专利技术属性】
技术研发人员：邓志红，王鹏宇，尚克军，曹运，严丹，
申请(专利权)人：北京理工大学，
类型：发明
国别省市：北京,11