发烧友10周年庆典,全网超值优惠来袭!千元现金券,下单抽奖赶紧参与》》

如何在单片机上实现卡尔曼滤波详细计算方法和程序概述

玩转单片机 2019-08-11 11:23 次阅读


      程序十分简洁易懂,而且使用效果不错,分享

#ifndef _KALMAN_H_

#define _KALMAN_H_

extern  KalmanGain;//  卡尔曼增益

extern  EstimateCovariance;//估计协方差

extern  MeasureCovariance;//测量协方差

extern  EstimateValue;//估计值

extern void KalmanFilterInit(void);

extern      KalmanFilter(   Measure);

#endif

#include "config.h"

#include "math.h"

KalmanGain;//  卡尔曼增益

EstimateCovariance;//估计协方差

MeasureCovariance;//测量协方差

EstimateValue;//估计值

void KalmanFilterInit(void);

extern    float  KalmanFilter(float   Measure);

void KalmanFilterInit(void)

{

EstimateValue=0;

EstimateCovariance=0.1;

MeasureCovariance=0.02;

}

KalmanFilter(   Measure)

{

//计算卡尔曼增益

KalmanGain=EstimateCovariance*sqrt(1/(EstimateCovariance*EstimateCovariance+MeasureCovariance*MeasureCovariance));

//计算本次滤波估计值

EstimateValue=EstimateValue+KalmanGain*(Measure-EstimateValue);

//更新估计协方差

EstimateCovariance=sqrt(1-KalmanGain)*EstimateCovariance;

//更新测量方差

MeasureCovariance=sqrt(1-KalmanGain)*MeasureCovariance;

//返回估计值

return EstimateValue;

}

原文标题:在单片机上实现卡尔曼滤波

文章出处:【微信号:mcu168,微信公众号:玩转单片机】欢迎添加关注!文章转载请注明出处。

收藏 人收藏
分享:

评论

相关推荐

AltiumDesigner画图不求人56 软件汉化处理

​ 原文地址(有视频教程):
发表于 09-15 23:38 95次 阅读
AltiumDesigner画图不求人56 软件汉化处理

单片机系统硬件的抗干扰措施解析

单片机系统硬件抗干扰常用方法实践影响单片机系统可靠安全运行的主要因素主要来自系统内部和外部的各种电气....
发表于 09-15 16:27 23次 阅读
单片机系统硬件的抗干扰措施解析

51单片机系列封装库

AltiumDesigner封装最全库,将为大家分享原理图库和PCB库。 原文地址(有视频教程): 网盘链接: 提取码:ht1r ...
发表于 09-14 20:21 244次 阅读
51单片机系列封装库

如何定义单片机的AD精度

AD精度指的是AD实际转换的结果和理想的计算结果之间的误差,也叫做积分非线性误差,符号是(INL) ....
发表于 09-14 16:36 29次 阅读
如何定义单片机的AD精度

单片机对1602液晶的驱动设计

1.1读状态:输入:RS = L,RW =H,E = H输出D0~D7 1.2写指令:输入:R....
发表于 09-14 16:25 22次 阅读
单片机对1602液晶的驱动设计

如何生成C51HEX文件的技术和创建单片机最小系统的资料说明

常用来保存单片机或其他处理器的目标程序代码。它保 存物理程序存储区中的目标代码映象。一般的编程器都支....
的头像 Wildesbeast 发表于 09-14 11:49 50次 阅读
如何生成C51HEX文件的技术和创建单片机最小系统的资料说明

单片机中的AD精度是如何定义的

AD精度指的是AD实际转换的结果和理想的计算结果之间的误差,也叫做积分非线性误差,符号是(INL) ....
发表于 09-12 16:24 70次 阅读
单片机中的AD精度是如何定义的

单片机执行编制程序的全过程解析

单片机执行程序的过程,实际上就是执行我们所编制程序的过程。即逐条指令的过程。计算机每执行一条指令都可....
发表于 09-12 16:21 144次 阅读
单片机执行编制程序的全过程解析

单片机编程的常见问题解答

C 语言是一种结构化的高级语言。其优点是可读性好,移植容易,是普遍使 用的一种计算机语言。缺点是占用....
发表于 09-12 16:11 92次 阅读
单片机编程的常见问题解答

如何退出登录?

如何退出登录? 找不到退出的地方!
发表于 09-12 15:47 223次 阅读
如何退出登录?

使用ADUC812单片机和AD603设计一个宽带放大器的报告资料免费下载

本设计由三个模块电路构成:前级放大电路(带AGC部分)、后级放大电路和单片机显示与控制模块。在前级放....
发表于 09-12 11:39 35次 阅读
使用ADUC812单片机和AD603设计一个宽带放大器的报告资料免费下载

