[精品]卡尔曼滤波在单片机上的实现

与其它一些基于搜索的技术相比，该算法不但不需要任何 [14] [15] [16]估计误差准则，而且不用对多组fft 信号取平均 ，数据滤波 或者内插 。以kalman滤波为基本算法，结合试验分析卡尔曼滤波程序框图，通过估计系统噪声特征和修正量测方程卡尔曼滤波程序框图，改进了算法对加速度量测信号静态偏差变化的跟踪能力，提高了参考车速的估计精度。滤波器输出端的信号瞬时功率与噪声平均功率的比值最大的线性滤波器.其滤波器的传递函数形式是信号频谱的共轭.因此匹配滤波器对信号做两种处理：一、滤波器的相频特性与信号相频特性共轭,使得输出信号所有频率分量都在输出端同相叠加而形成峰值.二、按照信号的幅频特性对输入波形进行加权,以便最有效地接收信号能量而抑制干扰的输出功率.即当信号与噪声同时进入滤波器时,它使信号成分在某一瞬间出现尖峰值,而噪声成分受到抑制.匹配滤波器广泛用于雷达、声纳和通信.其作用是：一、提高信噪比.毫不夸张地说,任何电子系统都有匹配滤波或近似匹配滤波的环节,目的是提高信噪比.二、对于大时间带宽积信号,匹配滤波等效于脉冲压缩.因此可以提高雷达或声纳的距离分辨率和距离测量精度.在扩频通信中,可以实现解扩.。

一,‘一,〕滤波估计 污住一‘·巾污快 一召任 〔仅一孕亏一·下次预测 夕估计均方误差滤波预测计算机辅助计算模型的建立在实际工作中无信号模型研祥工控绍压十中考·。。一一一。电必,。,我们只能得到随机信号的观察估计信号模型及观察白北京,而。但可 由观察一,户一、。户一和‘ , 一 , ,已知,。是指是指一阶预测器的前向预测误差阶预测 器 的后 向预测误。户一一差沙噪声的方差用时间均值代替总体统计均值估计反射系数一艺” 二下芍竺七一—一。一‘,为预测器的预测误差 的方差,等于激励 白。·阶模型 的了户一。一户一一一一一考 一净一一面月州习户一万净一·按 自相关算法的递推公式估计和激励白噪声的功率犷轰,一 迄为。 ‘ 户,‘ 户一 , ,〔一递推高一阶模型的预测误差序列一一阶模型的系数,二尸‘,户一 , ,‘,‘ 户,‘,〕·,了户。”一一一。。一一‘ 户,,一·初始化计算采用。

一一。’一一责恩其程序框图见 图滤波增益根据实际情况或通过实验确定开始时的均方误差计算小于规定时。,估计的均方误差计算。,由式、、。、。、,当⋯。,停止计算,则卡尔曼滤波在单片机上的实现下面就以现卡尔曼滤波随机信号为例具体介绍在单片机如何实。的模型为、乏,秃一《电子技术应用》年第期一激励白噪声对式卜的方差为 嵘进行矢量化,令一,“刁。一「“一「 门一所以店几亏快一吞任快一快 壳一古〕一兮秃一无一占无 一亏无 掩一由下次预测式考习 “。亏得到, ,〕所以观 察和令所以随机 白噪声的协方差阵为,一“巨 “中一是信号与方差为 减 观察噪声的〕一’ ‘’飞一习一习‘’忍 “一‘ ’习形」所以落下一次观察值言其中二,污亏一应满足下式一。丫肠在 实 际 应 用 中按单 片机根据式计算即可得到考在手镯式数字血压计中我们采用了本方法取得了很好的效果是测量血压时脉膊信号在滤波前后的比较⋯ ⋯ ⋯⋯ ⋯ ⋯图滤波前后的比较参考文献杨福生等生物医学信号处理徐士 良语言常用算法程序集,将机 上 辅 助 计算得 到 的、值顺序制成表格固化在口输入中,从快,通过查表得到、,,程序框图见 图。

,图,可以看到滤波后的脉膊包络 比滤波前光滑⋯ ⋯滤波前。⋯了﹁︸。‘,‘,’〕一二无秃无’〕减〕可知增益矩 阵为由卡尔曼滤波滤波估计式‘尸一一﹁、护‘,它左月考滩必考乏一刀 乏差 一中亏秃一亏乏 泥一〕一秃左 一厂 弓一门一匕 忍一一瑞一〔哎竺 忌占‘’‘。」 」’〕‘一‘ ’’ 一忍‘一‘弓一一〔一一〕」⋯⋯ ⋯⋯ ⋯ ⋯ ⋯ ⋯滤波后初初始化‘‘,一、号罗‘·, ,·一‘,‘·,一‘·, ,按按式按按式求对求‘犷,一卜“按按式求· ·‘罗,·‘犷, ,初初始化言试试按按式求式按按式求式截截 一·高等教育出版社清华大学 出版社,,〕,飞一一收稿日期和一斗一一“一‘咔咔一咔咔一一一气于三合一微机原理教学实验系中文界面多窗口开发系统界面多窗口开发系统电子盘电公司,价格为元神一叫卜卜“ 一卜十州卜州卜翻叫卜图加 团 去估计《电子技术应用》模型年第困卡尔曼滤波在单片机上的实现期研祥工控魏臣北京