当前位置：首页 > news >正文

卡尔曼滤波Kalman Filter零基础入门到实践（上部）

news 文章来源：https://blog.csdn.net/m0_55841508/article/details/140356152 2025/5/5 8:27:04

参考视频：入门（秒懂滤波概要）_哔哩哔哩_bilibili

一、入门

1.引入

假设超声波距离传感器每1ms给单片机发数据。

理论数据为黑点，测量数据曲线为红线，引入滤波后的数据为紫线

引入滤波的作用是过滤数据中的噪声，使信号更趋于真实值。

2.卡尔曼滤波适用系统

卡尔曼滤波适用于线性高斯系统

2.1线性的理解

线性满足叠加性与齐次性。

如何理解叠加性？

如何理解齐次性？

输入x增大k倍，输出y也增大k倍

2.2高斯的理解

高斯：噪声满足正态分布

3.宏观意义：滤波即加权

理想状态：信号*1 +噪声*0（数字表示权值）

低通滤波：低频信号*1 + 高频信号*0

卡尔曼滤波：估计值*（待选择）+观测值*（待选择）；选择估计值与观测值的权重，总体得到一个最佳修正值。

二、进阶（基本滤波知识）

1.状态空间表达式（便于之后卡尔曼滤波公式的理解）

状态方程

$x_{k}=Ax_{k-1}+Bu_{k}+\omega_{k}$

其中， $x_{k}$ 是当前状态的当前值； $x_{k-1}$ 是上一个时刻该状态的值； $u_{k}$ 是检测输入； $\omega _{k}$ 是过程噪声；A是一个状态转移矩阵（用于刻画系统从一个状态转移到另一个状态的概率）；B是一个控制矩阵。

观测方程

$y_{k}=Cx_{k}+v_{k}$

其中， $y_{k}$ 是要观测的值； $v _{k}$ 是观测噪声（与观测器的误差有关）；

举例

加热一壶水，温度计观测到的温度与水温状态的关系C=1，当前温度计测量的温度 $y_{k}$ =当前状态的当前水温 $x_{k}$ +温度计的误差 $v _{k}$ ，A取单位矩阵， $Bu_{k}$ 为每一时刻会增加多少度， $\omega _{k}$ 是过程噪声（比如加热过程中环境温度的影响），观测方程为

$y_{k}=x_{k}+v_{k}$

状态方程为

$x_{k}=x_{k-1}+\Delta _{t}+\omega_{k}$

2.高斯分布

2.1直观图解

在二维和三维中，不管这些点投影到x轴、y轴还是z轴，都是正态分布

2.2参数分析

2.2.1 $v _{k}$ 和 $\omega _{k}$

$\omega _{k}\epsilon N(0;Q_{k})$ ： $\omega _{k}$ 符合正态分布，均值为0，方差为 $Q_{k}$

$v _{k} \epsilon N(0;R_{k})$ ： $v _{k}$ 符合正态分布，均值为0，方差为 $R_{k}$

统称以上两个为高斯白噪声

举例

假设车的位置移动了1000m，GPS检测值为 $1000\pm \Delta m$ ，方差为1m噪声

则 $v _{k}$ = $\Delta m$ ， $R _{k}$ =1m

假设车速是3000m/s，在风速的作用下，GPS的检测值为 $1000\pm \Delta n$

则 $\omega _{k}$ = $\Delta n$ m/s，n服从正态分布，方差 $Q_{k}$ =1m/s

2.2.2 方差

二维协方差（多维也类似）

3.超参数

Q、R、N PID

之后主要调的是Q和R（上面提到的方差）

4.卡尔曼直观图解

x轴是位置，y轴是概率密度， $\hat{x}_{k-1}$ 是后验估计值，也叫最优估计值（修正值）， $\bar{\hat{x}}_{k-1}$ 是先验估计值， $y_{k}$ 是观测值， $\hat{x}_{k}$ 是当前的最优估计值

$\hat{x}_{k-1}$ ：卡尔曼滤波最终输出的值

$\bar{\hat{x}}_{k-1}$ ：根据 $\hat{x}_{k-1}$ 估计出来的一个当前的估计值

