Nucleo-F446 によるグラフィック・イコライザ.DA変換器にデータを送る際は 4 倍にアップ・サンプリング.
Dependencies: mbed SerialTxRxIntr F446_AD_DA_Multirate
main.cpp@3:d6f1e5cf5354, 2018-06-12 (annotated)
- Committer:
- MikamiUitOpen
- Date:
- Tue Jun 12 01:18:36 2018 +0000
- Revision:
- 3:d6f1e5cf5354
- Parent:
- 2:3a115b023dd2
- Child:
- 4:56edc65750f3
4
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
MikamiUitOpen | 0:0312aa1893cf | 1 | //---------------------------------------------------------------------- |
MikamiUitOpen | 2:3a115b023dd2 | 2 | // グラフィック・イコライザ |
MikamiUitOpen | 0:0312aa1893cf | 3 | // |
MikamiUitOpen | 2:3a115b023dd2 | 4 | // PC 側のプログラム: F446_GraphicEqualizer |
MikamiUitOpen | 0:0312aa1893cf | 5 | // |
MikamiUitOpen | 3:d6f1e5cf5354 | 6 | // 2018/06/12, Copyright (c) 2018 MIKAMI, Naoki |
MikamiUitOpen | 0:0312aa1893cf | 7 | //---------------------------------------------------------------------- |
MikamiUitOpen | 0:0312aa1893cf | 8 | |
MikamiUitOpen | 0:0312aa1893cf | 9 | #include "main.hpp" |
MikamiUitOpen | 0:0312aa1893cf | 10 | using namespace Mikami; |
MikamiUitOpen | 0:0312aa1893cf | 11 | |
MikamiUitOpen | 0:0312aa1893cf | 12 | // 出力標本化周波数を4倍にするオブジェクト |
MikamiUitOpen | 0:0312aa1893cf | 13 | F446_Multirate myAdDa_(ORDER_SM_, HK_SM_, G0_SM_); |
MikamiUitOpen | 0:0312aa1893cf | 14 | // Serial クラスの受信割込み用オブジェクト |
MikamiUitOpen | 2:3a115b023dd2 | 15 | SerialRxTxIntr rx_; |
MikamiUitOpen | 0:0312aa1893cf | 16 | |
MikamiUitOpen | 0:0312aa1893cf | 17 | int main() |
MikamiUitOpen | 0:0312aa1893cf | 18 | { |
MikamiUitOpen | 0:0312aa1893cf | 19 | myAdDa_.Start(FS_); // ADC 変換終了割り込みを使えるようにする |
MikamiUitOpen | 0:0312aa1893cf | 20 | |
MikamiUitOpen | 0:0312aa1893cf | 21 | // 以下の割り込み優先順位の設定を忘れないこと |
MikamiUitOpen | 0:0312aa1893cf | 22 | NVIC_SetPriority(ADC_IRQn, 0); // ADC 終了割り込み:最優先 |
MikamiUitOpen | 0:0312aa1893cf | 23 | NVIC_SetPriority(USART2_IRQn, 1); // USART2 割り込み:次に優先 |
MikamiUitOpen | 0:0312aa1893cf | 24 | |
MikamiUitOpen | 0:0312aa1893cf | 25 | // グラフィック・イコライザ用パラメータ等の定義 |
MikamiUitOpen | 0:0312aa1893cf | 26 | const int BANDS = 9; |
MikamiUitOpen | 0:0312aa1893cf | 27 | const float Q_VAL = 1.0f/sqrtf(2.0f); // フィルタの Q 値 |
MikamiUitOpen | 0:0312aa1893cf | 28 | GrEqParams params(BANDS, FS_); // グラフィック・イコライザで使うフィルタの |
MikamiUitOpen | 0:0312aa1893cf | 29 | // 係数を計算するオブジェクト |
MikamiUitOpen | 0:0312aa1893cf | 30 | BiquadGrEq biquad[BANDS]; // グラフィック・イコライザで使うフィルタ |
MikamiUitOpen | 0:0312aa1893cf | 31 | float f0[BANDS]; // 中心周波数(ピーキング・フィルタの場合) |
MikamiUitOpen | 0:0312aa1893cf | 32 | for (int n=0; n<BANDS; n++) f0[n] = 62.5f*powf(2, n); |
MikamiUitOpen | 0:0312aa1893cf | 33 | for (int n=0; n<BANDS; n++) |
MikamiUitOpen | 0:0312aa1893cf | 34 | biquad[n].SetCoefficients(params.Get(n, f0[n], 0, Q_VAL)); |
MikamiUitOpen | 0:0312aa1893cf | 35 | |
MikamiUitOpen | 0:0312aa1893cf | 36 | bool on = true; // フィルタ処理の有効/無効を決める変数 |
MikamiUitOpen | 0:0312aa1893cf | 37 | |
MikamiUitOpen | 0:0312aa1893cf | 38 | while (true) |
MikamiUitOpen | 0:0312aa1893cf | 39 | { |
MikamiUitOpen | 0:0312aa1893cf | 40 | //------------------------------------------------------------ |
MikamiUitOpen | 0:0312aa1893cf | 41 | // ここにディジタルフィルタ等の処理を記述する |
MikamiUitOpen | 0:0312aa1893cf | 42 | float xn = myAdDa_.Input()*0.25f; // 入力 |
MikamiUitOpen | 0:0312aa1893cf | 43 | float yn = xn; |
MikamiUitOpen | 0:0312aa1893cf | 44 | for (int n=0; n<BANDS; n++) yn =biquad[n].Execute(yn); |
MikamiUitOpen | 0:0312aa1893cf | 45 | // 実行時間:約 7 μs |
MikamiUitOpen | 0:0312aa1893cf | 46 | myAdDa_.Output(on ? yn : xn); // 出力 |
MikamiUitOpen | 0:0312aa1893cf | 47 | //------------------------------------------------------------ |
MikamiUitOpen | 0:0312aa1893cf | 48 | |
MikamiUitOpen | 0:0312aa1893cf | 49 | //------------------------------------------------------------ |
MikamiUitOpen | 0:0312aa1893cf | 50 | // PC からの指令に対応する処理 |
MikamiUitOpen | 0:0312aa1893cf | 51 | if (rx_.IsEol()) // 受信バッファのデータが有効になった場合の処理 |
MikamiUitOpen | 0:0312aa1893cf | 52 | { |
MikamiUitOpen | 0:0312aa1893cf | 53 | string str = rx_.GetBuffer(); |
MikamiUitOpen | 3:d6f1e5cf5354 | 54 | if (str.find("GrEq") != string::npos) |
MikamiUitOpen | 0:0312aa1893cf | 55 | rx_.Tx("ACK"); // "ACK" を送り返す |
MikamiUitOpen | 0:0312aa1893cf | 56 | else if (str.find("ON") != string::npos) |
MikamiUitOpen | 0:0312aa1893cf | 57 | on = true; // フィルタ処理を有効にする |
MikamiUitOpen | 0:0312aa1893cf | 58 | else if (str.find("OFF") != string::npos) |
MikamiUitOpen | 0:0312aa1893cf | 59 | on = false; // フィルタ処理を無効にする |
MikamiUitOpen | 0:0312aa1893cf | 60 | else if (str.find("FLAT") != string::npos) |
MikamiUitOpen | 0:0312aa1893cf | 61 | for (int n=0; n<BANDS; n++) // フィルタの特性を平坦にする |
MikamiUitOpen | 0:0312aa1893cf | 62 | biquad[n].SetCoefficients(params.Get(n, f0[n], 0, Q_VAL)); |
MikamiUitOpen | 0:0312aa1893cf | 63 | // "ENQ", "ON", "OFF", "FLAT" 以外は float 型の数値に対応する文字列とし |
MikamiUitOpen | 0:0312aa1893cf | 64 | // て処理を行う |
MikamiUitOpen | 0:0312aa1893cf | 65 | else |
MikamiUitOpen | 0:0312aa1893cf | 66 | { |
MikamiUitOpen | 0:0312aa1893cf | 67 | // 最初の文字はフィルタの番号 |
MikamiUitOpen | 0:0312aa1893cf | 68 | int k = atoi(str.substr(0, 1).c_str()); // フィルタの番号 |
MikamiUitOpen | 0:0312aa1893cf | 69 | // 次の文字からは dB 値 |
MikamiUitOpen | 0:0312aa1893cf | 70 | str.erase(0, 1); |
MikamiUitOpen | 0:0312aa1893cf | 71 | float db = atof(str.c_str()); |
MikamiUitOpen | 0:0312aa1893cf | 72 | biquad[k].SetCoefficients(params.Get(k, f0[k], db, Q_VAL)); |
MikamiUitOpen | 0:0312aa1893cf | 73 | } |
MikamiUitOpen | 0:0312aa1893cf | 74 | } |
MikamiUitOpen | 0:0312aa1893cf | 75 | // PC からの指令に対応する処理はここまで |
MikamiUitOpen | 0:0312aa1893cf | 76 | //------------------------------------------------------------ |
MikamiUitOpen | 0:0312aa1893cf | 77 | } |
MikamiUitOpen | 0:0312aa1893cf | 78 | } |