卡尔曼滤波器使用教程

状态:kalman滤波器预测和跟新的值,一般也是我们需要关注的系统数据。例如,飞机的位置和速度

下面是使用kalmanfilter需要设置的参数(矩阵)。
dim_x(状态向量的长度);dim_z(测量数据向量的长度)。

F(状态外插矩阵)

shape:[dim_x, dim_x]。
kalmanfilter 的一大核心思想是通过此时刻【状态】预测下一时刻的【状态】这个矩阵把当前状态和下一时刻状态关联起来。预测时候这个矩阵会和【状态】做矩阵叉乘运算:

[ x 1 ˙ x 2 ˙ x 3 ˙ ] \begin{bmatrix}\dot{x_1} \\ \dot{x_2} \\ \dot{x_3}\end{bmatrix} x1˙x2˙x3˙ = [ f 11 f 12 f 13 f 21 f 22 f 23 f 31 f 32 f 33 ] \begin{bmatrix} f_{11} & f_{12} & f_{13} \\ f_{21} & f_{22} & f_{23} \\ f_{31} & f_{32} & f_{33} \end{bmatrix} f11f21f31f12f22f32f13f23f33 [ x 1 x 2 x 3 ] \begin{bmatrix} x_{1} \\ x_{2} \\ x_{3} \end{bmatrix} x1x2x3

根据叉乘法则:

x 1 ˙ = f 11 x 1 + f 12 x 2 + f 13 x 3 \dot{x_1}=f_{11}x_1+f_{12}x_2+f_{13}x_3 x1˙=f11x1+f12x2+f13x3
x 2 ˙ = f 21 x 1 + f 22 x 2 + f 23 x 3 \dot{x_2}=f_{21}x_1+f_{22}x_2+f_{23}x_3 x2˙=f21x1+f22x2+f23x3
x 3 ˙ = f 31 x 1 + f 32 x 2 + f 33 x 3 \dot{x_3}=f_{31}x_1+f_{32}x_2+f_{33}x_3 x3˙=f31x1+f32x2+f33x3

看到了吗,上边就是kalmanfilter的 【状态外插方程】,用矩阵运算代替方程的好处是我们不用修改代码,通过设置矩阵元素就可以修改这个组方程,没有关联的项设置为0就可以了。

相关推荐

  1. 滤波器使用教程

    2024-04-15 05:44:03       36 阅读
  2. 滤波

    2024-04-15 05:44:03       38 阅读

最近更新

  1. docker php8.1+nginx base 镜像 dockerfile 配置

    2024-04-15 05:44:03       94 阅读
  2. Could not load dynamic library ‘cudart64_100.dll‘

    2024-04-15 05:44:03       101 阅读
  3. 在Django里面运行非项目文件

    2024-04-15 05:44:03       82 阅读
  4. Python语言-面向对象

    2024-04-15 05:44:03       91 阅读

热门阅读

  1. php在apache运行的几种方式

    2024-04-15 05:44:03       33 阅读
  2. CSS的基本结构和用法

    2024-04-15 05:44:03       123 阅读
  3. Unity Android 2022 Release-Notes

    2024-04-15 05:44:03       29 阅读
  4. TensorRT从入门到了解-学习笔记(待续)

    2024-04-15 05:44:03       34 阅读
  5. SpringBoot实用开发(十六)-- SpringBoot整合ActiveMQ

    2024-04-15 05:44:03       44 阅读
  6. SpringBoot实用开发(十五)-- ActiveMQ的安装

    2024-04-15 05:44:03       41 阅读
  7. [HDFS Web界面功能 ]

    2024-04-15 05:44:03       41 阅读
  8. Docker in Docker (DinD): 深入探索与实际应用

    2024-04-15 05:44:03       40 阅读
  9. 快速配置docker 国内源地址

    2024-04-15 05:44:03       178 阅读
  10. 上一篇文章中的nvm有歧义

    2024-04-15 05:44:03       142 阅读
  11. 从零实现诗词GPT大模型:了解自注意力机制

    2024-04-15 05:44:03       65 阅读