首页 > 其他分享 >Kalman卡尔曼滤波

Kalman卡尔曼滤波

时间:2024-02-17 10:22:33浏览次数:22  
标签:plt reselt Kalman 卡尔曼滤波 step len state np

步骤:
1、计算\(y = 20 e^{0.24x}\)计算出\(x\) 在0.1~4区间内的y值作为真值:\(Y\);

2、在 Y 的基础上加入一个高斯分布的误差作为观测量,观测量:Y_OBS;

3、初始化P、Q、R矩阵,P代表初始状态精度,Q代表预测精度,R观测精度;

4、初始化状态值 state、结果存储空间 Y_reselt ,协方差存储空间 P_reselt.

# step 1
X = np.arange(0.1,4,0.01)
Y = 20 * np.exp(0.24*X)
# step  2
rand_error = 2
Y_obs = Y + rand_error * (2* np.random.random(len(X))-1)
# step  3
Q = 0.1
R = 5
P = 1
# step 4
state = 20
Y_reselt = np.zeros(len(X))
P_reselt = np.zeros(len(X))

Y_reselt[0] = state
P_reselt[0] = P

for i in range(1,len(X)):
    P = P + Q
    K = P / (P + R)
    state = state + K * (Y_obs[i]-state)
    P = (1-K) * P 
    P_reselt[i] = P 
    Y_reselt[i] = state


plt.plot(X,Y_obs,label = 'Noisy Signal')
plt.plot(X,Y_reselt,label = 'Estimated Signal')

plt.legend()
plt.show()

标签:plt,reselt,Kalman,卡尔曼滤波,step,len,state,np
From: https://www.cnblogs.com/conpi/p/18017746

相关文章

  • 书籍推荐-《卡尔曼滤波与信息融合》
    书籍:KalmanFilteringandInformationFusion作者:马宏宾,闫莉萍,夏元清,付梦印出版:SciencePressBeijing,Springer本文内容转载自公众号 【一点人工一点智能】关注51CTO @一点人工一点智能,了解更多移动机器人&人工智能信息01  书籍介绍这本书讲述了数字信息处理的一项关键技术:卡......
  • 【纯代码复制粘贴即可使用】卡尔曼滤波的C++实现
    使用Eigen实现卡尔曼滤波。如果实现扩展卡尔曼滤波只需将H矩阵换成雅可比的求解。#ifndef_MYKALMAN_H#define_MYKALMAN_H#include<Eigen\Dense>classKalmanFilter{public:KalmanFilter(intstateSize,intmeasSize,intuSize);~KalmanFilter()=default;......
  • 基于PLE结合卡尔曼滤波的RSSI定位算法matlab仿真
    1.算法运行效果图预览     2.算法运行软件版本MATLAB2022a 3.算法理论概述        基于PLE(Power-LawEqualizer)结合卡尔曼滤波的RSSI(ReceivedSignalStrengthIndicator)定位算法是一种利用无线信号强度进行位置估计的方法。该方法通过PLE算法对RSSI......
  • 卡尔曼滤波
    1.卡尔曼滤波入门卡尔曼滤波的引入:滤波就是将测量得到的波形中的的噪声过滤掉,使得到的数据更趋于真实情况,也更加平滑,方便使用。如下图所示(红色曲线是测量直接得到的波形,紫色曲线是滤波后得到的平滑曲线)卡尔曼滤波适用的系统:卡尔曼滤波适用线性高斯系统1.线性系统:满足叠加性和......
  • SLAM基础-扩展卡尔曼滤波
    https://slowlythinking.github.io/2019/07/Paper_Framework-EKF/                ......
  • 计算机舍入误差对卡尔曼滤波器的影响
    本文主要学习计算机舍入误差对卡尔曼滤波器的影响,在实际工程中,我们去分析跟踪轨迹和点云数据通常关注的点都是跟踪和点云数据的误差。至于计算机引入的舍入误差其实很多时候都会忽略。因此本文参考《卡尔曼滤波理论与实践(MATLAB版)》(第四版)对舍入误差的影响进行一个学习和讨论,......
  • 卡尔曼滤波器在实际工程中考虑的问题-------新息的分析
    一、本文重点本篇文章主要讨论的是什么可以称为卡尔曼滤波器工程的问题,该部分主要是根据卡尔曼滤波器在长期的应用和误用实践中发展出来的。本篇文章的参考内容来自《卡尔曼滤波理论和实践》,同时结合自己的项目开发挑出部分自己测试过程中经常调试的内容。如果有侵权请联系删......
  • 卡尔曼滤波发散原因、解决方案以及实测案例分析
    一、背景  2023年9月22日,今天本来开开心心搞测试,奈何雷达有了小情绪,之前能够稳定跟踪但今天不管如何测试对快速运动的行人都无法形成有效的跟踪,本来以为是SDK的问题(近两天测试换了一个新的SDK),换回去之后它也不行了。跟踪跟不上了,看着点云数据还可以,他就是跟不上。算法难搞哦,......
  • 【状态估计】基于卡尔曼滤波估计室内温度附matlab代码
    ✅作者简介:热爱科研的Matlab仿真开发者,修心和技术同步精进,matlab项目合作可私信。......
  • 卡尔曼滤波的五大公式
    预测:xhat_表示先验估计,xhat表示后验估计,带有_的先验估计,不带的后验估计xhat_(k)=A*xhat(k-1)+B*u(k-1)Pk_=A*Pk*A'+Q更新Kk=Pk_*H'*(H*Pk*H'_+R);xhat(k)=xhat_(k)+Kk(Zk-H*xhat_(k))Pk=(I-Kk*H)Pk_;clccloseall%%首先需要实际值和测量值需要考虑噪声信号(噪声信号符合高斯分布期望......