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

平方根无迹卡尔曼滤波（SR-UKF）的MATLAB例程，使用三维非线性的系统

news 来源：原创 2025/6/18 7:56:13

在这里插入图片描述

本MATLAB 代码实现了平方根无迹卡尔曼滤波（SR-UKF）算法，用于处理三维非线性状态估计问题

文章目录

运行结果
代码概述
代码

运行结果

三轴状态曲线对比：
在这里插入图片描述

三轴误差曲线对比：
在这里插入图片描述
误差统计特性输出（命令行截图）：

在这里插入图片描述

代码概述

初始化：
- 清空工作区和命令窗口，关闭所有图形窗口。
- 定义时间序列 t 和设置过程噪声、观测噪声的协方差矩阵 (Q 和 R)。
- 初始化状态估计协方差矩阵 P0 和状态向量 X，同时定义观测值 Z。
运动模型：
- 使用循环生成真实状态 X 和未滤波状态 X_，根据给定的运动模型更新状态。
- 生成观测值 Z，包含加入的观测噪声。
平方根UKF实现：
- 初始化滤波器的状态和协方差矩阵。
- 在每个时间步 k 中：
  - 生成 sigma 点并计算它们的权重。
  - 对 sigma 点进行预测，计算新的状态和观测值。
  - 更新状态估计和协方差矩阵，使用卡尔曼增益结合观测更新状态。

在这里插入图片描述

结果绘图：
- 绘制真实值、未滤波值和滤波值的对比图。
- 计算并绘制滤波前后的误差。
误差输出：
- 输出滤波前和 SR-UKF 后的三轴误差平均值。

代码

% 平方根无迹卡尔曼滤波（SR-UKF），三维非线性
% 2024-12-13/Ver1clear;clc;close all; %清空工作区、命令行，关闭小窗口
% rng(0); %固定随机种子
%% 滤波模型初始化
t = 1:1:100;% 定义时间序列
Q = 1*diag([1,1,1]);w=sqrt(Q)*randn(size(Q,1),length(t));% 设置过程噪声协方差矩阵和过程噪声
R = 1*diag([1,1,1]);v=sqrt(R)*randn(size(R,1),length(t));% 设置观测噪声协方差矩阵和观测噪声
P0 = 1*eye(3);% 初始状态估计协方差矩阵
X=zeros(3,length(t));% 初始化状态向量
Z=zeros(3,length(t)); %定义观测值形式
Z(:,1)=[X(1,1)^2/20;X(2,1);X(3,1)]+v(:,1); %观测量
residue_tag = 0; %自适应标签
%% 运动模型
% 初始化未滤波的状态向量
X_ = zeros(3,length(t)); %给未滤波的值分配空间
X_(:,1) = X(:,1); %给未滤波的值赋初值
for i1 = 2:length(t)X(:,i1) = [X(1,i1-1) + (2.5 * X(1,i1-1) / (1 + X(1,i1-1).^2)) + 8 * cos(1.2*(i1-1));X(2,i1-1)+1;X(3,i1-1)]; %真实值X_(:,i1) = [X_(1,i1-1) + (2.5 * X_(1,i1-1) / (1 + X_(1,i1-1).^2)) + 8 * cos(1.2*(i1-1));X_(2,i1-1)+1;X_(3,i1-1)] + w(:,i1-1);%未滤波的值Z(:,i1) = [X(1,i1).^2 / 20;X(2,i1);X(3,i1)] + v(i1); %观测值
end%% 平方根UKF
P = P0;
X_ukf=zeros(3,length(t));
X_ukf(:,1)=X(:,1);
alpha = 0.95;            % 自适应增益因子，用于更新观测噪声协方差for k = 2 : length(t)Xpre = X_ukf(:,k-1);% 预测下一状态

如需帮助：

平方根无迹卡尔曼滤波（SR-UKF）的MATLAB例程，使用三维非线性的系统

本MATLAB 代码实现了平方根无迹卡尔曼滤波（SR-UKF）算法，用于处理三维非线性状态估计问题文章目录运行结果代码概述代码运行结果三轴状态曲线对比： 三轴误差曲线对比： 误差统计特性输出（命令行截图&…...

编程日记 2025/6/1 14:16:32

【从零开始入门unity游戏开发之——C#篇04】栈（Stack）和堆（Heap），值类型和引用类型，以及特殊的引用类型string，垃圾回收（ GC）

