[发明专利]一种在线校准步长、修正运动偏差角和自适应能量管理的行人导航方法

说明书

本发明公开了一种在线校准步长、运动偏差角修正和自适应能量管理的行人导航方法，属于行人导航领域。该方法首先在初始化阶段基于滤波进行位置姿态更新，然后在此基础上对步长模型进行标定并基于滤波进行行人运动方向修正；最后在初始化阶段结束后进行步长加方向的位置推算。在此过程中提出一套自适应的能量管理测略：增加陀螺休眠机制，满足特定条件下进行唤醒；在初始化阶段选择高采样率，进入正式的位置推算阶段进行降采样处理。通过使用本方法进行行人导航位置推算，避免了离线校准，并且对行人运动方向进行修正，同时使用自适应能量管理策略，有效降低了能耗。

技术领域

本发明属于行人导航技术领域，具体是一种在线校准步长、修正运动偏差角和自适应能量管理的行人导航方法。

背景技术

近几十年来，随着微电子机械(MEMS)技术的发展，MEMS惯性传感器被广泛应用于行人导航。由三轴陀螺仪和三轴加速度计构成的MEMS惯性传感器通常附着在人体的某一部位上，用于运动监测或生物医学等目的。现有的基于惯性器件技术的行人导航代表性方法主要可分为两类。一类是基于捷联惯导的力学编排计算方法。由于受陀螺仪和加速度计的固有漂移与零偏影响，捷联惯性系统的导航误差迅速增大，不可避免地导致结果发散。为了解决这一问题，人们对零速更新(ZUPT)方法进行了大量的研究，将零速视为行走姿态阶段的伪测量引入其中。ZUPT被证明能够有效地补偿惯性传感器漂移并重置系统部分累积误差。为了保持良好的航向精度和抑制陀螺仪的垂向漂移，磁力计越来越普遍地与惯性传感器在大规模低成本装置上集成，被称为MARG传感器，包含磁强计、角速率和重力传感器阵列。为了最佳地融合MARG传感器数据，发展了各种线性或非线性卡尔曼滤波器(KF)如传统KF、扩展KF、无味KF和粒子KF，用以估计一个人的位置和方向。另一类方法是基于航位推算的行人导航方法。它递推地在每个检测步骤中计算行人步长和行走方向。然而，现有的航位推算法在使用前需要用足够的个人离线数据集校准步长参数。这一点是它作为产品便捷使用的主要障碍。此外，尽管有很多学者在汽车导航领域已经讨论并修正了由于安装的传感器框架和定义的车身框架不一致而导致的各种类型的失调角，然而目前还没有文献对步行导航中与人的步态相关的航向偏差角补偿问题进行研究。值得指出的是，这种航向偏差角因人和步态而异。能量管理是可穿戴设备的另一个关键问题。对于行人导航应用而言，与加速度计或磁强计相比，陀螺仪消耗的能量要更为显著。例如，根据STMicroelectronics公司的官方用户手册，其典型产品MEMS陀螺仪LSGD20和加速度计LIS3DH，前者工作电流约6.1毫安，而后者仅约为11为微安。

发明内容

针对上述问题，本发明提出一种在线校准步长、修正运动偏差角和自适应能量管理的行人导航方法。该发明主要解决三个问题：第一，针对不同使用者的不同运动行为涉及步长模型进行在线标定；第二，对行人导航中与步态相关的运动方向偏差进行修正；第三，自适应能量管理策略：在推算过程中基于加速度信息进行运动行为智能检测与分类，根据运动行为自适应调整系统采样率；并引入陀螺休眠机制，在检测到明显运动行为变化后进行唤醒，达到降低能耗的目的。

本发明的技术方案为：一种在线校准步长、修正运动偏差角和自适应能量管理的行人导航方法，具体包括以下步骤：

步骤1：采用MARG传感器获取行人位置、速度、姿态数据；

步骤2：行人开始运动后进入“捷联惯导推算”阶段，基于惯性推算方法进行行人位置姿态更新；

步骤3：进行行人步态检测，以每一步为单位进行分割；

步骤4：进行行人步长在线标定；

步骤5：进行行人航向偏差角修正；

步骤6：检测总位移是否达预设长度，如否，则转至步骤2；如是，MARG传感器中陀螺仪进行休眠，转至步骤7；

步骤7：进入“步态航位推算”阶段位置推算。

进一步的，所述步骤2的具体方法为：