aboutsummaryrefslogtreecommitdiffstats
path: root/src/test/test_emphasis.c
blob: eda8d8e43e6610c7d7ca700c2c0302e53096dc2b (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
#include <stdio.h>
#include <stdint.h>
#include <math.h>
#include <string.h>
#include "../common/sample.h"
#include "../common/iir_filter.h"
#include "../common/emphasis.h"
#include "../common/debug.h"

#define level2db(level)		(20 * log10(level))
#define db2level(db)		pow(10, (double)db / 20.0)

#define SAMPLERATE	48000

static double get_level(sample_t *samples)
{
	int i;
	double envelope = 0;
	for (i = SAMPLERATE/2; i < SAMPLERATE; i++) {
		if (samples[i] > envelope)
			envelope = samples[i];
	}

	return envelope;
}

static void gen_samples(sample_t *samples, double freq)
{
	int i;
	double value;

	for (i = 0; i < SAMPLERATE; i++) {
		value = cos(2.0 * M_PI * freq / (double)SAMPLERATE * (double)i);
		samples[i] = value;
	}
}

int main(void)
{
	emphasis_t estate;
	double cut_off = CUT_OFF_EMPHASIS_DEFAULT;
	sample_t samples[SAMPLERATE];
	double level;
	double i;

	debuglevel = DEBUG_DEBUG;

	init_emphasis(&estate, SAMPLERATE, cut_off);

	printf("testing pre-emphasis filter with cut-off frequency %.1f\n", cut_off);

	for (i = 31.25; i < 4001; i = i * sqrt(sqrt(2.0))) {
		gen_samples(samples, (double)i);
		pre_emphasis(&estate, samples, SAMPLERATE);
		level = get_level(samples);
		printf("%s%.0f Hz: %.1f dB", debug_db(level), i, level2db(level));
		if ((int)round(i) == 1000)
			printf(" level=%.6f\n", level);
		else
			printf("\n");
	}

	printf("testing de-emphasis filter with cut-off frequency %.1f\n", cut_off);

	for (i = 31.25; i < 4001; i = i * sqrt(sqrt(2.0))) {
		gen_samples(samples, (double)i);
		dc_filter(&estate, samples, SAMPLERATE);
		de_emphasis(&estate, samples, SAMPLERATE);
		level = get_level(samples);
		printf("%s%.0f Hz: %.1f dB", debug_db(level), i, level2db(level));
		if ((int)round(i) == 1000)
			printf(" level=%.6f\n", level);
		else
			printf("\n");
	}

	return 0;
}