FFT アナライザ このプログラムの説明は,CQ出版社「トランジスタ技術」の2021年10月号から開始された連載記事「STM32マイコンではじめるPC計測」の中にあります.このプログラムといっしょに使うPC側のプログラムについても同誌を参照してください.

Dependencies:   Array_Matrix mbed SerialTxRxIntr DSP_ADDA UIT_FFT_Real Window

Committer:
MikamiUitOpen
Date:
Wed Nov 03 01:29:16 2021 +0000
Revision:
1:d9dbfbe95c8d
Parent:
0:e5fc70976c00
2

Who changed what in which revision?

UserRevisionLine numberNew contents of line
MikamiUitOpen 0:e5fc70976c00 1 //--------------------------------------------------------------
MikamiUitOpen 0:e5fc70976c00 2 // 縦続形 IIR フィルタの構成要素として使う 2 次の IIR フィルタ
MikamiUitOpen 0:e5fc70976c00 3 // b0 は 1 と仮定している
MikamiUitOpen 0:e5fc70976c00 4 //
MikamiUitOpen 0:e5fc70976c00 5 // 2020/11/04, Copyright (c) 2020 MIKAMI, Naoki
MikamiUitOpen 0:e5fc70976c00 6 //--------------------------------------------------------------
MikamiUitOpen 0:e5fc70976c00 7
MikamiUitOpen 0:e5fc70976c00 8 #include "mbed.h"
MikamiUitOpen 0:e5fc70976c00 9
MikamiUitOpen 0:e5fc70976c00 10 #ifndef IIR_BIQUAD_HPP
MikamiUitOpen 0:e5fc70976c00 11 #define IIR_BIQUAD_HPP
MikamiUitOpen 0:e5fc70976c00 12
MikamiUitOpen 0:e5fc70976c00 13 class Biquad
MikamiUitOpen 0:e5fc70976c00 14 {
MikamiUitOpen 0:e5fc70976c00 15 public:
MikamiUitOpen 0:e5fc70976c00 16 // フィルタの係数をまとめて扱うための構造体
MikamiUitOpen 0:e5fc70976c00 17 struct Coefs { float a1, a2, b1, b2; };
MikamiUitOpen 0:e5fc70976c00 18
MikamiUitOpen 0:e5fc70976c00 19 // デフォルト・コンストラクタ
MikamiUitOpen 0:e5fc70976c00 20 // 係数は構造体 Ceofs で与える
MikamiUitOpen 0:e5fc70976c00 21 Biquad(const Coefs ck = (Coefs){0, 0, 0, 0})
MikamiUitOpen 0:e5fc70976c00 22 : a1_(ck.a1), a2_(ck.a2), b1_(ck.b1), b2_(ck.b2),
MikamiUitOpen 0:e5fc70976c00 23 un1_(0), un2_(0) {}
MikamiUitOpen 0:e5fc70976c00 24
MikamiUitOpen 0:e5fc70976c00 25 // 係数を個別に与えるコンストラクタ
MikamiUitOpen 0:e5fc70976c00 26 Biquad(float a1, float a2, float b1, float b2)
MikamiUitOpen 0:e5fc70976c00 27 : a1_(a1), a2_(a2), b1_(b1), b2_(b2), un1_(0), un2_(0) {}
MikamiUitOpen 0:e5fc70976c00 28
MikamiUitOpen 0:e5fc70976c00 29 virtual ~Biquad() {}
MikamiUitOpen 0:e5fc70976c00 30
MikamiUitOpen 0:e5fc70976c00 31 // 2 次のフィルタを実行する
MikamiUitOpen 0:e5fc70976c00 32 float Execute(float xn)
MikamiUitOpen 0:e5fc70976c00 33 {
MikamiUitOpen 0:e5fc70976c00 34 float un = xn + a1_*un1_ + a2_*un2_;
MikamiUitOpen 0:e5fc70976c00 35 float yn = un + b1_*un1_ + b2_*un2_;
MikamiUitOpen 0:e5fc70976c00 36
MikamiUitOpen 0:e5fc70976c00 37 un2_ = un1_;
MikamiUitOpen 0:e5fc70976c00 38 un1_ = un;
MikamiUitOpen 0:e5fc70976c00 39
MikamiUitOpen 0:e5fc70976c00 40 return yn;
MikamiUitOpen 0:e5fc70976c00 41 }
MikamiUitOpen 0:e5fc70976c00 42
MikamiUitOpen 0:e5fc70976c00 43 // 係数を設定する
MikamiUitOpen 0:e5fc70976c00 44 void SetCoefs(const Coefs ck)
MikamiUitOpen 0:e5fc70976c00 45 {
MikamiUitOpen 0:e5fc70976c00 46 a1_ = ck.a1;
MikamiUitOpen 0:e5fc70976c00 47 a2_ = ck.a2;
MikamiUitOpen 0:e5fc70976c00 48 b1_ = ck.b1;
MikamiUitOpen 0:e5fc70976c00 49 b2_ = ck.b2;
MikamiUitOpen 0:e5fc70976c00 50 }
MikamiUitOpen 0:e5fc70976c00 51
MikamiUitOpen 0:e5fc70976c00 52 // 内部変数(遅延器)のクリア
MikamiUitOpen 0:e5fc70976c00 53 void Clear() { un1_ = un2_ = 0; }
MikamiUitOpen 0:e5fc70976c00 54
MikamiUitOpen 0:e5fc70976c00 55 private:
MikamiUitOpen 0:e5fc70976c00 56 float a1_, a2_, b1_, b2_; // フィルタの係数
MikamiUitOpen 0:e5fc70976c00 57 float un1_, un2_; // 遅延器
MikamiUitOpen 0:e5fc70976c00 58
MikamiUitOpen 0:e5fc70976c00 59 // コピー・コンストラクタ禁止
MikamiUitOpen 0:e5fc70976c00 60 Biquad(const Biquad&);
MikamiUitOpen 0:e5fc70976c00 61 };
MikamiUitOpen 0:e5fc70976c00 62 #endif // IIR_BIQUAD_HPP