常见的信号处理滤波方法

1、低通滤波：又叫一阶惯性滤波，或一阶低通滤波。是使用软件编程实现普通硬件RC低通滤波器的功能。 适用范围：单个信号，有高频干扰信号。一阶低通滤波的算法公式为：式中：是滤波系数；是本次采样值；是上次滤波输出值；是本次滤波输出值。滤波效果1：红色线是滤波前数据（matlab中生成的正弦波加高斯白噪声信号）黄色线是滤波后结果。滤波效果2：matlab中函数，相当于一阶滤波，蓝色是原始数据（GPS采集到的x（北）方向数据，单位m），红色是滤波结果。一阶滤波算法的不足：一阶滤波无法完美地兼顾灵敏度和平稳度。有时，我们只能寻找一个平衡，在可接受的灵敏度范围内取得尽可能好的平稳度。互补滤波：适用于两种传感器进

2、行融合的场合。必须是一种传感器高频特性好（动态响应好但有累积误差，比如陀螺仪。），另一传感器低频特性好（动态响应差但是没有累积误差，比如加速度计）。他们在频域上互补，所以进行互补滤波融合可以提高测量精度和系统动态性能。应用：陀螺仪数据和加速度计数据的融合。互补滤波的算法公式为：式中：和是滤波系数；和是本次采样值；是上次滤波输出值；是本次滤波输出值。滤波效果（测试数据）：蓝色是陀螺仪信号，红色是加速度计信号，黄色是滤波后的角度。互补滤波实际效果：卡尔曼滤波：卡尔曼滤波器是一个“optimal recursive data processing algorithm（最优化自回归数据处理算法）”。对

3、于解决很大部分的问题，它是最优，效率最高甚至是最有用的。他的广泛应用已经超过30年，包括机器人导航，控制，传感器数据融合甚至在军事方面的雷达系统以及导弹追踪等等。近来更被应用于计算机图像处理，例如头脸识别，图像分割，图像边缘检测。首先，用于测量的系统必须是线性的。是系统k时刻的状态，是系统k时刻的控制量。是系统k时刻的测量值。和为系统参数，和分别表示过程和测量的噪声，是测量系统参数。在进行卡尔曼滤波时：首先进行先验预测：计算先验预测方差：计算增益矩阵：后验估计值：后验预测方差：其中，是系统过程激励噪声协方差，是测量噪声协方差。举例说明：（下文中加粗的是专有名词，需要理解）预测小车的位置和速度的

4、例子（博客+自己理解）:小车上面安装了GPS传感器，这个传感器的精度是10米。但是如果小车行驶的荒野上面有河流和悬崖的话，10米的范围就太大，很容易掉进去进而无法继续工作。所以，单纯靠GPS的定位是无法满足需求的。另外，如果有人说小车本身接收操控着发送的运动指令，根据车轮所转动过的圈数时能够知道它走了多远，但是方向未知，并且在路上小车打滑车轮空转的现象绝对是不可避免。所以，GPS以及车轮上面电机的码盘等传感器是间接地为我们提供了小车的信息，这些信息包含了很多的和不确定性。如果将所有这些信息综合起来，就能够通过计算得到我们想要的准确信息小车的状态向量可以写为：。协方差，一般初始化为第一步：根据k

5、-1时刻的状态来预测k时刻的状态，有（上次位置+上次速度估计*=当前位置先验估计）（认为速度不变）写成矩阵形式：（先验状态估计向量），令表示系统固有特性参数（这个名词是我生造的，便于理解）矩阵。(先验状态估计协方差矩阵)（有数学推导过程，是和概率论和矩阵协方差相关的内容，还在研究中）第二步：确定外部控制影响比如在k-1时刻给小车发送了刹车指令，假设刹车加速度为（），（第一步结果+刹车导致的位移）（上次速度+本次控制加速度*=当前速度先验估计）结合第一步，写成矩阵形式，令表示控制矩阵，令表示控制向量。第三步：确定外部不确定性影响。假设不确定干扰项为，成高斯分布，协方差为，称为过程激励噪声协方差，

6、那么结合前两步，得到（先验状态估计向量）。(先验状态估计协方差矩阵)前三步属于先验估计，进行一个简单总结：从前三步看出：先验估计，分为三个部分，一是上一次的最优估计，二是这一次的控制量，三是这一次的不确定性影响，假定不确定性影响成高斯分布。先验估计协方差矩阵，根据前一次的后验估计的协方差进行递推，再加上这次先验估计的不确定对系统造成的影响。第四步，确定测量系统参数。 。是只考虑测量单位换算后的测量结果。传感器的输出值不一定与状态向量中的元素对等，需要进行换算。例如测量到的气压换算成高度。但在本例中，传感器直接测量到了小车的位移和速度，所以不需要进行换算，这时，是单位矩阵。的维数取决于状态向量元

7、素个数和观测量的个数，不一定是方阵。如果在本例中只测量了速度，那么。同理，只测量位移，那么，这时，如果测量的位移单位是mm，而状态向量中位移单位是m，那么第五步，确定测量系统噪声和其测量噪声协方差。传感器测量会有一定误差，假定误差量符合高斯分布。观测噪声向量用表示，其测量噪声协方差用表示。那么测量值可以表示为：，是考虑测量单位和测量误差之后的测量结果。（关于协方差的定义及数学意义，可以查阅第四到五步是传感器的测量结果，进行一个简单的总结测量值，分为两个部分，第一部分是考虑单位换算得到的测量值，第二部分是引入的测量误差，该测量误差成高斯分布，其协方差是（测量噪声协方差）。第六步：卡尔曼估计。确定卡尔曼增益：（描述“更相信由前一状态和控制量得到的估计还是更相信当