基于简化Sage-Husa自适应滤波的室内目标跟踪方法.pdf

《基于简化Sage-Husa自适应滤波的室内目标跟踪方法.pdf》由会员分享，可在线阅读，更多相关《基于简化Sage-Husa自适应滤波的室内目标跟踪方法.pdf（12页完成版）》请在专利查询网上搜索。

1、(19)中华人民共和国国家知识产权局 (12)发明专利申请 (10)申请公布号 (43)申请公布日 (21)申请号 201910300089.6 (22)申请日 2019.04.15 (71)申请人 哈尔滨工程大学 地址 150001 黑龙江省哈尔滨市南岗区南 通大街145号哈尔滨工程大学科技处 知识产权办公室 (72)发明人 苘大鹏杨武王巍玄世昌 吕继光梁冰 (51)Int.Cl. G01S 5/02(2010.01) (54)发明名称 一种基于简化Sage-Husa自适应滤波的室内 目标跟踪方法 (57)摘要 本发明属于室内跟踪领域， 具体涉及一种基 于简化Sage-Husa自适应滤波的室。

2、内目标跟踪方 法； 包括在普通系统方程的基础上建立本跟踪系 统的系统方程； 预测阶段： 在不利用观测值的前 提下， 目标估计当前时刻状态； 更新阶段： 利用观 测值更新估计状态； 噪声估计阶段： 利用Sage- Husa自适应滤波的时变噪声统计估值器对系统 噪声统计特征和实时修正； 重复步骤2至步 骤4， 直至结束跟踪。 相比于传统卡尔曼滤波， 当 目标的运动状态不确定或者运动状态发生突变 时， 本发明提出的基于简化的Sage-Husa自适应 滤波的跟踪算法在卡尔曼滤波的基础上引入了 时变噪声统计估值器， 可以实时校正系统噪声， 使得系统方程更加符合实际情况， 能提升滤波精 度并且抑制滤波发散。

3、， 应用前景广阔。 权利要求书3页 说明书7页 附图1页 CN 110031798 A 2019.07.19 CN 110031798 A 1.一种基于简化Sage-Husa自适应滤波的室内目标跟踪方法， 其特征在于， 具体包括以 下步骤： 步骤1、 在普通系统方程的基础上建立本跟踪系统的系统方程； 步骤2、 预测阶段： 在不利用观测值的前提下， 目标估计当前时刻状态； 步骤3、 更新阶段： 利用观测值更新估计状态； 步骤4、 噪声估计阶段： 利用Sage-Husa自适应滤波的时变噪声统计估值器对系统噪声 统计特征和实时修正； 步骤5、 至此一轮迭代完毕， 令kk-1， 本轮中估计的和用于下一。

4、轮的计算中， 重复 步骤2至步骤4， 直至结束跟踪。 2.根据权利要求1所述一种基于简化Sage-Husa自适应滤波的室内目标跟踪方法， 其特 征在于， 所述普通系统方程为： xkFkxk-1+Bkuk+wk 式中， xk是状态向量， 描述位置、 速度、 航向信息， uk代表控制输入向量， 包括转向角， 油 门设置， 制动力， Fk是状态转移矩阵， 它表示k-1时刻的每个系统状态参数对k时刻的系统状 态的影响， Bk是控制输入矩阵， 其将相量uk中的每个控制输入参数应用于状态向量上， wk代 表包含状态向量中每个参数的过程噪声向量， 假设wk服从一个由协方差矩阵Qk给出的零均 值多元高斯分布，。

5、 观测模型为： zkHkxk+vk 式中zk是观测向量， Hk是将状态向量参数映射到观测域的变换矩阵， vk是观测噪声， 它 与wk一样是高斯白噪声， wk和vk的统计特征如下： 式中，kj为Krinecker- 函数： 3.根据权利要求1所述一种基于简化Sage-Husa自适应滤波的室内目标跟踪方法， 其特 征在于， 步骤1中所述建立本跟踪系统的系统方程具体包括以下步骤： 步骤1.1、 在跟踪系统中， 假设目标以恒定的速度行走， 且不存在外界输入， 所以忽略对 uk和Bk的讨论， 因此， 目标在k到k+1的时间间隔t内的运动能用一个具有随机加速度的固 定速度描述， 将状态向量xk定义为xkp。

