基于粒子滤波的TBD算法仿真----MATLAB仿真

原文链接:https://blog.xxcxw.cn/2019/08/10/%e5%9f%ba%e4%ba%8e%e7%b2%92%e5%ad%90%e6%bb%a4%e6%b3%a2%e7%9a%84tbd%e7%ae%97%e6%b3%95%e4%bb%bf%e7%9c%9f-matlab%e4%bb%bf%e7%9c%9f/

目标跟踪的最终目的是在最小的误差下确定目标的位置,而在无线传感器网络中要实现这个目的需要很多相关技术的支持,如定位技术、目标检测技术、估计技术、节能技术等。目标跟踪问题的求解有很多方法, 从算法的考虑方向上来说可以分为两大类: 自顶向下的算法和自底向上的算法 。自顶向下的目标跟踪算法的核心思想是先对要跟踪的目标进行恰当的建模, 从模型出发来实现跟踪目的,状态空间方法就是一种典型的自顶向下的方法。所谓自底向上的方法, 就是指没有现成的理论框架, 从实际问题出发、从得到的数据出发来实现对目标的跟踪。从效果上来看, 两种方法的跟踪效果并没有特别明显的差异,但是由于自顶向下的方法有严格的理论框架, 便于进行研究, 本文中主要考虑这种方法。

无线传感器网络中,在特定的检测区域布设好无线传感器网络后,网络先进行初始化,对网络中所有的节点 进行定位,然后就可以对感兴趣的目标进行跟踪了。

目标跟踪和检测的问题描述

对于无线传感器网络中的目标跟踪和检测问题, 目标的运动过程即状态转移方程通常可以用一阶的马尔

科夫状态方程来描述

式中, xk 表示 xk -1 时刻的目标状态向量, 一般可能包含目标的位置、速度、加速度等信息; f( xk -1) 表示目标状态从 xk -1 时刻到 xk 时刻的状态转移函数( 线性或非线性) ; wk 表示过程噪声向量。相应的, 时刻的观测方程的一般形式:

式中, zk 表示 xk 时刻节点中得到的观测向量, h( xk) 表示观测函数( 线性或非线性) , vk 表示观测噪声。过程噪声和观测噪声均是未知的, 且不一定是均值为零的高斯白噪声, 但是它们的概率密度一般都是知道的。有了这两个模型后, 目标跟踪所要解决的问题就是根据目标之前的状态和得到的观测序列来求解目标的当前状态量。

粒子滤波算法

粒子滤波算法的出现历时半个多世纪, 最早可以追溯到 20 世纪四十年代 Metropolis 等人提出的蒙特卡洛方法( Monte Carlo method) 20 世纪七十年代 MC 方法首次用于解决非线性滤波问题, 当时使用的是序贯重要性采样方法: 用一组从建议分布中采样得到的带权值的样本来近似目标状态分布,这种方法存在很严重的样本权值退化问题,实际的应用非常有限; 1993 年,Gordon 等人提出了重采样的概念[6] ,并将重采样引入到蒙特卡洛重要性采样过程中有效地解决了样本权值退化问题, 开启了基于蒙特卡洛积分的粒子滤波算法的研究热潮。经过二十多年的研究和发展,如今粒子滤波算法已经相当成熟,成为非线性、非高斯系统中的估计问题最重要的解决方法之一, 广泛应用于自主导航、机器人视觉和目标跟踪等问题中 。

已知目标状态的初始分布为 p( x0) 、它在 k - 1 时刻的后验概率密度分布为 p( xk -1 z1: k -1) = { xi k -1,wi k -1} N i = 1,结合重要性采样和重采样, 一般的粒子滤波算法估计 k时刻的目标状态向量 xk 的具体步骤如下

( 1) 初始化: k = 0, 从 p( x0) 中随机抽取 N 个初始粒子 { x0i ,i = 1,2,…,N} , 并令每个粒子的初始权值都为 1 /N。

( 2) 根据提议分布( 一般使用 SIS 算法, 即取先验概率密度函数为提议分布) 更新粒子

( 3) 在得到 k 时刻观测值 zk 后, 根据公式计算每个粒子的权值

( 4) 重采样过程, 先根据公式计算有效粒子数,执行重采样算法( 如多项式重采样等) ,否则就直接跳到第( 5) 步。

( 5) 根据蒙特卡洛积分得到 k 时刻目标状态的估计值:

( 6) 令 k = k + 1, 得到 k + 1 时刻的观测值后转到步骤( 2) ,直到结束。

仿真结果

文档下载:链接:https://pan.baidu.com/s/1IOwb2cOw3A2tvlTboVa88g

提取码:p7a1

程序下载:链接:https://pan.baidu.com/s/1XA42i4oYesMWayf5ts3fWA

提取码:juo7

解码密码获取:http://t.cn/AiTjdQZq

