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
|
#include <stdio.h>
#include <stdint.h>
#include <math.h>
#include <string.h>
#include "../common/emphasis.h"
#define level2db(level) (20 * log10(level))
#define db2level(db) pow(10, (double)db / 20.0)
#define SAMPLERATE 48000
#define DEVIATION 8000.0
static void check_level(int16_t *samples, const char *desc)
{
int i;
int last = 0, envelope = 0;
int up = 0;
int freq;
for (i = 0; i < SAMPLERATE; i++) {
if (last < samples[i]) {
up = 1;
} else if (last > samples[i]) {
if (up) {
envelope = last;
}
up = 0;
}
if ((i % (SAMPLERATE/40)) == 0) {
freq = 500 + 500 * (i / (SAMPLERATE / 8));
printf("%s: f = %d envelop = %.4f\n", desc, freq, level2db((double)envelope / DEVIATION));
}
last = samples[i];
}
}
static void gen_samples(int16_t *samples)
{
int i;
double value;
int freq;
for (i = 0; i < SAMPLERATE; i++) {
freq = 500 + 500 * (i / (SAMPLERATE / 8));
value = sin(2.0 * M_PI * (double)freq / (double)SAMPLERATE * (double)i);
samples[i] = value * DEVIATION;
}
}
int main(void)
{
emphasis_t estate;
int16_t samples[SAMPLERATE];
/* generate sweep 0..4khz */
gen_samples(samples);
init_emphasis(&estate, SAMPLERATE);
// check_level(samples, "unchanged");
pre_emphasis(&estate, samples, SAMPLERATE);
check_level(samples, "pre-emphasis");
/* generate sweep 0..4khz */
gen_samples(samples);
de_emphasis(&estate, samples, SAMPLERATE);
check_level(samples, "de-emphasis");
return 0;
}
|