CN105205313B - 模糊高斯和粒子滤波方法、装置及目标跟踪方法、装置 - Google Patents

模糊高斯和粒子滤波方法、装置及目标跟踪方法、装置 Download PDF

Info

Publication number
CN105205313B
CN105205313B CN201510564644.8A CN201510564644A CN105205313B CN 105205313 B CN105205313 B CN 105205313B CN 201510564644 A CN201510564644 A CN 201510564644A CN 105205313 B CN105205313 B CN 105205313B
Authority
CN
China
Prior art keywords
gaussian
probability density
density function
state
weight
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201510564644.8A
Other languages
English (en)
Other versions
CN105205313A (zh
Inventor
李良群
谢维信
刘宗香
易正龙
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Kunshan Ruixiang Xuntong Communication Technology Co Ltd
Original Assignee
Shenzhen University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Shenzhen University filed Critical Shenzhen University
Priority to CN201510564644.8A priority Critical patent/CN105205313B/zh
Publication of CN105205313A publication Critical patent/CN105205313A/zh
Application granted granted Critical
Publication of CN105205313B publication Critical patent/CN105205313B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Complex Calculations (AREA)

Abstract

本发明公开了一种模糊高斯和粒子滤波方法、装置及目标跟踪方法、装置，该模糊粒子滤波方法包括：利用高斯和方法构建上一目标时刻的状态后验概率密度函数、观测噪声概率密度函数和状态噪声概率密度函数，利用高斯‑厄米特积分规则和蒙特卡罗原理获取当前时刻目标状态的预测概率密度函数，利用模糊聚类原理获取当前目标观测时刻的粒子权值和积分点权值，并计算各高斯项的权值，以计算每个高斯分布的均值和协方差，并对高斯项重采样获取G个权值较大的高斯项，然后利用高斯和原理得到当前目标观测时刻的状态后验概率密度函数，完成粒子滤波。通过上述方式，本发明能够有效提高滤波精度以及目标状态的估计性能。

Description

模糊高斯和粒子滤波方法、装置及目标跟踪方法、装置
技术领域
本发明涉及非线性滤波领域，特别是涉及一种模糊高斯和粒子滤波方法、装置及目标跟踪方法、装置。
背景技术
在飞机、航空飞行器、车辆等目标的运动过程中，常常需要对目标的实时状态进行估计以实现对目标的跟踪，飞机等目标的运动系统模型一般属于非线性随机系统。非线性滤波技术为非线性随机系统中进行状态估计的常用手段。
根据应用背景的不同，现有技术非线性滤波技术主要分为两类：第一类是针对非线性高斯环境下的状态估计问题，如扩展卡尔曼滤波器(EKF)、无迹卡尔曼滤波器(UKF)、积分卡尔曼滤波(QKF)、截断无迹卡尔曼滤波(IUKF)，这类方法主要是利用泰勒级数展开或数值计算等线性近似技术对非线性的系统模型进行近似，忽略近似高阶项对滤波性能的影响。第二类是针对非线性非高斯环境下的状态估计问题，如高斯和滤波器(GSF)、高斯和积分卡尔曼滤波器(GS-QKF)，这类高斯和方法主要是利用多个混合高斯将状态的后验概率密度函数近似成单个高斯函数，然而，与上述EKF等方法类似，这类高斯和方法都必须进行线性化，对于强非线性非高斯系统，此类滤波器的滤波精度并不高，且滤波器的高斯混合项的数量随着时间快速增长。
此外，为了对非线性非高斯噪声进行处理，现有技术还采用另一种非线性滤波方法：高斯和粒子滤波方法，对于大规模被动传感器系统中观测信息有限、数据丢失率高、具有非周期、非线性、非高斯特征的观测数据，现有技术所采用的一类高斯和粒子滤波方法由于在时间更新时只是简单地采用状态转移函数进行粒子采样，粒子的多样性以及准确性较差，粒子并不能有效表示目标的后验概率分布，从而降低粒子滤波的性能。
发明内容
本发明主要解决的技术问题是提供一种模糊高斯和粒子滤波方法、装置及目标跟踪方法、装置，能够增强粒子的多样性和准确性，有效提高滤波精度以及目标状态的估计性能。
为解决上述技术问题，本发明的第一方面是：提供一种模糊高斯和粒子滤波方法，包括：利用高斯和构建上一目标观测时刻的状态后验概率密度函数、观测噪声概率密度函数以及状态噪声概率密度函数；根据所述上一目标观测时刻的状态后验概率密度函数和所述状态噪声概率密度函数，利用高斯-厄米特积分和蒙特卡罗原理获取当前目标观测时刻的目标状态预测概率密度函数；根据所述当前目标观测时刻的目标状态预测概率密度函数和所述观测噪声概率密度函数获取状态粒子集；利用模糊聚类原理获取当前目标观测时刻的粒子权值和积分点权值，并计算各高斯项的权值；根据所述状态粒子集和所述粒子权值、所述积分点权值计算每个高斯分布的均值和协方差；根据所述高斯项的权值对高斯项进行重采样，获取G个权值较大的高斯项，G为正整数；以及根据获取的G个高斯项，利用高斯和原理得到当前目标观测时刻的状态后验概率密度函数，完成粒子滤波。
其中，所述根据上一目标时刻的状态后验概率密度函数和状态噪声概率密度函 数，利用高斯-厄米特积分规则和蒙特卡罗原理获取当前时刻目标状态的预测概率密度函 数的步骤包括：利用高斯-厄米特积分构建上一目标观测时刻的多个积分点概率密度函数； 根据所述多个积分点概率密度函数获取所述积分点的近似粒子集；其中，所述积分点 的近似粒子集为N；获取所述近 似粒子集中每个近似粒子的预测粒子集；以及根据所述预测粒子集获取当前目标观测时刻 的目标状态预测概率密度函数。
其中，所述利用高斯-厄米特积分构建上一目标观测时刻的多个积分点概率密度函数的步骤具体包括：获取n时刻每个高斯分布的高斯-厄米特积分点的后验概率密度函数，具体如下式所示：
其中，n时刻表示上一目标观测时刻，为第g个高斯分布函数的均值，P(n|n)g为第g个高斯分布函数的协方差；
估计n时刻的目标状态后验概率密度函数对应的积分点具体如下式所示：
其中，g’＝g+(k-1)K；g＝1，2，……，G；k＝1，2，……，K；l＝1，2，……，m；ξl为高斯-厄米特积分点；
以n时刻的目标状态后验概率密度函数对应的积分点为均值，P(n|n)g为协方差，构建n时刻的多个积分点概率密度函数
其中，公式(5)、(6)中的非高斯过程噪声和量测噪声的概率密度函数利用高斯和方法近似得到如下式所示：
其中，αk和βj均为非负常数，且满足和 和分别表示第k个高斯概率密度函数的均值和协方差。
其中，所述根据预测粒子集获取当前目标观测时刻的目标状态预测概率密度函数的步骤具体包括：根据所述预测粒子集获取n时刻的目标状态后验概率密度函数对应的积分点的均值和协方差具体如下式所示：
根据所述积分点的均值和协方差获取n+1时刻的目标状态第g’个高斯概率密度函数的均值和协方差P(n+1|n)g'，具体如下式所示：
计算每个高斯概率密度函数的权值，具体如下式所示：
将G'个高斯概率密度函数的加权和近似为目标状态的预测概率密度函数，具体如下式所示：
其中，利用模糊聚类原理获取当前目标观测时刻的粒子权值和积分点权值，并计算各高斯项的权值的步骤包括：根据所述积分点构建n+1时刻的多个积分点的重要性函数根据所述n+1时刻的多个积分点的重要性函数获取积分点的近似粒子集具体如下式所示：
其中，l＝1，2，……，m；g’＝1，2，……，G’；j＝1，2，……L；i＝1，2，……，N；
计算所述近似粒子集中每个粒子的权值具体如下式所示：
其中，为根据拉格朗日乘子法最小化目标函数而得到的yn+1与粒子的模糊隶属度，yn+1为当前目标观测时刻n+1时刻的目标观测。
其中，根据所述状态粒子集和所述粒子权值、所述积分点权值计算每个高斯分布的均值和协方差的步骤包括：根据所述近似粒子集和权值获取积分点的均值和协方差具体如下式所示：
根据所述积分点的权值获取高斯混合项的概率密度函数的均值和协方差以得到相应的权值，具体如下式所示：
其中，
其中，根据所述高斯项的权值对高斯项进行重采样，获取G个权值较大的高斯项的 步骤包括：将计算得到的G*K*L个高斯项的权值按照降序排列以保留前G个高斯项和权值其中，g＝1,…,G；当时，设定其中，j为每次循环时随机提取，且j∈{1,…,G}，提取 到j的概率正比于标准化权值g＝1,…,G，G为循环次数且 以及获取G个权值较大的高斯项。
其中，根据获取的G个高斯项，利用高斯和原理得到当前目标观测时刻的状态后验概率密度函数，完成粒子滤波的步骤具体为：利用高斯和原理，根据获取的G个高斯项，当前目标观测时刻的目标状态后验概率密度函数p(xn+1|y0:n+1)可以近似成均值为协方差为Pn+1|n+1的高斯分布，具体如下式所示：
为解决上述技术问题，本发明的第二方面是：提供一种模糊高斯和粒子滤波装置，包括：积分点概率密度函数构建模块，用于利用高斯和构建上一目标观测时刻的状态后验概率密度函数、观测噪声概率密度函数以及状态噪声概率密度函数；目标状态预测概率密度函数获取模块，用于根据所述上一目标观测时刻的状态后验概率密度函数和所述状态噪声概率密度函数，利用高斯-厄米特积分和蒙特卡罗原理获取当前目标观测时刻的目标状态预测概率密度函数；状态粒子集获取模块，用于根据所述当前目标观测时刻的目标状态预测概率密度函数和所述观测噪声概率密度函数获取状态粒子集；高斯项权值计算模块，用于利用模糊聚类原理获取当前目标观测时刻的粒子权值和积分点权值，并计算各高斯项的权值；高斯分布计算模块，用于根据所述状态粒子集和所述粒子权值、所述积分点权值计算每个高斯分布的均值和协方差；重采样模块，用于根据所述高斯项的权值对高斯项进行重采样，获取G个权值较大的高斯项，G为正整数；以及概率密度函数获取模块，用于根据获取的G个高斯项，利用高斯和原理得到当前目标观测时刻的状态后验概率密度函数，完成粒子滤波。
为解决上述技术问题，本发明的第三方面是：提供一种目标跟踪方法，包括：接收当前目标观测时刻以及当前目标观测时刻之前所观测的目标状态；利用高斯和构建上一目标观测时刻的状态后验概率密度函数、观测噪声概率密度函数以及状态噪声概率密度函数；根据所述上一目标观测时刻的状态后验概率密度函数和所述状态噪声概率密度函数，利用高斯-厄米特积分和蒙特卡罗原理获取当前目标观测时刻的目标状态预测概率密度函数；根据所述当前目标观测时刻的目标状态预测概率密度函数和所述观测噪声概率密度函数获取状态粒子集；利用模糊聚类原理获取当前目标观测时刻的粒子权值和积分点权值，并计算各高斯项的权值；根据所述状态粒子集和所述粒子权值、所述积分点权值计算每个高斯分布的均值和协方差；根据所述高斯项的权值对高斯项进行重采样，获取G个权值较大的高斯项，G为正整数；根据获取的G个高斯项，利用高斯和原理得到当前目标观测时刻的状态后验概率密度函数；利用所述当前目标观测时刻的目标状态后验概率密度函数对目标状态进行估计，以获得当前目标观测时刻的目标状态估计值；输出所述当前目标观测时刻的目标状态估计值，以实现对目标的跟踪。
为解决上述技术问题，本发明的第四方面是：提供一种目标跟踪装置，包括：观测数据接收模块，用于接收当前目标观测时刻以及当前目标观测时刻之前所观测的目标状态；积分点概率密度函数构建模块，用于利用高斯和构建上一目标观测时刻的状态后验概率密度函数、观测噪声概率密度函数以及状态噪声概率密度函数；目标状态预测概率密度函数获取模块，用于根据所述上一目标观测时刻的状态后验概率密度函数和所述状态噪声概率密度函数，利用高斯-厄米特积分和蒙特卡罗原理获取当前目标观测时刻的目标状态预测概率密度函数；状态粒子集获取模块，用于根据所述当前目标观测时刻的目标状态预测概率密度函数和所述观测噪声概率密度函数获取状态粒子集；高斯项权值计算模块，用于利用模糊聚类原理获取当前目标观测时刻的粒子权值和积分点权值，并计算各高斯项的权值；高斯分布计算模块，用于根据所述状态粒子集和所述粒子权值、所述积分点权值计算每个高斯分布的均值和协方差；重采样模块，用于根据所述高斯项的权值对高斯项进行重采样，获取G个权值较大的高斯项，G为正整数；概率密度函数获取模块，用于根据获取的G个高斯项，利用高斯和原理得到当前目标观测时刻的状态后验概率密度函数；目标状态估计模块，用于利用所述当前目标观测时刻的目标状态后验概率密度函数对目标状态进行估计，以获得当前目标观测时刻的目标状态估计值；目标状态估计值输出模块，用于输出所述当前目标观测时刻的目标状态估计值，以实现对目标的跟踪。
本发明的有益效果是：区别于现有技术的情况，本发明提供的模糊高斯和粒子滤波方法利用高斯和方法构建上一目标时刻的状态后验概率密度函数、观测噪声概率密度函数和状态噪声概率密度函数，能够增强粒子的多样性；然后上一时刻的状态后验概率密度函数和状态噪声概率密度函数，利用高斯-厄米特积分规则和蒙特卡罗原理获取当前时刻目标状态的预测概率密度函数，进一步获取当前时刻的目标状态粒子集，并利用模糊聚类方法和当前观测获取粒子权值和积分点权值，并计算各高斯项的权值，最后计算每个高斯分布的均值和协方差，并根据高斯项权值，对高斯项进行重采样，以根据获取的G个高斯分布得到当前时刻的状态后验概率密度函数，完成粒子滤波过程。本发明的粒子滤波方法，能够增强粒子的多样性以及粒子权值、积分点权值的准确性，有效提高滤波精度以及目标状态的估计性能，解决非线性非高斯情况下目标状态滤波问题。
附图说明
图1是本发明模糊高斯和粒子滤波方法一实施方式的流程图；
图2是本发明模糊高斯和粒子滤波方法一实施方式中根据上一目标观测时刻的状态后验概率密度函数和状态噪声概率密度函数，利用高斯-厄米特积分和蒙特卡罗原理获取当前目标观测时刻的目标状态预测概率密度函数的流程图；
图3是本发明模糊高斯和粒子滤波方法一实施方式中利用高斯-厄米特积分构建上一目标观测时刻的多个积分点概率密度函数的流程图；
图4是本发明模糊高斯和粒子滤波方法一实施方式中根据预测粒子集获取当前目标观测时刻的目标状态预测概率密度函数的流程图；
图5是本发明模糊高斯和粒子滤波方法一实施方式中利用模糊聚类原理获取当前目标观测时刻的粒子权值和积分点权值，并计算各高斯项的权值的流程图；
图6是本发明模糊高斯和粒子滤波方法一实施方式中根据状态粒子集、粒子权值以及积分点权值计算每个高斯分布的均值和协方差的流程图；
图7是本发明模糊高斯和粒子滤波方法一实施方式中根据高斯项的权值对高斯项进行重采样，获取G个权值较大的高斯项的流程图；
图8是本发明模糊高斯和粒子滤波方法一实施方式中在非均匀稀疏采样环境下，GSQPF、GSPF以及QPF的目标跟踪轨迹和真实轨迹的对比图；
图9是图6中30-50个采样点之间的目标跟踪轨迹放大图；
图10是本发明模糊高斯和粒子滤波方法一实施方式中在非均匀稀疏采样环境下，量测噪声均值为零、协方差为0.15的情况下，GSQPF、GSPF以及QPF的均方根误差对比图；
图11是本发明模糊高斯和粒子滤波方法一实施方式中在非均匀稀疏采样环境下，量测噪声均值为零、协方差为0.5的情况下，GSQPF、GSPF以及QPF的均方根误差对比图；
图12是本发明模糊高斯和粒子滤波装置一实施方式的原理框图；
图13是本发明目标跟踪方法一实施方式的流程图；
图14是本发明目标跟踪装置一实施方式的流程图。
具体实施方式
下面将结合本发明实施方式中的附图，对本发明实施方式中的技术方案进行清楚、完整地描述，显然，所描述的实施方式仅仅是本发明一部分实施方式，而不是全部的实施方式。基于本发明中的实施方式，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施方式，均属于本发明保护的范围。
粒子滤波方法为一种基于序列蒙特卡罗模拟的非线性滤波方法，指通过寻找一组在状态空间传播的随机样本对概率密度函数进行近似，通过粒子滤波方法对飞机、航空飞行器、车辆等目标的实时状态进行估计，实现对目标的跟踪。
请一并参阅图1-7，本发明模糊高斯和粒子滤波方法一实施方式包括以下步骤：
步骤S11，利用高斯和构建上一目标观测时刻的状态后验概率密度函数、观测噪声概率密度函数以及状态噪声概率密度函数。
预先设定动态空间模型为：
xn＝f(xn-1)+un (1)
yn＝h(xn)+vn (2)
其中，为n时刻的系统状态向量，为n时刻的量测值，和分别为过程噪声和观测噪声，并且是相互独立的。
状态估计就是在给定观测数据集合y1:n的条件下估计状态向量xn的概率密度函数p(xn|y1:n)。假定在n-1时刻概率密度函数p(xn-1|y1:n-1)已知，则预测n时刻的先验概率密度函数为：
p(xn|y1::n-1)＝∫p(xn|xn-1)p(xn-1|y1::n-1)dxn-1 (3)
其中，p(xn|xn-1)表示状态转移概率密度函数。
在时刻n获得观测值yn后，根据贝叶斯规则，后验概率密度函数可以定义如下：
其中，p(yn|y1::n-1)可认为是一常数，p(yn|xn)表示观测似然函数，可由观测模型(2)和观测噪声vn获得。公式(3)和公式(4)是最优贝叶斯估计的一般表达式。
步骤S12，根据所述上一目标观测时刻的状态后验概率密度函数和所述状态噪声概率密度函数，利用高斯-厄米特积分和蒙特卡罗原理获取当前目标观测时刻的目标状态预测概率密度函数。
进一步地，步骤S12具体包括以下子步骤：
子步骤S121，利用高斯-厄米特积分构建上一目标观测时刻的多个积分点概率密度函数。
具体地，高斯-厄米特(Gauss-Hermite)积分：
对于一个概率密度函数为的随机变量，根据Gauss-Hermite积分理论，下式所示的函数积分可以近似表示为：
其中，ξl为高斯-厄米特积分点，m为高斯-厄米特积分点的数目，wl为高斯-厄米特积分点ξl相应的权值，Hm(ξl),l＝1,2,…,m。
进一步地，利用正交多项式与上三角矩阵之间的关系来计算高斯-厄米特积分点ξl及其权值wl，假设J为一个对角元素为0的对角矩阵且
因此，将高斯-厄米特积分点ξl设置为其中εl为对角矩阵的第l个特征值；权值(vl)1为对角矩阵J第l个标准化特征值的第1个元素。
由于矢量中各个元素分量互不相关，因此可以将上面所述的一维积分点的情况推广到多维积分点的情况：假设一个具有高斯密度的随机矢量x，表示nx×nx的单位矩阵，多维积分点公式如下式所示：
其中，高斯-厄米特积分点权值
利用高斯-厄米特积分构建上一目标观测时刻的多个积分点概率密度函数具体包括如下步骤：
子步骤S20，获取n时刻每个高斯分布的高斯-厄米特积分点的后验概率密度函数。
具体地，在时刻n目标状态的后验概率密度函数为G个高斯密度函数的加权和，具体如下式所示：
其中，n时刻表示上一目标观测时刻，目标观测时刻即为目标观测点的采样时刻，为第g个高斯分布函数的均值，P(n|n)g为第g个高斯分布函数的协方差。ωng为对应的权值，均值和协方差P(n|n)g为根据当前目标观测时刻之前，即包括n时刻以及n时刻之前传感器所观测的目标状态而获得。
子步骤S21，估计n时刻的目标状态后验概率密度函数对应的积分点
具体地，状态空间中包括G个高斯分布，估计n时刻的目标状态后验概率密度函数对应的每个高斯分布的高斯-厄米特积分点具体如下式所示：
其中，g’＝g+(k-1)K；g＝1，2，……，G；k＝1，2，……，K；l＝1，2，……，m；ξl为高斯-厄米特积分点，相应的权系数为{ωl}。
子步骤S22，以n时刻的目标状态后验概率密度函数对应的积分点为均值，P(n|n)g为协方差，构建n时刻的多个积分点概率密度函数
其中，公式(5)、(6)中的非高斯过程噪声和量测噪声的概率密度函数利用高斯和方法近似得到如下式所示：
其中，αk和βj均为非负常数，且满足和 和分别表示第k个高斯概率密度函数的均值和协方差。
子步骤S122，根据所述多个积分点概率密度函数获取所述积分点的近似粒子集。
根据上述多个积分点概率密度函数获取n时刻的目标状态后验概 率密度函数对应的积分点的近似粒子集其中，
子步骤S123，获取所述近似粒子集中每个近似粒子的预测粒子集。
子步骤S124，根据所述预测粒子集获取当前目标观测时刻的目标状态预测概率密度函数。
具体包括如下子步骤：
子步骤S30，根据所述预测粒子集获取n时刻的目标状态后验概率密度函数对应的积分点的均值和协方差具体如下式所示：
子步骤S31，根据所述积分点的均值和协方差获取n+1时刻的目标状态第g’个高斯概率密度函数的均值和协方差P(n+1|n)g'，具体如下式所示：
子步骤S32，计算每个高斯概率密度函数的权值，具体如下式所示：
子步骤S33，将G'个高斯概率密度函数的加权和近似为目标状态的预测概率密度函数，具体如下式所示：
具体地，假设在时刻n目标状态的后验概率密度函数为G个高斯密度函数的加权和，具体如下式所示：
其中，和P(n|n)g分别表示第g个高斯分布函数的均值和协方差，ωng表示对应的权值。
在n+1时刻目标的预测概率密度函数p(xn+1|y0:n)可表示为：
假设改变积分变量则
应用上述高斯-厄米特积分规则的同时，利用蒙特卡罗近似非线性的状态转移概率密度函数，公式(17)的预测概率密度函数p(xn+1|y0:n)可以近似为：
进一步地，重新定义g'＝g+(k-1)K,G'＝GK,αg'＝αkωng，则公式(18)可以写为：
其中，表示均值为协方差为的高斯概率密度函数，表示从状态转移概率密度函数中抽取的状态粒子，ul.i表示粒子相应的权值，m表示高斯-厄米特积分点ξl的数量，N表示粒子个数。
根据粒子集预测概率密度函数p(xn+1|y0:n)可以近似为G'个高斯概率密度函数的加权和，根据上述公式(15)-(19)获取n+1时刻的目标状态预测概率密度函数，从而完成时间更新。
步骤S13，根据所述当前目标观测时刻的目标状态预测概率密度函数和所述观测噪声概率密度函数获取状态粒子集。
具体地，估计所述n+1时刻的目标状态预测概率密度函数p(xn+1|y0:n)对应的积分点具体如下式所示：
其中，g'＝1,...G'；l＝1,...m；j＝1,...,L。
步骤S14，利用模糊聚类原理获取当前目标观测时刻的粒子权值和积分点权值，并计算各高斯项的权值。
具体包括如下子步骤：
子步骤S141，根据所述积分点构建n+1时刻的多个积分点的重要性函数
子步骤S142，根据所述n+1时刻的多个积分点的重要性函数获取积分点的近似粒子集具体如下式所示：
其中，l＝1，2，……，m；g’＝1，2，……，G’；j＝1，2，……L；i＝1，2，……，N。
子步骤S143，计算所述近似粒子集中每个粒子的权值具体如下式所示：
其中，为根据拉格朗日乘子法最小化目标函数而得到的yn+1与粒子的模糊隶属度，yn+1为当前目标观测时刻n+1时刻的目标观测；
上述子步骤143的粒子权值计算可对应理解为如下的过程：
基于粒子滤波的特点，在粒子间定义一种概率相似性测度函数，利用基于概率测度的模糊聚类方法得到粒子的模糊隶属度，以代替粒子权值。同时，为了自适应计算积分点权值，通过模糊加权指数自适应计算积分点权值，具体如下。
假设表示重要性密度函数提取的N个粒子，yn+1表示n+1时刻接收到的观测粒子。根据模糊C均值聚类(FCM)算法，表示观测粒子yn+1源于粒子的模糊隶属度(也可以说是概率)，且满足如下约束：
于是，构建如下目标函数：
其中，l＝1,2,…,m；m1表示加权指数，表示粒子与观测粒子yn+1之间的距离。为了更好地反映粒子与观测粒子的隶属关系，加快收敛速度，定义一种基于概率的相似性测度方法，定义如下：
其中，表示在粒子的条件下，观测粒子yn+1的条件似然函数，由观测方程可知：
其中，d表示状态粒子的维数，S表示观测信息协方差。为了最优化目标函数，建立新的目标函数，如下式所示：
根据拉格朗日乘子法，与FCM类似，最小化目标函数(28)，可得观测粒子yn+1与粒子的模糊隶属度之间的关系，具体如下式所示：
其中，l＝1,2,…,m,i＝1,2,…,N。
于是，观测更新阶段的粒子权值可以定义如下：
子步骤S144，根据每个积分点概率密度函数的粒子集，自适应计算积分点权值，具体如下式所示：
其中，l＝1，2，……，m。
由高斯-厄米特积分规则可知，积分点权值通常为常数。在实验中发现，存在大量的积分点实际上远离目标的预测位置，显然，这些点对于目标状态的更新基本上不起任何作用。因此，为了减少无效积分点在滤波过程中的作用，基于粒子权值和模糊加权指数，提出如公式(31)一种自适应的积分点权值计算方法。
步骤S15，根据所述状态粒子集、所述粒子权值以及所述积分点权值计算每个高斯分布的均值和协方差。
具体包括如下子步骤：
子步骤S151，根据所述近似粒子集和权值获取积分点的均值和协方差具体如下式所示：
子步骤S152，根据所述积分点的权值获取高斯混合项的概率密度函数的均值和协方差，以得到相应的权值。
具体地，根据所述积分点的权值获取高斯混合项的概率密度函数的均值和协方差具体如下式所示：
得到相应的权值，具体如下式所示：
其中，
步骤S16，根据所述高斯项的权值对高斯项进行重采样，获取G个权值较大的高斯项。
具体包括如下子步骤：
子步骤S161，将计算得到的G*K*L个高斯项的权值按照降序排列以保留前G个高斯项和权值
其中，g＝1,…,G。
子步骤S162，判断是否若是，则进入子步骤S163，否则，进入子步骤S164。
子步骤S163，设定其中，j为每次循环时随 机提取，且j∈{1,…,G}，提取到j的概率正比于标准化权值g＝1,…,G，G 为循环次数且
子步骤S164，获取G个权值较大的高斯项。
经过子步骤S161-S164，近似状态后验概率密度函数的高斯混合项由G项增加到了G*K*L项。随着时间的递推，算法的高斯项也会呈快速增长，造成计算量太大，无法进行实际应用。因此需要对高斯项进行重采样，以防止其快速增长。
步骤S17，根据获取的G个高斯项，利用高斯和原理得到当前目标观测时刻的状态后验概率密度函数，完成粒子滤波。
具体地，利用高斯和原理，根据获取的G个高斯项，当前目标观测时刻的目标状态后验概率密度函数p(xn+1|y0:n+1)可以近似成均值为协方差为Pn+1|n+1的高斯分布，具体如下式所示：
进一步地，随着时间地更新，在n+1时刻，当接收到观测目标yn+1，则后验概率密度函数可以表示为：
由式(14)可知，观测目标的预测概率密度函数p(yn+1|xn+1)可以定义如下：
则，目标状态的后验概率密度函数可以表示为：
其中，Cn+1为标准化常数，与时间更新类似。将后验概率密度函数p(xn+1|y0:n+1)近似为混合高斯模型，则基于预测概率密度函数p(xn+1|y0:n)的积分点构建积分点概率密度函数，抽取滤波粒子集计算出目标状态的估计均值xn+1|n+1和协方差Pn+1|n+1，因此后验概率密度函数可以表示为
上述步骤S11-S13对应为本发明粒子滤波方法的时间更新阶段，步骤S14-S17对应为本发明粒子滤波方法的观测更新阶段，通过时间更新阶段获得当前目标观测时刻的目标状态预测概率密度函数，在观测更新阶段进一步利用时间更新阶段所获得的目标状态预测概率密度函数而获得当前目标观测时刻的目标状态后验概率密度函数，从而完成粒子滤波过程。
本发明的粒子滤波方法为基于高斯-厄米特的积分粒子滤波方法(GSQPF)，以下将举例对本发明的GSQPF方法的性能进行评估以及与现有技术的GSPF和QPF方法的性能进行对比。
在本例子中将利用实际观测采集的一批雷达航迹数据对本发明的GSQPF方法以及现有的上述方法进行评估和对比。雷达航迹数据中包括50个非周期的航迹点，飞行时间为504s。由于航迹点的非周期性，因此采样时间间隔T＝t(n+1)-t(n)也是对应变化的，且某些航迹点的采样时间间隔达到30s以上，其中n表示采样次数，t(n+1)表示第n+1次采样时的时刻，t(n)表示第n次采样时的时刻。在本例子的实验中采用如下的目标跟踪模型：
其中，目标状态向量为xn、yn分别表示n时刻目标在x、y方向上 的位置，分别表示n时刻目标在xn、yn方向上的速度，采样间隔为1s。过程噪声un为混 合高斯模型其中，R11＝diag ([0.012km2s4 0.012km2s4]),R12＝diag([0.032km2s4 0.032km2s4])，α＝0.8。量测噪声vn为零 均值协方差R＝diag([0.152km2,0.152km2])的高斯分布。目标初始状态x0的先验密度服从其中初始状态x0为[104.58km-0.144kms-1 60.22km 0.066kms-1]T，初始状态 估计和关联协方差分别假设为： 雷达假设设在原点。
图8为本发明的GSQPF方法以及现有的上述各种方法的目标跟踪轨迹与真实轨迹的对比图，图9为本发明的GSQPF以及现有的上述各种方法在30-50个采样点之间的目标跟踪轨迹放大图。由图8和9可以看出：在目标机动或者目标观测点的采样时间间隔比较大时，QPF和GSPF的估计轨迹明显偏离真实轨迹，而本发明的GSQPF方法的估计轨迹基本与真实轨迹吻合，估计性能优于现有的上述各种方法，其原因为本发明的GSQPF方法利用多个积分点概率密度函数作为重要性密度函数，并引入了最新的目标观测、采样时间间隔以及目标速度等目标的相关特性修正近似粒子集，改善了粒子的多样性和准确性，从而提高了粒子滤波的目标跟踪精度。
为了对比本发明的GSQPF方法以及现有的上述各种方法的跟踪精度，图10给出了在量测噪声均值为零、协方差为0.15的情况下，GSQPF、GSPF以及QPF的均方根误差对比结果，图11给出了在量测噪声均值为零、协方差为0.5的情况下，GSQPF、GSPF以及QPF的均方根误差对比结果。由图10和11可以看出，GSPF和QPF方法在目标动机或采样时间间隔增大时，跟踪性能快速下降，而GSQPF方法则能够较好地对目标进行跟踪。
可以理解，本发明提供的模糊高斯和粒子滤波方法利用高斯和方法构建上一目标时刻的状态后验概率密度函数、观测噪声概率密度函数和状态噪声概率密度函数，能够增强粒子的多样性；然后上一时刻的状态后验概率密度函数和状态噪声概率密度函数，利用高斯-厄米特积分规则和蒙特卡罗原理获取当前时刻目标状态的预测概率密度函数，进一步获取当前时刻的目标状态粒子集，并利用模糊聚类方法和当前观测获取粒子权值和积分点权值，并计算各高斯项的权值，最后计算每个高斯分布的均值和协方差，并根据高斯项权值，对高斯项进行重采样，以根据获取的G个高斯分布得到当前时刻的状态后验概率密度函数，完成粒子滤波过程。本发明的粒子滤波方法，能够增强粒子的多样性以及粒子权值、积分点权值的准确性，有效提高滤波精度以及目标状态的估计性能，解决非线性非高斯情况下目标状态滤波问题。
请参阅图12，本发明模糊高斯和粒子滤波装置40包括：
积分点概率密度函数构建模块41，用于利用高斯和构建上一目标观测时刻的状态后验概率密度函数、观测噪声概率密度函数以及状态噪声概率密度函数；
目标状态预测概率密度函数获取模块42，用于根据所述上一目标观测时刻的状态后验概率密度函数和所述状态噪声概率密度函数，利用高斯-厄米特积分和蒙特卡罗原理获取当前目标观测时刻的目标状态预测概率密度函数；
状态粒子集获取模块43，用于根据所述当前目标观测时刻的目标状态预测概率密度函数和所述观测噪声概率密度函数获取状态粒子集；
高斯项权值计算模块44，用于利用模糊聚类原理获取当前目标观测时刻的粒子权值和积分点权值，并计算各高斯项的权值；
高斯分布计算模块45，用于根据所述状态粒子集和所述粒子权值、所述积分点权值计算每个高斯分布的均值和协方差；
重采样模块46，用于根据所述高斯项的权值对高斯项进行重采样，获取G个权值较大的高斯项，G为正整数；以及
概率密度函数获取模块47，用于根据获取的G个高斯项，利用高斯和原理得到当前目标观测时刻的状态后验概率密度函数，完成粒子滤波。
请参阅图13，本发明实施方式还提供一种目标跟踪方法，包括：
步骤S500，接收当前目标观测时刻以及当前目标观测时刻之前所观测的目标状态；
步骤S501，利用高斯和构建上一目标观测时刻的状态后验概率密度函数、观测噪声概率密度函数以及状态噪声概率密度函数；
步骤S502，根据所述上一目标观测时刻的状态后验概率密度函数和所述状态噪声概率密度函数，利用高斯-厄米特积分和蒙特卡罗原理获取当前目标观测时刻的目标状态预测概率密度函数；
步骤S503，根据所述当前目标观测时刻的目标状态预测概率密度函数和所述观测噪声概率密度函数获取状态粒子集；
步骤S504，利用模糊聚类原理获取当前目标观测时刻的粒子权值和积分点权值，并计算各高斯项的权值；
步骤S505，根据所述状态粒子集和所述粒子权值、所述积分点权值计算每个高斯分布的均值和协方差；
步骤S506，根据所述高斯项的权值对高斯项进行重采样，获取G个权值较大的高斯项，G为正整数；以及
步骤S507，根据获取的G个高斯项，利用高斯和原理得到当前目标观测时刻的状态后验概率密度函数；
步骤S508，利用所述当前目标观测时刻的目标状态后验概率密度函数对目标状态进行估计，以获得当前目标观测时刻的目标状态估计值；
步骤S509，输出所述当前目标观测时刻的目标状态估计值，以实现对目标的跟踪。
请参阅图14，本发明实施方式还提供一种目标跟踪装600，包括：
观测数据接收模块601，用于接收当前目标观测时刻以及当前目标观测时刻之前所观测的目标状态；
积分点概率密度函数构建模块602，用于利用高斯和构建上一目标观测时刻的状态后验概率密度函数、观测噪声概率密度函数以及状态噪声概率密度函数；
目标状态预测概率密度函数获取模块603，用于根据所述上一目标观测时刻的状态后验概率密度函数和所述状态噪声概率密度函数，利用高斯-厄米特积分和蒙特卡罗原理获取当前目标观测时刻的目标状态预测概率密度函数；
状态粒子集获取模块604，用于根据所述当前目标观测时刻的目标状态预测概率密度函数和所述观测噪声概率密度函数获取状态粒子集；
高斯项权值计算模块605，用于利用模糊聚类原理获取当前目标观测时刻的粒子权值和积分点权值，并计算各高斯项的权值；
高斯分布计算模块606，用于根据所述状态粒子集和所述粒子权值、所述积分点权值计算每个高斯分布的均值和协方差；
重采样模块607，用于根据所述高斯项的权值对高斯项进行重采样，获取G个权值较大的高斯项，G为正整数；以及
概率密度函数获取模块608，用于根据获取的G个高斯项，利用高斯和原理得到当前目标观测时刻的状态后验概率密度函数；
目标状态估计模块609，用于利用所述当前目标观测时刻的目标状态后验概率密度函数对目标状态进行估计，以获得当前目标观测时刻的目标状态估计值；
目标状态估计值输出模块610，用于输出所述当前目标观测时刻的目标状态估计值，以实现对目标的跟踪。
以上所述仅为本发明的实施方式，并非因此限制本发明的专利范围，凡是利用本发明说明书及附图内容所作的等效结构或等效流程变换，或直接或间接运用在其他相关的技术领域，均同理包括在本发明的专利保护范围内。

Claims (10)

1.一种模糊高斯和粒子滤波方法，其特征在于，包括：
利用高斯和构建上一目标观测时刻的状态后验概率密度函数、观测噪声概率密度函数以及状态噪声概率密度函数；
根据所述上一目标观测时刻的状态后验概率密度函数和所述状态噪声概率密度函数，利用高斯-厄米特积分和蒙特卡罗原理获取当前目标观测时刻的目标状态预测概率密度函数；
根据所述当前目标观测时刻的目标状态预测概率密度函数和所述观测噪声概率密度函数获取状态粒子集；
利用模糊聚类原理获取当前目标观测时刻的粒子权值和积分点权值，并计算各高斯项的权值；
根据所述状态粒子集和所述粒子权值、所述积分点权值计算每个高斯分布的均值和协方差；
根据所述高斯项的权值对高斯项进行重采样，获取G个权值较大的高斯项，G为正整数；以及
根据获取的G个高斯项，利用高斯和原理得到当前目标观测时刻的状态后验概率密度函数，完成粒子滤波；
其中所述利用模糊聚类原理获取当前目标观测时刻的粒子权值和积分点权值，并计算各高斯项的权值的步骤包括：
根据积分点构建当前目标观测n+1时刻的多个积分点的重要性函数P(n+1|n)g'为n+1时刻的目标状态的第g’个高斯分布函数的协方差；
根据所述n+1时刻的多个积分点的重要性函数获取积分点的近似粒子集具体如下式所示：
其中，l＝1，2，……，m；g’＝1，2，……，G’；j＝1，2，……L；i＝1，2，……，N，m为高斯-厄尔米特积分点的数目，G'＝GK，G为构建n时刻的目标状态后验概率密度函数的高斯分布函数的总数，K为构建非高斯过程噪声概率密度函数的高斯分布函数的总数，L为构建非高斯观测噪声概率密度函数的高斯分布函数的总数；
计算所述近似粒子集中每个粒子的权值具体如下式所示：
其中，为根据拉格朗日乘子法最小化目标函数而得到的yn+1与粒子的模糊隶属度，yn+1为当前目标观测时刻n+1时刻的目标观测，m1表示加权指数；
所述目标函数如下式所示：
根据每个所述积分点概率密度函数的粒子集，自适应计算所述积分点权值具体如下式所示：
其中，l＝1，2，……，m。
2.根据权利要求1所述的方法，其特征在于，所述根据上一目标时刻的状态后验概率密度函数和状态噪声概率密度函数，利用高斯-厄米特积分规则和蒙特卡罗原理获取当前时刻目标状态的预测概率密度函数的步骤包括：
利用高斯-厄米特积分构建上一目标观测时刻的多个积分点概率密度函数；
根据所述多个积分点概率密度函数获取所述积分点的近似粒子集；其中，所述积分点的近似粒子集为i＝1，2，……，N，P(n|n)g为上一目标观测时刻的积分点概率密度函数的均值和协方差；
获取所述近似粒子集中每个近似粒子的预测粒子集；以及
根据所述预测粒子集获取当前目标观测时刻的目标状态预测概率密度函数。
3.根据权利要求2所述的方法，其特征在于，所述利用高斯-厄米特积分构建上一目标观测时刻的多个积分点概率密度函数的步骤具体包括：
获取n时刻每个高斯分布的高斯-厄米特积分点的后验概率密度函数，具体如下式所示：
其中，n时刻表示上一目标观测时刻，为第g个高斯分布函数的均值，P(n|n)g为第g个高斯分布函数的协方差，ωng为所述第g个高斯分布函数的权值；
估计n时刻的目标状态后验概率密度函数对应的积分点具体如下式所示：
其中，g’＝g+(k-1)K；g＝1，2，……，G；k＝1，2，……，K；l＝1，2，……，m；ξl为高斯-厄米特积分点；
以n时刻的目标状态后验概率密度函数对应的积分点为均值，P(n|n)g为协方差，构建n时刻的多个积分点概率密度函数
其中，公式(5)、(6)中的非高斯过程噪声和观测噪声的概率密度函数利用高斯和方法近似得到如下式所示：
其中，αk和βj均为非负常数，且满足和 和分别表示第k个高斯概率密度函数的均值和协方差。
4.根据权利要求3所述的方法，其特征在于，所述根据预测粒子集获取当前目标观测时刻的目标状态预测概率密度函数的步骤具体包括：
根据所述预测粒子集获取n时刻的目标状态后验概率密度函数对应的积分点的均值和协方差具体如下式所示：
根据所述积分点的均值和协方差获取n+1时刻的目标状态第g’个高斯概率密度函数的均值和协方差P(n+1|n)g'，具体如下式所示：
其中wl为所述高斯-厄米特积分点ξl相应的权值；
计算每个高斯概率密度函数的权值，具体如下式所示：
将G'个高斯概率密度函数的加权和近似为目标状态的预测概率密度函数，具体如下式所示：
5.根据权利要求4所述的方法，其特征在于，根据所述状态粒子集和所述粒子权值、所述积分点权值计算每个高斯分布的均值和协方差的步骤包括：
根据所述近似粒子集和权值获取积分点的均值和协方差具体如下式所示：
根据所述积分点的权值获取高斯混合项的概率密度函数的均值和协方差以得到相应的权值，具体如下式所示：
其中，
6.根据权利要求5所述的方法，其特征在于，根据所述高斯项的权值对高斯项进行重采样，获取G个权值较大的高斯项的步骤包括：
将计算得到的G*K*L个高斯项的权值按照降序排列以保留前G个高斯项和权值其中，g＝1,...,G；
当时，设定其中，j为每次循环时随机提取，且j∈{1,...,G}，提取到j的概率正比于标准化权值g＝1,...,G，G为循环次数且以及
获取G个权值较大的高斯项。
7.根据权利要求6所述的方法，其特征在于，根据获取的G个高斯项，利用高斯和原理得到当前目标观测时刻的状态后验概率密度函数，完成粒子滤波的步骤具体为：
利用高斯和原理，根据获取的G个高斯项，当前目标观测时刻的目标状态后验概率密度函数p(xn+1|y0:n+1)可以近似成均值为协方差为Pn+1|n+1的高斯分布，具体如下式所示：
8.一种模糊高斯和粒子滤波装置，其特征在于，包括：
积分点概率密度函数构建模块，用于利用高斯和构建上一目标观测时刻的状态后验概率密度函数、观测噪声概率密度函数以及状态噪声概率密度函数；
目标状态预测概率密度函数获取模块，用于根据所述上一目标观测时刻的状态后验概率密度函数和所述状态噪声概率密度函数，利用高斯-厄米特积分和蒙特卡罗原理获取当前目标观测时刻的目标状态预测概率密度函数；
状态粒子集获取模块，用于根据所述当前目标观测时刻的目标状态预测概率密度函数和所述观测噪声概率密度函数获取状态粒子集；
高斯项权值计算模块，用于利用模糊聚类原理获取当前目标观测时刻的粒子权值和积分点权值，并计算各高斯项的权值；
高斯分布计算模块，用于根据所述状态粒子集和所述粒子权值、所述积分点权值计算每个高斯分布的均值和协方差；
重采样模块，用于根据所述高斯项的权值对高斯项进行重采样，获取G个权值较大的高斯项，G为正整数；以及
概率密度函数获取模块，用于根据获取的G个高斯项，利用高斯和原理得到当前目标观测时刻的状态后验概率密度函数，完成粒子滤波；
其中所述高斯项权值计算模块包括：
重要性函数构建单元，用于根据积分点构建当前目标观测n+1时刻的多个积分点的重要性函数P(n+1|n)g'为n+1时刻的目标状态的第g’个高斯分布函数的协方差；
近似粒子集获取单元，用于根据所述n+1时刻的多个积分点的重要性函数获取积分点的近似粒子集具体如下式所示：
其中，l＝1，2，……，m；g’＝1，2，……，G’；j＝1，2，……L；i＝1，2，……，N，m为高斯-厄尔米特积分点的数目，G'＝GK，G为构建n时刻的目标状态后验概率密度函数的高斯分布函数的总数，K为构建非高斯过程噪声概率密度函数的高斯分布函数的总数，L为构建非高斯观测噪声概率密度函数的高斯分布函数的总数；
近似粒子权值计算单元，用于计算所述近似粒子集中每个粒子的权值具体如下式所示：
其中，为根据拉格朗日乘子法最小化目标函数而得到的yn+1与粒子的模糊隶属度，yn+1为当前目标观测时刻n+1时刻的目标观测，m1表示加权指数；
所述目标函数如下式所示：
积分点权值计算单元，用于根据每个所述积分点概率密度函数的粒子集，自适应计算所述积分点权值具体如下式所示：
其中，l＝1，2，……，m。
9.一种目标跟踪方法，其特征在于，包括：
接收当前目标观测时刻以及当前目标观测时刻之前所观测的目标状态；
利用高斯和构建上一目标观测时刻的状态后验概率密度函数、观测噪声概率密度函数以及状态噪声概率密度函数；
根据所述上一目标观测时刻的状态后验概率密度函数和所述状态噪声概率密度函数，利用高斯-厄米特积分和蒙特卡罗原理获取当前目标观测时刻的目标状态预测概率密度函数；
根据所述当前目标观测时刻的目标状态预测概率密度函数和所述观测噪声概率密度函数获取状态粒子集；
利用模糊聚类原理获取当前目标观测时刻的粒子权值和积分点权值，并计算各高斯项的权值；
根据所述状态粒子集和所述粒子权值、所述积分点权值计算每个高斯分布的均值和协方差；
根据所述高斯项的权值对高斯项进行重采样，获取G个权值较大的高斯项，G为正整数；
根据获取的G个高斯项，利用高斯和原理得到当前目标观测时刻的状态后验概率密度函数；
利用所述当前目标观测时刻的目标状态后验概率密度函数对目标状态进行估计，以获得当前目标观测时刻的目标状态估计值；
输出所述当前目标观测时刻的目标状态估计值，以实现对目标的跟踪；
其中所述利用模糊聚类原理获取当前目标观测时刻的粒子权值和积分点权值，并计算各高斯项的权值的步骤包括：
根据积分点构建当前目标观测n+1时刻的多个积分点的重要性函数P(n+1|n)g'为n+1时刻的目标状态的第g’个高斯分布函数的协方差；
根据所述n+1时刻的多个积分点的重要性函数获取积分点的近似粒子集具体如下式所示：
其中，l＝1，2，……，m；g’＝1，2，……，G’；j＝1，2，……L；i＝1，2，……，N，m为高斯-厄尔米特积分点的数目，G'＝GK，G为构建n时刻的目标状态后验概率密度函数的高斯分布函数的总数，K为构建非高斯过程噪声概率密度函数的高斯分布函数的总数，L为构建非高斯观测噪声概率密度函数的高斯分布函数的总数；
计算所述近似粒子集中每个粒子的权值具体如下式所示：
其中，为根据拉格朗日乘子法最小化目标函数而得到的yn+1与粒子的模糊隶属度，yn+1为当前目标观测时刻n+1时刻的目标观测，m1表示加权指数；
所述目标函数如下式所示：
根据每个所述积分点概率密度函数的粒子集，自适应计算所述积分点权值具体如下式所示：
其中，l＝1，2，……，m。
10.一种目标跟踪装置，其特征在于，包括：
观测数据接收模块，用于接收当前目标观测时刻以及当前目标观测时刻之前所观测的目标状态；
积分点概率密度函数构建模块，用于利用高斯和构建上一目标观测时刻的状态后验概率密度函数、观测噪声概率密度函数以及状态噪声概率密度函数；
目标状态预测概率密度函数获取模块，用于根据所述上一目标观测时刻的状态后验概率密度函数和所述状态噪声概率密度函数，利用高斯-厄米特积分和蒙特卡罗原理获取当前目标观测时刻的目标状态预测概率密度函数；
状态粒子集获取模块，用于根据所述当前目标观测时刻的目标状态预测概率密度函数和所述观测噪声概率密度函数获取状态粒子集；
高斯项权值计算模块，用于利用模糊聚类原理获取当前目标观测时刻的粒子权值和积分点权值，并计算各高斯项的权值；
高斯分布计算模块，用于根据所述状态粒子集和所述粒子权值、所述积分点权值计算每个高斯分布的均值和协方差；
重采样模块，用于根据所述高斯项的权值对高斯项进行重采样，获取G个权值较大的高斯项，G为正整数；
概率密度函数获取模块，用于根据获取的G个高斯项，利用高斯和原理得到当前目标观测时刻的状态后验概率密度函数；
目标状态估计模块，用于利用所述当前目标观测时刻的目标状态后验概率密度函数对目标状态进行估计，以获得当前目标观测时刻的目标状态估计值；
目标状态估计值输出模块，用于输出所述当前目标观测时刻的目标状态估计值，以实现对目标的跟踪；
其中所述高斯项权值计算模块包括：
重要性函数构建单元，用于根据积分点构建当前目标观测n+1时刻的多个积分点的重要性函数P(n+1|n)g'为n+1时刻的目标状态的第g’个高斯分布函数的协方差；
近似粒子集获取单元，用于根据所述n+1时刻的多个积分点的重要性函数获取积分点的近似粒子集具体如下式所示：
其中，l＝1，2，……，m；g’＝1，2，……，G’；j＝1，2，……L；i＝1，2，……，N，m为高斯-厄尔米特积分点的数目，G'＝GK，G为构建n时刻的目标状态后验概率密度函数的高斯分布函数的总数，K为构建非高斯过程噪声概率密度函数的高斯分布函数的总数，L为构建非高斯观测噪声概率密度函数的高斯分布函数的总数；
近似粒子权值计算单元，用于计算所述近似粒子集中每个粒子的权值具体如下式所示：
其中，为根据拉格朗日乘子法最小化目标函数而得到的yn+1与粒子的模糊隶属度，yn+1为当前目标观测时刻n+1时刻的目标观测，m1表示加权指数；
所述目标函数如下式所示：
积分点权值计算单元，用于根据每个所述积分点概率密度函数的粒子集，自适应计算所述积分点权值具体如下式所示：
其中，l＝1，2，……，m。
CN201510564644.8A 2015-09-07 2015-09-07 模糊高斯和粒子滤波方法、装置及目标跟踪方法、装置 Active CN105205313B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201510564644.8A CN105205313B (zh) 2015-09-07 2015-09-07 模糊高斯和粒子滤波方法、装置及目标跟踪方法、装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201510564644.8A CN105205313B (zh) 2015-09-07 2015-09-07 模糊高斯和粒子滤波方法、装置及目标跟踪方法、装置

Publications (2)

Publication Number Publication Date
CN105205313A CN105205313A (zh) 2015-12-30
CN105205313B true CN105205313B (zh) 2019-12-20

Family

ID=54952991

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510564644.8A Active CN105205313B (zh) 2015-09-07 2015-09-07 模糊高斯和粒子滤波方法、装置及目标跟踪方法、装置

Country Status (1)

Country Link
CN (1) CN105205313B (zh)

Families Citing this family (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105894542B (zh) * 2016-04-26 2019-06-11 深圳大学 一种在线目标跟踪方法及装置
CN106529018B (zh) * 2016-11-08 2019-07-30 南京航空航天大学 基于高斯权值-混合粒子滤波的疲劳裂纹扩展预测方法
WO2018119912A1 (zh) * 2016-12-29 2018-07-05 深圳大学 基于并行模糊高斯和粒子滤波的目标跟踪方法及装置
CN106772354B (zh) * 2016-12-29 2019-06-11 深圳大学 基于并行模糊高斯和粒子滤波的目标跟踪方法及装置
CN107270889B (zh) * 2017-06-08 2020-08-25 东南大学 一种基于地磁图谱的室内定位方法及定位系统
CN107544067B (zh) * 2017-07-06 2020-05-19 西北工业大学 一种基于高斯混合近似的高超声速再入飞行器跟踪方法
CN109063602A (zh) * 2018-07-13 2018-12-21 北京理工大学 基于路径连贯性函数的星空背景下的目标跟踪方法和装置
CN109813316B (zh) * 2019-01-14 2022-07-29 东南大学 一种基于地形辅助的水下载体紧组合导航方法
CN110361744B (zh) * 2019-07-09 2022-11-01 哈尔滨工程大学 基于密度聚类的rbmcda水下多目标跟踪方法
CN110347971B (zh) * 2019-07-18 2023-04-07 深圳大学 基于tsk模糊模型的粒子滤波方法、装置及存储介质
CN110909312B (zh) * 2019-12-18 2022-04-22 哈尔滨工程大学 一种应用于rbmcda跟踪算法的目标消亡判断方法
CN111707997B (zh) * 2020-06-03 2022-05-27 南京慧尔视智能科技有限公司 雷达目标跟踪方法、装置、电子设备及存储介质
CN111965594B (zh) * 2020-07-14 2023-06-06 杭州电子科技大学 一种基于特征值搜索的轻量级直接跟踪方法
CN112318509B (zh) * 2020-10-30 2022-04-29 东南大学 一种空间机器人高斯过程轨迹跟踪控制方法
CN114719857B (zh) * 2022-04-13 2024-08-20 北京科技大学 一种基于约束粒子流的高斯聚合滤波协同定位追踪方法

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103902812B (zh) * 2014-03-05 2016-05-04 深圳大学 一种粒子滤波方法、装置及目标跟踪方法、装置

Also Published As

Publication number Publication date
CN105205313A (zh) 2015-12-30

Similar Documents

Publication Publication Date Title
CN105205313B (zh) 模糊高斯和粒子滤波方法、装置及目标跟踪方法、装置
CN106487358B (zh) 一种机动目标转弯跟踪方法
CN103902812B (zh) 一种粒子滤波方法、装置及目标跟踪方法、装置
CN109990786A (zh) 机动目标跟踪方法及装置
CN110659722A (zh) 基于AdaBoost-CBP神经网络的电动汽车锂离子电池健康状态估算方法
CN105447574B (zh) 一种辅助截断粒子滤波方法、装置及目标跟踪方法及装置
CN110311652A (zh) 一种欠观测条件下的增量求积分卡尔曼滤波方法
CN106022340A (zh) 一种改进的高斯混合势概率假设密度滤波方法
CN112464567B (zh) 基于变分同化框架的智能资料同化方法
Zhifei et al. Target maneuver trajectory prediction based on RBF neural network optimized by hybrid algorithm
CN106772354B (zh) 基于并行模糊高斯和粒子滤波的目标跟踪方法及装置
CN107797106A (zh) 一种加速em未知杂波估计的phd多目标跟踪平滑滤波方法
CN114626307B (zh) 一种基于变分贝叶斯的分布式一致性目标状态估计方法
CN105891820A (zh) 基于ukf和iufir的机动目标跟踪方法
CN113452349B (zh) 一种基于贝叶斯序贯重要性积分的卡尔曼滤波方法
CN106384152B (zh) 基于萤火虫群优化的pf空间非合作目标轨道预测方法
CN103296995A (zh) 任意维高阶(≥4阶)无味变换与无味卡尔曼滤波方法
CN105373805A (zh) 一种基于最大熵准则的多传感器机动目标跟踪方法
Hu et al. Multi-sensor Ensemble Kalman filtering algorithm based on observation fuzzy support degree fusion
Maroulas et al. A learning drift homotopy particle filter
CN109582915B (zh) 应用于纯方位跟踪的改进非线性可观测度自适应滤波方法
CN104467742A (zh) 基于高斯混合模型的传感器网络分布式一致性粒子滤波器
Zamani et al. Minimum-energy filtering on the unit circle
Wei et al. A Pearson-Type VII Distribution With Adaptive Parameters Selection-Based Interacting Multiple Model Kalman Filter
CN114611068A (zh) 一种高机动目标跟踪方法

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
TR01 Transfer of patent right

Effective date of registration: 20210712

Address after: 215300 no.1689-5 Zizhu Road, Yushan Town, Kunshan City, Suzhou City, Jiangsu Province

Patentee after: KUNSHAN RUIXIANG XUNTONG COMMUNICATION TECHNOLOGY Co.,Ltd.

Address before: 518060 No. 3688 Nanhai Road, Shenzhen, Guangdong, Nanshan District

Patentee before: SHENZHEN University

TR01 Transfer of patent right
CP03 Change of name, title or address

Address after: 215300 Room 009, No. 55, Shengchuang Road, Yushan Town, Kunshan, Suzhou, Jiangsu Province

Patentee after: KUNSHAN RUIXIANG XUNTONG COMMUNICATION TECHNOLOGY Co.,Ltd.

Country or region after: China

Address before: 215300 no.1689-5 Zizhu Road, Yushan Town, Kunshan City, Suzhou City, Jiangsu Province

Patentee before: KUNSHAN RUIXIANG XUNTONG COMMUNICATION TECHNOLOGY Co.,Ltd.

Country or region before: China

CP03 Change of name, title or address