一种行人航迹推算质量控制方法技术

本发明专利技术提供一种行人航迹推算质量控制方法，包括如下步骤：首先，结合手机内置IMU数据测量值，进行低动态判断，运用低动态状态下加速度量测值校正陀螺积分系统，得到当地坐标系下的加速度测量值及手机动态性指标；其次，结合三轴加速度平滑数据和步频检测方法得到的行人步伐时刻，记录当前步伐内平均加速度数据；再次，结合相邻步伐间加速度数据，运用动态时间规整算法，得到行人运动连续性指标；最后结合手机动态性指标与行人运动连续性指标，得到行人航迹推算质量控制指标，为PDR递推质量提供数值依据，实现PDR递推精度的可靠预测。本发明专利技术有效结合手机动态性与行人运动连续性信息，为行人航迹推算质量提供判断依据。为行人航迹推算质量提供判断依据。为行人航迹推算质量提供判断依据。

【技术实现步骤摘要】
一种行人航迹推算质量控制方法


[0001]本专利技术属于室内定位
，具体涉及一种行人航迹推算质量控制方法。
技术背景
[0002]基于手机的室内定位技术作为万物互联的重要一环，已经应用在人们的日常生活中，例如在商场、停车场、火车站等。行人航迹推算(Pedestrian Dead Reckoning,PDR)无需安装外部设备，已经成为了手机室内定位主要技术之一。它主要基于行人行走周期性特点进行定位，主要包括三个步骤：步伐检测、步长估计、航向估计。与传统捷联惯性导航不一样的是，它不通过对加速度计测量值进行两次积分得到位置，更适合于低精度的惯性测量单元传感器(Inertial Measurement Unit,IMU)。然而，由于行人行走的复杂性与任意性，基于手机的PDR步伐检测对行人行走动作敏感。行人运动方向与手机航向方向存在安装角误差，且在行进过程中安装角度会发生变化，这将影响PDR实际应用中的可靠性与稳定性。
[0003]为了提高基于手机的PDR可靠性，最常用的方法一方面是增加PDR步伐检测的复杂性，另一方面是通过主成分分析方法(Principal Component Analysis,PCA)实时估计行人运动方向。但在实际操作时，由于行人运动的随意性与行人携带手机方式的易变性，单独运行PDR很难获得稳定可靠的定位结果。因此，研究如何可靠控制PDR递推质量，将具有重要应用价值与意义。

技术实现思路

