卡尔曼滤波器实例:进一步讨论自由落体运动
上一篇中,我们使用向量[0 0 0]T作为系统的初始状态,并且使用$\infty$作为初始状态误差的方差,也就是假定物体的初始位置、初始速度、加速度都是未知的,所有的状态信息都通过Radar的测量结果估计出来。但实际上,物体的加速度是预先知道的(假定为标准重力加速度),因此,我们可以简化上一篇中的多项式,以得到更好的状态估计。
将物体的位置设为状态$x_1$:
$x_1=s_0-v_0t-\frac{1}{2}gt^2$
$\frac{dx_1}{dt}=x_2=-v_0t-gt$
$\frac{dx_2}{dt}=-g$
上一篇中,我们暂时“忘记了”g的数值,因此$\frac{dx_2}{dt}$仍然是一个需要估计的系统状态,需要继续微分。而此处,$\frac{dx_2}{dt}$是已知的,因此我们到此就可以写状态方程了:
$\left[ \begin{matrix} \frac{dx_1}{dt} \\ \frac{dx_2}{dt} \end{matrix} \right] = \left[ \begin{matrix} 0&1 \\ 0&0 \end{matrix} \right] \left[ \begin{matrix} x_1 \\ x_2 \end{matrix} \right] + \left[ \begin{matrix} 0\\-1 \end{matrix} \right]g$
将这个矩阵和如下标准状态矩阵对比:
$\mathbf{\dot{x}}=\mathbf{Fx}+\mathbf{Gu}+\mathbf{w}$
可得:
$\mathbf{F}=\left[ \begin{matrix} 0&1 \\ 0&0 \end{matrix} \right]$
$\mathbf{G}=\left[ \begin{matrix} 0 \\ -1 \end{matrix} \right]$
$\mathbf{u}=g$
将连续时间状态模型转换到离散时间:
$\boldsymbol{\Phi}_k=\left[ \begin{matrix} 1&T_s\\0&1 \end{matrix} \right]$
$\mathbf{G}_k=\int_0^{T_s}\boldsymbol{\Phi}(\tau)\mathbf{G}d\tau=\int_0^{T_s}\left[ \begin{matrix} 1&\tau \\ 0&1 \end{matrix} \right] \left[ \begin{matrix} 0\\-1 \end{matrix} \right]d\tau=\left[ \begin{matrix} -\frac{T_s^2}{2} \\ -T_s \end{matrix} \right]$
卡尔曼滤波器实例:进一步讨论自由落体运动相关推荐
- canvas动画:自由落体运动
经过前面的文章,我们已经能够在canvas画布上画出各种炫酷的图形和画面,但是这些画面都是禁止的,怎么样才能让他们动起来呢? 如何绘制基本图形可以参考:canvas基本图形绘制 如何对基本图形移动旋转 ...
- pygame里面物体闪烁运动_教师资格【试讲示范】高中物理试讲答辩——《自由落体运动》试讲稿答辩...
试讲备课纸 教学过程 各位考官: 大家好,我是高中物理组的***号考生,我试讲的题目是<自由落体运动>,下面开始我的试讲. 一.导入新课 同学们,老师手里现在拿着一个小笔记本和一张纸,现在 ...
- html画布实现小球沿直线下落,js+html5实现的自由落体运动效果代码
本文实例讲述了js+html5实现的自由落体运动效果.分享给大家供大家参考,具体如下: 运行效果截图如下: 具体代码如下: /p> "http://www.w3.org/TR/xhtm ...
- cocos2dx:重力加速度,自由落体:利用update()就能快速实现精灵自由落体运动
cocos2dx:重力加速度,自由落体:利用update()就能快速实现精灵自由落体运动 设备/引擎:Mac(11.6)/cocos 开发工具:Xcode(13.0) 开发需求:拖动精灵移动,在松手的 ...
- Android模拟自由落体运动
最近想看看android的游戏开发,因此首先绘图方面得练练,突然就想到模拟一下自由落体运动.本例采用serfaceView实现,接下来上代码: 一.首先定义一个自定义控件 public class M ...
- 手把手教你用Python来模拟绘制自由落体运动过程中的抛物线(附源码)
前言 前几天有个叫[-berry]的粉丝在问了一道关于自由落体运动过程中产生的抛物线作图的问题,如下图所示. 当某个物体以初速度v水平抛出,其轨迹为一条抛物线,模拟绘制这条抛物线.用高中物理知识,我们 ...
- lammps案例:分子自由落体运动模拟
大家好,我是小马老师. 本文分享一个比较有意思的lammps案例:分子的自由落体运动. lammps提供了fix gravity命令可设置分子或者原子的加速度. 语法规则为: fix ID group ...
- matlab小球水平抛出,如何用Matlab制作小球自由落体运动的动画
第一堂课布置了一个Mission Impossible作业,要求学生们用Matlab制作一个动画,模拟小球的自由落体运动. 以下将整个任务的问题解决的过程分享如下: 步骤一,这是一个动画的制作过程,以 ...
- matlab 地形模拟程序,MATLAB模拟小球自由落体运动
大部分朋友学习MATLAB,需要一个学习示例用来参考,有一个比较经典的题目就是如何利用Matlab模拟小球自由落体运动,这可能会是你的某次课后作业,这个程序的编写过程可以分为三个步骤: 第一部分,设置 ...
最新文章
- R in Action 读书笔记(5)
- 第二种PHP协议,PHP多种形式,第二种使用来自First的数据
- 报告称企业部署Windows 10比此前版本更快
- https和http的主要区别
- Ubuntu20.04运行帝国时代II征服者
- 控制台怎么查看错误的详细信息_Java 程序该怎么优化?命令篇
- C打印函数printf的一种实现原理简要分析
- php 动态加载html内容_ThinkPHP5.1+Swoole实现的开源内容管理框架
- 特斯拉:在行驶20万英里后 其电动汽车电池仍有90%容量
- 提高Eclipse的运行速度 去掉JPA这个Eclipse 插件
- vue-cli3的安装使用
- VMware Workstation 14 Pro永久激活密钥
- 美团斗鱼百度笔试概录
- java 中文转英文性能最快
- 示波器同步的调节方法
- 一道求极值的三角函数题
- JS学习日记--正则基础语法
- 用java编写图形用户界面_Java编写图形用户界面程序
- 如何给SCI收录的文章分区?
- MySQL数据库基础知识12,MySQL单列索引和联合索引
热门文章
- 【HTML5】媒体元素标签audio video
- php没有上级分类的联动,ThinkPHP使用心得分享-ThinkPHP + Ajax 实现2级联动下拉菜单...
- Vue (响应式原理-模拟-1-vue)
- 字符串字母大小写转换
- 4005基于邻接表的顶点的删除(C++,附思路)
- c++ double 只输出五位_C/C++编程笔记:C语言入门知识点(一),请收藏C语言最全笔记...
- ubuntu mysql双主热备配置_MySql双主热备配置
- spring实现事务原理
- Intel汇编语言程序设计学习笔记1
- POJ 2236 Wireless Network