Interface 2015年4月号 第1部 第7章のプログラム

Dependencies:   USBDevice mbed

Information

FftTest - Interface 2015年4月号 第1部 第7章 のソフトウェア

Program for Section 7 in April 2015 issue of Interface
(Japanese electronics magazine)

概要

このプログラムは、

  • ハイパスフィルタ、ローパスフィルタ、ノッチフィルタ
    を行うFilterTestクラス、
  • FFT (256点)
    を行うFftTestクラス、
    波形をUSBシリアル通信でホストへ送信するmain関数で構成されています。

FilterTest.h, FilterTest.cpp

  • A-Dサンプリング - 1 kSPS
  • ハイパスフィルタ(遮断周波数 0.5 Hz、1次バターワース)
  • ローパスフィルタ(遮断周波数 30 Hz、2次バターワース)
  • ノッチフィルタ(中心周波数 50 Hz、2次)

FftTest.h, FftTest.cpp

  • 256点FFT演算 - クーリー-テューキー アルゴリズム 基数-2 時間間引き
  • ハン窓(ハニング窓)適用
  • パワー値計算
  • 振幅値計算
  • 振幅値正規化(実効値にスケーリング)

main.cpp

  • データ送信レート - 200 SPS
  • メインループ - ポーリングにより、サンプリング、フィルタ処理完了フラグがセットされたら、
    また、FFT完了フラグがセットされたらUSBシリアル通信経由で、ホストへ送信する

シリアル通信フォーマット

 (※)誌面ではパケットサイズ 64 byteとなっていますが、
    64 byteでは、PCのUSBドライバが 4096 byteまで保持し、波形が滑らかに描画できないため、
    Ver.1.0.2で、32 byteに変更しています。

  • 34byte固定長パケット方式
  • 波形データパケット、FFTパケットの2種類
波形データパケットFFTパケット
0x00パケットヘッダ(固定値0xAA)パケットヘッダ(固定値0xAA)
0x01データ種別ID(0x01: 波形データ)(0x02: FFTデータ)
0x02パケット番号(0 - 99繰り返し)レンジ(0: DC - 23 Hz, 1: 23 - 46 Hz, 2: 46 - 70 Hz)
0x03ペイロードサイズ(固定値30)ペイロードサイズ(固定値30)
0x04 - 0x21波形データ(short, big endian)FFTデータ(unsigned short, big endian)

Description

This contains FilterTest class, FftTest class and main function.

FilterTest class:

  • High pass filter, Low pass, Notch filter

FftTest class:

  • FFT (256 points)

Main function:

  • Send waveform and FFT data to host via USB serial class.

FilterTest.h, FilterTest.cpp

  • A-D sampling - 1 kSPS
  • High pass filter - Cut off frequency 0.5 Hz, first order butterworth
  • Low pass filter - Cut off frequency 30 Hz, second order butterworth
  • Notch filter - Center frequency 50 Hz, second order

FftTest.h, FftTest.cpp

  • 256 points FFT - Cooley-Tukey algorithm Radix-2 Decimation-In-Time
  • Apply Hann window
  • Calculate power spectrum
  • Calculate amplitude spectrum
  • Normalize amplitude

main.cpp

  • Data sending rate - 200 SPS
  • Main loop - sending waveform and FFT data via USB serial interface when detecting ready flag.

Packet format for USB serial interface

  • Packet size: 34 bytes(fixed)
  • Two types of packet, waveform packet and FFT packet
Waveform packetFFT packet
0x00Packet header (0xAA (fixed))Packet header (0xAA (fixed))
0x01Data type ID (0x01: Waveform ID)(0x02: FFT ID)
0x02Packet number (0 - 99)Range (0: DC - 23 Hz, 1: 23 - 46 Hz, 2: 46 - 70 Hz)
0x03Payload size (30 (fixed))Payload size (30 (fixed))
0x04 - 0x21Waveform data (short, big endian)FFT data (unsigned short, big endian)
Committer:
t_tatsuoka
Date:
Thu Jul 30 10:26:38 2015 +0000
Revision:
1:537eb14c5332
Parent:
0:9779b89a8820
Notch filter 60 Hz version

Who changed what in which revision?