©著作权归作者所有,转载或内容合作请联系作者
  • 序言:七十年代末,一起剥皮案震惊了整个滨河市,随后出现的几起案子,更是在滨河造成了极大的恐慌,老刑警刘岩,带你破解...
    沈念sama阅读 216,039评论 6 498
  • 序言:滨河连续发生了三起死亡事件,死亡现场离奇诡异,居然都是意外死亡,警方通过查阅死者的电脑和手机,发现死者居然都...
    沈念sama阅读 92,223评论 3 392
  • 文/潘晓璐 我一进店门,熙熙楼的掌柜王于贵愁眉苦脸地迎上来,“玉大人,你说我怎么就摊上这事。” “怎么了?”我有些...
    开封第一讲书人阅读 161,916评论 0 351
  • 文/不坏的土叔 我叫张陵,是天一观的道长。 经常有香客问我,道长,这世上最难降的妖魔是什么? 我笑而不...
    开封第一讲书人阅读 58,009评论 1 291
  • 正文 为了忘掉前任,我火速办了婚礼,结果婚礼上,老公的妹妹穿的比我还像新娘。我一直安慰自己,他们只是感情好,可当我...
    茶点故事阅读 67,030评论 6 388
  • 文/花漫 我一把揭开白布。 她就那样静静地躺着,像睡着了一般。 火红的嫁衣衬着肌肤如雪。 梳的纹丝不乱的头发上,一...
    开封第一讲书人阅读 51,011评论 1 295
  • 那天,我揣着相机与录音,去河边找鬼。 笑死,一个胖子当着我的面吹牛,可吹牛的内容都是我干的。 我是一名探鬼主播,决...
    沈念sama阅读 39,934评论 3 416
  • 文/苍兰香墨 我猛地睁开眼,长吁一口气:“原来是场噩梦啊……” “哼!你这毒妇竟也来了?” 一声冷哼从身侧响起,我...
    开封第一讲书人阅读 38,754评论 0 271
  • 序言:老挝万荣一对情侣失踪,失踪者是张志新(化名)和其女友刘颖,没想到半个月后,有当地人在树林里发现了一具尸体,经...
    沈念sama阅读 45,202评论 1 309
  • 正文 独居荒郊野岭守林人离奇死亡,尸身上长有42处带血的脓包…… 初始之章·张勋 以下内容为张勋视角 年9月15日...
    茶点故事阅读 37,433评论 2 331
  • 正文 我和宋清朗相恋三年,在试婚纱的时候发现自己被绿了。 大学时的朋友给我发了我未婚夫和他白月光在一起吃饭的照片。...
    茶点故事阅读 39,590评论 1 346
  • 序言:一个原本活蹦乱跳的男人离奇死亡,死状恐怖,灵堂内的尸体忽然破棺而出,到底是诈尸还是另有隐情,我是刑警宁泽,带...
    沈念sama阅读 35,321评论 5 342
  • 正文 年R本政府宣布,位于F岛的核电站,受9级特大地震影响,放射性物质发生泄漏。R本人自食恶果不足惜,却给世界环境...
    茶点故事阅读 40,917评论 3 325
  • 文/蒙蒙 一、第九天 我趴在偏房一处隐蔽的房顶上张望。 院中可真热闹,春花似锦、人声如沸。这庄子的主人今日做“春日...
    开封第一讲书人阅读 31,568评论 0 21
  • 文/苍兰香墨 我抬头看了看天上的太阳。三九已至,却和暖如春,着一层夹袄步出监牢的瞬间,已是汗流浃背。 一阵脚步声响...
    开封第一讲书人阅读 32,738评论 1 268
  • 我被黑心中介骗来泰国打工, 没想到刚下飞机就差点儿被人妖公主榨干…… 1. 我叫王不留,地道东北人。 一个月前我还...
    沈念sama阅读 47,583评论 2 368
  • 正文 我出身青楼,却偏偏与公主长得像,于是被迫代替她去往敌国和亲。 传闻我的和亲对象是个残疾皇子,可洞房花烛夜当晚...
    茶点故事阅读 44,482评论 2 352

推荐阅读更多精彩内容

  • 本文参考博客地址 粒子滤波 粒子滤波的状态转移方程和观测方程如下:其中的x(t)为t时刻状态,u(t)为控制量,w...
    雨住多一横阅读 5,146评论 0 2
  • 多目标跟踪的问题是这样的:有一段视频,视频是由 N 个 连续帧构成的。从第一帧到最后一帧,里面有多个目标,不断地有...
    Fantesla阅读 6,448评论 0 9
  • 预估器 我们希望可以最大限度地使用测量结果来估计移动物体的运动。所以,多个测量的累积可以让我们检测出不受噪声影响的...
    JasonDing阅读 6,777评论 4 10
  • 前两天没记录宝宝读书的情况,但是他经常会自主阅读。我把所有的书放在箱子里,他每天从幼儿园回到家,(我还没下班,而爸...
    懒妈阅读 218评论 0 0
  • 亲爱的女儿,上次围棋赛赢得了一张永联农耕园的门票,我们商量好了今天一起去玩。以前没去过,所以今天去觉得一切都很新奇...
    小怪物_a3bf阅读 121评论 0 4