boblark
4 years ago
parent
d6f30882a7
commit
86b0b29a20
@ -1,41 +1,32 @@ |
||||
|
||||
/*
|
||||
* AudioFilterBiquad_F32.cpp |
||||
* |
||||
* Chip Audette, OpenAudio, Apr 2017 |
||||
* |
||||
* MIT License, Use at your own risk. |
||||
* |
||||
* This filter has been running in F32 as a single stage. This |
||||
* would work by using multiple instantations, but compute time and |
||||
* latency suffer. So, Feb 2021 convert to MAX_STAGES 4 as is the I16 |
||||
* Teensy Audio library. Bob Larkin |
||||
* |
||||
* See AudioFilterBiquad_F32.h for more notes. |
||||
*/ |
||||
|
||||
|
||||
#include "AudioFilterBiquad_F32.h" |
||||
|
||||
void AudioFilterBiquad_F32::update(void) |
||||
{ |
||||
void AudioFilterBiquad_F32::update(void) { |
||||
audio_block_f32_t *block; |
||||
|
||||
block = AudioStream_F32::receiveWritable_f32(); |
||||
if (!block) return; |
||||
if (!block) return; // Out of memory
|
||||
// Serial.print(block->data[37],6); Serial.print(", IN "); Serial.println(block->data[38],6);
|
||||
if(doBiquad) // Filter is defined, so go to it
|
||||
arm_biquad_cascade_df1_f32(&iir_inst, block->data, |
||||
block->data, block->length); |
||||
// Serial.print(block->data[37],6); Serial.print(", OUT "); Serial.println(block->data[38],6);
|
||||
|
||||
// If there's no coefficient table, give up.
|
||||
if (coeff_p == NULL) { |
||||
AudioStream_F32::release(block); |
||||
return; |
||||
} |
||||
// Add double filter call here
|
||||
|
||||
// do passthru
|
||||
if (coeff_p == IIR_F32_PASSTHRU) { |
||||
// Just passthrough
|
||||
// Transmit the data, filtered or unfiltered
|
||||
AudioStream_F32::transmit(block); |
||||
AudioStream_F32::release(block); |
||||
return; |
||||
} |
||||
|
||||
// do IIR
|
||||
arm_biquad_cascade_df1_f32(&iir_inst, block->data, block->data, block->length); |
||||
|
||||
//transmit the data
|
||||
AudioStream_F32::transmit(block); // send the IIR output
|
||||
AudioStream_F32::release(block); |
||||
} |
||||
|
||||
@ -0,0 +1,121 @@ |
||||
/*
|
||||
TestBiquad.ino Test the |
||||
* F32 library AudioFilterBiquad_F32 |
||||
* Bob Larkin 26Feb 2021 |
||||
* Public Domain |
||||
*/ |
||||
#include "OpenAudio_ArduinoLibrary.h" |
||||
#include "AudioStream_F32.h" |
||||
#include <Audio.h> |
||||
#include <Wire.h> |
||||
#include <SPI.h> |
||||
#include <SD.h> |
||||
#include <SerialFlash.h> |
||||
|
||||
// T3.x supported sample rates: 2000, 8000, 11025, 16000, 22050, 24000, 32000, 44100, 44117, 48000,
|
||||
// 88200, 88235 (44117*2), 95680, 96000, 176400, 176470, 192000
|
||||
// T4.x supports any sample rate the codec will handle.
|
||||
const float sample_rate_Hz = 44117.0f ; // 24000, 44117, or other frequencies listed above (untested)
|
||||
const int audio_block_samples = 128; // Others untested
|
||||
AudioSettings_F32 audio_settings(sample_rate_Hz, audio_block_samples); // Not used
|
||||
|
||||
// GUItool: begin automatically generated code
|
||||
AudioInputI2S_F32 audioInI2S1; //xy=73.5,556
|
||||
AudioSynthWaveformSine_F32 sine1; //xy=89,595
|
||||
AudioMixer4_F32 mixer4_1; //xy=263,572
|
||||
AudioAnalyzeRMS_F32 rms1; //xy=411,528
|
||||
AudioFilterBiquad_F32 biquad1; //xy=414,586
|
||||
AudioAnalyzeRMS_F32 rms2; //xy=547,528
|
||||
AudioOutputI2S_F32 audioOutI2S1; //xy=576,585
|
||||
AudioConnection_F32 patchCord1(audioInI2S1, 0, mixer4_1, 0); |
||||
AudioConnection_F32 patchCord2(audioInI2S1, 1, mixer4_1, 1); |
||||
AudioConnection_F32 patchCord3(sine1, 0, mixer4_1, 2); |
||||
AudioConnection_F32 patchCord4(mixer4_1, biquad1); |
||||
AudioConnection_F32 patchCord5(mixer4_1, rms1); |
||||
AudioConnection_F32 patchCord6(biquad1, 0, audioOutI2S1, 1); |
||||
AudioConnection_F32 patchCord7(biquad1, 0, audioOutI2S1, 0); |
||||
AudioConnection_F32 patchCord8(biquad1, rms2); |
||||
AudioControlSGTL5000 sgtl5000_1; //xy=327,636
|
||||
// GUItool: end automatically generated code
|
||||
// Reminder: Check that AudioMemory_F32 is allocated and that
|
||||
// settings are added to F32 objects as needed, including Memory.
|
||||
|
||||
void setup() { |
||||
Serial.begin(300); |
||||
delay(1000); |
||||
Serial.println("OpenAudio_ArduinoLibrary - TestBiquad"); |
||||
|
||||
AudioMemory(10); //allocate Int16 audio data blocks
|
||||
|
||||
AudioMemory_F32(20, audio_settings); |
||||
|
||||
// Enable the audio shield, select input, and enable output
|
||||
sgtl5000_1.enable(); //start the audio board
|
||||
sgtl5000_1.inputSelect(AUDIO_INPUT_LINEIN); // or AUDIO_INPUT_MIC
|
||||
sgtl5000_1.volume(0.8); //volume can be 0.0 to 1.0
|
||||
sgtl5000_1.lineInLevel(10, 10); //level can be 0 to 15. 5 is the Teensy Audio Library's default
|
||||
|
||||
mixer4_1.gain(0, 1.0f); // Left in
|
||||
mixer4_1.gain(1, 1.0f); // Right In
|
||||
mixer4_1.gain(2, 0.0f); // Sine wave in
|
||||
|
||||
// **** BiQuad Filter Selection - Pick one of the next ****
|
||||
//biquad1.setHighpass(0, 40.0f, 0.707f);
|
||||
//biquad1.setHighpass(0, 1000.0f, 0.707f);
|
||||
biquad1.setLowpass(0, 2500.0f, 0.707f); |
||||
//for(int jj=0; jj<4; jj++) biquad1.setLowpass(jj, 2000.0f, 0.707f);
|
||||
//biquad1.setBandpass(0, 1000.0f, 1.5f);
|
||||
//biquad1.setNotch(0, 1000.0f, 1.0f);
|
||||
|
||||
// Coeffs, a0=1.0 always b0 b1 b2 a1 a2
|
||||
//double cfLP2500[] = {0.025157343556, 0.050314687112, 0.025157343556, 1.503844064936, -0.604473439160};
|
||||
//biquad1.setCoefficients(0, cfLP2500); // (int iStage, double *cf) // Load cfLP2500, 1 stage
|
||||
// ************************************************************
|
||||
biquad1.begin(); |
||||
|
||||
// Download a pointer to the coefficients to see what is happening
|
||||
double* pc=biquad1.getCoeffs(); |
||||
Serial.println(" b0 b1 b2 a1 a2"); |
||||
for(int ii=0; ii<4; ii++) { |
||||
Serial.print( *(pc + 0 + ii*5),12 ); Serial.print(", "); |
||||
Serial.print( *(pc + 1 + ii*5),12 ); Serial.print(", "); |
||||
Serial.print( *(pc + 2 + ii*5),12 ); Serial.print(", "); |
||||
Serial.print( *(pc + 3 + ii*5),12 ); Serial.print(", "); |
||||
Serial.print( *(pc + 4 + ii*5),12 ); Serial.println(); |
||||
} |
||||
|
||||
sine1.frequency(500.0); // Connect via mixer4_1.gain(2, 0.0f);
|
||||
sine1.amplitude(0.02); |
||||
} |
||||
|
||||
void loop() { |
||||
//update the memory and CPU usage...if enough time has passed
|
||||
printMemoryAndCPU(millis()); |
||||
} |
||||
|
||||
void printMemoryAndCPU(unsigned long curTime_millis) { |
||||
static unsigned long updatePeriod_millis = 2000; //how many milliseconds between updating gain reading?
|
||||
static unsigned long lastUpdate_millis = 0; |
||||
float r1, r2; |
||||
//has enough time passed to update everything?
|
||||
if (curTime_millis < lastUpdate_millis) lastUpdate_millis = 0; //handle wrap-around of the clock
|
||||
if ((curTime_millis - lastUpdate_millis) > updatePeriod_millis) { //is it time to update the user interface?
|
||||
|
||||
if( rms1.available() ) { |
||||
Serial.print("RMS in: "); |
||||
Serial.print(r1=rms1.read(), 6); |
||||
} |
||||
if( rms2.available() ) { |
||||
Serial.print(" RMS out: "); |
||||
Serial.print(r2=rms2.read(), 6); |
||||
Serial.print(" Gain, dB = "); |
||||
Serial.print( 20.0f*log10f(r2/r1)); |
||||
} |
||||
|
||||
Serial.print(" CPU: Usage, Max: "); |
||||
Serial.print(AudioProcessorUsageMax()); |
||||
Serial.print(" Float Memory, Max: "); |
||||
Serial.println(AudioMemoryUsageMax_F32()); |
||||
lastUpdate_millis = curTime_millis; //we will use this value the next time around.
|
||||
} |
||||
} |
||||
Loading…
Reference in new issue