不韋 呂 / Mbed 2 deprecated F746_AudioOutQSPI

Output the audio signal with filtering by IIR filter in the Quad-SPI flash memory using onboard CODEC. QSPI フラッシュメモリのオーディオデータを遮断周波数可変の IIR フィルタを通してボードに搭載されているCODEC で出力するプログラム．

Dependencies:   BSP_DISCO_F746NG_patch_fixed F746_GUI LCD_DISCO_F746NG QSPI_DISCO_F746NG TS_DISCO_F746NG mbed

MyClasses_Functions/BilinearDesignLH.cpp@1:a1be09c2533a, 2016-04-07 (annotated)

Committer:
MikamiUitOpen
Date:
Thu Apr 07 00:32:00 2016 +0000
Revision:
1:a1be09c2533a
Parent:
0:2eb96a7cf9b9 
2

Who changed what in which revision?

UserRevisionLine numberNew contents of line
MikamiUitOpen 0:2eb96a7cf9b9 1 //------------------------------------------------------------------------------
MikamiUitOpen 0:2eb96a7cf9b9 2 // Design of Butterworth LPF and HPF using bilinear transform
MikamiUitOpen 0:2eb96a7cf9b9 3 //
MikamiUitOpen 0:2eb96a7cf9b9 4 // 2016/03/31, Copyright (c) 2016 MIKAMI, Naoki
MikamiUitOpen 0:2eb96a7cf9b9 5 //------------------------------------------------------------------------------
MikamiUitOpen 0:2eb96a7cf9b9 6
MikamiUitOpen 0:2eb96a7cf9b9 7 #include "BilinearDesignLH.hpp"
MikamiUitOpen 0:2eb96a7cf9b9 8
MikamiUitOpen 0:2eb96a7cf9b9 9 namespace Mikami
MikamiUitOpen 0:2eb96a7cf9b9 10 {
MikamiUitOpen 0:2eb96a7cf9b9 11 // Execute design
MikamiUitOpen 0:2eb96a7cf9b9 12 // input
MikamiUitOpen 0:2eb96a7cf9b9 13 // fc: Cutoff frequency
MikamiUitOpen 0:2eb96a7cf9b9 14 // pb: Passband (LPF or HPF)
MikamiUitOpen 0:2eb96a7cf9b9 15 // output
MikamiUitOpen 0:2eb96a7cf9b9 16 // c : Coefficients for cascade structure
MikamiUitOpen 0:2eb96a7cf9b9 17 // g : Gain factor for cascade structure
MikamiUitOpen 0:2eb96a7cf9b9 18 void BilinearDesign::Execute(float fc, Type pb, Coefs c[], float& g)
MikamiUitOpen 0:2eb96a7cf9b9 19 {
MikamiUitOpen 0:2eb96a7cf9b9 20 Butterworth();
MikamiUitOpen 0:2eb96a7cf9b9 21 Bilinear(fc);
MikamiUitOpen 0:2eb96a7cf9b9 22 ToCascade(pb);
MikamiUitOpen 0:2eb96a7cf9b9 23 GetGain(pb);
MikamiUitOpen 0:2eb96a7cf9b9 24 GetCoefs(c, g);
MikamiUitOpen 0:2eb96a7cf9b9 25 }
MikamiUitOpen 0:2eb96a7cf9b9 26
MikamiUitOpen 0:2eb96a7cf9b9 27 // Get poles for Butterworth characteristics
MikamiUitOpen 0:2eb96a7cf9b9 28 void BilinearDesign::Butterworth()
MikamiUitOpen 0:2eb96a7cf9b9 29 {
MikamiUitOpen 0:2eb96a7cf9b9 30 float pi_2order = PI_/(2.0f*ORDER_);
MikamiUitOpen 0:2eb96a7cf9b9 31 for (int j=0; j<ORDER_/2; j++) // Pole with imaginary part >= 0
MikamiUitOpen 0:2eb96a7cf9b9 32 {
MikamiUitOpen 0:2eb96a7cf9b9 33 float theta = (2.0f*j + 1.0f)*pi_2order;
MikamiUitOpen 0:2eb96a7cf9b9 34 sP_[j] = Complex(-cosf(theta), sinf(theta));
MikamiUitOpen 0:2eb96a7cf9b9 35 }
MikamiUitOpen 0:2eb96a7cf9b9 36 }
MikamiUitOpen 0:2eb96a7cf9b9 37
MikamiUitOpen 0:2eb96a7cf9b9 38 // Bilinear transform
MikamiUitOpen 0:2eb96a7cf9b9 39 // fc: Cutoff frequency
MikamiUitOpen 0:2eb96a7cf9b9 40 void BilinearDesign::Bilinear(float fc)
MikamiUitOpen 0:2eb96a7cf9b9 41 {
MikamiUitOpen 0:2eb96a7cf9b9 42 float wc = tanf(fc*PI_FS_);
MikamiUitOpen 0:2eb96a7cf9b9 43 for (int k=0; k<ORDER_/2; k++)
MikamiUitOpen 0:2eb96a7cf9b9 44 zP_[k] = (1.0f + wc*sP_[k])/(1.0f - wc*sP_[k]);
MikamiUitOpen 0:2eb96a7cf9b9 45 }
MikamiUitOpen 0:2eb96a7cf9b9 46
MikamiUitOpen 0:2eb96a7cf9b9 47 // Convert to coefficients for cascade structure
MikamiUitOpen 0:2eb96a7cf9b9 48 void BilinearDesign::ToCascade(Type pb)
MikamiUitOpen 0:2eb96a7cf9b9 49 {
MikamiUitOpen 0:2eb96a7cf9b9 50 for (int j=0; j<ORDER_/2; j++)
MikamiUitOpen 0:2eb96a7cf9b9 51 {
MikamiUitOpen 0:2eb96a7cf9b9 52 ck_[j].a1 = 2.0f*real(zP_[j]); // a1m
MikamiUitOpen 0:2eb96a7cf9b9 53 ck_[j].a2 = -norm(zP_[j]); // a2m
MikamiUitOpen 0:2eb96a7cf9b9 54 ck_[j].b1 = (pb == LPF) ? 2.0f : -2.0f; // b1m
MikamiUitOpen 0:2eb96a7cf9b9 55 ck_[j].b2 = 1.0f; // b2m
MikamiUitOpen 0:2eb96a7cf9b9 56 }
MikamiUitOpen 0:2eb96a7cf9b9 57 }
MikamiUitOpen 0:2eb96a7cf9b9 58
MikamiUitOpen 0:2eb96a7cf9b9 59 // Calculate gain factor
MikamiUitOpen 0:2eb96a7cf9b9 60 void BilinearDesign::GetGain(Type pb)
MikamiUitOpen 0:2eb96a7cf9b9 61 {
MikamiUitOpen 0:2eb96a7cf9b9 62 float u = (pb == LPF) ? 1.0f : -1.0f;
MikamiUitOpen 0:2eb96a7cf9b9 63 float g0 = 1.0f;
MikamiUitOpen 0:2eb96a7cf9b9 64 for (int k=0; k<ORDER_/2; k++)
MikamiUitOpen 0:2eb96a7cf9b9 65 g0 = g0*(1.0f - (ck_[k].a1 + ck_[k].a2*u)*u)/
MikamiUitOpen 0:2eb96a7cf9b9 66 (1.0f + (ck_[k].b1 + ck_[k].b2*u)*u);
MikamiUitOpen 0:2eb96a7cf9b9 67 gain_ = g0;
MikamiUitOpen 0:2eb96a7cf9b9 68 }
MikamiUitOpen 0:2eb96a7cf9b9 69
MikamiUitOpen 0:2eb96a7cf9b9 70 // Get coefficients
MikamiUitOpen 0:2eb96a7cf9b9 71 void BilinearDesign::GetCoefs(Coefs c[], float& gain)
MikamiUitOpen 0:2eb96a7cf9b9 72 {
MikamiUitOpen 0:2eb96a7cf9b9 73 for (int k=0; k<ORDER_/2; k++) c[k] = ck_[k];
MikamiUitOpen 0:2eb96a7cf9b9 74 gain = gain_;
MikamiUitOpen 0:2eb96a7cf9b9 75 }
MikamiUitOpen 0:2eb96a7cf9b9 76 }