$\hat{x}_{k}$ ：是由先验估计值和当前观测值取共有部分得到的

相关文章：

卡尔曼滤波Kalman Filter零基础入门到实践（上部）

参考视频：入门（秒懂滤波概要）_哔哩哔哩_bilibili 一、入门 1.引入假设超声波距离传感器每1ms给单片机发数据。理论数据为黑点， 测量数据曲线为红线，引入滤波后的数据为紫线引入滤波的作用是过滤数据中的噪声&a…...

编程日记 2024/7/12 5:41:09

力扣-dfs

何为深度优先搜索算法？ 深度优先搜索算法，即DFS。就是找一个点，往下搜索，搜索到尽头再折回，走下一个路口。 695.岛屿的最大面积 695. 岛屿的最大面积题目给你一个大小为 m x n 的二进制矩阵 grid 。岛屿是由一些相…...

编程日记 2024/7/12 5:40:08

keepalived高可用集群

一、keepalived： 1.keepalive是lvs集群中的高可用架构，只是针对调度器的高可用，基于vrrp来实现调度器的主和备，也就是高可用的HA架构；设置一台主调度器和一台备调度器，在主调度器正常工作的时候&#xff0…...

编程日记 2024/7/12 5:36:05

文献翻译与阅读《Integration Approaches for Heterogeneous Big Data: A Survey》

CYBERNETICS AND INFORMATION TECHNOLOGIES’24 论文原文下载地址：原文下载目录 1 引言 2 大数据概述 3 大数据的异构性 4 讨论整合方法 4.1 大数据仓库（BDW） 4.2 大数据联盟（BDF） 5 DW 和 DF 方法的比较、分…...

编程日记 2024/7/12 5:35:04

应用最优化方法及MATLAB实现——第3章代码实现

一、概述在阅读最优方法及MATLAB实现后，想着将书中提供的代码自己手敲一遍，来提高自己对书中内容理解程度，巩固一下。这部分内容主要针对第3章的内容，将其所有代码实现均手敲一遍，中间部分代码自己根据其公式有些许的…...

编程日记 2024/7/12 5:34:03

django的增删改查，排序，分组等常用的ORM操作

Django 的 ORM（对象关系映射）提供了一种方便的方式来与数据库进行交互。 1. Django模型在 myapp/models.py 中定义一个示例模型：python from django.db import modelsclass Person(models.Model):name models.CharField(max_length100)age…...

编程日记 2024/7/12 5:33:02

Leetcode Java学习记录——树、二叉树、二叉搜索树