文章目录知识回顾一、栈（Stack）和堆（Heap）1、什么是栈和堆2、为什么要分栈和堆3、栈和堆的区别栈堆 4、总结二、值类型和引用类型1、那么值类型和引用类型到底有什么区别呢？值类型引用类型 2、总结三、特殊的引用类…...

编程日记 2025/6/1 11:06:45

人员离岗监测摄像机智能人员睡岗、逃岗监测 Python 语言结合 OpenCV

在安全生产领域，人员的在岗状态直接关系到生产流程的顺利进行和工作环境的安全稳定。人员离岗监测摄像机的出现，为智能人员睡岗、逃岗监测提供了高效精准的解决方案，而其中的核心技术如AI识别睡岗脱岗以及相关的算法盒子和常见的安全生产AI算…...

编程日记 2025/6/4 5:25:09

Linux-ubuntu点LED灯C语言版

一，C语言点灯 1.寄存器配置设置为SVC模式，复用寄存器设置GPIO1-IO003,设置电气属性，设置为输出模式。 2.软件汇编语言对模式设置，并且将堆栈指针指向主程序： .global _start_start: /*设置为svr模式 */mrs …...

编程日记 2025/6/2 0:02:54

第P3周：Pytorch实现天气识别

🍨 本文为🔗365天深度学习训练营中的学习记录博客🍖 原作者：K同学啊目标读取天气图片，按文件夹分类搭建CNN网络，保存网络模型并加载模型使用保存的模型预测真实天气具体实现 （一&#xf…...

编程日记 2025/6/2 3:39:10

代理IP与生成式AI：携手共创未来

目录代理IP：网络世界的“隐形斗篷” 1. 隐藏真实IP，保护隐私 2. 突破网络限制，访问更多资源生成式AI：创意与效率的“超级大脑” 1. 提高创作效率 2. 个性化定制代理IP与生成式AI的协同作用 1. 网络安全 2. 内容创作与…...

编程日记 2025/6/1 20:30:56

函数式编程

Lambda表达式 1、什么时候可以使用Lambda表达式呢？一般都是在简化匿名内部类，当这个函数是一个接口，并且接口中只要一个方法时，就可以使用Lambda表达式 2、格式 (参数列表)->{方法体} 其中形参也不需要传，只需要传实参只关注参数列表和方法体不关注方法啥的东西…...

编程日记 2025/5/29 18:45:52

抖音SEO短视频矩阵源码系统开发分享

在数字营销的前沿阵地，抖音短视频平台凭借其独特的魅力和庞大的用户基础，已成为社交媒体领域一股不可小觑的力量。随着平台影响力的持续扩大，如何有效提升视频内容的可见度与流量成为了内容创作者关注的焦点。在此背景下，一套专为…...

编程日记 2025/6/1 23:32:54

常见的锁与线程安全

目录一、STL,智能指针和线程安全 STL中的容器是否是线程安全的? 智能指针是否是线程安全的? 二、其他常见的各种锁三、自旋锁四、读者写者问题读写锁接口读者优先伪代码一、STL,智能指针和线程安全 STL中的容器是否是线程安全的? 不是 . 原因是 , STL 的设…...

编程日记 2025/6/2 4:29:04

java中的List、数组和set

在Java中，List、数组（Array）和Set 是三种常用的数据结构，它们各自有不同的特性、用途和实现方式。下面我们将深入探讨这三者的特点、区别以及它们在 Java 中的常见使用场景。 1. 数组（Array） 特性&#x…...

编程日记 2025/6/3 3:59:16

NLP-Huggingface基本使用方法

NLP的网络结构大同小异，只不过训练策略可能会不同。因为与图像cv不同，文本训练数据非常的多，cv可以使用10几张就可以获得特征向量，而文本做不到学几句话就能让计算机听得懂话。因此，我们都需要使用预训练模型&#xff…...

编程日记 2025/6/3 19:35:22

Liquibase结合SpringBoot使用实现数据库管理

Liquibase概述 Liquibase 是一个开源的数据库变更管理工具，用于跟踪、版本化、和管理数据库结构（如表、字段、索引等）的变更。它的目的是使数据库变更的过程更加透明、可控制、自动化，避免开发团队在多个环境中手动执行相同的数据…...

编程日记 2025/5/28 5:36:43

高防CDN 如何防止DDoS和CC攻击？

在数字化时代，网络安全威胁日益严重，尤其是DDoS（分布式拒绝服务）攻击和CC（Challenge Collapsar）攻击，已成为企业网站和网络服务最常见且最具破坏力的攻击手段。为了有效抵御这些攻击&#xff0c…...