[0004]为了解决上述问题，本专利技术提供一种行人航迹推算质量控制方法。所述方法以智能手机为平台，智能结合内置加速度计、陀螺仪传感器，在行人行进过程中运用实时航向可靠估计、加速度滑动窗口分析，得到手机动态性指标与行人运动连续性指标。结合这两种指标，为PDR递推质量提供判断基准。此方法也适用于室内定位其他平台的应用。
[0005]进一步地，所述方法具体包括以下步骤：
[0006]步骤1、结合手机内置三轴陀螺仪和三轴加速度数据，结合惯性导航陀螺积分原理，运用低动态状态下检测重力加速度，得到当地坐标系下东方向和北方向角速度测量值，以此得到手机动态性指标；
[0007]步骤2、结合手机内置三轴加速度数据，运用滑动窗口平滑加速度数据；运用步频检测方法探测行人行走步伐时刻，并记录每步间隔内的平滑加速度数据；
[0008]步骤3、结合每步间隔内的平滑加速度数据，运用动态时间规整算法(Dynamic Time Warping,DTW)计算相邻步伐间加速度数据的相似性，以此得到行人运动连续性指标；
[0009]步骤4、结合手机动态性指标和行人运动连续性指标，得到行人航迹推算质量控制指标，为PDR递推质量提供依据。
[0010]步骤5，结合基于PDR的多源融合系统，通过行人航迹推算质量控制指标，动态调整融合系统时间更新的过程噪声，以此实现对行人航迹推算的质量控制。将质量控制指标运用至基于PDR的多源融合系统时间更新过程噪声中，以此提高融合系统的稳健性与可靠性。
[0011]进一步地，步骤1具体为：运用三轴陀螺仪与三轴加速度数据，判断手机是否属于低动态状态，如公式1所示；在低动态状态下运用三轴加速度测量值实时校正陀螺积分系统；基于陀螺积分系统，计算当地坐标系下东方向角速度测量值和北方向角速度测量值，得到手机动态性指标，如公式2所示。
[0012][0013][0014]其中，M表示低动态状态判断窗口数目，g表示当地重力加速度，f
i
和ω
i
分别表示第i个三轴加速度测量幅值与三轴陀螺仪测量幅值，σ
f
和σ
ω
分别是加速度计噪声测量值和陀螺仪传感器噪声测量值，γ表示低动态状态判断阈值，ω
e
表示当地坐标系下东方向角速度测量值，ω
n
表示当地坐标系下北方向角速度测量值，A
indicator
表示手机动态性指标。
[0015]进一步地，步骤2具体为：结合手机内置三轴加速度数据，得到加速度幅值结果，并对加速度幅值结果进行滑动窗口平滑，如公式3
‑
4所示；运用步频检测方法得到行人步伐时刻，记录该步伐内的平滑加速度数据，如公式5所示。
[0016][0017][0018][0019]其中，t
i
表示采样时间，acc
x
、acc
y
、acc
z
表示三轴加速度原始测量值，表示t
i
时刻下加速度幅值，表示平滑后的加速度幅值结果，N表示该步伐内的平滑加速度数据。
[0020]进一步地，步骤3具体为：结合步骤2得到的相邻步伐间平滑加速度数据，运用动态时间规整算法计算对应步伐加速度数据相似性，如公式6
‑
8所示。
[0021][0022][0023]B
indicator
＝DTW(N,M)
ꢀꢀ
(8)
[0024]其中，N表示第N步伐内的平滑加速度数据，M表示第M步伐内的平滑加速度数据，DTW表示动态时间规整算法，B
indicator
表示行人运动连续性指标。
[0025]进一步地，步骤4具体为：结合步骤1得到的手机动态性指标与步骤3得到的行人运动连续性指标，得到行人航迹推算质量控制指标，如公式9所示。根据行人航迹推算质量控制指标数值大小，为PDR递推质量提供数值判断依据。
[0026]C
indicator
＝A
indicator
·
B
indicator
ꢀꢀ
(9)
[0027]其中，A
indicator
表示手机动态性指标，B
indicator
表示行人运动连续性指标，C
indicator
表示行人航迹推算质量控制指标。
[0028]进一步的，基于PDR的多源融合卡尔曼系统状态量设置如下：
[0029]x＝[e, n, v, θ, ω]T
ꢀꢀ
(10)
[0030]其中，x表示待估计的状态量，e和n分别表示东方向和北方向的当地坐标，v表示行人步行速度，θ和ω分别表示航向角度与角速度；
[0031]基于PDR的多源融合卡尔曼系统是将PDR和外部其他源结果一起融合，将PDR和外部其他源结果按一定比例加权得到最后结果，该系统的时间更新过程如下：
[0032][0033]其中，下标k表示时刻，上标
‑
和+分别表示状态量的预测值与更新值，Δt表示时间间隔，w1‑
w5均表示噪声；
[0034]结合行人航迹推算质量控制指标C
indicator
，实时控制系统的过程噪声矩阵Q,即Q＝C
indicator
×
Q0，其中Q0为原始系统过程噪声矩阵，C
indicator
表示行人航迹推算质量本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种行人航迹推算质量控制方法，其特征在于，包括如下步骤：步骤1，结合手机内置三轴陀螺仪和三轴加速度数据，结合惯性导航陀螺积分原理，运用低动态状态下检测重力加速度，得到当地坐标系下东方向和北方向角速度测量值，以此得到手机动态性指标；步骤2，结合手机内置三轴加速度数据，运用滑动窗口平滑加速度数据；运用步频检测方法探测行人行走步伐时刻，并记录每步间隔内的平滑加速度数据；步骤3，结合每步间隔内的平滑加速度数据，运用动态时间规整算法DTW计算相邻步伐间加速度数据的相似性，以此得到行人运动连续性指标；步骤4，结合手机动态性指标和行人运动连续性指标，得到行人航迹推算质量控制指标，为PDR递推质量提供依据；所述行人航迹推算质量控制指标即为手机动态性指标与行人运动连续性指标的乘积；步骤5，结合基于PDR的多源融合卡尔曼系统，通过行人航迹推算质量控制指标，动态调整多源融合卡尔曼系统时间更新的过程噪声，以此实现对行人航迹推算的质量控制。2.如权利要求1所述的一种行人航迹推算质量控制方法，其特征在于：步骤1的具体实现方式如下；运用三轴陀螺仪与三轴加速度数据，判断手机是否属于低动态状态，如公式1所示；在低动态状态下运用三轴加速度测量值实时校正陀螺积分系统；基于陀螺积分系统，计算当地坐标系下东方向角速度测量值和北方向角速度测量值，得到手机动态性指标，如公式2所示；示；其中，M表示低动态状态判断窗口数目，g表示当地重力加速度，f
i
和ω
i
分别表示第i个三轴加速度测量幅值与三轴陀螺仪测量幅值，σ
f
和σ
ω
分别是加速度计噪声测量值和陀螺仪传感器噪声测量值，γ表示低动态状态判断阈值，ω
e
表示当地坐标系下东方向角速度测量值，ω
n
表示当地坐标系下北方向角速度测量值，A
indicator
表示手机动态性指标。3.如权利要求1所述的一种行人航迹推算质量控制方法，其特征在于：步骤2的具体实现方式如下；结合手机内置三轴加速度数据，得到加速度幅值结果，并对加速度幅值结果进行滑动窗口平滑，如公式3
‑
4所示；运用步频检测方法得到行人步伐时刻，记录该步伐内的平滑加速度数据，如公式5所示；速度数据，如公式5所示；速度数据，如公式5所示；其中，t
i
表示采样时间，acc
x
、acc
y
、acc
z
表示三轴加速度原始测量值，表示t
i
时刻下加速度幅值，表示平滑后的加速度幅值结果，N表示该步伐内的平滑加速度数据。
4.如权利要求3所述的一种行人...

【专利技术属性】
技术研发人员：柳景斌，杨盛，龚晓东，黄格格，赵智博，白羽，刘德龙，
申请(专利权)人：武汉大学，
类型：发明
国别省市：