文章目录树的定义树的遍历中序遍历代码二叉搜索树常见二维数据结构：树/图树和图的区别就在于有没有环。树的定义 public class TreeNode{public int val;public TreeNode left,right;public TreeNode(int val){this.val val;this.left null;this.right nu…...

编程日记 2024/7/12 5:32:01

华为HCIP Datacom H12-821 卷30

1.单选题以下关于OSPF协议报文说法错误的是? A、OSPF报文采用UDP报文封装并且端口号是89 B、OSPF所有报文的头部格式相同 C、OSPF协议使用五种报文完成路由信息的传递 D、OSPF所有报文头部都携带了Router-ID字段正确答案：A 解析： OSPF用IP报文直接封装协议报文，…...

编程日记 2024/7/12 5:31:00

element el-table实现表格动态增加/删除/编辑表格行，带校验规则

本篇文章记录el-table增加一行可编辑的数据列，进行增删改。 1.增加空白行直接在页面mounted时对form里面的table列表增加一行数据，直接使用push() 方法增加一列数据这个时候也可以设置一些默认值。比如案例里面的产品件数。 mounted() {this.$nextTi…...

编程日记 2024/7/12 5:29:59

QT调节屏幕亮度

1、目标利用QT实现调节屏幕亮度功能：在无屏幕无触控时，将屏幕亮度调低，若有触控则调到最亮。 2、调节亮度命令目标装置使用嵌入式Linux系统，调节屏幕亮度的指令为： echo x > /sys/class/backlight/backlight/…...

编程日记 2024/7/12 5:26:56

实变函数精解【3】

文章目录点集求导集闭集参考文献点集求导集例1 E { 1 / n 1 / m : n , m ∈ N } 1. lim ⁡ n → ∞ ( 1 / n 1 / m ) 1 / m 2. lim ⁡ n , m → ∞ ( 1 / n 1 / m ) 0 3. E ′ { 0 , 1 , 1 / 2 , 1 / 3 , . . . . } E\{1/n1/m:n,m \in N\} \\1.\lim_{n \rightar…...

编程日记 2024/7/12 5:25:55

JVM：SpringBoot TomcatEmbeddedWebappClassLoader

文章目录一、介绍二、SpringBoot中TomcatEmbeddedWebappClassLoader与LaunchedURLClassLoader的关系一、介绍 TomcatEmbeddedWebappClassLoader 是 Spring Boot 在其内嵌 Tomcat 容器中使用的一个类加载器（ClassLoader）。在 Spring Boot 应用中&#…...

编程日记 2024/7/12 5:24:54

蜂窝互联网接入：连接世界的无缝体验

通过Wi—Fi，人们可以方便地接入互联网，但无线局域网的覆盖范围通常只有10～100m。当我们携带笔记本电脑在外面四处移动时，并不是在所有地方都能找到可接入互联网的Wi—Fi热点，这时候蜂窝移动通信系统可以为我们提供广域…...

编程日记 2024/7/12 5:23:53

Sprint Boot 2 核心功能（一）

核心功能 1、配置文件 application.properties 同基础入门篇的application.properties用法一样 Spring Boot 2 入门基础 application.yaml（或application.yml） 基本语法 key: value；kv之间有空格大小写敏感使用缩进表示层级关系缩进不允…...

编程日记 2024/7/12 5:22:52

GitLab CI/CD实现项目自动化部署

1 GitLab CI/CD介绍 GitLab CI/CD 是 GitLab 中集成的一套用于软件开发的持续集成（Continuous Integration）、持续交付（Continuous Delivery）和持续部署（Continuous Deployment）工具。这套系统允许开发团队…...

编程日记 2024/7/12 5:21:51

阿里云调整全球布局关停澳洲云服务器，澳洲服务器市场如何选择稳定可靠的云服务？

近日，阿里云宣布将关停澳大利亚地域的数据中心服务，这一决定引发了全球云计算行业的广泛关注。作为阿里云的重要海外市场之一，澳洲的数据中心下架对于当地的企业和个人用户来说无疑是一个不小的挑战。那么，在阿里云调整全球布局的…...

编程日记 2024/7/12 5:18:49

排序（二）——快速排序（QuickSort)

欢迎来到繁星的CSDN，本期内容包括快速排序(QuickSort)的递归版本和非递归版本以及优化。一、快速排序的来历快速排序又称Hoare排序，由霍尔 (Sir Charles Antony Richard Hoare) ，一位英国计算机科学家发明。霍尔本人是在发现冒泡排序不够快…...

编程日记 2024/7/12 5:17:48

＜数据集＞穿越火线cf人物识别数据集＜目标检测＞

数据集格式：VOCYOLO格式图片数量：3440张标注数量(xml文件个数)：3440 标注数量(txt文件个数)：3440 标注类别数：1 标注类别名称：[person] 使用标注工具：labelImg 标注规则：对…...

编程日记 2024/7/12 5:16:47

a+=1和a=a+1的区别

文章目录 a1 和a a1的区别一、实例代码二、代码解释三、总结 a1 和a a1的区别一、实例代码 public class Test {public static void main(String[] args) {byte a 10; // a a 1; // a (byte) (a 1);a 1;System.out.println(a);} }上面的对变量a进行加一操作时&a…...

编程日记 2024/7/12 5:13:43

设计模式使用场景实现示例及优缺点（结构型模式——桥接模式）

结构型模式桥接模式（Bridge Pattern） 桥接模式（Bridge Pattern）是一种结构型设计模式，其主要目的是“将抽象与实现解耦，使得两者可以独立地变化”。这种模式通过提供抽象化和实现化之间的桥接结构&#…...

编程日记 2024/7/12 5:12:42

Spring——自动装配Bean

自动装配是Spring满足bean依赖的一种方式 Spring会在上下文中自动寻找，并自动给bean装配属性在Spring中有三种装配的方式： 1. 在xml中显示配置 2. 在java中显示配置 3. 隐式的自动装配bean【重要】测试记得创建Cat、Dog、People类 public clas…...

编程日记 2024/7/12 5:11:41

云端典藏：iCloud中个人收藏品目录的智能存储方案

云端典藏：iCloud中个人收藏品目录的智能存储方案在数字化生活不断推进的今天，个人收藏品的管理也趋向于电子化和云端化。iCloud作为苹果公司提供的云服务，为个人收藏品目录的存储和管理提供了一个安全、便捷、跨设备的解决方案。本文将详细…...

编程日记 2024/7/12 5:10:40

安全开发基础篇-数据溢出

上一节我们简单讲解了多语言的数据类型，我们只需要知道这个概念，并且在不同语言有不同的规矩就好。这节讲数据溢出，严格说应该是字符串溢出和整数溢出。在软件开发中，字符串和整数溢出漏洞是常见的安全问题，它们可能…...

编程日记 2024/7/12 5:09:38

Scanner工具类

扫描控制台输入 1.nextLine nextLine() 方法会扫描输入流中的字符，直到遇到行末尾的换行符 \n，然后将该行的内容作为字符串返回，同时，nextLine() 会将 Scanner 对象的位置移动到下一行的开头，以便下一次读取数据时从下…...

编程日记 2024/7/12 5:08:37

springboot3 集成GraalVM

目录安装GraalVM 配置环境变量 Pom.xml 配置 build包测试安装GraalVM Download GraalVM 版本和JDK需要自己选择配置环境变量 Jave_home 和 path 设置setting.xml <profile><id>graalvm-ce-dev</id><repositories><repository><id&…...

编程日记 2024/7/12 5:07:36

HumanoidBench——模拟仿人机器人算法有未来

概述论文地址：https://arxiv.org/pdf/2403.10506 仿人机器人具有类似人类的外形，有望在各种环境和任务中为人类提供支持。然而，昂贵且易碎的硬件是这项研究面临的挑战。因此，本研究开发了使用先进模拟技术的 HumanoidBench。该基…...

编程日记 2024/7/12 5:06:34

实现前端用户密码重置功能（有源码）

引言密码重置功能是任何Web应用程序中至关重要的一部分。当用户忘记密码时，密码重置功能可以帮助他们安全地重设密码。本文将介绍如何使用HTML、CSS和JavaScript（包括Vue.js）来实现前端的密码重置功能。 1. 项目结构首先，我们…...

编程日记 2024/7/12 5:05:33

《双流多依赖图神经网络实现精确的癌症生存分析》| 文献速递-基于深度学习的多模态数据分析与生存分析

Title 题目 Dual-stream multi-dependency graph neural network enables precise cancer survival analysis 《双流多依赖图神经网络实现精确的癌症生存分析》 01 文献速递介绍癌症是全球主要的死亡原因，2020年约有1930万新发癌症病例和近1000万癌症相关死亡…...

编程日记 2024/7/12 5:04:32

【Hive SQL 每日一题】在线峰值人数计算

文章目录测试数据需求说明需求实现测试数据 -- 创建 user_activity 表 DROP TABLE IF EXISTS user_activity ; CREATE TABLE user_activity (user_id STRING,activity_start TIMESTAMP,activity_end TIMESTAMP );-- 插入数据 INSERT INTO user_activity VALUES (user1, 2024…...

编程日记 2024/7/12 5:02:30

谷粒商城学习笔记-18-快速开发-配置测试微服务基本CRUD功能

文章目录一，product模块整合mybatis-plus1，引入依赖2，product启动类指定mapper所在包3，在配置文件配置数据库连接信息4，在配置文件中配置mapper.xml映射文件信息二，单元测试1，编写测试代码&am…...

编程日记 2024/7/12 5:01:29