本发明专利技术公开了一种基于双轴MEMS陀螺仪的计步装置及实现方法，包括：测试模块，用于感知行人的步态，并解析行人的步数和行走状态后发送至显示模块；显示模块，用以实时显示测试模块所发送的行人的步数和行进轨迹；测试模块包括感知行人步态的MEMS陀螺仪、解析行人的步数和行走状态的CPU和将CPU的解析信息发送至显示模块的无线发送模块；显示模块包括接收测试模块所发送信息的无线接收模块和用于显示信息的LCD液晶显示屏。本发明专利技术利用人行走过程中足部的周期性抬起落下的特征，使用MEMS陀螺仪感知角速度的变化进行计步，同时感知行人的转动来辨识行人是转弯的角度和方向，算法简单，成本低，计步更加准确，易于实现。
【技术实现步骤摘要】
【专利说明】一种基于双轴MEMS陀螺仪的计步装置及实现方法
本专利技术属于行人导航
，特别涉及了基于双轴MEMS陀螺仪的计步装置及实现方法。
技术介绍
传统计步装置的设计思想是利用固定与人体腰、背部等部位的3轴加速度计测量行人行进时的加速度信号，然后通过算法足够识别出行人行走的站立期和迈步期，同时实现行走的步数的计算，利用加速度计传感器进行计步是目前最常用技术，但由于行人步行形态的不确定性，若要准确实现计步就需要高精度的传感器和复杂的软件算法来精确检测真实的步伐，对CPU和成本提出了较高的要求。本专利提出了一种新的基于双轴MEMS陀螺仪的计步方法，但与加速度计计步不同的是，它是利用人行走过程中脚部的周期性抬起和落下带动陀螺仪输出角速度绕轴向前后周期性摆动进行计步的，本专利实现的算法简单，对硬件要求低，易于推广。
技术实现思路
本专利技术的目的: 为了解决现有技术中存在的技术问题，本专利技术专利提出了一种以双轴MEMS陀螺仪为核心的新的计步实现方法，它利用人行走过程中足部的周期性抬起落下的特征，使用MEMS陀螺仪感知角速度的变化进行计步，同时感知行人的转动来辨识行人是转弯的角度和方向，算法简单，成本低，计步更加准确，而且易于实现。为了实现上述技术目的，本专利技术的技术方案为: 一种基于双轴MEMS陀螺仪的计步装置，其特征是，包括: 测试模块，用于感知行人的步态，并解析行人的步数和行走状态后发送至显示模块； 显示模块，用以实时显示测试模块所发送的行人的步数和行进轨迹； 测试模块包括感知行人步态的MEMS陀螺仪、解析行人的步数和行走状态的CPU和将CPU的解析信息发送至显示模块的无线发送模块； 显示模块包括接收测试模块所发送信息的无线接收模块和用于显示信息的LCD液晶显示屏。进一步，以人的脚踝为原点建立坐标系，设人的正前方为坐标系的X轴，人体的竖直向下为坐标系的Y轴，人的正右侧且同时垂直于X、Y轴的方向为Z轴方向；测试模块中的MEMS陀螺仪放置于行人的脚踝部位，且与坐标系的三轴重合。进一步，MEMS陀螺仪为双轴或三轴数字输出的MEMS陀螺仪；双轴数字输出的MEMS陀螺仪的轴向分别与坐标系的Y、Z轴重合。所述的基于双轴MEMS陀螺仪的计步装置的计步实现方法，其特征是，包括以下步骤: (1)MEMS陀螺仪采集数据 MEMS陀螺仪放置在人体的脚踝部位，并以人的脚踝为原点建立坐标系，设人的正前方为坐标系的X轴，人体的竖直向下为坐标系的Y轴，人的正右侧且同时垂直于X、Y轴的方向为Z轴方向，MEMS陀螺仪的轴向与坐标系的Y、Z轴或三轴重合，分别用于测试人行走时的航向与角速度；获取步伐计数和运动方向改变值； (2)根据Z轴向MEMS陀螺仪数据的角速度周期性进行计步 (2)根据Z轴向MEMS陀螺仪数据的角速度周期性进行计步 对采集到CPU中的Z轴向的MEMS陀螺仪数据首先进行降采样频率和平滑处理，滤除部分高频噪声和毛刺；然后通过检测波形上升沿或下降沿的个数确定周期波的个数，人行走的步数即为周期波个数的两倍； (3)根据Y轴向MEMS陀螺仪数据的角速度周期性进行方向计算 对采集到CPU中的Y轴向MEMS陀螺仪数据，首先进行降采样频率和平滑处理，滤除部分高频噪声和毛刺； 再根据Y轴向数据的突变数据进行步伐方向的判断和计算； (4)计算行人运动里程 对计步数、运动方向以及运动里程进行实时的更新，设L为步长值，计算出运动距离增量值Λ SX、A Sy，设第1-1次里程更新时人的运动里程为SX1 1、Syl i，则第i次里程更新的运动里程为Sxl= Λ Sx + SX1 1; Syl= Λ Sy + Syl 1;从而依次推算出行人的运动里程。进一步，步骤(2)中， 周期波的个数的检测包括以下步骤: 首先所检测波形幅值的绝对值是否大于阈值K ; 然后判断该幅值是不是极大值； 最后判断两个检测波形有效振动之间的数据之差是否大于门限值M，且小于门限值N;其中，阈值K是行人行走时的脚抬起和下落时的最小角速度；门限值Μ是行人以最慢速度行走时的步速；Ν是行人以最快速度行走时的步速。采用数组data存放3个连续的Z轴数据，其中data是当前要判断处理的数据，具体要满足的条件是:①data>K ；②data>data && data>data。如果上述条件同时满足则计步有效标志flag=l ； 当判断下一组数据时，对数据data进行移位，即data=data，data=data，data中存放最新采集的陀螺数据； ③(T-t)> M &&(T-t) < No如果条件①、②、③同时成立，则行人行走的总步伐数为Step=Step+flag*2 ; 其中T为当前有效振动步伐总更新数据，t为前一刻有效振动步伐总更新数。进一步，步骤(3)中， 步伐方向的判断包括以下步骤: 第一步，步伐方向改变时陀螺数据突变的幅值检测； 第二步，判断MEMS陀螺仪Y轴向数据的幅值在相邻两侧的两个数据中是不是最大值； 第三步，使用数据窗口滤除无效的方向改变。进一步，步骤(4)中， 运动距离增量值Λ Sx=flag*2*L*sin (angle)，Δ Sy=flag*2*L*cos (angle) 式中，flag为计步有效标志，angle为寄存器存放的步伐方向改变值。本专利技术创造的优点以及达到的效果: (1)实现本专利的算法简单，降低了传统计步装置的软件复杂度，减少了对高性能CPU的依赖，可以有效降低能耗和成本。(2)本专利使用陀螺仪感知行人的运动状态，可以作为计步装置设计中步伐检测和计步的一种全新的实现方法，而且对传感器精度要求低，易于实现。(3)本专利进一步应用于导航定位系统中，可以省去专门用于计步的加速度计，对简化系统和节省成本具有重要意义。【附图说明】图1计步装置原理框图； 图2双轴陀螺仪数据变化图； 图3计步装置参数算法流程图。【具体实施方式】下面结合附图对本专利技术作进一步描述。以下实施例仅用于更加清楚地说明本专利技术的技术方案，而不能以此来限制本专利技术的保护范围。图1为计步装置原理图，它由测试模块和显示模块组成。测试模块感知行人的步态，并按照算法解析行人的步数和行走状态，由MEMS陀螺仪、CPU、无线发送模块构成；显示模块有无线接收模块和LCD液晶显示屏组成，用以实时显示行人的步数和行进轨迹，本专利实施中采用4.2寸液晶IXD模块(800*400)，也可以采用其他同类型液晶显示屏。CPU模块包括嵌入式处理器及外围电路，CPU实时采集陀螺仪输出的数据，首先对数据进行滤波预处理，然后进行解算得到行人的行进状态，最后将结果发送到输出显示模块。本专利中采用ST公司的高性能低功耗产品SMT32L151型ARM处理器，实施中也可以采用同等性能的其他产品，如各种类型的单片机等。无线收发模块实现计步端与显示端的数据通信。本专利实施中选用支持Zigbee技术的低功耗2.4GHz双向无线模块JF24C，实施中也可以采用同等性能的其他产品。( 1)双轴陀螺仪数据的采集 MEMS陀螺仪选用双轴或三轴数字输出的MEMS陀螺仪，每个轴向量程大于200dps，本专利实施中本文档来自技高网...
【技术保护点】
一种基于双轴MEMS陀螺仪的计步装置，其特征是，包括：测试模块，用于感知行人的步态，并解析行人的步数和行走状态后发送至显示模块； 显示模块，用以实时显示测试模块所发送的行人的步数和行进轨迹；测试模块包括感知行人步态的MEMS陀螺仪、解析行人的步数和行走状态的CPU和将CPU的解析信息发送至显示模块的无线发送模块；显示模块包括接收测试模块所发送信息的无线接收模块和用于显示信息的LCD液晶显示屏。
【技术特征摘要】
【专利技术属性】
技术研发人员：黄艳辉，高玉霞，董冀，
申请(专利权)人：中国兵器工业集团第二一四研究所苏州研发中心，
类型：发明
国别省市：江苏;32
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。