cannam@85
|
1 /*
|
cannam@85
|
2 ** Copyright (C) 2002-2011 Erik de Castro Lopo <erikd@mega-nerd.com>
|
cannam@85
|
3 **
|
cannam@85
|
4 ** This program is free software; you can redistribute it and/or modify
|
cannam@85
|
5 ** it under the terms of the GNU General Public License as published by
|
cannam@85
|
6 ** the Free Software Foundation; either version 2 of the License, or
|
cannam@85
|
7 ** (at your option) any later version.
|
cannam@85
|
8 **
|
cannam@85
|
9 ** This program is distributed in the hope that it will be useful,
|
cannam@85
|
10 ** but WITHOUT ANY WARRANTY; without even the implied warranty of
|
cannam@85
|
11 ** MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
cannam@85
|
12 ** GNU General Public License for more details.
|
cannam@85
|
13 **
|
cannam@85
|
14 ** You should have received a copy of the GNU General Public License
|
cannam@85
|
15 ** along with this program; if not, write to the Free Software
|
cannam@85
|
16 ** Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
|
cannam@85
|
17 */
|
cannam@85
|
18
|
cannam@85
|
19 #include <stdio.h>
|
cannam@85
|
20 #include <stdlib.h>
|
cannam@85
|
21 #include <math.h>
|
cannam@85
|
22
|
cannam@85
|
23 #include "dft_cmp.h"
|
cannam@85
|
24 #include "utils.h"
|
cannam@85
|
25
|
cannam@85
|
26 #ifndef M_PI
|
cannam@85
|
27 #define M_PI 3.14159265358979323846264338
|
cannam@85
|
28 #endif
|
cannam@85
|
29
|
cannam@85
|
30 #define DFT_SPEC_LENGTH (DFT_DATA_LENGTH / 2)
|
cannam@85
|
31
|
cannam@85
|
32 static void dft_magnitude (const double *data, double *spectrum) ;
|
cannam@85
|
33 static double calc_max_spectral_difference (const double *spec1, const double *spec2) ;
|
cannam@85
|
34
|
cannam@85
|
35 /*--------------------------------------------------------------------------------
|
cannam@85
|
36 ** Public functions.
|
cannam@85
|
37 */
|
cannam@85
|
38
|
cannam@85
|
39 double
|
cannam@85
|
40 dft_cmp_float (int linenum, const float *in_data, const float *test_data, int len, double target_snr, int allow_exit)
|
cannam@85
|
41 { static double orig [DFT_DATA_LENGTH] ;
|
cannam@85
|
42 static double test [DFT_DATA_LENGTH] ;
|
cannam@85
|
43 unsigned k ;
|
cannam@85
|
44
|
cannam@85
|
45 if (len != DFT_DATA_LENGTH)
|
cannam@85
|
46 { printf ("Error (line %d) : dft_cmp_float : Bad input array length.\n", linenum) ;
|
cannam@85
|
47 return 1 ;
|
cannam@85
|
48 } ;
|
cannam@85
|
49
|
cannam@85
|
50 for (k = 0 ; k < ARRAY_LEN (orig) ; k++)
|
cannam@85
|
51 { test [k] = test_data [k] ;
|
cannam@85
|
52 orig [k] = in_data [k] ;
|
cannam@85
|
53 } ;
|
cannam@85
|
54
|
cannam@85
|
55 return dft_cmp_double (linenum, orig, test, len, target_snr, allow_exit) ;
|
cannam@85
|
56 } /* dft_cmp_float */
|
cannam@85
|
57
|
cannam@85
|
58 double
|
cannam@85
|
59 dft_cmp_double (int linenum, const double *orig, const double *test, int len, double target_snr, int allow_exit)
|
cannam@85
|
60 { static double orig_spec [DFT_SPEC_LENGTH] ;
|
cannam@85
|
61 static double test_spec [DFT_SPEC_LENGTH] ;
|
cannam@85
|
62 double snr ;
|
cannam@85
|
63
|
cannam@85
|
64 if (! orig || ! test)
|
cannam@85
|
65 { printf ("Error (line %d) : dft_cmp_double : Bad input arrays.\n", linenum) ;
|
cannam@85
|
66 return 1 ;
|
cannam@85
|
67 } ;
|
cannam@85
|
68
|
cannam@85
|
69 if (len != DFT_DATA_LENGTH)
|
cannam@85
|
70 { printf ("Error (line %d) : dft_cmp_double : Bad input array length.\n", linenum) ;
|
cannam@85
|
71 return 1 ;
|
cannam@85
|
72 } ;
|
cannam@85
|
73
|
cannam@85
|
74 dft_magnitude (orig, orig_spec) ;
|
cannam@85
|
75 dft_magnitude (test, test_spec) ;
|
cannam@85
|
76
|
cannam@85
|
77 snr = calc_max_spectral_difference (orig_spec, test_spec) ;
|
cannam@85
|
78
|
cannam@85
|
79 if (snr > target_snr)
|
cannam@85
|
80 { printf ("\n\nLine %d: Actual SNR (% 4.1f) > target SNR (% 4.1f).\n\n", linenum, snr, target_snr) ;
|
cannam@85
|
81 oct_save_double (orig, test, len) ;
|
cannam@85
|
82 if (allow_exit)
|
cannam@85
|
83 exit (1) ;
|
cannam@85
|
84 } ;
|
cannam@85
|
85
|
cannam@85
|
86 if (snr < -500.0)
|
cannam@85
|
87 snr = -500.0 ;
|
cannam@85
|
88
|
cannam@85
|
89 return snr ;
|
cannam@85
|
90 } /* dft_cmp_double */
|
cannam@85
|
91
|
cannam@85
|
92 /*--------------------------------------------------------------------------------
|
cannam@85
|
93 ** Quick dirty calculation of magnitude spectrum for real valued data using
|
cannam@85
|
94 ** Discrete Fourier Transform. Since the data is real, the DFT is only
|
cannam@85
|
95 ** calculated for positive frequencies.
|
cannam@85
|
96 */
|
cannam@85
|
97
|
cannam@85
|
98 static void
|
cannam@85
|
99 dft_magnitude (const double *data, double *spectrum)
|
cannam@85
|
100 { static double cos_angle [DFT_DATA_LENGTH] = { 0.0 } ;
|
cannam@85
|
101 static double sin_angle [DFT_DATA_LENGTH] ;
|
cannam@85
|
102
|
cannam@85
|
103 double real_part, imag_part ;
|
cannam@85
|
104 int k, n ;
|
cannam@85
|
105
|
cannam@85
|
106 /* If sine and cosine tables haven't been initialised, do so. */
|
cannam@85
|
107 if (cos_angle [0] == 0.0)
|
cannam@85
|
108 for (n = 0 ; n < DFT_DATA_LENGTH ; n++)
|
cannam@85
|
109 { cos_angle [n] = cos (2.0 * M_PI * n / DFT_DATA_LENGTH) ;
|
cannam@85
|
110 sin_angle [n] = -1.0 * sin (2.0 * M_PI * n / DFT_DATA_LENGTH) ;
|
cannam@85
|
111 } ;
|
cannam@85
|
112
|
cannam@85
|
113 /* DFT proper. Since the data is real, only generate a half spectrum. */
|
cannam@85
|
114 for (k = 1 ; k < DFT_SPEC_LENGTH ; k++)
|
cannam@85
|
115 { real_part = 0.0 ;
|
cannam@85
|
116 imag_part = 0.0 ;
|
cannam@85
|
117
|
cannam@85
|
118 for (n = 0 ; n < DFT_DATA_LENGTH ; n++)
|
cannam@85
|
119 { real_part += data [n] * cos_angle [(k * n) % DFT_DATA_LENGTH] ;
|
cannam@85
|
120 imag_part += data [n] * sin_angle [(k * n) % DFT_DATA_LENGTH] ;
|
cannam@85
|
121 } ;
|
cannam@85
|
122
|
cannam@85
|
123 spectrum [k] = sqrt (real_part * real_part + imag_part * imag_part) ;
|
cannam@85
|
124 } ;
|
cannam@85
|
125
|
cannam@85
|
126 spectrum [k] = 0.0 ;
|
cannam@85
|
127
|
cannam@85
|
128 spectrum [0] = spectrum [1] = spectrum [2] = spectrum [3] = spectrum [4] = 0.0 ;
|
cannam@85
|
129
|
cannam@85
|
130 return ;
|
cannam@85
|
131 } /* dft_magnitude */
|
cannam@85
|
132
|
cannam@85
|
133 static double
|
cannam@85
|
134 calc_max_spectral_difference (const double *orig, const double *test)
|
cannam@85
|
135 { double orig_max = 0.0, max_diff = 0.0 ;
|
cannam@85
|
136 int k ;
|
cannam@85
|
137
|
cannam@85
|
138 for (k = 0 ; k < DFT_SPEC_LENGTH ; k++)
|
cannam@85
|
139 { if (orig_max < orig [k])
|
cannam@85
|
140 orig_max = orig [k] ;
|
cannam@85
|
141 if (max_diff < fabs (orig [k] - test [k]))
|
cannam@85
|
142 max_diff = fabs (orig [k] - test [k]) ;
|
cannam@85
|
143 } ;
|
cannam@85
|
144
|
cannam@85
|
145 if (max_diff < 1e-25)
|
cannam@85
|
146 return -500.0 ;
|
cannam@85
|
147
|
cannam@85
|
148 return 20.0 * log10 (max_diff / orig_max) ;
|
cannam@85
|
149 } /* calc_max_spectral_difference */
|