6、xk， pyk， vxk， vykT,其中(pxk， pyk)和(vxk， vyk)是目 标的坐标和速度， t内目标在x轴方向上的位移与速度用下式描述： 步骤1.2、 系统模型为xk+1Fkxk+kwk， 则 权利要求书 1/3 页 2 CN 110031798 A 2 假设在任意时间间隔t内的加速度wk为高斯随机噪声， 且wk的方差是设kwk的协 方差矩阵为Qk， 所以 步骤1.3、 观测模型为： zkHkxk+vk 则 zk为观测值， 把定位的结果作为观测值不断输入到跟踪系统中。 4.根据权利要求1所述一种基于简化Sage-Husa自适应滤波的室内目标跟踪方法， 其特 征在于， 所述步骤2。

7、具体包括以下步骤： 步骤2.1、 状态一步预测方程： 步骤2.2、 用估计误差协方差矩阵pk|k-1表示本轮预测的不确定程度： 步骤2.3、 新息方程： 步骤2.4、 利用遗忘因子b计算中间变量dk， 0b1： 5.根据权利要求1所述一种基于简化Sage-Husa自适应滤波的室内目标跟踪方法， 其特 征在于， 所述步骤3具体包括以下步骤： 步骤3.1、 更新卡尔曼增益矩阵， 其中通过pk|k-1间接的影响Kk： 步骤3.2、 估计目标位置： 步骤3.3、 更新预测误差协方差矩阵： pk(I-KkHk)pk|k-1。 权利要求书 2/3 页 3 CN 110031798 A 3 6.根据权利要求。

8、1所述一种基于简化Sage-Husa自适应滤波的室内目标跟踪方法， 其特 征在于， 所述步骤4具体包括以下步骤： 步骤4.1、 ； 利用Sage-Husa自适应滤波的时变噪声统计估值器重新估计 步骤4.2、 利用Sage-Husa自适应滤波的时变噪声统计估值器重新估计 权利要求书 3/3 页 4 CN 110031798 A 4 一种基于简化Sage-Husa自适应滤波的室内目标跟踪方法 技术领域 0001 本发明属于室内跟踪领域， 具体涉及一种基于简化Sage-Husa自适应滤波的室内 目标跟踪方法。 背景技术 0002 在现今这个时代中， 无线网络发展迅速， 人们对于生活和工作的各方面需求。

9、也越 来越高， 室内定位与跟踪服务以其广泛的实用性和功能性越来越被人们所需要。 其中由于 Wi-Fi设备在大型公共场所、 办公室或者家庭中都很常见， 所以基于Wi-Fi的室内定位与跟 踪是现今研究的重点。 Wi-Fi环境下常见的研究都是基于信号接收强度(RSSI)， 但是跟踪效 果不理想。 可以从无线网卡中获得的信道状态信息(CSI)是更精细的特征， 对环境的感知更 加敏感， 本文就采用信道状态信息的幅度为特征值， 进行室内跟踪算法的设计。 现有的跟踪 滤波算法在实际应用中存在着收敛速度慢、 易发散、 收敛精度低等问题。 比如变化大的观测 数据容易引起扩展类卡尔曼滤波的发散现象， 锚节点低密度。

10、时容易引起粒子滤波的粒子退 化、 样本贫化现象； 并且当目标处于复杂且无规律的运动状态时， 单一的滤波技术由于误差 累计问题难以进行长时间高精度的动态跟踪。 因此， 现有滤波算法仍需进一步改进。 0003 对于移动跟踪系统， 利用时间序列上的多次测量来迭代减少定位误差是一种通用 的做法。 针对无源跟踪系统， 研究者提出了几种解决方案。 例如， Chen Z利用卡尔曼滤波器 分别使用基于变量的RTI和基于子空间变量的射电断层扫描的定位结果来跟踪单个目标。 此外， 他们将该方案扩展到跟踪多人。 与卡尔曼滤波不同， 跟踪多人的问题被表述为数据分 配问题(DAP)， 并通过最小化DAP的总成本来解决。。

