【分享帖】RM入门教学系列数字滤波器设计与实现（含代码）

Extreme · 2018-1-24 20:57:32

马上注册，玩转Robomaster！

您需要登录才可以下载或查看，没有帐号？立即注册

x

随着RoboMaster比赛的推广，不断有新的学校参与进来，有些同学因为刚接触比赛，缺乏实践经验，可能会遇到一些基础的技术问题。我们可能会陆续更新一些基础教程。今天给大家介绍一个实用技巧：利用MATLAB设计滤波器并在STM32平台上跑起来。

滤波器的重要作用不必多说，在传感器数据处理、电机控制、视觉算法中都会用到。这里举一个最简单的例子，对陀螺仪采集的数据进行低通滤波，从而达到去除噪声的作用。

1. 分析原数据
首先我们将MPU6500的陀螺仪数据带宽设置为250Hz，然后使用J-Scope采集静置时候的陀螺仪x轴的数据。可以看出角速度有幅度约为0.3°/s的跳动。（为了让J-Scope读到值，这里将原始数据乘以1000转化成整型了）

登录/注册后可看帖子

250Hz_s.png (16.2 KB, 下载次数: 0)

下载附件保存到相册

2018-1-24 21:23 上传

对数据进行FFT变换之后得到频谱图：

登录/注册后可看帖子

fft_250hz.png (74.93 KB, 下载次数: 1)

下载附件保存到相册

2018-1-24 21:24 上传

可以看出信号在250Hz之后有衰减，证明MPU6500确实有对原始adc采样数据做过滤波，但是效果不明显。

2. FDATool工具介绍
现在我们来自己设计一个低通滤波器。
首先打开MATLAB，在命令行窗口键入 fdatool，打开滤波器设计和分析工具（Filter Design & Analysis Tool），初始界面如下图所示：

登录/注册后可看帖子

fdatool_orig.png (65.59 KB, 下载次数: 0)

下载附件保存到相册

2018-1-24 21:24 上传

这是经典的MATLAB工具箱界面，第一行菜单栏，第二行工具栏，中间展示结果，最下方的功能区可以切换，默认的功能就是设置滤波器参数。这点英文肯定难不倒大家，随便点点看就能学会。

3. 设计滤波器
在设计滤波器界面，可以根据自己的需求选择滤波器类型、阶数、频率特性、幅度特性等参数。
例如我选择了切比雪夫Ⅱ型低通滤波器，采用Minimum order模式（根据频率、幅度指标自动选择最小阶数），设置采样频率（Fs）1000Hz，通带频率（Fpass）50Hz，阻带频率（Fstop）60Hz，衰减幅度保持默认。点击Design Filter按钮，一个滤波器就出来了。

登录/注册后可看帖子

fdatool_50Hz.png (83.92 KB, 下载次数: 0)

下载附件保存到相册

2018-1-24 21:23 上传

该滤波器是17阶的，点击工具栏的按钮可以看到该滤波器的详细特性，例如幅频、相频、群延时、零极点等等。蓝色线表示的幅频响应曲线，橙色线是相频响应曲线。可以看出切比雪夫Ⅱ型滤波器在通带内平滑，阻带内有等幅度纹波。

4. 转化和导出
FDATool默认生成的滤波器是二阶级联组成，这样的稳定性更高（尤其是滤波器阶数较高时），但是结构比较复杂，程序实现也不方便，一般将其转化成一阶级联型再使用，点击菜单栏的Edit->Convert to Single Section进行转换。至此，一个50Hz的切比雪夫Ⅱ型低通滤波器就完成了。
点击 Targets-> Generate C Header，将滤波器的系数存到.h文件中。然后我们可以进入C语言的部分了。

登录/注册后可看帖子

fdatool_gen.png (99.46 KB, 下载次数: 1)

下载附件保存到相册

2018-1-24 21:24 上传

登录/注册后可看帖子

coef.png (41.54 KB, 下载次数: 0)

下载附件保存到相册

2018-1-24 21:23 上传

5. C语言实现
把系数提取出来，然后把下面这个滤波器函数放到定时器中断或者数据接收中断处理函数里面，按照固定频率运行，即可输出滤波后的陀螺仪数据了。（具体原理再文章最后有介绍）

登录/注册后可看帖子

filter_c2.png (12.42 KB, 下载次数: 1)

下载附件保存到相册