专利名称：一种基于智能手机的惯性导航系统及方法
技术领域：
本发明涉及无线定位和惯性导航领域，特别涉及一种基于智能手机的惯性导航系统及方法。
背景技术：
惯性导航是利用惯性传感器实现导航定位的技术，手机惯性导航依靠智能手机上低精度、低成本的内置传感器来实现智能手机基于位置的服务。由于手机天然地和人绑定在一起，手机惯性导航也通常被用来估算人的运动轨迹，并为人提供导航定位服务。目前最常用的手机惯性导航技术通过手机上内置的加速度传感器进行计步，并乘以一个特定的步长以估算位移；指南针或者陀螺仪被用来估计移动方向。从理论上讲，结合位移和方向，就 能够估算出目标的移动轨迹。但是，传统的手机惯性导航在估算人的运动轨迹时仍然存在以下问题I)、不精确的计步。手机加速度传感器的采样频率不高，加上用户的动作行为十分复杂与不确定，造成了加速度传感器的读数误差较大。传统的方法利用固定阈值判断手机加速度传感器读数的波峰(或波谷)，其计步结果不尽如人意。2)、步长估计。步长是估算用户位移的基本参数。然而，不同身高体重的人有不同的步长，即使同一个人在不同场景下也可能表现出不同的步长。如何估算人在特定场景下的步幅，是一个十分挑战的问题。传统的很多方法，根据自然科学的规律，直接利用用户的身高体重估算一个确定的步长。很显然，这样的方法在实际中可能带来巨大的误差。因此，现有技术仍有待于改善。