UserRevisionLine numberNew contents of line
t_tatsuoka 0:9779b89a8820 1 /**
t_tatsuoka 0:9779b89a8820 2 * @file FilterTest.h
t_tatsuoka 0:9779b89a8820 3 * @brief Header file for FilterTest.cpp
t_tatsuoka 1:537eb14c5332 4 * @date 2015.07.30
t_tatsuoka 1:537eb14c5332 5 * @version 1.0.2.1
t_tatsuoka 0:9779b89a8820 6 */
t_tatsuoka 0:9779b89a8820 7 #ifndef _INC_FilterTest
t_tatsuoka 0:9779b89a8820 8 #define _INC_FilterTest
t_tatsuoka 0:9779b89a8820 9
t_tatsuoka 0:9779b89a8820 10 #include "mbed.h"
t_tatsuoka 0:9779b89a8820 11
t_tatsuoka 0:9779b89a8820 12 /* High pass filter fc = 0.5 Hz, fs = 1000 Hz */
t_tatsuoka 0:9779b89a8820 13 #define INIT_HB (0.998431665916719) /* HPF numerator coefficient */
t_tatsuoka 0:9779b89a8820 14 #define INIT_HA (-0.996863331833438) /* HPF denominator coefficient */
t_tatsuoka 0:9779b89a8820 15
t_tatsuoka 0:9779b89a8820 16 /* Low pass filter fc = 30 Hz, fs = 1000 Hz */
t_tatsuoka 0:9779b89a8820 17 #define INIT_LB (0.007820208033497) /* LPF numerator coefficient */
t_tatsuoka 0:9779b89a8820 18 #define INIT_LA1 (-1.734725768809275) /* LPF denominator coefficient 1 */
t_tatsuoka 0:9779b89a8820 19 #define INIT_LA2 (0.766006600943264) /* LPF denominator coefficient 2 */
t_tatsuoka 0:9779b89a8820 20
t_tatsuoka 0:9779b89a8820 21 /* Notch filter fc = 50 Hz, fs = 1000 Hz */
t_tatsuoka 1:537eb14c5332 22 // #define INIT_NB (0.820675769028781) /* BRF numerator coefficient */
t_tatsuoka 1:537eb14c5332 23 // #define INIT_NA1 (-1.561018075800720) /* BRF denominator coefficient 1 */
t_tatsuoka 1:537eb14c5332 24 // #define INIT_NA2 (0.641351538057563) /* BRF denominator coefficient 2 */
t_tatsuoka 0:9779b89a8820 25
t_tatsuoka 0:9779b89a8820 26 // /* Notch filter fc = 60 Hz, fs = 1000 Hz */
t_tatsuoka 1:537eb14c5332 27 #define INIT_NB (0.793459754030595) /* BRF numerator coefficient */
t_tatsuoka 1:537eb14c5332 28 #define INIT_NA1 (-1.475480443592650) /* BRF denominator coefficient 1 */
t_tatsuoka 1:537eb14c5332 29 #define INIT_NA2 (0.586919508061190) /* BRF denominator coefficient 2 */
t_tatsuoka 0:9779b89a8820 30
t_tatsuoka 0:9779b89a8820 31 /** Filter test
t_tatsuoka 0:9779b89a8820 32 */
t_tatsuoka 0:9779b89a8820 33 class FilterTest
t_tatsuoka 0:9779b89a8820 34 {
t_tatsuoka 0:9779b89a8820 35
t_tatsuoka 0:9779b89a8820 36 public:
t_tatsuoka 0:9779b89a8820 37 FilterTest();
t_tatsuoka 0:9779b89a8820 38 double calc(double val, int hpf_on, int lpf_on, int brf_on);
t_tatsuoka 0:9779b89a8820 39 bool set_hpf_coef(double hb, double ha);
t_tatsuoka 0:9779b89a8820 40 bool set_lpf_coef(double lb, double la1, double la2);
t_tatsuoka 0:9779b89a8820 41 bool set_brf_coef(double nb, double na1, double na2);
t_tatsuoka 0:9779b89a8820 42
t_tatsuoka 0:9779b89a8820 43 private:
t_tatsuoka 0:9779b89a8820 44
t_tatsuoka 0:9779b89a8820 45 /* Coefficient */
t_tatsuoka 0:9779b89a8820 46 double _hb; /* High pass filter numerator coefficient */
t_tatsuoka 0:9779b89a8820 47 double _ha; /* High pass filter denominator coefficient */
t_tatsuoka 0:9779b89a8820 48 double _lb; /* Low pass filter numerator coefficient */
t_tatsuoka 0:9779b89a8820 49 double _la1; /* Low pass filter denominator coefficient 1 */
t_tatsuoka 0:9779b89a8820 50 double _la2; /* Low pass filter denominator coefficient 2 */
t_tatsuoka 0:9779b89a8820 51 double _nb; /* Notch filter numerator coefficient */
t_tatsuoka 0:9779b89a8820 52 double _na1; /* Notch filter denominator coefficient 1 */
t_tatsuoka 0:9779b89a8820 53 double _na2; /* Notch filter denominator coefficient 2 */
t_tatsuoka 0:9779b89a8820 54
t_tatsuoka 0:9779b89a8820 55 /* Delay buffer */
t_tatsuoka 0:9779b89a8820 56 double _hw; /* High pass filter delay buffer */
t_tatsuoka 0:9779b89a8820 57 double _lw1; /* Low pass filter delay buffer 1 */
t_tatsuoka 0:9779b89a8820 58 double _lw2; /* Low pass filter delay buffer 2 */
t_tatsuoka 0:9779b89a8820 59 double _nw1; /* Notch filter delay buffer 1 */
t_tatsuoka 0:9779b89a8820 60 double _nw2; /* Notch filter delay buffer 2 */
t_tatsuoka 0:9779b89a8820 61
t_tatsuoka 0:9779b89a8820 62 /* Member functions */
t_tatsuoka 0:9779b89a8820 63 void reset_hpf_buf();
t_tatsuoka 0:9779b89a8820 64 void reset_lpf_buf();
t_tatsuoka 0:9779b89a8820 65 void reset_brf_buf();
t_tatsuoka 0:9779b89a8820 66 double hpf(double x);
t_tatsuoka 0:9779b89a8820 67 double lpf(double x);
t_tatsuoka 0:9779b89a8820 68 double brf(double x);
t_tatsuoka 0:9779b89a8820 69 };
t_tatsuoka 0:9779b89a8820 70 #endif /* INC_FilterTest */