发明名称 基于智能设备的高精度步行方向检测方法
摘要 本发明涉及一种基于智能设备的高精度步行方向检测方法,首先将智能设备的方向传感器的三个读数转换为以大地坐标系为参考系的加速度,再进行基于重力方向上加速度的步子和步频检测、纯步行加速度水平分量计算,最后根据当前步子的时间范围,找到该时间范围内水平方向上的和加速度最大的时刻t,则该步前进的方向与正北之间的夹角的正切值为滤波后的时刻t的东方向上加速度和北方向上加速度的比值;利用该比值,通过反正切函数计算出当前步行的方向。其优点是:本发明基于普通的移动智能设备,利用实时坐标变换,智能步频检测,加速度滤波等技术,实现高精度的用户步行方向的测量。
申请公布号 CN103675338B 申请公布日期 2015.07.29
申请号 CN201310659422.5 申请日期 2013.12.06
申请人 无锡清华信息科学与技术国家实验室物联网技术中心 发明人 张兰;李向阳;刘云浩
分类号 G01P13/02(2006.01)I 主分类号 G01P13/02(2006.01)I
代理机构 无锡市大为专利商标事务所(普通合伙) 32104 代理人 曹祖良;韩凤
主权项 基于智能设备的高精度步行方向检测方法,其特征在于,包括以下步骤:(1)加速度坐标转换:通过智能设备的方向传感器的三个读数,即围绕X,Y,Z轴的旋转角度,得到当前智能设备相对于大地坐标系的旋转矩阵R,将旋转矩阵R乘以以当前智能设备为参考系的加速度向量A,将加速度转换为以大地坐标系为参考系的加速度(a<sub>N</sub>,a<sub>E</sub>,a<sub>G</sub>)<sup>T</sup>;a<sub>N</sub>,a<sub>E</sub>,a<sub>G</sub>分别为在北、东、重力方向上的加速度;(2)基于重力方向上加速度的步子和步频检测:将重力方向上加速度采用截止频率为5Hz的低通滤波器进行滤波,对滤波后的加速度寻找相邻的一组穿过0点的波谷和波峰,则该波谷到下一波谷之间为一步;计算当前步子加速度包含的采样点数得到当前步频f<sub>w</sub>;(3)纯步行加速度水平分量计算:根据当前步频f<sub>w</sub>,用通带为<img file="FDA0000703392350000011.GIF" wi="246" he="138" />的带通滤波器对北和东方向上的加速度a<sub>N</sub>,a<sub>E</sub>分别进行滤波,得到滤波后的a<sub>N</sub>′,a<sub>E</sub>′,对a<sub>N</sub>′,a<sub>E</sub>′进行向量求和,得到水平方向上的和加速度;(4)步行方向计算:利用步骤(2)得到的步子检测结果,确定当前步子的时间范围,找到该时间范围内水平方向上的和加速度最大的时刻t,滤波后的时刻t的东方向上加速度和北方向上加速度分别为<img file="FDA0000703392350000014.GIF" wi="239" he="79" />则当前步子前进的方向与正北之间的夹角为<img file="FDA0000703392350000013.GIF" wi="342" he="92" />
地址 214135 江苏省无锡市新区太科园大学科技园清源路立业楼A区501号