发明内容
针对现有技术存在的不足，本发明提供一种基于智能手机的惯性导航系统及方法，使得手机惯性导航能够提供准确度高的计步和步长估计，达到较高的惯性导航精度。本发明通过以下技术方案予以实现一种基于智能手机的惯性导航方法，包括以下步骤SI、根据智能手机上三轴加速度传感器捕捉到人走路时产生的三轴加速度值，利用基于有限状态机的计步算法，估计人所走过的步数并获得其每一步的起止时间戳；S2、根据三轴陀螺仪所读取的数据及所述每一步的起止时间戳，结合指南针读数，计算人走过的每一步所发生的方向变化；S3、根据不同步长的人行走时所产生的不同的加速度特征，估计人的步长；S4、根据路径起点的坐标，结合所述步长以及所述方向变化，计算人走过的每一步相对于所述路径起点的坐标；通过每一步相对于所述路径起点的坐标，得到人的运动轨迹。所述步骤SI进一步包括以下步骤S11、采集智能手机上三轴加速度传感器的一系列读数，获得人走路时产生的三轴加速度值，记作A = Ia1, a2, a3,…，aj ；
S12、利用低通滤波器对A = Iapaaaf^aJ进行降噪处理，即a」=a a」+(l-α ) ，其中，a e
，j={l，2，…n};S13、对经过降噪处理的A,去除其包含的重力成分，即aj=aj_g, j={l, 2，…η},其中，g为当地重力加速度；S14、以去除重力成分后的A为输入，利用基于有限状态机的计步算法，估算所述序列A中所包括的步数Q并获得每一步的起止时间戳，将所述每一步的起止时间戳记作S =匕，WiJ = {( )，( )，··.,(K,)丨，其中&$分别代表第j步的起止时间。所述步骤SI中的基于有限状态机的计步算法包括以下状态
MO :用户静止；Ml :向上加速度由零开始增大，表明一步的开始状态；M2 :向上加速度逐渐增大至到达波谷；M3 :向上加速度由波谷位置逐渐减小；M4 :向上加速度数值回归到接近于零，表明抬脚至最高点；M5 :向下加速度由零开始增大；M6 向下加速度逐渐增大至到达波峰；M7 :向下加速度由波峰位置逐渐减小；M8 :向下加速度回归到接近于零，表明脚回到地面。所述步骤S14进一步包括当所述基于有限状态机的计步算法到达状态M8时，步数Q加I。所述步骤S2进一步包括以下步骤S21、记录人在行走过程中水平手持智能手机时所产生的三轴陀螺仪的数据，利用低通滤波器去除高频噪音，得到人在行走过程中所产生的水平方向上的角速度变化，记作R=Ir1, r2, r3,…，rn}；S22、计算人行走的每一步过程中所发生的方向变化；对于第j步，其起止时间戳为 ^ p、则第j步过程中的方向变化的计算方法为Ji = f； rfdt.S23、在人行走过程的同时记录指南针的读数,记作C= Ic1, C2, C3,…，cN},每隔k步，利用指南针第j +k步指示的方向对通过三轴陀螺仪读数计算得到的第j +k步的方向变化进行修正，并将修正后的数据作为人在第j+k步的方向。所述步骤S23进一步包括以下步骤S231、对所记录的指南针的读数进行平滑处理；S232、获取指南针所指示的第j步与第j+k步之间的方向变化为？，获取通过三轴陀螺仪读数计算得到的第j步与第j+k步之间的方向变化为<，;+灸；S233、设置||匕4 — <I的角度阀值，当- K,;^|超过该角度阀值时，利用
指南针第j+k步指示的方向对通过三轴陀螺仪读数计算得到的第j+k步的方向变化进行修正，并将修正后的数据作为人在第j+k步的方向。所述步骤S3进一步包括以下步骤
S31、采集一组不同步长的用户以规定步长行走时所产生的加速度数据，记作B=IA11A21A3,…，AJ，每一组加速度数值对应一个步长，记作L=U1, I2, I3,…，I1J ；S32、对B中的每一组加速度Ai利用低通滤波器进行降噪处理；S33、对经过降噪处理的Ai,去除其包含的重力成分；S34、计算经过步骤S33后的每一组Ai的方差,记作V=Iv1, v2，V3,…，vj ;S35、利用最小二乘法对V和L作最佳线性拟合，得到Vi和Ii之间的对应关系，从而得到B中任一组加速度值对应的步长为liKvi-bVa，其中a和b为最佳线性拟合的系数，Vi为该组加速度值所对应的方差。所述步骤S4进一步包括以路径起点的坐标为原点，其坐标为(0，O);第j-Ι步的坐 标为(Xj-丨，yj-丨)，则第j步的坐标(X」，Yj)为(Xj, Yj) = (Xj^+ljCos ( Φ + Y j), Yj^+ljSin ( Φ + Y j))其中，Iy Yj分别为第j步所对应的步长和方向变化；Φ为前j_l步内所发生的
1
方向变化之和，即多=Σ&。
P=I一种基于智能手机的惯性导航系统，包括有第一估计单元，用于根据智能手机上三轴加速度传感器捕捉到人走路时产生的三轴加速度值，利用基于有限状态机的计步算法，估计人所走过的步数并获得其每一步的起止时间戳；第二估计单元，用于根据三轴陀螺仪所读取的数据及所述每一步的起止时间戳，结合指南针读数，计算人走过的每一步所发生的方向变化；第三估计单元，用于根据不同步长的人行走时所产生的不同的加速度特征，估计人的步长；第四估计单元，用于根据路径起点的坐标，结合所述步长以及所述方向变化，计算人走过的每一步相对于所述路径起点的坐标；通过每一步相对于所述路径起点的坐标，得到人的运动轨迹。本发明提供的基于智能手机的惯性导航系统及方法，无需高精度、价格昂贵的惯性传感器，仅利用通用智能手机中集成的传感器实现惯性导航，利用基于有限状态机的计步算法计算人所走过的步数，并根据不同步长的人行走时所产生的不同的加速度，估计人的步长；其准确度高，能够达到较高的惯性导航精度，而且本发明实用性高，通用性广，成本低廉。


