r语言中正定矩阵由于误差不正定_Kalman滤波在MOT中的应用(一)——理论篇
前言
Kalman滤波器是多目标跟踪任务中一个经典的运动模型,接下来会从理论、发展和代码实践三个方面对其进行展开,本次主要以理论基础为主。 在这篇之前还有一个关于多目标背景任务的介绍,不过被知乎删了,可以去我的博客看。
1背景介绍
卡尔曼滤波(Kalman)无论是在单目标还是多目标领域都属于很基础的一种算法,这个是属于自动控制理论中的一种方法,所以对于工科比较容易理解。为了方便理解,我下面对其进行详细的讲解。
首先,卡尔曼滤波器处理的是随机信号,例如,假设我们研究一个房间的温度,依据我们的经验判断,房间温度是恒定的(假设为23℃),但是由于我们的经验不完全可信,所以我们可以引入高斯白噪声来衡量一定的偏差程度(假设上一时刻的偏差是3,但是自己对于预测的不确定度为4,那么此时预测的偏差为5,这里采用的勾股定理)。这时候我们在房间放一个温度计,但是温度计本身也不一定准确,测量值(25℃)与实际值的偏差也视为一种高斯白噪声(假设为4),那么现在同时存在一个根据上一个时刻温度得来的估计量和这个时刻的测量值。
假设这两个值为23℃和25℃,这其实就对应着跟踪问题中的运动估计和实际跟踪结果,此时我们究竟相信谁呢?可利用他们的均方误差来计算:
由此可将均方误差不断地传递下去,从而估计估算出最优的温度值。
为了方便解释卡尔曼滤波方程,下面以一辆小车的运动为例,假设我们已知上一时刻小车的状态,现在要估计当前时刻的状态:
可以看到,对于一个线性系统,我们能根据上一时刻状态得到一个简单的估计量,其中F代表了状态转移矩阵,B则代表了控制矩阵,反映了加速度如何作用于当前状态。假设每一时刻的各个维度的不确定性都通过协方差矩阵来描述,另外预测模型本身也不一定准确,所以系统状态的不确定性如下:
有了预测值,现在我们通过在路上布设装置来测定小汽车的位置,观测值的误差记为V,然后将真实状态x通过一定变换,可以得到真实状态x和观测状态y的关系:
显然,这里的H是[1 0],因为观测到的是位置信息p,同样的我们需要用一个协方差矩阵R来取代上式中的V,以衡量观测不确定性。现在,我们已知此时刻的预测值,观测值,以及几个不确定性矩阵,可以得到此时刻最终的估计:
其中
最后我们需要更新最有估计值的噪声分布:
2高斯分布融合
先从高斯分布说起,Kalman滤波算法的假设分布即为高斯分布,而一维的高斯分布概率密度函数及其分布示意图如下:
![](/assets/blank.gif)
这是一个很简单的高斯分布图,标准差决定分布曲线宽窄,均值决定其中心位置。那么如果我们对任意两个高斯分布进行运算,则会得如下的效果图:
![](/assets/blank.gif)
其中两个高斯分布的运算都加入了归一化,可以发现,他们的分布融合也是高斯分布,下面我们对这两个新的高斯分布进行求解证明,主要讲乘法融合,加法以此类推。对于任意两个高斯分布,将二者相乘之后可得:
对于这个概率分布函数,我们利用高斯分布的两个特性进行求解,其一是均值处分布函数取极大值,其二是均值处分布曲线的曲率为其二阶导数,并且与s2成反比。
因此我们可以得到如下结论:
当然我们遇到的问题大多是多阶的所以要引入多维高斯分布:
3线性卡尔曼滤波
3.1理论推导
首先假设状态变量为x,观测量为z,那么结合贝叶斯后验概率模型:
多目标跟踪从形式上讲可以理解为最大化后验概率,现在结合第二节的内容,假设状态变量x服从高斯分布,反映的是运动模型的不稳定性。基于状态变量x的估计先验,观测量z也服从高斯分布,反映的是量测误差,比如传感器误差。那么我们就可以利用高斯分布的融合来刻画Kalman滤波器的更新部分。
这里我们先给出一阶Kalman滤波器的公式,其中预测环节就是基于线性运动特性对状态变量的预测,即:
其中
对于更新环节,同样地,假设量测误差分布满足
代入变量得:
上式即为Kalman滤波器是更新环节,其中H是从状态变量到观测量/输出变量的转换矩阵。
3.2实验分析
我们可以看到的是,Kalman滤波器有很多参数,除去运动模型形式假设的F和B参数,存在有多个协方差矩阵P、Q、R。下面我们逐一分析各个参数的影响。
- 协方差矩阵变化规律
在此之前可以看看不经过更新校正的状态变量均值和方差的变化,假设有如下的运动方式:
- 则有状态变量分布如下:
![](/assets/blank.gif)
可以看到,在不引入量测的情况下,物体一直保持匀速直线运动,所以其误差的协方差分布一直向水平方向倾斜。
(1)不同Kalman模型
下面我们分别用一阶和二阶的Kalman滤波器去跟踪一个直线运动的物体,其中一阶Kalman滤波完全依赖量测的矫正,二阶Kalman滤波加入了速度因素,可见二阶模型跟踪效果更好,不过其实在这里,如果加入控制变量u,也能恰好达到匀速直线运动的效果。
![](/assets/blank.gif)
(2) R和Q的影响
![](/assets/blank.gif)
![](/assets/blank.gif)
![](/assets/blank.gif)
![](/assets/blank.gif)
![](/assets/blank.gif)
对于匀速直线运动,我们保持量测误差R不变,对比运动估计误差Q发现,Q越小,模型越相信运动规律,而模型正好也是匀速直线运动,因此跟踪效果更好。而当R变大时,模型会更加不相信量测结果,从而使得状态变量的协方差越来越大,但是由于预测环节模型的准确性,跟踪依然比较准确,可以从图中看出,当初始状态偏差很大时,模型不相信量测,导致跟踪轨迹很难与目标轨迹一致,而当R变小却可以重新跟踪到。
(3)P的影响
![](/assets/blank.gif)
![](/assets/blank.gif)
对于上面两幅图,表面上看上去P=1时,跟踪轨迹跟贴近于真实轨迹,但是如果将协方差矩阵P中的参数绘制出来即为:
![](/assets/blank.gif)
![](/assets/blank.gif)
我们可以发现,后者关于位置的方差变化趋势比较复杂,虽然二者均能跟踪到,但是当初始状态估计不好时,P过小会使得跟踪周期变长,而P较大时跟踪效果没有明显降低,因此通常P取值较大。
参考资源
https://github.com/rlabbe/filterpy
r语言中正定矩阵由于误差不正定_Kalman滤波在MOT中的应用(一)——理论篇相关推荐
- r语言中正定矩阵由于误差不正定_R语言之数据处理(一)
在上一篇小文中,提到了关于R语言导入数据的一些方法,之后的重点就转向了数据的处理上.数据处理其实在整个数据分析项目中所占用的时间是比较多的,所以根据处理的目的不同,也有不同的处理方法.在R语言中,我通 ...
- r语言中正定矩阵由于误差不正定_浅谈「正定矩阵」和「半正定矩阵」
在众多的机器学习模型中,线性代数的身影无处不在,当然,我们也会时常碰到线性代数中的正定矩阵和半正定矩阵.例如,多元正态分布的协方差矩阵要求是半正定的. --------------×--------- ...
- r语言中正定矩阵由于误差不正定_矩阵的几种分解方式
A = LU 这实际上就是我们解矩阵方程组一般使用的方式,比如方程组是: 我们一般把它写成增广矩阵: 然后化简成阶梯型矩阵的形式,这个时候可以方便的算出 ,然后再往上代回,逐渐得到所有的x. 如果我们 ...
- r语言中正定矩阵由于误差不正定_Rcall:Stata 与 R 的无缝对接
NEW!连享会·推文专辑: Stata资源 | 数据处理 | Stata绘图 | Stata程序 结果输出 | 回归分析 | 时间序列 | 面板数据 | 离散数据 交乘调节 | DID | RDD ...
- R语言ggplot2可视化分面图、在分面图中的每个直方图中添加均值文本标签、添加均值红色竖线
R语言ggplot2可视化分面图.在分面图中的每个直方图中添加均值文本标签.添加均值红色竖线 目录
- R语言ggplot2可视化:可视化堆叠的直方图、在bin中的每个分组部分添加数值标签、使用position_stack函数设置
R语言ggplot2可视化:可视化堆叠的直方图.在bin中的每个分组部分添加数值标签.使用position_stack函数设置 目录
- R语言ggplot2可视化:可视化箱图、在箱图中添加抖动数据点(Dot + Box Plot)、自定义抖动数据点的大小、颜色、数据点分布在箱图中间、添加主标题、副标题、题注信息
R语言ggplot2可视化:可视化箱图.在箱图中添加抖动数据点(Dot + Box Plot).自定义抖动数据点的大小.颜色.数据点分布在箱图中间.添加主标题.副标题.题注信息 目录
- R语言可视化散点图(scatter plot)图、为图中的部分数据点添加标签、ggrepel包来帮忙
R语言可视化散点图(scatter plot)图.为图中的部分数据点添加标签.ggrepel包来帮忙 目录
- R语言可视化散点图(scatter plot)、并在散点图中叠加回归曲线、叠加lowess拟合曲线(linear and lowess fit lines)、使用plot、line、abline函数
R语言可视化散点图(scatter plot).并在散点图中叠加回归曲线.叠加lowess拟合曲线(linear and lowess fit lines).使用plot函数.line函数和ablin ...
最新文章
- es的聚合mysql聚合速度_Elasticsearch(8) --- 聚合查询(Metric聚合)
- 电子工程就业前景真的不如计算机吗?
- python中view的用法_APIview使用
- 原生ajax crossO,Ajax问题,求助
- Cocos2D学习笔记(1)- 常用的类
- 前端自适应----单位rem
- 数据中心智能化运维之路
- ZStack源码剖析之核心库鉴赏——Defer
- 杂项 Chrome浏览器截取长图
- 《人机交互技术》 第五章 界面设计
- Jenkins的安装及使用
- 进入大数据时代,目前我国大数据的发展趋势怎么样
- 用一个简单的例子来阐述强化学习的相关概念(二)
- 我们是怎么看中国企业服务的​
- 5 个常用 Python 标准库
- for循环打印等腰三角形
- C# 实现打印机队列监控Win32_PrintJob,Win32_Printer
- 【读书笔记】被讨厌的勇气之自卑感
- 系统权限设计说明文档
- 创建Android定时器的5种方法
热门文章
- commit your changes or stash them before you can merge
- 如何使用Jenkins持续集成C#网站项目
- mac 安装mqtt
- P4factory ReadMe Quickstart 安装p4factory
- 在虚拟机中安装Ubuntu Server 15.04
- 配置red hat的ip 自动地址
- Eclipse快捷键详细解析
- IOS-获取Model(设备型号)、Version(设备版本号)、app(程序版本号)等
- oracle merge
- eclipse failed to create the java virtual machine 问题图文解析