基于步态特征的微惯性导航Kalman滤波器参数自适应设置方法技术

本发明专利技术公开了基于步态特征的微惯性导航Kalman滤波器参数自适应设置方法，将微惯性传感器绑定于行人足部，采集行人在直线走、弧线走、转弯等步态下的原始惯性数据；利用每一步零速区间内解算航向角的均值计算相邻步航向角差值；利用航向角差值判断行人步态；在行人弧线走或转弯时，利用航向角差值自适应调整系统噪声Q矩阵的值，利用新息自适应调整量测噪声R矩阵的值。本发明专利技术自适应调整Kalman滤波器的系统噪声和量测噪声，大幅度提升了误差估计精度，实现行人高精度定位导航。实现行人高精度定位导航。实现行人高精度定位导航。

【技术实现步骤摘要】
基于步态特征的微惯性导航Kalman滤波器参数自适应设置方法


[0001]本专利技术属于基于微惯性传感器的足绑式行人导航
，涉及到一种基于步态特征的微惯性导航Kalman滤波器参数自适应设置方法。

技术介绍

[0002]传统的足绑式行人导航算法在利用Kalman滤波器修正导航误差时，滤波器Q矩阵和R矩阵的值都是不变的，但行人在直线走、弧线走、转弯等不同步态下的姿态误差估计精度和速度观测准确度不同，利用固定参数滤波器进行误差修正的精度会下降。

技术实现思路

