卡尔曼滤波_附代码


欢迎加入技术交流QQ群(2000人):电力电子技术与新能源 954221326


高可靠新能源行业顶尖自媒体


在这里有电力电子、新能源干货、行业发展趋势分析、最新产品介绍、众多技术达人与您分享经验,欢迎关注微信公众号:电力电子技术与新能源(Micro_Grid),论坛:www.21micro-grid.com,建立的初衷就是为了技术交流,作为一个与产品打交道的技术人员,市场产品信息和行业技术动态也是必不可少的,希望大家不忘初心,怀有一颗敬畏之心,做出更好的产品!

电力电子技术与新能源论坛

www.21micro-grid.com


小编推荐值得一看的书单电力电子技术与新能源推荐书单


  • The Power MOSFET 应用手册

  • [视频]反激电路Flyback

  • 车用永磁同步电机控制及弱磁方法

  • [视频]IGBT模块技术参数详解

  • [视频]英飞凌双脉冲实验教具使用说明

  • 碳化硅在光伏逆变器中的应用-阳光电源

  • 华为精华资料—终端互连PCB设计规范分享

  • 复旦电赛培训_辅助电源_刘祖望_电力电子技术与新能源

  • 环路指导书LOOP Training

  • [视频]浙大碳化硅技术发展与应用介绍

本文中公式较长,请滑动查看,或点击阅读原文在Github中下载PDF

卡尔曼滤波

卡尔曼滤波以其发明者鲁道夫.E.卡尔曼(Rudolph E. Kalman)命名,但根据文献可知卡尔曼并非第一个提出该算法的人,Peter Swerling在更早之前就提出了类似算法1

卡尔曼滤波的典型实例是从一组有限、包含噪声的观测序列中预测出物体的位置和速度。最为常见的卡尔曼滤波器是锁相环。

线性卡尔曼滤波

待估计模型

卡尔曼滤波建立在隐马尔可夫模型上,其基本动态系统使用一个马尔可夫链表示。

img1

使用公式表示即,对于需要求解的状态  满足

其中  为  状态的转移矩阵,在现实的过程中他可能是时变的,但是在这里假设其为常量。 矩阵  是可能存在的控制器  的输入-控制模型。对于这一隐马尔可夫链有观测值  满足

其中  矩阵  为观测模型,在真实情况中观测模型可能会是时变的,但在此处假设其为常量。

随机变量  分别为过程噪声和观测噪声,假设他们是独立的高斯白噪声且

推导

卡尔曼滤波器是建立在贝叶斯滤波器的基础上的2,首先介绍贝叶斯滤波器。

贝叶斯准则与全概率公式

贝叶斯准则:

全概率公式:

贝叶斯滤波器

贝叶斯滤波器的思想即使用已有的观测值和控制输入来估计当前时刻的状态,对于状态  ,观测值  ,控制量 ,写成概率的形式即:

根据贝叶斯准则

分母与  无关,使用常数  代替,由于隐马尔可夫链的性质,某时刻的观测值只与其状态有关,则   上式可以化简为:

可以理解为使用先验和似然估计后验。则先验为:

代入全概率公式,由于积分中乘积的前一项为根据前一时刻状态预测下一时刻状态,根据马尔可夫链的性质,这一概率与观测值  无关。同时,马尔可夫性质表明只有当前的控制信号和上一时刻的状态对当前时刻的状态有影响,则积分乘积前一项中的  可以被化为  ,乘积后一项中的  可以被化为 。同时观察可知乘积的第二项即 

后验为:

代入待估计模型

求解先验分布

由于假设噪声符合高斯分布,则  也应符合高斯分布,设其均值为  ,方差  。对于先验公式,有

则  可以表示成  的形式,其中  为常数,有

两个高斯分布的乘积  也为高斯分布,而  是关于  的二次型,则求解   可以得到该分布的均值 ,  为其方差的倒数。可以解得:

为了求解积分,需要使用一些技巧来简化运算,定义二次型函数

可以发现  为  的二次型,且有  ,则可以将  拆分来去积分。定义

由于  为关于  的二次型,且  符合高斯分布,则使用求一阶导数和二阶导数的方法来求取其方差  和均值 

一阶导数:

令一阶导数等于零


二阶导数:

则得到先验分布 

求解后验分布

由系统的观测方程可以得到  ,已经求得先验分布 ,则后验分布

可以简化为  ,其中

由于  为  的二次型,同时  符合高斯分布,继续通过求解一阶导数和二阶导数的方法求均值和方差。

一阶导数:

令一阶导数等于零

化简  可以得到一个更常见的形式:

二阶导数:

将  代入  的表达式中,可以得到更加简化的表达形式

结论

至此,卡尔曼滤波器的五条公式全部推出,分别为式(1~5),即:

可以看到,卡尔曼滤波器即是在贝叶斯滤波器的基础上加入了带有噪声的模型。观察  可以发现

即当观测误差趋于 0 时,引入观测值进行修正的权重将增大;当预测误差趋于 0 时,引入观测值进行修正的权重将减小并趋于 0。

卡尔曼滤波器的实现

卡尔曼滤波器通过如下的算法进行实现:

img2

接下来在倒立摆模型中实现卡尔曼滤波器,倒立摆模型预测方程近似如下:

其中  为小车位移、杆角度、小车速度、杆角速度, 为小车重量、杆重量, 为杆长度, 为向小车施加的力, 在离散系统中为两次更新间经过的时间,

在实现中一般不希望或不能观测所有的变量,而且在观测中会引入误差,假设只有小车速度和杆角速度能被测量,观测方程如下:

使用卡尔曼滤波器实现状态估计。使用 Open AI 的开源库 gym 中的CartPole-v1 进行仿真,使用 PID 算法进行控制,由于本文只关心卡尔曼滤波,PID参数较为粗放。仿真结果如下图:


卡尔曼滤波器的 python 代码如下:

class KFilter:
def __init__(self, f_mat, b_mat, q_mat, h_mat, r_mat):
self.f_mat = f_mat
self.b_mat = b_mat
self.q_mat = q_mat
self.h_mat = h_mat
self.r_mat = r_mat

def kal_filter(self, x_mat, p_mat, z_mat, action):
x_predict = self.f_mat * x_mat + self.b_mat * action
p_predict = self.f_mat * p_mat * self.f_mat.T + self.q_mat
k_num = p_predict * self.h_mat.T * np.linalg.pinv(self.h_mat * p_predict * self.h_mat.T + self.r_mat)
x_mat = x_predict + k_num * (z_mat - self.h_mat * x_predict)
p_mat = (np.eye(4) - k_num * self.h_mat) * p_predict
return x_mat, p_mat

倒立摆的 PID 算法修改自 GitHub 3

考文献

由于公众号文章无法插入外链,以下引用均未附原文链接

[1] Wikipedia

[2] 卡尔曼滤波器的数学推导—木独—CSDN

[3] The PID control implementation of cart-pole environment in gym—lukewys—Github


转到Github查看全部代码:

https://github.com/Versemongerr/Kalman_PID_Cartpole


文章首尾冠名广告正式招商,功率器件,SiC,GaN,数字电源,新能源厂家都可合作,有意者加微信号1768359031详谈。

说明:本文来源网络;文中观点仅供分享交流,不代表本公众号立场,转载请注明出处,如涉及版权等问题,请您告知,我们将及时处理。

电力电子技术与新能源通讯录:

Please clik the advertisement and exit

重点

如何下载《电力电子技术板块内高清PDF电子书


点击文章底部阅读原文,访问电力电子技术与新能源论坛(www.21micro-grid.com)下载!


或者转发所要文章到朋友圈不分组不屏蔽,然后截图发给小编(微信1413043922),小编审核后将文章发你!


推荐阅读:点击标题阅读

LLC_Calculator__Vector_Method_as_an_Application_of_the_Design

自己总结的电源板Layout的一些注意点

High_Frequency_Transformers_for_HighPower_Converters_Materials

华为电磁兼容性结构设计规范V2.0

Communication-less Coordinative Control of Paralleled Inverters

Soft Switching for SiC MOSFET Three-phase Power Conversion

Designing Compensators for Control of Switching Power Supplies

100KHZ 10KW Interleaved Boost Converter with full SiC MOSFET

华为-单板热设计培训教材


看完有收获?请分享给更多人


公告:

电力电子技术与新能源微信群,欢迎加小编微信号:(QQ号)1413043922,请注明研究方向或从事行业(比如光伏逆变器硬件),小编对电力电子技术与新能源及微电网的市场发展很看好,对其关键技术很感兴趣,如有技术问题,欢迎加小编微信,共同讨论。

在这里有电力电子技术:光伏并网逆变器(PV建模,MPPT,并网控制,LCL滤波,孤岛效应),光伏离网,光伏储能,风电变流器(双馈、直驱),双向变流器PCS,新能源汽车,充电桩,车载电源,数字电源,双向DCDC(LLC,移相全桥,DAB),储能(锂电池、超级电容),低电压穿越(LVRT),高电压穿越,虚拟同步发电机,多智能体,电解水,燃料电池,能量管理系统(直流微网、交流微网)以及APF,SVG ,DVR,UPQC等谐波治理和无功补偿装置等。
PSCAD/MATLABsimulink/Saber/PSPICE/PSIM——软件仿真+DSP+(TI)TMS320F2812,F28335,F28377,(Microchip)dsPIC30F3011,FPGA,ARM,STM32F334——硬件实物。
欢迎技术人员加入,多多交流,共同进步!