11、 标准卡尔曼滤波算法要求准确的系统模 型和噪声统计特性， 在实际应用中很难达到， 最终可能导致滤波发散。 Sage-Husa自适应卡 尔曼滤波算法可以实时估计噪声统计特性， 但会降低滤波实时性， 增加算法的复杂程度， 实 际应用中效果并不理想。 Vasisht提出一种对Sage-Husa自适应卡尔曼滤波算法的改进方 法， 但是其公式复杂， 计算量大， 不易在实际应用中实现。 Wu C提出一种简化的Sage-Husa算 法， 只对对滤波响大的测量噪声协方差阵进行在线估计， 但每个采样周期都对进行估计， 未 能降低算法的复杂度， 无法保证滤波的实时性。 Cai S结合协方差匹配技术对Sage-Hu。

12、sa算 法进行了改进， 有效防止了滤波发散并提高了实时性， 但由于此方法对系统模型不确定性 的鲁棒性差， 并且在系统稳定后对突变状态失去跟踪能力所以在实际应用中效果并非特别 理想。 发明内容 0004 本发明的目的在于提供一种基于简化的Sage-Husa自适应滤波的室内目标跟踪算 法， 其能够解决目标运动状态发生突变时跟踪效果差的问题。 0005 一种基于简化Sage-Husa自适应滤波的跟踪算法， 具体包括以下步骤： 0006 步骤1、 在普通系统方程的基础上建立本跟踪系统的系统方程； 0007 步骤2、 预测阶段： 在不利用观测值的前提下， 目标估计当前时刻状态； 说明书 1/7 页 5 。

13、CN 110031798 A 5 0008 步骤3、 更新阶段： 利用观测值更新估计状态； 0009 步骤4、 噪声估计阶段： 利用Sage-Husa自适应滤波的时变噪声统计估值器对系统 噪声统计特征和实时修正； 0010步骤5、 至此一轮迭代完毕， 令kk-1， 本轮中估计的和用于下一轮的计算中， 重复步骤2至步骤4， 直至结束跟踪。 0011 所述一种基于简化Sage-Husa自适应滤波的室内目标跟踪算法， 普通系统方程为： 0012 xkFkxk-1+Bkuk+wk 0013 式中， xk是状态向量， 描述位置， 速度， 航向等信息， uk代表了所有控制输入向量， 包 括转向角， 油门设。

14、置， 制动力等， Fk是状态转移矩阵， 它表示k-1时刻的每个系统状态参数对 k时刻的系统状态的影响(例如， k-1时刻的位置和速度都影响k时刻的位置)， Bk是控制输入 矩阵， 其将相量uk中的每个控制输入参数应用于状态向量上， wk代表包含状态向量中每个参 数的过程噪声向量， 假设wk服从一个由协方差矩阵Qk给出的零均值多元高斯分布， 观测模型 为： 0014 zkHkxk+vk 0015 式中zk是观测向量， Hk是将状态向量参数映射到观测域的变换矩阵， vk是观测噪 声， 它与wk一样是高斯白噪声， wk和vk的统计特征如下： 0016 0017 式中，kj为Krinecker- 函数。

15、： 0018 0019 所述一种基于简化Sage-Husa自适应滤波的室内目标跟踪算法， 步骤1中建立本跟 踪系统的系统方程具体包括以下步骤： 0020 步骤1.1、 在跟踪系统中， 假设目标以恒定的速度行走， 且不存在外界输入， 所以忽 略对uk和Bk的讨论， 因此， 目标在k到k+1的时间间隔t内的运动能用一个具有随机加速度 的固定速度来描述， 将状态向量xk定义为xkpxk， pyk， vxk， vykT， 其中(pxk， pyk)和(vxk， vyk)是目标的坐标和速度， t内目标在x轴方向上的位移与速度用下式描述： 0021 0022 步骤1.2、 系统模型为xk+1Fkxk+kwk。

16、， 则 0023 说明书 2/7 页 6 CN 110031798 A 6 0024 0025假设在任意时间间隔t内的加速度wk为高斯随机噪声， 且wk的方差是设kwk 的协方差矩阵为Qk， 所以 0026 步骤1.3、 观测模型为： 0027 zkHkxk+vk 0028 则 0029 0030 zk为观测值， 把定位的结果作为观测值不断输入到跟踪系统中。 将观测噪声vk定义 为其中和分别是x和y轴方向的观测噪声， 假设它们不相关； 从文献49中可 以看出， 在使用Sage-Husa滤波时不可能同时估计系统噪声与观测噪声的统计特性， 只能固 定其中一个而估计另外一个。 在本文中， 认为目标在。