[0003]针对利用固定参数滤波器进行误差修正精度会下降的问题，本专利技术目的提供基于步态特征的微惯性导航Kalman滤波器参数自适应设置方法，能够提升滤波修正的精度，从而提高定位精度。
[0004]为实现本专利技术目的，本专利技术提供基于步态特征的微惯性导航Kalman滤波器参数自适应设置方法，采取技术方案如下：
[0005]将微惯性传感器绑定于行人足部，采集行人在直线走、弧线走、转弯等步态下的原始惯性数据；利用每一步零速区间内解算航向角的均值计算相邻步航向角差值；利用航向角差值判断行人步态；在行人弧线走或转弯时，利用航向角差值自适应调整系统噪声Q矩阵的值，利用新息自适应调整量测噪声R矩阵的值。
[0006]进一步的，利用相邻步航向角差值判断行人步态，方法为：设定步态判别阈值，当相邻步航向角差值小于设定的阈值，表明行人处于直线走状态，当相邻步航向角差值大于设定的阈值，表明行人处于弧线走或转弯状态。
[0007]进一步的，当行人在进行弧线走或转弯机动运动时，姿态误差对应Q矩阵的值自适应调整为：
[0008][0009]其中，i＝1,2,3，q
i
′
为调整后Q矩阵对角线元素值，为两个相邻步间的航向角差值，表示根据运动剧烈程度引入的噪声修正量，Δ
base
表示修正的基底阈值，为常值。
[0010]进一步的，当行人在进行弧线走或转弯机动运动时，利用新息对R矩阵进行自适应调整：
[0011]R
i
′
＝R
i
+Rk*Rk
[0012]其中，i＝1,2,3，R
i
′
为调整后R矩阵对角线元素值，同时对R矩阵进行限幅设置：
[0013][0014]其中，Th
R
为R矩阵限幅判别阈值。
[0015]本专利技术与现有技术对比有益效果如下：
[0016]本专利技术将微惯性传感器固定在人体足部，通过捷联惯性导航解算实时更新行人导航信息，利用基于速度误差观测的Kalman滤波器抑制导航误差发散。为了挖掘行人直线走、弧线走、转弯等步态特征，利用相邻步间航向角的差值判断运动状态，基于步态判别结果自适应调整Kalman滤波器的Q矩阵和R矩阵，提升了滤波修正的精度，从而提高定位精度。本专利技术尤其适用于解决楼宇、巷道等城市环境中的行人高精度定位导航问题。
附图说明
[0017]所包括的附图用来提供对本专利技术实施例的进一步的理解，其构成了说明书的一部分，用于例示本专利技术的实施例，并与文字描述一起来阐释本专利技术的原理。显而易见地，下面描述中的附图仅仅是本专利技术的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。
[0018]图1示出了根据本专利技术的具体实施例提供的基于步态特征的微惯性导航Kalman滤波器参数自适应设置方法基本原理框图。
具体实施方式
[0019]需要说明的是，在不冲突的情况下，本申请中的实施例及实施例中的特征可以相互组合。下面将结合本专利技术实施例中的附图，对本专利技术实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本专利技术一部分实施例，而不是全部的实施例。以下对至少一个示例性实施例的描述实际上仅仅是说明性的，决不作为对本专利技术及其应用或使用的任何限制。基于本专利技术中的实施例，本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例，都属于本专利技术保护的范围。
[0020]作为本专利技术实施例提供的基于步态特征的微惯性导航Kalman滤波器参数自适应设置方法内容如下：
[0021]将微惯性传感器绑定于行人足部，采集行人在直线走、弧线走、转弯等步态下的原始惯性数据；利用每一步零速区间内解算航向角的均值计算相邻步航向角差值；利用航向角差值判断行人步态；在行人弧线走或转弯时，利用航向角差值自适应调整系统噪声Q矩阵的值，利用新息自适应调整量测噪声R矩阵的值。
[0022]如图1所示，本专利技术的具体方法包括如下步骤：
[0023]步骤1.惯性数据采集
[0024]将微惯性传感器绑定于行人足部，采集多种行进运动状态下的原始惯性数据，包括直线走、弧线走、转弯等动作。
[0025]步骤2.零速区间检测
[0026]行人在运动过程中的每一个单步都存在周期性脚面贴地的时段，该时段内行人足部的运动速度为零，被称为零速区间。利用阈值法、滑动方差法、广义似然比检测等方法找到每一个单步的零速区间。
[0027]步骤3.相邻步航向角差值计算
[0028]假设第k个单步的零速区间起止时刻分别为t
k,start
和t
k,end
，该零速区间内共包含n
k
个惯性数据采样时刻，其中i时刻的航向解算角为第k+1个单步的零速区间起止时刻分别为t
k+1,start
和t
k+1,end
，该零速区间内共包含n
k+1
个惯性数据采样时刻，其中i时刻的航向解算角为则第k步和第k+1步的航向角可以分别表示为：
[0029][0030][0031]则第k步和第k+1步这两个相邻步间的航向角差值可以表示为：
[0032][0033]步骤4.行人步态判别
[0034]利用相邻步航向角差值判断行人步态。设Th
heading
为步态判别阈值，当满足：
[0035][0036]表明行人处于直线走状态。
[0037]当满足：
[0038][0039]表明行人处于弧线走或转弯状态。
[0040]步骤5.Kalman滤波器Q矩阵自适应设置
[0041]设Kalman滤波器的系统状态向量为：
[0042][0043]其中，δV
n
，δV
u
，δV
e
分别表示微惯性导航系统的北向、天向、东向速度误差；δL，δh，δλ分别表示纬度误差、高度误差、经度误差；δγ，δθ分别表示滚转角误差、航向角误差、俯仰角误差。
[0044]系统状态方程为：
[0045][0046]其中，F(t)为状态转移矩阵，W(t)为系统噪声向量，满足：
[0047]E[W
k
]＝0,Cov[W
k
,W
j
]＝E[W
本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.基于步态特征的微惯性导航Kalman滤波器参数自适应设置方法，其特征在于，将微惯性传感器绑定于行人足部，采集行人步态下的原始惯性数据；利用每一步零速区间内解算航向角的均值计算相邻步航向角差值；利用航向角差值判断行人步态；在行人弧线走或转弯时，利用航向角差值自适应调整系统噪声Q矩阵的值，利用新息自适应调整量测噪声R矩阵的值。2.根据权利要求1所述的基于步态特征的微惯性导航Kalman滤波器参数自适应设置方法，其特征在于，利用相邻步航向角差值判断行人步态，方法为：设定步态判别阈值，当相邻步航向角差值小于设定的阈值，表明行人处于直线走状态，当相邻步航向角差值大于设定的阈值，表明行人处于弧线走或转弯状态。3.根据权利要求1所述的基于步态特征的微惯性导航Kalman滤波器参数自适应设置方法，其特征在于，当行人在进行弧线走或转弯机动...

【专利技术属性】
技术研发人员：郑辛，王鹏宇，孙伟，李海军，蒋荣，徐西京，苗宏胜，裴玉锋，
申请(专利权)人：北京自动化控制设备研究所，
类型：发明
国别省市：