常见的信号处理滤波方法

精品文档 1欢迎下载1欢迎下载1欢迎下载 低通滤波 又叫一阶惯性滤波 或一阶低通滤波 是使用软件编程实现普 通硬件 RC 低通滤波器的功能 适用范围 单个信号 有高频干扰信号 一阶低通滤波的算法公式为 Y n X n 1 Y n 1 式中 是滤波系数 是本次采样值 是上次滤波输出值 X n Y n 1 是本次滤波输出值 Y n 滤波效果 1 红色线是滤波前数据 matlab 中生成的正弦波加高斯白噪声信号 黄色线是滤波后结果 滤波效果 2 精品文档 2欢迎下载2欢迎下载2欢迎下载 05001000150020002500300035004000 5 0 5 10 15 20 25 30 x位置滤波前后对比 matlab 中函数 相当于一阶滤波 蓝色是原始数据 GPS 采集到的 x 北 方向数据 单位 m 红色是滤波结果 一阶滤波算法的不足 一阶滤波无法完美地兼顾灵敏度和平稳度 有时 我们只能寻找一个平衡 在可接受的灵敏度范围内取得尽可能好的平稳度 精品文档 3欢迎下载3欢迎下载3欢迎下载 互补滤波 适用于两种传感器进行融合的场合 必须是一种传感器高频特 性好 动态响应好但有累积误差 比如陀螺仪 另一传感器低频特性好 动态响应差但是没有累积误差 比如加速度计 他们在频域上互补 所以 进行互补滤波融合可以提高测量精度和系统动态性能 应用 陀螺仪数据和加速度计数据的融合 互补滤波的算法公式为 1122 Y n X n X n Y n 1 式中 和是滤波系数 和是本次采样值 是上次 1 2 1 X n 2 X n Y n 1 滤波输出值 是本次滤波输出值 Y n 滤波效果 测试数据 蓝色是陀螺仪 信号 红色是 加速度计信号 黄色是滤波后 的角度 精品文档 4欢迎下载4欢迎下载4欢迎下载 互补滤波实际效果 精品文档 5欢迎下载5欢迎下载5欢迎下载 精品文档 6欢迎下载6欢迎下载6欢迎下载 卡尔曼滤波 卡尔曼滤波器是一个 optimal recursive data processing algorithm 最优化自回归数据处理算法 对于解决很大部分的问题 它是 最优 效率最高甚至是最有用的 他的广泛应用已经超过 30 年 包括机器人导 航 控制 传感器数据融合甚至在军事方面的雷达系统以及导弹追踪等等 近 来更被应用于计算机图像处理 例如头脸识别 图像分割 图像边缘检测 首先 用于测量的系统必须是线性的 k k 1 k k XAXBUw k k k ZHXv 是系统 k 时刻的状态 是系统 k 时刻的控制量 是系统 k k X k U k Z 时刻的测量值 和为系统参数 和分别表示过程和测量的噪声 AB k w k v 是测量系统参数 H 在进行卡尔曼滤波时 首先进行先验预测 k 1 k k k k k XAXBUw 计算先验预测方差 k 1 k k k k PAPAQ 计算增益矩阵 k 1 k 1 k k 1 k k 1 KgPHHPHR 后验估计值 k 1 k 1 k 1 k k 1 Z k 1 k 1 k XXKgHX 后验预测方差 精品文档 7欢迎下载7欢迎下载7欢迎下载 k 1 k 1 1 k 1 k 1 k PKgH P 其中 是系统过程激励噪声协方差 是测量噪声协方差 k Q k R 举例说明 下文中加粗加粗的是专有名词 需要理解 预测小车的位置和速度的例子 博客 自己理解 小车上面安装了 GPS 传感器 这个传感器的精度是 10 米 但是如果小车行 驶的荒野上面有河流和悬崖的话 10 米的范围就太大 很容易掉进去进而无法 继续工作 所以 单纯靠 GPS 的定位是无法满足需求的 另外 如果有人说小 车本身接收操控着发送的运动指令 根据车轮所转动过的圈数时能够知道它走 了多远 但是方向未知 并且在路上小车打滑车轮空转的现象绝对是不可避免 所以 GPS 以及车轮上面电机的码盘等传感器是间接地为我们提供了小车的信 息 这些信息包含了很多的和不确定性 如果将所有这些信息综合起来 就能 够通过计算得到我们想要的准确信息 小车的状态向量状态向量可以写为 协方差协方差 一般初始化为 k xp v pppv vpvv P 10 01 第一步 根据 k 1 时刻的状态来预测 k 时刻的状态 有 上次位置 上次速度估计 当前位置先验估计 11kkk pptv t 认为速度不变 1kk vv 写成矩阵形式 精品文档 8欢迎下载8欢迎下载8欢迎下载 先验状态估计向量 令表示系系 1 1 01 kk t xx 1 01 t A 统固有特性参数统固有特性参数 这个名词是我生造的 便于理解 矩阵 先验状态估计协方差矩阵 有数学推导过程 是和概率 T kk PAP A 论和矩阵协方差相关的内容 还在研究中 第二步 确定外部控制影响 比如在 k 1 时刻给小车发送了刹车指令 假设刹车加速度为 a0 第一步结果 刹车导致的位移 2 11 1 2 kkk pptva t 上次速度 本次控制加速度 当前速度先验估计 1kk vva t t 结合第一步 写成矩阵形式 令表示控制矩阵控制矩阵 令 2 1 2 kk t xAxa t 2 2 t B t 表示控制向量控制向量 k ua 第三步 确定外部不确定性影响 假设不确定干扰项为 成高斯分布高斯分布 协方差为 称为过程激励过程激励 k w k w k Q 噪声协方差噪声协方差 那么结合前两步 得到 先验状态估计向量 1kkkk xAxBuw 先验状态估计协方差矩阵 T kkk PAP AQ 前三步属于先验估计先验估计 进行一个简单总结 精品文档 9欢迎下载9欢迎下载9欢迎下载 从前三步看出 先验估计 分为三个部分 一 1kkkk xAxBuw 是上一次的最优估计 二是这一次的控制量 三是这一次的不确定性影响 假 定不确定性影响成高斯分布 先验估计协方差矩阵 根 1 T kkk PAPAQ 据前一次的后验估计的协方差进行递推 再加上这次先验估计的不确定对系统 造成的影响 第四步 确定测量系统参数测量系统参数 H 是只考虑测量单位换算后的测量结果 kk zHx k z 传感器的输出值不一定与状态向量中的元素对等 需要进行换算 例如测 量到的气压换算成高度 但在本例中 传感器直接测量到了小车的位移和速度 所以不需要进行换算 这时 是单位矩阵 的维数取决于 10 01 H H 状态向量元素个数和观测量的个数 不一定是方阵 如果在本例中只测量了速 度 那么 同理 只测量位移 那么 这时 如 01H 10H 果测量的位移单位是 mm 而状态向量状态向量中位移单位是 m 那么 0 0010H 第五步 确定测量系统噪声测量系统噪声和其测量噪声协方差测量噪声协方差 k v k R 传感器测量会有一定误差 假定误差量符合高斯分布 观测噪声向量用 表示 其测量噪声协方差用表示 那么测量值可以表示为 k v k R k z 是考虑测量单位和测量误差之后的测量结果 k kk zHxv k z 关于协方差的定义及数学意义 可以查阅 covariance matrix 结合概率论 用图形表示 是介绍比较好的一个版本 精品文档 10欢迎下载10欢迎下载10欢迎下载 第四到五步是传感器的测量结果 进行一个简单的总结 测量值 分为两个部分 第一部分是考虑单位换算得 k kk zHxv 到的测量值 第二部分是引入的测量误差 该测量误差成高 k Hx k v k v 斯分布 其协方差是 测量噪声协方差 k R 第六步 卡尔曼估计 确定卡尔曼增益卡尔曼增益 描述 更相信由前一状态和控制量得到的估计还是K 更相信当前测量值 的变量 是一个矩阵 有数学推导过程 和概率论相关的内容 KPHHPHR 还在研究中 后验估计后验估计 最终估计结果