Add second order notching filter.

This commit is contained in:
David Reid
2020-02-23 20:08:44 +10:00
parent a5d4109a6a
commit f1abfccb52
3 changed files with 327 additions and 1 deletions
+7 -1
View File
@@ -27,6 +27,7 @@ ma_result filtering_init_decoder_and_encoder(const char* pInputFilePath, const c
#include "ma_test_filtering_hpf.c"
#include "ma_test_filtering_bpf.c"
#include "ma_test_filtering_peak.c"
#include "ma_test_filtering_notch.c"
int main(int argc, char** argv)
{
@@ -57,12 +58,17 @@ int main(int argc, char** argv)
if (result != MA_SUCCESS) {
hasError = MA_TRUE;
}
#endif
result = ma_register_test("Peaking EQ Filtering", test_entry__peak);
if (result != MA_SUCCESS) {
hasError = MA_TRUE;
}
#endif
result = ma_register_test("Notching Filtering", test_entry__notch);
if (result != MA_SUCCESS) {
hasError = MA_TRUE;
}
for (iTest = 0; iTest < g_Tests.count; iTest += 1) {
printf("=== BEGIN %s ===\n", g_Tests.pTests[iTest].pName);
@@ -0,0 +1,168 @@
ma_result notch_init_decoder_and_encoder(const char* pInputFilePath, const char* pOutputFilePath, ma_format format, ma_decoder* pDecoder, ma_encoder* pEncoder)
{
return filtering_init_decoder_and_encoder(pInputFilePath, pOutputFilePath, format, 0, 0, pDecoder, pEncoder);
}
ma_result test_notch2__by_format(const char* pInputFilePath, const char* pOutputFilePath, ma_format format)
{
ma_result result;
ma_decoder decoder;
ma_encoder encoder;
ma_notch2_config notchConfig;
ma_notch2 notch;
printf(" %s\n", pOutputFilePath);
result = notch_init_decoder_and_encoder(pInputFilePath, pOutputFilePath, format, &decoder, &encoder);
if (result != MA_SUCCESS) {
return result;
}
notchConfig = ma_notch2_config_init(decoder.outputFormat, decoder.outputChannels, decoder.outputSampleRate, 0, 2000);
result = ma_notch2_init(&notchConfig, &notch);
if (result != MA_SUCCESS) {
ma_decoder_uninit(&decoder);
ma_encoder_uninit(&encoder);
return result;
}
for (;;) {
ma_uint8 tempIn[4096];
ma_uint8 tempOut[4096];
ma_uint64 tempCapIn = sizeof(tempIn) / ma_get_bytes_per_frame(decoder.outputFormat, decoder.outputChannels);
ma_uint64 tempCapOut = sizeof(tempOut) / ma_get_bytes_per_frame(decoder.outputFormat, decoder.outputChannels);
ma_uint64 framesToRead;
ma_uint64 framesJustRead;
framesToRead = ma_min(tempCapIn, tempCapOut);
framesJustRead = ma_decoder_read_pcm_frames(&decoder, tempIn, framesToRead);
/* Filter */
ma_notch2_process_pcm_frames(&notch, tempOut, tempIn, framesJustRead);
/* Write to the WAV file. */
ma_encoder_write_pcm_frames(&encoder, tempOut, framesJustRead);
if (framesJustRead < framesToRead) {
break;
}
}
ma_encoder_uninit(&encoder);
return MA_SUCCESS;
}
ma_result test_notch2__f32(const char* pInputFilePath)
{
return test_notch2__by_format(pInputFilePath, "output/notch2_f32.wav", ma_format_f32);
}
ma_result test_notch2__s16(const char* pInputFilePath)
{
return test_notch2__by_format(pInputFilePath, "output/notch2_s16.wav", ma_format_s16);
}
#if 0
ma_result test_notch4__by_format(const char* pInputFilePath, const char* pOutputFilePath, ma_format format)
{
ma_result result;
ma_decoder decoder;
ma_encoder encoder;
ma_notch_config notchConfig;
ma_notch notch;
printf(" %s\n", pOutputFilePath);
result = notch_init_decoder_and_encoder(pInputFilePath, pOutputFilePath, format, &decoder, &encoder);
if (result != MA_SUCCESS) {
return result;
}
notchConfig = ma_notch_config_init(decoder.outputFormat, decoder.outputChannels, decoder.outputSampleRate, 2000, 4);
result = ma_notch_init(&notchConfig, &notch);
if (result != MA_SUCCESS) {
ma_decoder_uninit(&decoder);
ma_encoder_uninit(&encoder);
return result;
}
for (;;) {
ma_uint8 tempIn[4096];
ma_uint8 tempOut[4096];
ma_uint64 tempCapIn = sizeof(tempIn) / ma_get_bytes_per_frame(decoder.outputFormat, decoder.outputChannels);
ma_uint64 tempCapOut = sizeof(tempOut) / ma_get_bytes_per_frame(decoder.outputFormat, decoder.outputChannels);
ma_uint64 framesToRead;
ma_uint64 framesJustRead;
framesToRead = ma_min(tempCapIn, tempCapOut);
framesJustRead = ma_decoder_read_pcm_frames(&decoder, tempIn, framesToRead);
/* Filter */
ma_notch_process_pcm_frames(&notch, tempOut, tempIn, framesJustRead);
/* Write to the WAV file. */
ma_encoder_write_pcm_frames(&encoder, tempOut, framesJustRead);
if (framesJustRead < framesToRead) {
break;
}
}
ma_encoder_uninit(&encoder);
return MA_SUCCESS;
}
ma_result test_notch4__f32(const char* pInputFilePath)
{
return test_notch4__by_format(pInputFilePath, "output/notch4_f32.wav", ma_format_f32);
}
ma_result test_notch4__s16(const char* pInputFilePath)
{
return test_notch4__by_format(pInputFilePath, "output/notch4_s16.wav", ma_format_s16);
}
#endif
int test_entry__notch(int argc, char** argv)
{
ma_result result;
ma_bool32 hasError = MA_FALSE;
const char* pInputFilePath;
if (argc < 2) {
printf("No input file.\n");
return -1;
}
pInputFilePath = argv[1];
result = test_notch2__f32(pInputFilePath);
if (result != MA_SUCCESS) {
hasError = MA_TRUE;
}
result = test_notch2__s16(pInputFilePath);
if (result != MA_SUCCESS) {
hasError = MA_TRUE;
}
#if 0
result = test_notch4__f32(pInputFilePath);
if (result != MA_SUCCESS) {
hasError = MA_TRUE;
}
result = test_notch4__s16(pInputFilePath);
if (result != MA_SUCCESS) {
hasError = MA_TRUE;
}
#endif
if (hasError) {
return -1;
} else {
return 0;
}
}