https://blog.csdn.net/qq295109601/article/details/78778835
加速度计滤波实验参数:
采样频率Fs=250Hz 截止频率Cutoff Frequency | 未开电机静止 | 开电机悬停 | 未开电机转动飞控 |
原始输出(Raw) | 260 Hz | 260Hz | 260Hz |
MPU6050内部(LPF) | 94 Hz | 94 Hz | 94 Hz |
2阶(Butterworth) | 30 Hz | 30 Hz | 30 Hz |
8深度窗口滑动(Window) | N/A | N/A | N/A |
数据分析 | 4组画图对比(A) | 4组画图对比(C) | 4组画图对比(F) |
4组FFT变换(B) | 4组FFT变换(D) | N/A | |
8组 RMSE (E) | N/A |
说明:
1. 所有数据来源于MPU6050,单片机采样周期为4ms,即采样频率Fs=250Hz
2. 开电机悬停:绑住对角机臂,四电机同时打开,解开绳索飞行器可在空中飞行不掉下。由于没有快速无线数传,所以没有测试实际飞行悬停加速度计输出,因此该测试结果只近似做参考。
3. 原始输出Raw:根据芯片手册配置,低通滤波器最大带宽为260Hz,即截止频率为260Hz。近似可看成原始加速度计输出
4. MPU6050内部LPF:根据芯片手册配置,LPF这里选择94Hz,用于测试内部LPF性能
5. 2阶Butterworth:截止频率选择为30Hz,对Raw进行滤波
6. 8深度窗口滑动:目前四轴上广泛使用的平均滑动滤波,深度为8,对Raw进行滤波
测试结果(以下“>”表示:“性能好于”):
A(未开电机静止):
结论:
静态平滑性能:窗口滑动>Butterworth>LPF>Raw
B(未开电机静止):
结论:
1. 从Raw的FFT变换结果可以看出静态时的加速度计类似白噪声,其振幅平均分布在Fs/2上
2. LPF的结果不尽如人意。LPF的截止频率为94Hz,理应在94Hz处有较大的幅值下降,但是这种幅值变化的不明显,由此可见MPU6050内置的LPF性能有待改进
3. 2阶Butterworth滤波器效果就好很多,在30Hz以前和Raw的频谱大致相同,接着在30Hz出现大幅度的幅值衰减,说明滤波器起到了效果
4. 窗口平均滑动滤波出现了匪夷所思的现象,这种幅值衰减特别有规律!鉴于笔者信号分析学的很烂,这里就不展开了。
5. 其实从窗口滑动滤波的FFT结果就可以看出来效果了,简单的平均滤波效果在频谱上确实有不错的效果,至少比内置的LPF效果要好。如果在四轴同时应用了LPF和窗口平均滑动,那么效果会更好
C(开电机悬停):
结论:
打开电机之后,结果同静态平滑性能:窗口滑动>Butterworth>LPF>Raw
D(开电机悬停):
结论:
1. 从Raw的FFT变换结果可以看出打开电机时的加速度计与静止时的结果有了明显不同:首先是振幅有了明显的变化,从原先的200~600,到现在的10000~60000,这是由于打开电机后的机械震动引起的巨大振幅;其次就是频率分布,可以清楚地看到在40Hz和90Hz附近有较大的振幅分布,说明机械震动产生的信号频率大多数分布在这两个频率范围附近,而这种频率附近的信号我们是不需要的,这也就是说:我们要采用某种滤波器,至少在40Hz或者90Hz处截止,高于该频率的信号一律屏蔽。
2. LPF的结果很奇怪。在低频阶段0~40Hz的振幅极小,反而在100Hz处有较大的幅值分布,看起来就像是高通滤波器,而不像是低通滤波器。虽然设置的LPF在94Hz截止,但是在94Hz后面仍然有较大的震动信号出现,再次证明了MPU6050内置的LPF的效果确实不怎么令人满意
3. 2阶Butterworth滤波器效果比LPF效果好很多。在打开电机后,可以看到在30Hz之前的信号频谱和Raw的分布基本一致,说明保留了真实的信号输出。而在30Hz以后,其信号的幅值有了大幅度的明显衰减,有效的滤掉了高频的电机震动引起的干扰信号
4. 对于窗口平均滑动滤波依旧出现了匪夷所思的现象。这种有规律的频谱实在是看不懂,不过在低频段和原始输出保持一致,而在高频部分也有效的抑制了电机产生的震动信号。所以这种方法应用在四轴上的加速度计滤波是可以的,至少比内部LPF效果要好。
E(8组 RMSE):
这个图很有意思,RMSE(Root-Mean-Square-Error)均方根误差,常用来表征估计的准确程度。RMSE越小说明精度越高,这里由于是静止测试和开电机悬停测试,所以这里的RMSE用来表示数据的平滑性。
结论:
无论开电机与否,数据平滑性性能:窗口滑动>Butterworth>LPF>Raw
F(未开电机转动):
该测试用来比较Butterworth和窗口滑动滤波的延迟特性
结论:
数据平滑性性能指标:窗口滑动>Butterworth>Raw
为了更加清楚的看到延迟特性,下图放大Y轴在980次采样点的三条输出曲线:
结论:
数据延迟性能特性:Raw>Butterworth>窗口滑动,也就是说Butterworth滤波延迟小于8深度的窗口滑动滤波。
最后总结:
1. 尽量不要用MPU6050内置的LPF滤波。虽然相比于原始加速度计输出,该LPF可以平滑输出,但是在FFT频谱上的表现相当差劲。
2. 广泛使用的窗口平均滑动滤波无论在FFT还是RMSE表现上都有不错的表现,所以一般基础应用(低速运动或四轴初学者)采用窗口平均滤波是比较明智的选择。
3. 想要达到更好的滤波效果,FIR或者IIR滤波器是更好的选择。笔者测试2阶30Hz的Butterworth滤波器虽然在平滑性RMSE只比窗口平均滑动差了一点(但是比LPF要好),但是数据实时性性能指标上比前者响应速度提高了近一倍。因此在制作四轴的进阶阶段,可以考虑将窗口平均滑动换成Butterworth滤波器。
欢迎使用Markdown编辑器
你好! 这是你第一次使用 Markdown编辑器 所展示的欢迎页。如果你想学习如何使用Markdown编辑器, 可以仔细阅读这篇文章,了解一下Markdown的基本语法知识。
新的改变
我们对Markdown编辑器进行了一些功能拓展与语法支持,除了标准的Markdown编辑器功能,我们增加了如下几点新功能,帮助你用它写博客:
- 全新的界面设计 ,将会带来全新的写作体验;
- 在创作中心设置你喜爱的代码高亮样式,Markdown 将代码片显示选择的高亮样式 进行展示;
- 增加了 图片拖拽 功能,你可以将本地的图片直接拖拽到编辑区域直接展示;
- 全新的 KaTeX数学公式 语法;
- 增加了支持甘特图的mermaid语法1 功能;
- 增加了 多屏幕编辑 Markdown文章功能;
- 增加了 焦点写作模式、预览模式、简洁写作模式、左右区域同步滚轮设置 等功能,功能按钮位于编辑区域与预览区域中间;
- 增加了 检查列表 功能。
功能快捷键
撤销:Ctrl/Command + Z
重做:Ctrl/Command + Y
加粗:Ctrl/Command + B
斜体:Ctrl/Command + I
标题:Ctrl/Command + Shift + H
无序列表:Ctrl/Command + Shift + U
有序列表:Ctrl/Command + Shift + O
检查列表:Ctrl/Command + Shift + C
插入代码:Ctrl/Command + Shift + K
插入链接:Ctrl/Command + Shift + L
插入图片:Ctrl/Command + Shift + G
合理的创建标题,有助于目录的生成
直接输入1次#,并按下space后,将生成1级标题。
输入2次#,并按下space后,将生成2级标题。
以此类推,我们支持6级标题。有助于使用TOC
语法后生成一个完美的目录。
如何改变文本的样式
强调文本 强调文本
加粗文本 加粗文本
标记文本
删除文本
引用文本
H2O is是液体。
210 运算结果是 1024.
插入链接与图片
链接: link.
图片:
带尺寸的图片:
居中的图片:
居中并且带尺寸的图片:
当然,我们为了让用户更加便捷,我们增加了图片拖拽功能。
如何插入一段漂亮的代码片
去博客设置页面,选择一款你喜欢的代码片高亮样式,下面展示同样高亮的 代码片
.
// An highlighted block
var foo = 'bar';
生成一个适合你的列表
- 项目
- 项目
- 项目
- 项目
- 项目1
- 项目2
- 项目3
- 计划任务
- 完成任务
创建一个表格
一个简单的表格是这么创建的:
项目 | Value |
---|---|
电脑 | $1600 |
手机 | $12 |
导管 | $1 |
设定内容居中、居左、居右
使用:---------:
居中
使用:----------
居左
使用----------:
居右
第一列 | 第二列 | 第三列 |
---|---|---|
第一列文本居中 | 第二列文本居右 | 第三列文本居左 |
SmartyPants
SmartyPants将ASCII标点字符转换为“智能”印刷标点HTML实体。例如:
TYPE | ASCII | HTML |
---|---|---|
Single backticks | 'Isn't this fun?' | ‘Isn’t this fun?’ |
Quotes | "Isn't this fun?" | “Isn’t this fun?” |
Dashes | -- is en-dash, --- is em-dash | – is en-dash, — is em-dash |
创建一个自定义列表
-
Markdown
- Text-to- HTML conversion tool Authors
- John
- Luke
如何创建一个注脚
一个具有注脚的文本。2
注释也是必不可少的
Markdown将文本转换为 HTML。
KaTeX数学公式
您可以使用渲染LaTeX数学表达式 KaTeX:
Gamma公式展示 Γ ( n ) = ( n − 1 ) ! ∀ n ∈ N \Gamma(n) = (n-1)!\quad\forall n\in\mathbb N Γ(n)=(n−1)!∀n∈N 是通过欧拉积分
Γ ( z ) = ∫ 0 ∞ t z − 1 e − t d t   . \Gamma(z) = \int_0^\infty t^{z-1}e^{-t}dt\,. Γ(z)=∫0∞tz−1e−tdt.
你可以找到更多关于的信息 LaTeX 数学表达式here.
新的甘特图功能,丰富你的文章
- 关于 甘特图 语法,参考 这儿,
UML 图表
可以使用UML图表进行渲染。 Mermaid. 例如下面产生的一个序列图::
这将产生一个流程图。:
- 关于 Mermaid 语法,参考 这儿,
FLowchart流程图
我们依旧会支持flowchart的流程图:
- 关于 Flowchart流程图 语法,参考 这儿.
导出与导入
导出
如果你想尝试使用此编辑器, 你可以在此篇文章任意编辑。当你完成了一篇文章的写作, 在上方工具栏找到 文章导出 ,生成一个.md文件或者.html文件进行本地保存。
导入
如果你想加载一篇你写过的.md文件或者.html文件,在上方工具栏可以选择导入功能进行对应扩展名的文件导入,
继续你的创作。
注脚的解释 ↩︎