CN112697122A - 基于数字带阻滤波的降噪方法、系统及石英音叉陀螺 - Google Patents
基于数字带阻滤波的降噪方法、系统及石英音叉陀螺 Download PDFInfo
- Publication number
- CN112697122A CN112697122A CN202011437330.9A CN202011437330A CN112697122A CN 112697122 A CN112697122 A CN 112697122A CN 202011437330 A CN202011437330 A CN 202011437330A CN 112697122 A CN112697122 A CN 112697122A
- Authority
- CN
- China
- Prior art keywords
- tuning fork
- quartz tuning
- filtering
- fork gyroscope
- time
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Images
Landscapes
- Gyroscopes (AREA)
Abstract
本发明涉及石英音叉陀螺仪降噪技术领域，公开了一种基于数字带阻滤波的降噪方法、系统及石英音叉陀螺。该方法用于石英音叉陀螺，其中，该方法包括：确定石英音叉陀螺的频差点频率和带阻滤波宽度；根据频差点频率和带阻滤波宽度确定二阶带阻滤波器的滤波参数；利用二阶带阻滤波器根据滤波参数对石英音叉陀螺的原始输出进行滤波降噪，得到石英音叉陀螺降噪后的输出。由此，可以很好的消除陀螺在振动环境下的高频噪声，从而提高陀螺的测量精度。
Description
技术领域
本发明涉及石英音叉陀螺仪降噪技术领域，尤其涉及一种基于数字带阻滤波的降噪方法、系统及石英音叉陀螺。
背景技术
由于石英音叉陀螺的驱动频率和检测频率之间存在一定的差值(以下简称：频差)，在频差对应的频率点噪声值会十倍甚至数百倍会放大，严重影响陀螺的测量精度。目前石英音叉陀螺仪数字降噪都是基于低通滤波器进行设计的，降噪效果不明显。在静态条件下，频差引起的误差可以忽略不计，但在振动环境下，频差引起噪声幅值会很大，严重影响陀螺的测量精度，所以必须要对噪声误差变大进行进一步的降噪处理。
发明内容
本发明的目的在于克服现有技术不足，提供了一种基于数字带阻滤波的降噪方法、系统及石英音叉陀螺，能够解决上述现有技术中的问题。
本发明的技术解决方案：一种基于数字带阻滤波的降噪方法，该方法用于石英音叉陀螺，其中，该方法包括：
确定石英音叉陀螺的频差点频率和带阻滤波宽度；
根据频差点频率和带阻滤波宽度确定二阶带阻滤波器的滤波参数；
利用二阶带阻滤波器根据滤波参数对石英音叉陀螺的原始输出进行滤波降噪，得到石英音叉陀螺降噪后的输出。
优选地，通过下式利用二阶带阻滤波器根据滤波参数对石英音叉陀螺的原始输出进行滤波降噪，得到石英音叉陀螺降噪后的输出：
其中，a0、a1、a2、a3、a4、b1、b2、b3、b4为滤波参数，y(k)、y(k-1)、y(k-2)、y(k-3)、y(k-4)分别为k时刻、k-1时刻、k-2时刻、k-3时刻、k-4时刻石英音叉陀螺降噪后的输出，x(k)、x(k-1)、x(k-2)、x(k-3)、x(k-4)分别为k时刻、k-1时刻、k-2时刻、k-3时刻、k-4时刻石英音叉陀螺的原始输出。
本发明还提供了一种基于数字带阻滤波的降噪系统，该系统用于石英音叉陀螺，其中，该系统包括：
第一参数确定模块，用于确定石英音叉陀螺的频差点频率和带阻滤波宽度；
第二参数确定模块，用于根据频差点频率和带阻滤波宽度确定二阶带阻滤波器的滤波参数；
二阶带阻滤波器，用于根据滤波参数对石英音叉陀螺的原始输出进行滤波降噪，得到石英音叉陀螺降噪后的输出。
优选地，通过下式根据滤波参数对石英音叉陀螺的原始输出进行滤波降噪，得到石英音叉陀螺降噪后的输出：
其中，a0、a1、a2、a3、a4、b1、b2、b3、b4为滤波参数， y(k)、y(k-1)、y(k-2)、y(k-3)、y(k-4)分别为k时刻、k-1时刻、k-2时刻、k-3时刻、k-4时刻石英音叉陀螺降噪后的输出，x(k)、x(k-1)、x(k-2)、x(k-3)、x(k-4)分别为k时刻、k-1时刻、k-2时刻、k-3时刻、k-4时刻石英音叉陀螺的原始输出。
本发明还提供了一种石英音叉陀螺，其中，包括上述的基于数字带阻滤波的降噪系统。
通过上述技术方案，可以将二阶带阻滤波器加入到石英音叉陀螺组合的误差补偿中，且根据陀螺本身频差的特点确定对应的滤波参数，应用此方法可以很好的消除陀螺在振动环境下的高频噪声，从而提高陀螺的测量精度。
附图说明
所包括的附图用来提供对本发明实施例的进一步的理解，其构成了说明书的一部分，用于例示本发明的实施例，并与文字描述一起来阐释本发明的原理。显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。
图1为本发明实施例提供的一种基于数字带阻滤波的降噪方法的流程图。
具体实施方式
下面将结合附图对本发明的具体实施例进行详细说明。在下面的描述中，出于解释而非限制性的目的，阐述了具体细节，以帮助全面地理解本发明。然而，对本领域技术人员来说显而易见的是，也可以在脱离了这些具体细节的其它实施例中实践本发明。
在此需要说明的是，为了避免因不必要的细节而模糊了本发明，在附图中仅仅示出了与根据本发明的方案密切相关的设备结构和/或处理步骤，而省略了与本发明关系不大的其他细节。
图1为本发明实施例提供的一种基于数字带阻滤波的降噪方法的流程图。
如图1所示，本发明实施例提供了一种基于数字带阻滤波的降噪方法，该方法用于石英音叉陀螺，其中，该方法包括：
S100，确定石英音叉陀螺的频差点频率和带阻滤波宽度；
S102，根据频差点频率和带阻滤波宽度确定二阶带阻滤波器的滤波参数；
S104，利用二阶带阻滤波器根据滤波参数对石英音叉陀螺的原始输出进行滤波降噪，得到石英音叉陀螺降噪后的输出。
通过上述技术方案，可以将二阶带阻滤波器加入到石英音叉陀螺组合的误差补偿中，且根据陀螺本身频差的特点确定对应的滤波参数，应用此方法可以很好的消除陀螺在振动环境下的高频噪声，从而提高陀螺的测量精度。
其中，石英音叉陀螺的频差点频率可以通过实际测量获得，也可以根据经验设定，带阻滤波宽度也可以根据经验设定。
根据本发明一种实施例，通过下式利用二阶带阻滤波器根据滤波参数对石英音叉陀螺的原始输出进行滤波降噪，得到石英音叉陀螺降噪后的输出：
其中，a0、a1、a2、a3、a4、b1、b2、b3、b4为滤波参数， y(k)、y(k-1)、y(k-2)、y(k-3)、y(k-4)分别为k时刻、k-1时刻、k-2时刻、k-3时刻、k-4时刻石英音叉陀螺降噪后的输出，x(k)、x(k-1)、x(k-2)、x(k-3)、x(k-4)分别为k时刻、k-1时刻、k-2时刻、k-3时刻、k-4时刻石英音叉陀螺的原始输出。
也就是，可以将确定的滤波参数带入式(1)得到石英音叉陀螺降噪后的输出。
在本发明中，上述式(1)为式(2)所示的二阶带阻滤波器的传递函数的实现形式，传递函数为：
本发明实施例还提供了一种基于数字带阻滤波的降噪系统，该系统用于石英音叉陀螺，其中，该系统包括：
第一参数确定模块，用于确定石英音叉陀螺的频差点频率和带阻滤波宽度；
第二参数确定模块，用于根据频差点频率和带阻滤波宽度确定二阶带阻滤波器的滤波参数；
二阶带阻滤波器，用于根据滤波参数对石英音叉陀螺的原始输出进行滤波降噪，得到石英音叉陀螺降噪后的输出。
其中，二阶带阻滤波器可以为二阶巴特沃斯带阻滤波器。
通过上述技术方案，可以将二阶带阻滤波器加入到石英音叉陀螺组合的误差补偿中，且根据陀螺本身频差的特点确定对应的滤波参数，应用此方法可以很好的消除陀螺在振动环境下的高频噪声，从而提高陀螺的测量精度。
根据本发明一种实施例，通过下式根据滤波参数对石英音叉陀螺的原始输出进行滤波降噪，得到石英音叉陀螺降噪后的输出：
其中，a0、a1、a2、a3、a4、b1、b2、b3、b4为滤波参数， y(k)、y(k-1)、y(k-2)、y(k-3)、y(k-4)分别为k时刻、k-1时刻、k-2时刻、k-3时刻、k-4时刻石英音叉陀螺降噪后的输出，x(k)、x(k-1)、x(k-2)、x(k-3)、x(k-4)分别为k时刻、k-1时刻、k-2时刻、k-3时刻、k-4时刻石英音叉陀螺的原始输出。
本发明实施例还提供了一种石英音叉陀螺，包括上述实施例中的基于数字带阻滤波的降噪系统。
下面结合实例对本发明所述的基于数字带阻滤波的降噪方法和系统进行描述。
在该实例中，确定的石英音叉陀螺的频差点频率可以为350Hz，确定的石英音叉陀螺的带阻滤波宽度可以为100Hz。
通过频差点频率和带阻滤波宽度可以计算得到二阶带阻滤波器的滤波参数为a0＝0.6389455,a1＝-1.2200125,a2＝1.8602687,a3＝-1.2200125,a4＝0.6389455， b1＝-1.5003139,b2＝1.7253582,b3＝-0.9397110,b4＝0.4128016。
通过将确定的滤波参数带入式(1)可以得到石英音叉陀螺降噪后的输出，如下所示：
y(k)＝0.6389455x(k)-1.2200125x(k-1)+1.8602687x(k-2)-1.2200125x(k-3)+0.6389455x(k-4) -(-1.5003139y(k-1)+1.7253582y(k-2)-0.939711y(k-3)+0.4128016y(k-4))
从上述实施例可以看出，本发明所述的基于数字带阻滤波的降噪方法和系统在陀螺的频差点进行定点带阻滤波，从而可以明显降低陀螺在力学振动环境下的输出噪声。
如上针对一种实施例描述和/或示出的特征可以以相同或类似的方式在一个或更多个其它实施例中使用，和/或与其它实施例中的特征相结合或替代其它实施例中的特征使用。
应该强调，术语“包括/包含”在本文使用时指特征、整件、步骤或组件的存在，但并不排除一个或更多个其它特征、整件、步骤、组件或其组合的存在或附加。
本发明以上的装置和方法可以由硬件实现，也可以由硬件结合软件实现。本发明涉及这样的计算机可读程序，当该程序被逻辑部件所执行时，能够使该逻辑部件实现上文所述的装置或构成部件，或使该逻辑部件实现上文所述的各种方法或步骤。本发明还涉及用于存储以上程序的存储介质，如硬盘、磁盘、光盘、DVD、flash存储器等。
这些实施例的许多特征和优点根据该详细描述是清楚的，因此所附权利要求旨在覆盖这些实施例的落入其真实精神和范围内的所有这些特征和优点。此外，由于本领域的技术人员容易想到很多修改和改变，因此不是要将本发明的实施例限于所例示和描述的精确结构和操作，而是可以涵盖落入其范围内的所有合适修改和等同物。
本发明未详细说明部分为本领域技术人员公知技术。
Claims (5)
1.一种基于数字带阻滤波的降噪方法，该方法用于石英音叉陀螺，其特征在于，该方法包括：
确定石英音叉陀螺的频差点频率和带阻滤波宽度；
根据频差点频率和带阻滤波宽度确定二阶带阻滤波器的滤波参数；
利用二阶带阻滤波器根据滤波参数对石英音叉陀螺的原始输出进行滤波降噪，得到石英音叉陀螺降噪后的输出。
2.根据权利要求1所述的方法，其特征在于，通过下式利用二阶带阻滤波器根据滤波参数对石英音叉陀螺的原始输出进行滤波降噪，得到石英音叉陀螺降噪后的输出：
其中，α0、α1、α2、a3、a4、b1、b2、b3、b4为滤波参数，y(k)、y(k-1)、y(k-2)、y(k-3)、y(k-4)分别为k时刻、k-1时刻、k-2时刻、k-3时刻、k-4时刻石英音叉陀螺降噪后的输出，x(k)、x(k-1)、x(k-2)、x(k-3)、x(k-4)分别为k时刻、k-1时刻、k-2时刻、k-3时刻、k-4时刻石英音叉陀螺的原始输出。
3.一种基于数字带阻滤波的降噪系统，该系统用于石英音叉陀螺，其特征在于，该系统包括：
第一参数确定模块，用于确定石英音叉陀螺的频差点频率和带阻滤波宽度；
第二参数确定模块，用于根据频差点频率和带阻滤波宽度确定二阶带阻滤波器的滤波参数；
二阶带阻滤波器，用于根据滤波参数对石英音叉陀螺的原始输出进行滤波降噪，得到石英音叉陀螺降噪后的输出。
4.根据权利要求3所述的系统，其特征在于，通过下式根据滤波参数对石英音叉陀螺的原始输出进行滤波降噪，得到石英音叉陀螺降噪后的输出：
其中，α0、α1、α2、a3、α4、b1、b2、b3、b4为滤波参数，y(k)、y(k-1)、y(k-2)、y(k-3)、y(k-4)分别为k时刻、k-1时刻、k-2时刻、k-3时刻、k-4时刻石英音叉陀螺降噪后的输出，x(k)、x(k-1)、x(k-2)、x(k-3)、x(k-4)分别为k时刻、k-1时刻、k-2时刻、k-3时刻、k-4时刻石英音叉陀螺的原始输出。
5.一种石英音叉陀螺，其特征在于，包括权利要求3或4所述的基于数字带阻滤波的降噪系统。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202011437330.9A CN112697122A (zh) | 2020-12-10 | 2020-12-10 | 基于数字带阻滤波的降噪方法、系统及石英音叉陀螺 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202011437330.9A CN112697122A (zh) | 2020-12-10 | 2020-12-10 | 基于数字带阻滤波的降噪方法、系统及石英音叉陀螺 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN112697122A true CN112697122A (zh) | 2021-04-23 |
Family
ID=75507222
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202011437330.9A Pending CN112697122A (zh) | 2020-12-10 | 2020-12-10 | 基于数字带阻滤波的降噪方法、系统及石英音叉陀螺 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN112697122A (zh) |
Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20060096374A1 (en) * | 2003-06-30 | 2006-05-11 | Siemens Aktiengesellscherplatz 2 | Rotation rate sensor comprising a vibration gyroscope |
| CN106525015A (zh) * | 2015-09-09 | 2017-03-22 | 精工爱普生株式会社 | 物理量检测系统、电子设备以及移动体 |
| US20180017388A1 (en) * | 2015-01-26 | 2018-01-18 | Atlantic Inertial Systems Limited | Gyroscope loop filter |
| CN111024056A (zh) * | 2019-12-19 | 2020-04-17 | 西北工业大学 | 一种高动态输入的mems陀螺带宽扩展闭环控制方法 |
-
2020
- 2020-12-10 CN CN202011437330.9A patent/CN112697122A/zh active Pending
Patent Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20060096374A1 (en) * | 2003-06-30 | 2006-05-11 | Siemens Aktiengesellscherplatz 2 | Rotation rate sensor comprising a vibration gyroscope |
| US20180017388A1 (en) * | 2015-01-26 | 2018-01-18 | Atlantic Inertial Systems Limited | Gyroscope loop filter |
| CN106525015A (zh) * | 2015-09-09 | 2017-03-22 | 精工爱普生株式会社 | 物理量检测系统、电子设备以及移动体 |
| CN111024056A (zh) * | 2019-12-19 | 2020-04-17 | 西北工业大学 | 一种高动态输入的mems陀螺带宽扩展闭环控制方法 |
Non-Patent Citations (5)
| Title |
|---|
| 万彦辉等: "数字滤波器在微机械陀螺系统中的应用", 《传感器技术》 * |
| 余学飞 等: "《现代医学电子仪器原理与设计》", 31 December 2018, 华南理工大学出版社 * |
| 杨娟等: "基于DSP的MEMS陀螺去噪算法研究", 《电子测量技术》 * |
| 蔡杏山: "《电气自动化工程师自学宝典（提高篇）》", 30 April 2020, 机械工业出版社 * |
| 陶晋等: "石英音叉陀螺数字电路的算法设计研究", 《仪表技术与传感器》 * |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US9106208B2 (en) | Switched-capacitor band-pass filter of a discrete-time type, in particular for cancelling offset and low-frequency noise of switched-capacitor stages | |
| JP2015511330A (ja) | 適応型ノイズ除去方法及び装置 | |
| Kopparapu et al. | Identifying optimal Gaussian filter for Gaussian noise removal | |
| JP2017199948A5 (zh) | ||
| JP5253020B2 (ja) | 像振れ補正装置およびその制御方法 | |
| JP6204807B2 (ja) | 像振れ補正装置及びその制御方法、プログラム、記憶媒体 | |
| US20210287650A1 (en) | Digital filter, audio signal processing system, and method of designing digital filter | |
| CN113156163B (zh) | 用于改善mem加速度计的频率响应的方法和装置 | |
| JP2015105975A5 (zh) | ||
| CN112697122A (zh) | 基于数字带阻滤波的降噪方法、系统及石英音叉陀螺 | |
| CN110988399A (zh) | 加速度计补偿方法 | |
| CN103940447A (zh) | 一种基于自适应数字滤波器的系泊状态初始对准方法 | |
| CN109186571B (zh) | 一种陀螺仪滤波去噪方法 | |
| CN106525015B (zh) | 物理量检测系统、电子设备以及移动体 | |
| JP5906397B2 (ja) | 慣性力センサ | |
| JP2019117999A (ja) | ノイズ除去フィルタ装置及びノイズ除去方法 | |
| CN111294014B (zh) | 一种信号积分去偏差方法及其系统、电子设备 | |
| CN108490792A (zh) | 一种基于耳机插孔信号提取的硬盘音频振动自适应前馈控制方法 | |
| CN115420398A (zh) | 一种温度传感器和温度确定方法 | |
| CN112067927B (zh) | 中高频振荡检测方法及装置 | |
| Kopparapu et al. | Optimal Gaussian Filter for Effective Noise Filtering | |
| CN108199697B (zh) | 一种声表面波滤波器及其实现方法 | |
| CN111189447A (zh) | 一种位置测量惯性导航系统的低通滤波方法 | |
| JP2014173918A (ja) | 物理量センサー、電子機器、移動体及び物理量センサーの温度特性調整方法 | |
| CN116449051B (zh) | 加速度传感器的标定方法、装置及电子设备 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| RJ01 | Rejection of invention patent application after publication |
Application publication date: 20210423 |
|
| RJ01 | Rejection of invention patent application after publication |