17、室内行走或转弯时会发生随机加速度， 这个加速度需要实时估计， 而观测噪声的统计特性可以通过定位误差来求得。 所以相比于 传统做法以经验确定vk的统计特性的做法， 在本文中， 将定位阶段获得的沿x轴和y轴 方向的定位误差的均值和方差作为观测噪声的统计特征， 更加贴合实际情况。 0031 所述一种基于简化Sage-Husa自适应滤波的室内目标跟踪算法， 步骤2具体包括以 下步骤： 0032 步骤2.1、 状态一步预测方程： 0033 0034 步骤2.2、 用估计误差协方差矩阵pk|k-1表示本轮预测的不确定程度： 0035 0036 步骤2.3、 新息方程： 0037 0038 步骤2.4、 利。

18、用遗忘因子b计算中间变量dk， 0b1： 0039 0040 所述一种基于简化Sage-Husa自适应滤波的室内目标跟踪算法， 步骤3具体包括以 下步骤： 0041步骤3.1、 更新卡尔曼增益矩阵， 其中通过pk|k-1间接的影响Kk： 0042 0043 步骤3.2、 估计目标位置： 说明书 3/7 页 7 CN 110031798 A 7 0044 0045 步骤3.3、 更新预测误差协方差矩阵： 0046 pk(I-KkHk)pk|k-1。 0047 所述一种基于简化Sage-Husa自适应滤波的室内目标跟踪算法， 步骤4具体包括以 下步骤： 0048步骤4.1、 ； 利用Sage-Hu。

19、sa自适应滤波的时变噪声统计估值器重新估计 0049 0050步骤4.2、 利用Sage-Husa自适应滤波的时变噪声统计估值器重新估计 0051 0052 本发的有益效果在于： 0053 相比于传统卡尔曼滤波， 当目标的运动状态不确定或者运动状态发生突变时， 本 发明提出的基于简化的Sage-Husa自适应滤波的室内目标跟踪算法可以实时校正系统噪 声， 使得系统方程更加符合实际情况， 提升滤波精度并且抑制滤波发散。 附图说明 0054 图1为本发明的流程图。 具体实施方式 0055 下面结合附图对本发明作进一步描述。 0056 在实际应用中， 随着观测数量的增加， 可能会由于系统方程、 观测。

20、方程中的某些参 数设置不正确或者递推的过程中误差不断累积使滤波逐渐失去准确估计的作用， 也就是滤 波发散。 为了应对上述发散的种种原因， 本发明使用一种基于简化Sage-Husa滤波的追踪算 法来抑制发散， 从而完成追踪。 0057 在实际应用中， 有时并不能完全确定系统噪声Qk和观测噪声Rk， 甚至连状态转移矩 阵和观测矩阵都不能确定， 从而使得滤波发散。 这种情况一旦发生， 要控制卡尔曼增益矩阵 Kk来保证滤波结果不变， 所以应该首先对Qk或者Rk进行估计， 然后反馈给增益矩阵Kk， 对已 经变化了的Qk或者Rk进行估计后反馈调节Kk的过程就是系统自适应调节过程。 Sage-Husa自 适。

21、应滤波就是在卡尔曼滤波的基础上， 引入了时变噪声统计估值器， 所以它可以不断校正 系统噪声和观测噪声的均值与方差， 以减小滤波误差。 0058 如附图1所示， 为本发明流程图， 具体包括以下步骤： 0059 步骤1、 在普通系统方程的基础上建立本跟踪系统的系统方程； 0060 步骤2、 预测阶段： 在不利用观测值的前提下， 目标估计当前时刻状态； 0061 步骤3、 更新阶段： 利用观测值更新估计状态。 0062 步骤4、 噪声估计阶段： 利用Sage-Husa自适应滤波的时变噪声统计估值器对系统 噪声统计特征和实时修正； 0063步骤5、 至此一轮迭代完毕， 令kk-1， 本轮中估计的和用于。