更多精彩点下方阅读原文

      点亮在看,小编工资涨1毛!

电力电子技术与新能源 电力电子技术,交直流微电网,光伏并网逆变器,储能逆变器,风电变流器(双馈,直驱),双向变流器PCS,新能源汽车,充电桩,车载电源,数字电源,双向DCDC,锂电池,超级电容,燃料电池,能量管理系统以及APF,SVG ,UPQC等
评论
  • 在物联网领域中,无线射频技术作为设备间通信的核心手段,已深度渗透工业自动化、智慧城市及智能家居等多元场景。然而,随着物联网设备接入规模的不断扩大,如何降低运维成本,提升通信数据的传输速度和响应时间,实现更广泛、更稳定的覆盖已成为当前亟待解决的系统性难题。SoC无线收发模块-RFM25A12在此背景下,华普微创新推出了一款高性能、远距离与高性价比的Sub-GHz无线SoC收发模块RFM25A12,旨在提升射频性能以满足行业中日益增长与复杂的设备互联需求。值得一提的是,RFM25A12还支持Wi-S
    华普微HOPERF 2025-02-28 09:06 143浏览
  •         近日,广电计量在聚焦离子束(FIB)领域编写的专业著作《聚焦离子束:失效分析》正式出版,填补了国内聚焦离子束领域实践性专业书籍的空白,为该领域的技术发展与知识传播提供了重要助力。         随着芯片技术不断发展,芯片的集成度越来越高,结构也日益复杂。这使得传统的失效分析方法面临巨大挑战。FIB技术的出现,为芯片失效分析带来了新的解决方案。它能够在纳米尺度上对芯片进行精确加工和分析。当芯
    广电计量 2025-02-28 09:15 116浏览
  • 应用趋势与客户需求,AI PC的未来展望随着人工智能(AI)技术的日益成熟,AI PC(人工智能个人电脑)逐渐成为消费者和企业工作中的重要工具。这类产品集成了最新的AI处理器,如NPU、CPU和GPU,并具备许多智能化功能,为用户带来更高效且直观的操作体验。AI PC的目标是提升工作和日常生活的效率,通过深度学习与自然语言处理等技术,实现更流畅的多任务处理、实时翻译、语音助手、图像生成等功能,满足现代用户对生产力和娱乐的双重需求。随着各行各业对数字转型需求的增长,AI PC也开始在各个领域中显示
    百佳泰测试实验室 2025-02-27 14:08 255浏览
  • 在2024年的科技征程中,具身智能的发展已成为全球关注的焦点。从实验室到现实应用,这一领域正以前所未有的速度推进,改写着人类与机器的互动边界。这一年,我们见证了具身智能技术的突破与变革,它不仅落地各行各业,带来新的机遇,更在深刻影响着我们的生活方式和思维方式。随着相关技术的飞速发展,具身智能不再仅仅是一个技术概念,更像是一把神奇的钥匙。身后的众多行业,无论愿意与否,都像是被卷入一场伟大变革浪潮中的船只,注定要被这股汹涌的力量重塑航向。01为什么是具身智能?为什么在中国?最近,中国具身智能行业的进
    艾迈斯欧司朗 2025-02-28 15:45 221浏览
  • 构建巨量的驾驶场景时,测试ADAS和AD系统面临着巨大挑战,如传统的实验设计(Design of Experiments, DoE)方法难以有效覆盖识别驾驶边缘场景案例,但这些边缘案例恰恰是进一步提升自动驾驶系统性能的关键。一、传统解决方案:静态DoE标准的DoE方案旨在系统性地探索场景的参数空间,从而确保能够实现完全的测试覆盖范围。但在边缘案例,比如暴露在潜在安全风险的场景或是ADAS系统性能极限场景时,DoE方案通常会失效,让我们看一些常见的DoE方案:1、网格搜索法(Grid)实现原理:将
    康谋 2025-02-27 10:00 252浏览
  • 美国加州CEC能效跟DOE能效有什么区别?CEC/DOE是什么关系?美国加州CEC能效跟DOE能效有什么区别?CEC/DOE是什么关系?‌美国加州CEC能效认证与美国DOE能效认证在多个方面存在显著差异‌。认证范围和适用地区‌CEC能效认证‌:仅适用于在加利福尼亚州销售的电器产品。CEC认证的范围包括制冷设备、房间空调、中央空调、便携式空调、加热器、热水器、游泳池加热器、卫浴配件、光源、应急灯具、交通信号模块、灯具、洗碗机、洗衣机、干衣机、烹饪器具、电机和压缩机、变压器、外置电源、消费类电子设备
    张工nx808593 2025-02-27 18:04 120浏览
  • 1,微软下载免费Visual Studio Code2,安装C/C++插件,如果无法直接点击下载, 可以选择手动install from VSIX:ms-vscode.cpptools-1.23.6@win32-x64.vsix3,安装C/C++编译器MniGW (MinGW在 Windows 环境下提供类似于 Unix/Linux 环境下的开发工具,使开发者能够轻松地在 Windows 上编写和编译 C、C++ 等程序.)4,C/C++插件扩展设置中添加Include Path 5,
    黎查 2025-02-28 14:39 140浏览
  • 振动样品磁强计是一种用于测量材料磁性的精密仪器,广泛应用于科研、工业检测等领域。然而,其测量准确度会受到多种因素的影响,下面我们将逐一分析这些因素。一、温度因素温度是影响振动样品磁强计测量准确度的重要因素之一。随着温度的变化,材料的磁性也会发生变化,从而影响测量结果的准确性。因此,在进行磁性测量时,应确保恒温环境,以减少温度波动对测量结果的影响。二、样品制备样品的制备过程同样会影响振动样品磁强计的测量准确度。样品的形状、尺寸和表面处理等因素都会对测量结果产生影响。为了确保测量准确度,应严格按照规
    锦正茂科技 2025-02-28 14:05 134浏览
  • RGB灯光无法同步?细致的动态光效设定反而成为产品客诉来源!随着科技的进步和消费者需求变化,电脑接口设备单一功能性已无法满足市场需求,因此在产品上增加「动态光效」的形式便应运而生,藉此吸引消费者目光。这种RGB灯光效果,不仅能增强电脑周边产品的视觉吸引力,还能为用户提供个性化的体验,展现独特自我风格。如今,笔记本电脑、键盘、鼠标、鼠标垫、耳机、显示器等多种电脑接口设备多数已配备动态光效。这些设备的灯光效果会随着音乐节奏、游戏情节或使用者的设置而变化。想象一个画面,当一名游戏玩家,按下电源开关,整
    百佳泰测试实验室 2025-02-27 14:15 137浏览
  •           近日受某专业机构邀请,参加了官方举办的《广东省科技创新条例》宣讲会。在与会之前,作为一名技术工作者一直认为技术的法例都是保密和侵权方面的,而潜意识中感觉法律有束缚创新工作的进行可能。通过一个上午学习新法,对广东省的科技创新有了新的认识。广东是改革的前沿阵地,是科技创新的沃土,企业是创新的主要个体。《广东省科技创新条例》是广东省为促进科技创新、推动高质量发展而制定的地方性法规,主要内容包括: 总则:明确立法目
    广州铁金刚 2025-02-28 10:14 103浏览
  • Matter 协议,原名 CHIP(Connected Home over IP),是由苹果、谷歌、亚马逊和三星等科技巨头联合ZigBee联盟(现连接标准联盟CSA)共同推出的一套基于IP协议的智能家居连接标准,旨在打破智能家居设备之间的 “语言障碍”,实现真正的互联互通。然而,目标与现实之间总有落差,前期阶段的Matter 协议由于设备支持类型有限、设备生态协同滞后以及设备通信协议割裂等原因,并未能彻底消除智能家居中的“设备孤岛”现象,但随着2025年的到来,这些现象都将得到完美的解决。近期,
    华普微HOPERF 2025-02-27 10:32 214浏览
  • 一、VSM的基本原理震动样品磁强计(Vibrating Sample Magnetometer,简称VSM)是一种灵敏且高效的磁性测量仪器。其基本工作原理是利用震动样品在探测线圈中引起的变化磁场来产生感应电压,这个感应电压与样品的磁矩成正比。因此,通过测量这个感应电压,我们就能够精确地确定样品的磁矩。在VSM中,被测量的样品通常被固定在一个震动头上,并以一定的频率和振幅震动。这种震动在探测线圈中引起了变化的磁通量,从而产生了一个交流电信号。这个信号的幅度和样品的磁矩有着直接的关系。因此,通过仔细
    锦正茂科技 2025-02-28 13:30 100浏览
  • 更多生命体征指标风靡的背后都只有一个原因:更多人将健康排在人生第一顺位!“AGEs,也就是晚期糖基化终末产物,英文名Advanced Glycation End-products,是存在于我们体内的一种代谢产物” 艾迈斯欧司朗亚太区健康监测高级市场经理王亚琴说道,“相信业内的朋友都会有关注,最近该指标的热度很高,它可以用来评估人的生活方式是否健康。”据悉,AGEs是可穿戴健康监测领域的一个“萌新”指标,近来备受关注。如果站在学术角度来理解它,那么AGEs是在非酶促条件下,蛋白质、氨基酸
    艾迈斯欧司朗 2025-02-27 14:50 400浏览
我要评论
0
点击右上角,分享到朋友圈 我知道啦
请使用浏览器分享功能 我知道啦