编程日记 2025/6/1 15:41:25

15.初始接口1.0 C#

这是一个用于实验接口的代码适合初认识接口的人【CSDN开头介绍】（文心一言AI生成） 在C#编程世界中，接口（Interface）扮演着至关重要的角色，它定义了一组方法，但不提供这些方法的实现。接口作为…...

编程日记 2025/6/2 19:05:23

一、loopLink.h #ifndef __LOOPLINK_H__ #define __LOOPLINK_H__#include <stdio.h> #include <stdlib.h>typedef int DataType;typedef struct node {union{int len;DataType data;};struct node* next; }loopLink, *loopLinkPtr;//创建 loopLinkPtr create();//…...

编程日记 2025/6/4 1:52:33

利用CNN与多尺度特征、注意力机制的融合实现低分辨率人脸表情识别，并给出模型介绍与代码实现

大家好，我是微学AI，今天给大家介绍一下利用CNN与多尺度特征、注意力机制的融合实现低分辨率人脸表情识别，并给出模型介绍与代码实现。在当今社会，人脸识别技术已广泛应用，但特定场景下的低质量图像仍是一大挑战。低分…...

编程日记 2025/6/2 1:07:06

spring RestTemplate使用说明

rest-template是spring对httpclient的逻辑封装，它底层还是基于httpclient，所以一些配置其实跟httpclient是强相关的。基本配置 rest-template可以不带参数，使用默认配置，也可以指定ClientHttpRequestFactory参数，Cl…...

编程日记 2025/6/3 13:43:12

设置HP条UI

概述设置常见的生命值条， 实现过程设置UI/image作为形状设置UI/Image作为背景设置UI/image（healthfill）作为填充图片，层数低于背景设置heathfill的imagetype为filled fillmethod为horizontal [SerializeField] private Im…...

编程日记 2025/6/3 10:03:52

常见排序算法总结 (五) - 堆排序与堆操作

堆排序（借助 API） 算法思想利用堆能够维护数组中最大值的性质，根据数组元素建立最大堆，依次弹出元素并维护堆结构，直到堆为空。稳定性分析堆排序是不稳定的，因为堆本质上是完全二叉树，排…...

编程日记 2025/6/4 6:45:56

Linux 本地编译安装 gcc9

这里演示非sudo权限的本地linux 用户安装 gcc9 下载源代码： 可以从GCC官方网站或其镜像站点下载GCC 9的源代码压缩包。使用wget或curl命令，这通常不需要额外权限 wget https://ftp.gnu.org/gnu/gcc/gcc-9.5.0/gcc-9.5.0.tar.gz tar -xf gcc-9.5.0.tar…...

编程日记 2025/6/2 5:19:21

开源FreeSWITCH大模型智能客服系统的最佳实践

开源 FreeSWITCH 大模型智能客服系统的最佳实践原作者：开源呼叫中心FreeIPCC，其Github：https://github.com/lihaiya/freeipcc 引言开源 FreeSWITCH 大模型智能客服系统因其灵活性、成本效益和技术先进性，成为众多企业提升客户…...

编程日记 2025/6/1 6:36:35

大数据技术与应用——数据可视化（山东省大数据职称考试）

大数据分析应用-初级第一部分基础知识一、大数据法律法规、政策文件、相关标准二、计算机基础知识三、信息化基础知识四、密码学五、大数据安全六、数据库系统七、数据仓库. 第二部分专业知识一、大数据技术与应用二、大数据分析模型三、数据科学数据可视化大…...

编程日记 2025/6/1 15:47:22

大数据之Hbase环境安装

Hbase软件版本下载地址： http://mirror.bit.edu.cn/apache/hbase/ 1. 集群环境 Master 172.16.11.97 Slave1 172.16.11.98 Slave2 172.16.11.99 2. 下载软件包 #Master wget http://archive.apache.org/dist/hbase/0.98.24/hbase-0.98.24-hadoop1-bin.tar.gz…...

编程日记 2025/6/4 16:31:01

Node.js day-01

01.Node.js 讲解什么是 Node.js，有什么用，为何能独立执行 JS 代码，演示安装和执行 JS 文件内代码 Node.js 是一个独立的 JavaScript 运行环境，能独立执行 JS 代码，因为这个特点，它可以用来编写服务器后端…...

编程日记 2025/6/3 21:29:17

OpenCV相机标定与3D重建(25)计算两个三维点集之间的最优仿射变换矩阵（3x4）函数estimateAffine3D()的使用