22、下一轮的计算 说明书 4/7 页 8 CN 110031798 A 8 中， 重复步骤2至步骤4。 0064 所述一种基于简化Sage-Husa自适应滤波的室内目标跟踪算法， 普通系统方程为： 0065 xkFkxk-1+Bkuk+wk 0066 式中， xk是状态向量， 描述位置， 速度， 航向等信息， uk代表了所有控制输入向量， 包 括转向角， 油门设置， 制动力等， Fk是状态转移矩阵， 它表示k-1时刻的每个系统状态参数对 k时刻的系统状态的影响(例如， k-1时刻的位置和速度都影响k时刻的位置)， Bk是控制输入 矩阵， 其将相量uk中的每个控制输入参数应用于状态向量上， wk代表。

23、包含状态向量中每个参 数的过程噪声向量， 假设wk服从一个由协方差矩阵Qk给出的零均值多元高斯分布， 观测模型 为： 0067 zkHkxk+vk 0068 式中zk是观测向量， Hk是将状态向量参数映射到观测域的变换矩阵， vk是观测噪 声， 它与wk一样是高斯白噪声， wk和vk的统计特征如下： 0069 0070 式中，kj为Krinecker- 函数： 0071 0072 所述一种基于简化Sage-Husa自适应滤波的室内目标跟踪算法， 步骤1中建立本跟 踪系统的系统方程具体包括以下步骤： 0073 步骤1.1、 在跟踪系统中， 假设目标以恒定的速度行走， 且不存在外界输入， 所以忽 。

24、略对uk和Bk的讨论， 因此， 目标在k到k+1的时间间隔t内的运动能用一个具有随机加速度 的固定速度来描述， 将状态向量xk定义为xkpxk， pyk， vxk， vykT， 其中(pxk， pyk)和(vxk， vyk)是目标的坐标和速度， t内目标在x轴方向上的位移与速度用下式描述： 0074 0075 步骤1.2、 系统模型为xk+1Fkxk+kwk， 则 0076 0077 0078假设在任意时间间隔t内的加速度wk为高斯随机噪声， 且wk的方差是设kwk 说明书 5/7 页 9 CN 110031798 A 9 的协方差矩阵为Qk， 所以 0079 步骤1.3、 观测模型为： 00。

25、80 zkHkxk+vk 0081 则 0082 0083 zk为观测值， 把定位的结果作为观测值不断输入到跟踪系统中。 将观测噪声vk定义 为其中和分别是x和y轴方向的观测噪声， 假设它们不相关； 从文献49中可以 看出， 在使用Sage-Husa滤波时不可能同时估计系统噪声与观测噪声的统计特性， 只能固定 其中一个而估计另外一个。 在本文中， 认为目标在室内行走或转弯时会发生随机加速度， 这 个加速度需要实时估计， 而观测噪声的统计特性可以通过定位误差来求得。 所以相比于传 统做法以经验确定vk的统计特性的做法， 在本文中， 将定位阶段获得的沿x轴和y轴方 向的定位误差的均值和方差作为观测。

26、噪声的统计特征， 更加贴合实际情况。 0084 所述一种基于简化Sage-Husa自适应滤波的室内目标跟踪算法， 步骤2具体包括以 下步骤： 0085 步骤2.1、 状态一步预测方程： 0086 0087 步骤2.2、 用估计误差协方差矩阵pk|k-1表示本轮预测的不确定程度： 0088 0089 步骤2.3、 新息方程： 0090 0091 步骤2.4、 利用遗忘因子b计算中间变量dk， 0b1： 0092 0093 所述一种基于简化Sage-Husa自适应滤波的室内目标跟踪算法， 步骤3具体包括以 下步骤： 0094步骤3.1、 更新卡尔曼增益矩阵， 其中通过pk|k-1间接的影响Kk： 。

27、0095 0096 步骤3.2、 估计目标位置： 0097 0098 步骤3.3、 更新预测误差协方差矩阵： 0099 pk(I-KkHk)pk|k-1。 0100 所述一种基于简化Sage-Husa自适应滤波的室内目标跟踪算法， 步骤4具体包括以 下步骤： 0101步骤4.1、 ； 利用Sage-Husa自适应滤波的时变噪声统计估值器重新估计 说明书 6/7 页 10 CN 110031798 A 10 0102 0103步骤4.2、 利用Sage-Husa自适应滤波的时变噪声统计估值器重新估计 0104 说明书 7/7 页 11 CN 110031798 A 11 图1 说明书附图 1/1 页 12 CN 110031798 A 12 。