2017-01-15 10:08:42 +00:00
|
|
|
#include <stdio.h>
|
|
|
|
#include <stdint.h>
|
|
|
|
#include <math.h>
|
|
|
|
#include <string.h>
|
2017-11-18 07:06:06 +00:00
|
|
|
#include "../libsample/sample.h"
|
2017-11-13 18:15:09 +00:00
|
|
|
#include "../libfilter/iir_filter.h"
|
2020-02-27 17:47:54 +00:00
|
|
|
#include "../libfilter/fir_filter.h"
|
2017-11-18 07:58:57 +00:00
|
|
|
#include "../libdebug/debug.h"
|
2017-01-15 10:08:42 +00:00
|
|
|
|
|
|
|
#define level2db(level) (20 * log10(level))
|
|
|
|
#define db2level(db) pow(10, (double)db / 20.0)
|
|
|
|
|
|
|
|
#define SAMPLERATE 48000
|
|
|
|
|
2017-01-29 06:25:12 +00:00
|
|
|
static double get_level(sample_t *samples)
|
2017-01-15 10:08:42 +00:00
|
|
|
{
|
|
|
|
int i;
|
|
|
|
double envelope = 0;
|
|
|
|
for (i = SAMPLERATE/2; i < SAMPLERATE; i++) {
|
|
|
|
if (samples[i] > envelope)
|
|
|
|
envelope = samples[i];
|
|
|
|
}
|
|
|
|
|
|
|
|
return envelope;
|
|
|
|
}
|
|
|
|
|
2017-01-29 06:25:12 +00:00
|
|
|
static void gen_samples(sample_t *samples, double freq)
|
2017-01-15 10:08:42 +00:00
|
|
|
{
|
|
|
|
int i;
|
|
|
|
double value;
|
|
|
|
|
|
|
|
for (i = 0; i < SAMPLERATE; i++) {
|
|
|
|
value = cos(2.0 * M_PI * freq / (double)SAMPLERATE * (double)i);
|
|
|
|
samples[i] = value;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2017-12-03 08:30:54 +00:00
|
|
|
int num_kanal;
|
2017-08-20 06:27:02 +00:00
|
|
|
|
2017-01-15 10:08:42 +00:00
|
|
|
int main(void)
|
|
|
|
{
|
2017-05-13 14:04:00 +00:00
|
|
|
iir_filter_t filter_low;
|
|
|
|
iir_filter_t filter_high;
|
2020-02-27 17:47:54 +00:00
|
|
|
fir_filter_t *fir_low/*, *fir_high*/;
|
2017-01-29 06:25:12 +00:00
|
|
|
sample_t samples[SAMPLERATE];
|
2017-01-15 10:08:42 +00:00
|
|
|
double level;
|
|
|
|
int iter = 2;
|
|
|
|
int i;
|
|
|
|
|
|
|
|
printf("testing low-pass filter with %d iterations\n", iter);
|
|
|
|
|
2017-05-13 14:04:00 +00:00
|
|
|
iir_lowpass_init(&filter_low, 1000.0, SAMPLERATE, iter);
|
2017-01-15 10:08:42 +00:00
|
|
|
|
|
|
|
for (i = 0; i < 4001; i += 100) {
|
|
|
|
gen_samples(samples, (double)i);
|
2017-05-13 14:04:00 +00:00
|
|
|
iir_process(&filter_low, samples, SAMPLERATE);
|
2017-01-15 10:08:42 +00:00
|
|
|
level = get_level(samples);
|
2017-01-27 16:17:39 +00:00
|
|
|
printf("%s%4d Hz: %.1f dB", debug_db(level), i, level2db(level));
|
2017-01-15 10:08:42 +00:00
|
|
|
if (i == 1000)
|
|
|
|
printf(" cutoff\n");
|
|
|
|
else if (i == 2000)
|
|
|
|
printf(" double frequency\n");
|
|
|
|
else if (i == 4000)
|
|
|
|
printf(" quad frequency\n");
|
|
|
|
else
|
|
|
|
printf("\n");
|
|
|
|
}
|
|
|
|
|
|
|
|
printf("testing high-pass filter with %d iterations\n", iter);
|
|
|
|
|
2017-05-13 14:04:00 +00:00
|
|
|
iir_highpass_init(&filter_high, 2000.0, SAMPLERATE, iter);
|
2017-01-15 10:08:42 +00:00
|
|
|
|
|
|
|
for (i = 0; i < 4001; i += 100) {
|
|
|
|
gen_samples(samples, (double)i);
|
2017-05-13 14:04:00 +00:00
|
|
|
iir_process(&filter_high, samples, SAMPLERATE);
|
2017-01-15 10:08:42 +00:00
|
|
|
level = get_level(samples);
|
2017-01-27 16:17:39 +00:00
|
|
|
printf("%s%4d Hz: %.1f dB", debug_db(level), i, level2db(level));
|
2017-01-15 10:08:42 +00:00
|
|
|
if (i == 2000)
|
|
|
|
printf(" cutoff\n");
|
|
|
|
else if (i == 1000)
|
|
|
|
printf(" half frequency\n");
|
|
|
|
else if (i == 500)
|
|
|
|
printf(" quarter frequency\n");
|
|
|
|
else
|
|
|
|
printf("\n");
|
|
|
|
}
|
|
|
|
|
|
|
|
printf("testing band-pass filter with %d iterations\n", iter);
|
|
|
|
|
2017-05-13 14:04:00 +00:00
|
|
|
iir_lowpass_init(&filter_low, 2000.0, SAMPLERATE, iter);
|
|
|
|
iir_highpass_init(&filter_high, 1000.0, SAMPLERATE, iter);
|
2017-01-15 10:08:42 +00:00
|
|
|
|
|
|
|
for (i = 0; i < 4001; i += 100) {
|
|
|
|
gen_samples(samples, (double)i);
|
2017-05-13 14:04:00 +00:00
|
|
|
iir_process(&filter_low, samples, SAMPLERATE);
|
|
|
|
iir_process(&filter_high, samples, SAMPLERATE);
|
2017-01-15 10:08:42 +00:00
|
|
|
level = get_level(samples);
|
2017-01-27 16:17:39 +00:00
|
|
|
printf("%s%4d Hz: %.1f dB", debug_db(level), i, level2db(level));
|
2017-01-15 10:08:42 +00:00
|
|
|
if (i == 1000)
|
|
|
|
printf(" cutoff high\n");
|
|
|
|
else if (i == 2000)
|
|
|
|
printf(" cutoff low\n");
|
|
|
|
else
|
|
|
|
printf("\n");
|
|
|
|
}
|
|
|
|
|
2020-02-27 17:47:54 +00:00
|
|
|
double freq = 2000.0;
|
|
|
|
double tb = 400.0;
|
|
|
|
printf("testing low-pass FIR filter with %.0fHz transition bandwidth\n", tb);
|
|
|
|
|
|
|
|
fir_low = fir_lowpass_init(SAMPLERATE, freq, tb);
|
|
|
|
printf("Using %d taps\n", fir_low->ntaps);
|
|
|
|
|
|
|
|
for (i = 0; i < 4001; i += 100) {
|
|
|
|
gen_samples(samples, (double)i);
|
|
|
|
fir_process(fir_low, samples, SAMPLERATE);
|
|
|
|
level = get_level(samples);
|
|
|
|
printf("%s%s%4d Hz: %.1f dB", debug_amplitude(level), debug_db(level), i, level2db(level));
|
|
|
|
if (i == freq)
|
|
|
|
printf(" cutoff\n");
|
|
|
|
else
|
|
|
|
printf("\n");
|
|
|
|
}
|
|
|
|
fir_exit(fir_low);
|
|
|
|
|
|
|
|
#if 0
|
|
|
|
double freq1 = 1000.0, freq2 = 2000.0;
|
|
|
|
tb = 100.0;
|
|
|
|
printf("testing two-pass FIR filter\n");
|
|
|
|
|
|
|
|
fir_high = fir_twopass_init(SAMPLERATE, freq1, freq2, tb);
|
|
|
|
printf("Using %d taps\n", fir_high->ntaps);
|
|
|
|
|
|
|
|
for (i = 0; i < 4001; i += 100) {
|
|
|
|
gen_samples(samples, (double)i);
|
|
|
|
fir_process(fir_high, samples, SAMPLERATE);
|
|
|
|
level = get_level(samples);
|
|
|
|
printf("%s%s%4d Hz: %.1f dB", debug_amplitude(level), debug_db(level), i, level2db(level));
|
|
|
|
if (i == freq1 || i == freq2)
|
|
|
|
printf(" cutoff\n");
|
|
|
|
else
|
|
|
|
printf("\n");
|
|
|
|
}
|
|
|
|
fir_exit(fir_high);
|
|
|
|
#endif
|
|
|
|
|
2017-01-15 10:08:42 +00:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|