操作系统：ubuntu22.04 OpenCV版本：OpenCV4.9 IDE:Visual Studio Code 编程语言：C11 算法描述计算两个3D点集之间的最优仿射变换。它计算 [ x y z ] [ a 11 a 12 a 13 a 21 a 22 a 23 a 31 a 32 a 33 ] [ X Y Z ] [ b 1 b 2 b 3 ] \beg…...

编程日记 2025/6/1 1:01:52

SQL 中 INNER JOIN 和 LEFT JOIN 的区别和用法

在数据库语言 SQL 中，连接 (也称进行表结合操作)是一种常见的操作，用于将多个数据表格核实关联进行查询。常见的连接类型中， INNER JOIN 和 LEFT JOIN 是最基本且最常用的。下面将给出完整的区别和用法说明。 1. 基本概念 INNER JOIN (内连…...

编程日记 2025/6/4 17:26:50

【计算机网络】lab2 Ethernet（链路层Ethernet frame结构细节）

🌈 个人主页：十二月的猫-CSDN博客 🔥 系列专栏： 🏀各种软件安装与配置_十二月的猫的博客-CSDN博客 💪🏻 十二月的寒冬阻挡不了春天的脚步，十二点的黑夜遮蔽不住黎明的曙光目录 1. …...

编程日记 2025/6/3 5:06:56

2024 年 MySQL 8.0.40 安装配置、Workbench汉化教程最简易（保姆级）

首先到官网上下载安装包：http://www.mysql.com 点击下载，拉到最下面，点击社区版下载 windows用户点击下面适用于windows的安装程序点击下载，网络条件好可以点第一个，怕下着下着断了点第二个离线下载双击下载好的安装…...

编程日记 2025/6/2 11:52:27

提升PHP技能：18个实用高级特性

掌握PHP基础知识只是第一步。深入了解这18个强大的PHP特性，将显著提升您的开发效率和代码质量。 1、超越 __construct() 的魔法方法虽然 __construct() 为大多数开发者所熟知，PHP 却提供了更多强大的魔术方法，例如： class Da…...

编程日记 2025/6/1 23:00:02

QT数据库（三）：QSqlQuery使用

QSqlQuery 简介 QSqlQuery 是能运行任何 SQL 语句的类，如 SELECT、INSERT、UPDATE、DELETE 等 SQL 语句。所以使用 QSqlQuery 几乎能进行任何操作，例如创建数据表、修改数据表的字段定义、进行数据统计等。如果运行的是 SELECT 语句，它查询…...

编程日记 2025/6/2 18:30:12

【机器学习】在向量的流光中，揽数理星河为衣，以线性代数为钥，轻启机器学习黎明的瑰丽诗章

文章目录线性代数入门：机器学习零基础小白指南前言一、向量：数据的基本单元1.1 什么是向量？1.1.1 举个例子： 1.2 向量的表示与维度1.2.1 向量的维度1.2.2 向量的表示方法 1.3 向量的基本运算1.3.1 向量加法1.3.2 向量的数乘1.3.3…...

编程日记 2025/5/31 16:05:36

设计模式详解（十一）：模板方法——Template Method

Template Method 设计模式 1. 概述 Template Method 是一种行为设计模式，它定义了一个算法的框架，并允许子类在不改变算法结构的前提下重新定义算法中的某些步骤。在 Template Method 模式中： 父类（抽象类）定义了…...

编程日记 2025/6/2 21:14:07

使用 DeepSpeed 微调 OPT 基础语言模型

文章目录 OPT 基础语言模型Using OPT with DeepSpeedmain.py 解析1、导入库和模块2、解析命令行参数3、main 函数3.1 设备与分布式初始化3.2 模型与数据准备3.3 定义评估函数3.4 优化器与学习率调度器设置3.5 使用 deepspeed 进行模型等初始化3.6 训练循环3.7 模型保存 4、dsch…...

编程日记 2025/5/31 23:09:34

DPDK用户态协议栈-TCP Posix API 2

tcp posix api send发送 ssize_t nsend(int sockfd, const void *buf, size_t len, __attribute__((unused))int flags) {ssize_t length 0;void* hostinfo get_host_fromfd(sockfd);if (hostinfo NULL) {return -1;}struct ln_tcp_stream* stream (struct ln_tcp_stream…...

编程日记 2025/6/1 4:56:12

文章目录

运行结果

代码概述

代码

相关文章：