图I为本发明的流程图；图2为有限状态机的计步算法示意图；图3为本发明的系统装置图。
具体实施例方式下面对于本发明所提出的一种基于智能手机的惯性导航系统及方法，结合附图和实施例详细说明。如图I所示，本发明提供一种基于智能手机的惯性导航方法，包括以下步骤SI、根据智能手机上三轴加速度传感器捕捉到人走路时产生的三轴加速度值，利用基于有限状态机的计步算法，估计人所走过的步数并获得其每一步的起止时间戳；S2、根据三轴陀螺仪所读取的数据及所述每一步的起止时间戳，结合指南针读数，计算人走过的每一步所发生的方向变化；S3、根据不同步长的人行走时所产生的不同的加速度特征，估计人的步长；S4、根据路径起点的坐标，结合所述步长以及所述方向变化，计算人走过的每一步相对于所述路径起点的坐标；通过每一步相对于所述路径起点的坐标，得到人的运动轨迹。所述步骤SI进一步包括以下步骤·S11、采集智能手机上三轴加速度传感器的一系列读数，获得人走路时产生的三轴加速度值，记作A = Ia1, a2, a3,…，aj ；S12、利用低通滤波器对A = Iapaaaf^aJ进行降噪处理，即a」=a a」+(l-α ) ，其中，a e
，j={l，2，…n};S13、对经过降噪处理的A,去除其包含的重力成分，即aj=aj_g, j={l, 2，…η},其中，g为当地重力加速度；S14、以去除重力成分后的A为输入，利用有限状态机的计步算法，估算所述序列A中所包括的步数Q并获得每一步的起止时间戳，将所述每一步的起止时间戳记作s = ·^，ν，％} = {( ，α( )，·..，Κ)},其中O,豸分别代表第·]·步的起止时间。所述步骤SI中的基于有限状态机的计步算法包括以下状态MO :用户静止；Ml :向上加速度由零开始增大,表明一步的开始状态,即对应人抬起脚步；M2 :向上加速度逐渐增大至到达波谷；M3 :向上加速度由波谷位置逐渐减小；M2和M3代表了抬起脚步至最高点的加速度变化过程；Μ4 :向上加速度数值回归到接近于零，表明抬脚至最高点；Μ5 :向下加速度由零开始增大，表明脚由最高点开始往下降；Μ6 向下加速度逐渐增大至到达波峰；Μ7 :向下加速度由波峰位置逐渐减小；Μ6和Μ7表明脚由最高点下降到接触地面的过程；Μ8 :向下加速度回归到接近于零，表明脚回到地面。如图2所示为基于有限状态机的计步算法的示意图，基于有限状态机的计步算法以三轴加速度传感器的数据作为输入，设定其上升沿阀值(pos)、下降沿阀值(neg)以及波峰阀值(posPeak)、波谷阀值(negPeak)，其中所述下降沿阀值与波谷阀值分别为所述上升沿阀值和波峰阀值的相反数。在实际中，上升沿阀值可以取
，波峰阀值可以取[I. O, I. 5],不同的阀值会得到不同的估计精度，以a标记在三轴加速度传感器读取的当前加速度值。如图2所示，所述基于有限状态机的计步算法其初始状态为MO，表示一步的开始状态；
在状态MO上，当a小于或等于下降沿阈值时，由MO跳转到M1，否则仍停留在状态MO ；在状态Ml上，当a小于或等于波谷阈值时，由Ml跳转到M2，当a大于下降沿阈值时，由Ml跳转回MO，否则仍停留 在状态Ml ；在状态M2上，当a大于波谷阈值时，由M2跳转到M3，否则仍停留在状态M2 ；在状态M3上，当a大于下降沿阈值时，由M3跳转到M4，否则仍停留在状态M3 ；在状态M4上，当a大于或等于上升沿阈值时，由M4跳转到M5，当a小于或等于下降沿阈值时，由M4跳转回M3，否则仍停留在状态M4 ；在状态M5上，当a大于或等于波峰阈值时，由M5跳转到M6，当a小于上升沿阈值时，由M5跳转回M4，否则仍停留在状态M5 ；在状态M6上，当a小于波峰阈值时，由M6跳转到M7，否则仍停留在状态M6 ；在状态M7上，当a小于上升沿阈值时，由M7跳转到M8，否则仍停留在状态M7 ；当有限状态机的计步算法到达状态M8时，表示检测到一步。在状态M8上，当a小于上升沿阈值时，由M8跳转到初始状态MO，当a小于下降沿阈值时，直接跳转到状态Ml，继续检测下一步。所述步骤S14进一步包括当所述基于有限状态机的计步算法到达状态M8时，步数Q加I。所述步骤S2进一步包括以下步骤S21、记录人在行走过程中水平手持智能手机时所产生的三轴陀螺仪得数据，利用低通滤波器去除高频噪音，得到人在行走过程中所产生的水平方向上的角速度变化，记作R=^r2jr3,-,rn};其中，三轴陀螺仪Z轴上的读数代表了智能手机朝向的方向，即人在行走过程中的方向变化；S22、计算人行走的每一步过程中所发生的方向变化；对于第j步，其起止时间戳为—w 则第j步过程中的方向变化的计算方法为.I = s r dt
sj -、W，Jtj °S23、在人行走过程的同时记录指南针的读数,记作C= Ic1, C2, C3,…，cN},每隔k步，利用指南针第j +k步指示的方向对通过三轴陀螺仪读数计算得到的第j +k步的方向变化进行修正，并将修正后的数据作为人在第j+k步的方向。由于三轴陀螺仪记录的角速度只能提供相对的方向，无法获取相对于地球表面的绝对方向信息。通过步骤S23不仅可以得到人行走的绝对方向，同时也可以避免三轴陀螺仪引起的累积误差。所述步骤S23进一步包括以下步骤S231、对所记录的指南针的读数进行平滑处理；由于指南针读数波动较大，因此需要对所记录的指南针数据进行平滑处理，即利用一小段时间内的平均值取代记录的指南针的读数；S232、获取指南针所指示的第j步与第j+k步之间的方向变化为，获取通过三轴陀螺仪读数计算得到的第j步与第j+k步之间的方向变化为；S233、设置KjU-I的角度阀值，当超过该角度阀值时，利用指南针第j+k步指示的方向对通过三轴陀螺仪读数计算得到的第j+k步的方向变化进行修正，并将修正后的数据作为人在第j+k步的方向。所述步骤S3进一步包括以下步骤S31、采集一组不同步长的用户以规定步长行走时所产生的加速度数据，记作B=IA11A21A3,…，AJ，每一组加速度数值对应一个步长，记作L=U1, I2, I3,…，I1J ；S32、对B中的每一组加速度Ai利用低通滤波器进行降噪处理；S33、对经过降噪处理的Ai,去除其包含的重力成分；S34、计算经过步骤S33后的每一组Ai的方差,记作V=Iv1, v2, V3,…，vj ；
S35、利用最小二乘法对V和L作最佳线性拟合，得到Vi和Ii之间的对应关系，从而得到B中任一组加速度值对应的步长为liKvi-bVa，其中a和b为最佳线性拟合的系数，Vi为该组加速度值所对应的方差。所述步骤S4进一步包括以路径起点的坐标为原点，其坐标为(0，O);第j-Ι步的坐标为(Xj-丨，yj-丨)，则第j步的坐标(X」，Yj)为(Xj, υΡ = (χ^1+1^08(Φ + υ j), γ^1+1 ·8 η(Φ + γ j))其中，U L分别为第j步所对应的步长和方向变化；Φ为前j-Ι步内所发生的方向变化之和，即多；
P=I计算得到每一步相对于路径起点的相对坐标之后，只要给定第一步的绝对坐标，即可计算之后每一步的绝对坐标，从而得到人的运动轨迹，通常第一步的绝对坐标可以通过GPS获得。如图3所示，本发明还提供一种基于智能手机的惯性导航系统，包括有第一估计单元，用于根据智能手机上三轴加速度传感器捕捉到人走路时产生的三轴加速度值，利用基于有限状态机的计步算法，估计人所走过的步数并获得其每一步的起止时间戳；第二估计单元，用于根据三轴陀螺仪所读取的数据及所述每一步的起止时间戳，结合指南针读数，计算人走过的每一步所发生的方向变化；第三估计单元，用于根据不同步长的人行走时所产生的不同的加速度特征，估计人的步长；第四估计单元，用于根据路径起点的坐标，结合所述步长以及所述方向变化，计算人走过的每一步相对于所述路径起点的坐标；通过每一步相对于所述路径起点的坐标，得到人的运动轨迹。本发明提供的基于智能手机的惯性导航系统及方法，无需高精度、价格昂贵的惯性传感器，仅利用通用智能手机中集成的传感器实现惯性导航，利用基于有限状态机的计步算法计算人所走过的步数，并根据不同步长的人行走时所产生的不同的加速度，估计人的步长；其准确度高，能够达到较高的惯性导航精度，而且本发明实用性高，通用性广，成本低廉。以上实施方式仅用于说明本发明，而并非对本发明的限制，有关技术领域的普通技术人员，在不脱离本发明的精神和范围的情况下，还可以做出各种变化和变型，因此所有等同的技术方案也属于本发明的范畴，本发明的专利保护范围应由权利要求限 定。
权利要求
1.一种基于智能手机的惯性导航方法，其特征在于，包括以下步骤 .51、根据智能手机上三轴加速度传感器捕捉到人走路时产生的三轴加速度值，利用基于有限状态机的计步算法，估计人所走过的步数并获得其每一步的起止时间戳； .52、根据三轴陀螺仪所读取的数据及所述每一步的起止时间戳，结合指南针读数，计算人走过的每一步所发生的方向变化； .53、根据不同步长的人行走时所产生的不同的加速度特征，估计人的步长； .54、根据路径起点的坐标，结合所述步长以及所述方向变化，计算人走过的每一步相对于所述路径起点的坐标；通过每一步相对于所述路径起点的坐标，得到人的运动轨迹。
2.如权利要求I所述的方法，其特征在于，所述步骤SI进一步包括以下步骤 .511、采集智能手机上三轴加速度传感器的一系列读数，获得人走路时产生的三轴加速度值，记作 A = Ia1, a2, a3, ...，aj ； .512、利用低通滤波器对A= Ia^a2, a3,…，aj进行降噪处理，即a」=a a」+(I-a ) ,其中，α e [O, I], j={l, 2，...η}; . 513、对经过降噪处理的A，去除其包含的重力成分，即afaj-g，j={l,2，···!!}，其中，g为当地重力加速度； .514、以去除重力成分后的A为输入，利用基于有限状态机的计步算法，估算所述序列A中所包括的步数Q并获得每一步的起止时间戳，将所述每一步的起止时间戳记作 s = K，wv} =，其中 分别代表第J步的起止时间。
3.如权利要求2所述的方法，其特征在于，所述步骤SI中的基于有限状态机的计步算法包括以下状态 MO :用户静止； Ml :向上加速度由零开始增大,表明一步的开始状态； M2 :向上加速度逐渐增大至到达波谷； M3 :向上加速度由波谷位置逐渐减小； M4 :向上加速度数值回归到接近于零，表明抬脚至最高点； M5 :向下加速度由零开始增大； M6 :向下加速度逐渐增大至到达波峰； M7 :向下加速度由波峰位置逐渐减小； M8 :向下加速度回归到接近于零，表明脚回到地面。
4.如权利要求3所述的方法，其特征在于，所述步骤S14进一步包括当所述基于有限状态机的计步算法到达状态M8时,步数Q加I。
5.如权利要求2所述的方法，其特征在于，所述步骤S2进一步包括以下步骤 .521、记录人在行走过程中水平手持智能手机时所产生的三轴陀螺仪的数据，利用低通滤波器去除高频噪音，得到人在行走过程中所产生的水平方向上的角速度变化，记作R=Ir1, r2, r3,…，rn}； . 522、计算人行走的每一步过程中所发生的方向变化；对于第j步，其起止时间戳为 则第j步过程中的方向变化的计算方法为
6.如权利要求5所述的方法，其特征在于，所述步骤S23进一步包括以下步骤 5231、对所记录的指南针的读数进行平滑处理； 5232、获取指南针所指示的第j步与第j+k步之间的方向变化为？^/+|,获取通过三轴陀螺仪读数计算得到的第j步与第j+k步之间的方向变化为； 5233、设置||<#-彳-I的角度阀值，当
7.如权利要求6所述的方法，其特征在于，所述步骤S3进一步包括以下步骤 531、采集一组不同步长的用户以规定步长行走时所产生的加速度数据，记作B=IA11A21A3,…，AJ，每一组加速度数值对应一个步长，记作L=U1, I2, I3,…，I1J ； 532、对B中的每一组加速度Ai利用低通滤波器进行降噪处理； 533、对经过降噪处理的Ai,去除其包含的重力成分； 534、计算经过步骤S33后的每一组Ai的方差,记作V=Iv1,v2, V3,…，vm}； 535、利用最小二乘法对V和L作最佳线性拟合，得到Vi和Ii之间的对应关系，从而得到B中任一组加速度值对应的步长为 lfGi-bVa，其中a和b为最佳线性拟合的系数，Vi为该组加速度值所对应的方差。
8.如权利要求7所述的方法，其特征在于，所述步骤S4进一步包括以路径起点的坐标为原点，其坐标为(O, O);第j-ι步的坐标为(Xp1, Yj-i),则第j步的坐标(Xj, Yj)为 (X」，Yj) = (xj^+ljcos ( Φ + Y j), y^+ljSin ( Φ + Y j)) 其中，Iy Yj分别为第j步所对应的步长和方向变化；Φ为前j_l步内所发生的方向变化之和，即
9.一种基于智能手机的惯性导航系统，其特征在于，包括有 第一估计单元，用于根据智能手机上三轴加速度传感器捕捉到人走路时产生的三轴加速度值，利用基于有限状态机的计步算法，估计人所走过的步数并获得其每一步的起止时间戳； 第二估计单元，用于根据三轴陀螺仪所读取的数据及所述每一步的起止时间戳，结合指南针读数，计算人走过的每一步所发生的方向变化； 第三估计单元，用于根据不同步长的人行走时所产生的不同的加速度特征，估计人的步长; 第四估计单元，用于根据路径起点的坐标，结合所述步长以及所述方向变化，计算人走过的每一步相对于所述路径起点的坐标；通过每一步相对于所述路径起点的坐标，得到人的运动轨迹。
全文摘要
本发明涉及无线定位和惯性导航领域，通过提供一种基于智能手机的惯性导航系统及方法，设计基于有限状态机的计步算法计算人所走过的步数，并获得每一步的起止时间戳，根据三轴陀螺仪所读取的数据及所述每一步的起止时间戳，计算人走过的每一步所发生的方向变化；并根据不同步长的人行走时所产生的不同的加速度，估计人的步长；然后根据路径起点的坐标，结合所述步长以及所述方向变化，计算人走过的每一步相对于所述路径起点的坐标；通过每一步相对于所述路径起点的坐标，得到人的运动轨迹；本发明无需高精度、价格昂贵的惯性传感器，即可能够达到较高的惯性导航精度，其准确度高，实用性强，通用性广，成本低廉。
文档编号G01C21/16GK102944240SQ20121043464
公开日2013年2月27日 申请日期2012年11月2日 优先权日2012年11月2日
发明者刘云浩, 吴陈沭, 杨峥 申请人:清华大学