使用LabWindows实现多个单片机与PC进行串口通信的工程文件和程序

本文档的主要内容详细介绍的是使用LabWindows实现多个单片机与PC进行串口通信的工程文件和程序....
发表于 09-12 11:37 36次 阅读
使用LabWindows实现多个单片机与PC进行串口通信的工程文件和程序

请问单片机怎么编程计数脉冲个数用lcd显示出来?

如何单片机编程计数脉冲个数并用lcd显示出来,求程序源代码...
发表于 09-12 09:12 135次 阅读
请问单片机怎么编程计数脉冲个数用lcd显示出来?

请问单片机怎么控制舵机?

单片机的IO口是不是直接跟舵机相连,怎么控制,需要驱动芯片吗,请大虾指教...
发表于 09-12 09:12 67次 阅读
请问单片机怎么控制舵机?

请问用单片机怎么检测电网电压电流?

求详尽的硬件电路搭建
发表于 09-12 09:10 105次 阅读
请问用单片机怎么检测电网电压电流?

如何入门NEC单片机?

我是新手,看了NEC单片机的技术手册,好几个月了,但就是入不了门,恳请高手提携下。...
发表于 09-12 08:00 109次 阅读
如何入门NEC单片机?

54个单片机的经典设计案例的程序和工程文件免费下载

本文档的主要内容详细介绍的是54个单片机的经典设计案例的程序和工程文件免费下载包括了:33个基础实验....
发表于 09-12 08:00 60次 阅读
54个单片机的经典设计案例的程序和工程文件免费下载

KEIL C51的安装与工程建立教程免费下载

本章将向大家介绍 KEIL C51 软件的安装,通过本章的学习,我们可以在电脑上安装一个 KEIL ....
发表于 09-12 08:00 32次 阅读
KEIL C51的安装与工程建立教程免费下载

请问430单片机ADC12中VR+与外围分压测量电路的Vref有什么区别?

如图,430单片机 ADC12中VR+、VR-与外围分压测量电路的Vref的有何区别或者关系? 是否(1)式中的Vin就是(2)式中的...
发表于 09-12 06:51 62次 阅读
请问430单片机ADC12中VR+与外围分压测量电路的Vref有什么区别?

为什么我在运行程序时遇到此错误?

大家好, 资源限制:SC固定块的最大数量超过(max=4,需要=5)。 在我的设计中放置PGA时,我得到了这个错误。 我使用P...
发表于 09-12 06:03 31次 阅读
为什么我在运行程序时遇到此错误?

stm32f103单片机引脚电压不受控制该怎么办?

自己开的pcb板,IC也都是自己手焊的,测试时没问题,但是实际使用几小时后,就出现了问题,检查后发现是因为单片机的引脚电压不...
发表于 09-12 01:16 112次 阅读
stm32f103单片机引脚电压不受控制该怎么办?

嵌入式技术是怎么一回事

物联网时代的到来,不管是从行业应用,还是智能硬件的爆发,亦或是大数据等等嵌入式技术都得到了史无前例的....
发表于 09-11 16:14 83次 阅读
嵌入式技术是怎么一回事

单片机和嵌入式之间有什么差异

嵌入式在软件系统层次,比单片机丰富了许多。
发表于 09-11 16:10 106次 阅读
单片机和嵌入式之间有什么差异

基于STC89C54RD单片机的高精度自动电阻测试仪设计

本系统由单片机STC89C54RD 控制,将被测电阻通过测量电路,将电阻的变化转变为电压和电流的变化....
发表于 09-11 15:42 62次 阅读
基于STC89C54RD单片机的高精度自动电阻测试仪设计

如何将单片机的TMR用作定时器和计数器使用

TMR1为16位宽,附带一个可编程的预分频器和一个可选的低频时基振荡器,适合与CPP模块配合使用来实....
发表于 09-11 15:36 66次 阅读
如何将单片机的TMR用作定时器和计数器使用

单片机嵌入式编程需要注意哪一些事项

在单片机嵌入式的编程过程中程序的好坏往往是由细节决定的,一个程序写的是否详细、灵活,是与日积月累的知....
发表于 09-11 15:31 65次 阅读
单片机嵌入式编程需要注意哪一些事项

使用STM32单片机实现手势识别的程序和工程文件免费下载

本文档的主要内容详细介绍的是单片机使用STM32单片机实现手势识别的程序和工程文件免费下载。
发表于 09-11 11:37 54次 阅读
使用STM32单片机实现手势识别的程序和工程文件免费下载

Kineties系列单片机中的FTM模块的详细资料概述

FTM是Kinetis 单片机中重要的一个外设,如果你仅仅认为其仅仅是能够产生PWM波来控制你的小车....
发表于 09-11 11:36 38次 阅读
Kineties系列单片机中的FTM模块的详细资料概述

PZ-ISP和STC-ISP程序的烧录步骤资料免费下载

1, USB安装驱动程序,驱动程序在“学习光盘”中,具体安装方法参考配套“使用说明书”对于XP系统驱....
发表于 09-11 10:31 24次 阅读
PZ-ISP和STC-ISP程序的烧录步骤资料免费下载

单片机通信与控制应用编程实例的实例源程序免费下载

本文档的主要内容详细介绍的是单片机通信与控制应用编程实例的实例源程序免费下载包括了:单片机开发板B的....
发表于 09-11 08:00 44次 阅读
单片机通信与控制应用编程实例的实例源程序免费下载

C++串口程序第三方类代码免费下载

本文档的主要内容详细介绍的是C++串口程序第三方类代码免费下载。
发表于 09-11 08:00 33次 阅读
C++串口程序第三方类代码免费下载

MLX90614ESF红外非接触温度测量传感器模块的程序和工程文件免费下载

本文档的主要内容详细介绍的是MLX90614ESF红外非接触温度测量传感器模块的程序和工程文件免费下....
发表于 09-10 08:00 30次 阅读
MLX90614ESF红外非接触温度测量传感器模块的程序和工程文件免费下载

STC12C60S2单片机RS485通讯开发板的资料合集免费下载

本文档的主要内容详细介绍的是STC12C60S2单片机485通讯开发板的资料合集免费下载包括了:48....
发表于 09-10 08:00 53次 阅读
STC12C60S2单片机RS485通讯开发板的资料合集免费下载

SKG09DT高性能的GNSS模块数据手册免费下载

SKG09DT是一款高性能的GNSS一体化解决方案模块,具有超灵敏度、超低功耗、小体积等特点。将射频....
发表于 09-10 08:00 42次 阅读
SKG09DT高性能的GNSS模块数据手册免费下载

FD650B LED驱动控制和键盘扫描专用集成电路的数据手册免费下载

FD650B 对数码管和发光管采用动态扫描驱动,顺序为DIG1至DIG4,当其中一个引脚吸入电流时,....
发表于 09-09 17:15 74次 阅读
FD650B LED驱动控制和键盘扫描专用集成电路的数据手册免费下载

MPU6050与单片机通讯的C语言源码免费下载

本文档的主要内容详细介绍的是MPU6050与单片机通讯的C语言源码免费下载。
发表于 09-09 17:15 53次 阅读
MPU6050与单片机通讯的C语言源码免费下载

C++的基础课程学习笔记资料免费下载

多态是指在一般类中定义的属性或行为,被特殊类继承之后,可以具有不同的数据类型或表现出不同的行为。这使....
发表于 09-09 08:00 28次 阅读
C++的基础课程学习笔记资料免费下载

C++ Primer中文第四版PDF电子书免费下载

本书全面介绍了 C++ 语言。作为一本入门书(Primer),它以教程的形式对 C++ 语言进行清晰....
发表于 09-09 08:00 39次 阅读
C++ Primer中文第四版PDF电子书免费下载

使用单片机的PWM信号实现舵机控制的详细资料说明

在机器人机电控制系统中,舵机控制效果是性能的重要影响因素。舵机可以在微机电系统和航模中作为基本的输出....
发表于 09-09 08:00 84次 阅读
使用单片机的PWM信号实现舵机控制的详细资料说明

单片机初学者的经典教材LED的资料合集免费下载

学习单片机也已经有几年了,藉此机会和大家聊一下我学习过程中的一些经历和想法吧。也感谢一线工人提供了这....
发表于 09-09 08:00 70次 阅读
单片机初学者的经典教材LED的资料合集免费下载

单片机C语言有哪些优越性?如何建立一个Keil C51项目

随着单片机技术的不断发展,以单片机C语言为主流的高级语言也不断被更多的单片机爱好者和工程师所喜爱。使....
的头像 Wildesbeast 发表于 09-08 11:43 427次 阅读
单片机C语言有哪些优越性?如何建立一个Keil C51项目

8259A中断控制芯片的引脚图和主要功能的资料概述

  8259A是一种中断控制芯片,在单片机系统中一般用来扩展单片机的中断,pc机中也有这个芯片,
的头像 Wildesbeast 发表于 09-08 11:43 446次 阅读
8259A中断控制芯片的引脚图和主要功能的资料概述

8255接口芯片的引脚图及引脚功能的详细资料概述

单片机系统里常用的8255芯片是一个典型的可编程通用并行接口芯片,用来扩展单片机的端口,它具有3个8....
的头像 Wildesbeast 发表于 09-08 11:26 469次 阅读
8255接口芯片的引脚图及引脚功能的详细资料概述

8253接口芯片的引脚图和引脚定义及在PC机中的应用代码说明

8253是在单片机系统常用的定时/计数器接口芯片,他能扩展几个定时/计数器,而不占用单片机的cpu时....
的头像 Wildesbeast 发表于 09-08 11:17 445次 阅读
8253接口芯片的引脚图和引脚定义及在PC机中的应用代码说明

MAX232芯片的引脚图和电脑串口的连接电路及RS232引脚定义详细说明

max232是一种把电脑的串行口rs232信号电平(-10 ,+10v)转换为单片机所用到的TTL信....
的头像 Wildesbeast 发表于 09-08 11:10 345次 阅读
MAX232芯片的引脚图和电脑串口的连接电路及RS232引脚定义详细说明

如何才能快速入门单片机详细方法教程说明

当你有了学习单片机的愿望,接下来的问题就是从何学起,如何学? 对于在校学生有老师指导,开始时的迷茫会....
的头像 Wildesbeast 发表于 09-08 10:29 1229次 阅读
如何才能快速入门单片机详细方法教程说明

单片机外部结构的引脚功能的简介和使用资料概述

51系列单片机8031、8051及89c51/89s51均采用40Pin封装的双列直接DIP结构。上....
的头像 Wildesbeast 发表于 09-08 10:15 1011次 阅读
单片机外部结构的引脚功能的简介和使用资料概述

学习单片机需要准备那些东西?怎么样才算入门了

如果你想学单片机,请在学习单片机之前,请做好如下准备工作: 一、硬件准备: 本人推荐给大家的学习....
的头像 Wildesbeast 发表于 09-08 09:56 289次 阅读
学习单片机需要准备那些东西?怎么样才算入门了

单片机可做的四大项目

目前使用单片机微控制器作为核心的电子产品数不胜数,只要是能够给大家带来便利,或者乐趣,或者解决问题的....
的头像 电子魔法师 发表于 09-07 09:07 411次 阅读
单片机可做的四大项目

单片机的各个应用领域分析

我认为单片机产品在现在和可预见的未来其市场潜力还是很巨大的,就以目前的情况看基本上所见到的家电产品都....
的头像 电子魔法师 发表于 09-07 08:25 337次 阅读
单片机的各个应用领域分析

使用MSP430单片机设计一个波形发生器的资料免费下载

以模拟电路为核心,以MSP430 为控制系统,设计了一个波形发生器。该波形发生器采集其输出信号的频率....
发表于 09-06 16:43 69次 阅读
使用MSP430单片机设计一个波形发生器的资料免费下载

使用单片机设计一个电能收集充电器的论文免费下载

本设计包括LM2671构成的Buck直流-直流转换器(即DC-DC转换器)电路,MC34063 构成....
发表于 09-06 16:43 99次 阅读
使用单片机设计一个电能收集充电器的论文免费下载

SHT85温湿度传感器的使用程序和工程文件免费下载

本文档的主要内容详细介绍的是SHT85温湿度传感器的使用例程和工程文件免费下载。
发表于 09-06 08:00 66次 阅读
SHT85温湿度传感器的使用程序和工程文件免费下载

CHKDCL6907电磁炉专用单片机的数据手册免费下载

CHKDCL6907是针对电磁炉完整解决方案而设计的- 款MCU。集成了SH6610D CPU内核、....
发表于 09-06 08:00 85次 阅读
CHKDCL6907电磁炉专用单片机的数据手册免费下载

使用51单片机设计的电子时钟程序免费下载

本文档的主要内容详细介绍的是使用51单片机设计的电子时钟程序免费下载。
发表于 09-05 17:03 68次 阅读
使用51单片机设计的电子时钟程序免费下载

MPU6050三轴陀螺角速度传感器的计算角度程序免费下载

本文档的主要内容详细介绍的是MPU6050三轴陀螺角速度传感器的计算角度程序免费下载。
发表于 09-05 16:37 59次 阅读
MPU6050三轴陀螺角速度传感器的计算角度程序免费下载

单片机执行程序的全过程介绍

一般计算机进行工作时,首先要通过外部设备把程序和数据通过输入接口电路和数据总线送入到存储器,然后逐条....
发表于 09-05 15:03 228次 阅读
单片机执行程序的全过程介绍

海信TF29R08N机芯应该如何才能进入总线详细方法说明

 G2大屏幕机芯由型号为TMPA8873的G2芯片组成,属于海信专用掩膜芯片,内部已写入程序。
发表于 09-05 08:00 34次 阅读
海信TF29R08N机芯应该如何才能进入总线详细方法说明