1*a58d3d2aSXin Li /* Copyright (c) 2008-2011 Xiph.Org Foundation
2*a58d3d2aSXin Li Written by Jean-Marc Valin */
3*a58d3d2aSXin Li /*
4*a58d3d2aSXin Li Redistribution and use in source and binary forms, with or without
5*a58d3d2aSXin Li modification, are permitted provided that the following conditions
6*a58d3d2aSXin Li are met:
7*a58d3d2aSXin Li
8*a58d3d2aSXin Li - Redistributions of source code must retain the above copyright
9*a58d3d2aSXin Li notice, this list of conditions and the following disclaimer.
10*a58d3d2aSXin Li
11*a58d3d2aSXin Li - Redistributions in binary form must reproduce the above copyright
12*a58d3d2aSXin Li notice, this list of conditions and the following disclaimer in the
13*a58d3d2aSXin Li documentation and/or other materials provided with the distribution.
14*a58d3d2aSXin Li
15*a58d3d2aSXin Li THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
16*a58d3d2aSXin Li ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
17*a58d3d2aSXin Li LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
18*a58d3d2aSXin Li A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER
19*a58d3d2aSXin Li OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
20*a58d3d2aSXin Li EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
21*a58d3d2aSXin Li PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
22*a58d3d2aSXin Li PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
23*a58d3d2aSXin Li LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
24*a58d3d2aSXin Li NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
25*a58d3d2aSXin Li SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
26*a58d3d2aSXin Li */
27*a58d3d2aSXin Li
28*a58d3d2aSXin Li #ifdef HAVE_CONFIG_H
29*a58d3d2aSXin Li #include "config.h"
30*a58d3d2aSXin Li #endif
31*a58d3d2aSXin Li
32*a58d3d2aSXin Li #include <stdio.h>
33*a58d3d2aSXin Li
34*a58d3d2aSXin Li #include "mdct.h"
35*a58d3d2aSXin Li #include "stack_alloc.h"
36*a58d3d2aSXin Li #include "kiss_fft.h"
37*a58d3d2aSXin Li #include "mdct.h"
38*a58d3d2aSXin Li #include "modes.h"
39*a58d3d2aSXin Li
40*a58d3d2aSXin Li #ifndef M_PI
41*a58d3d2aSXin Li #define M_PI 3.141592653
42*a58d3d2aSXin Li #endif
43*a58d3d2aSXin Li
44*a58d3d2aSXin Li int ret = 0;
check(kiss_fft_scalar * in,kiss_fft_scalar * out,int nfft,int isinverse)45*a58d3d2aSXin Li void check(kiss_fft_scalar * in,kiss_fft_scalar * out,int nfft,int isinverse)
46*a58d3d2aSXin Li {
47*a58d3d2aSXin Li int bin,k;
48*a58d3d2aSXin Li double errpow=0,sigpow=0;
49*a58d3d2aSXin Li double snr;
50*a58d3d2aSXin Li for (bin=0;bin<nfft/2;++bin) {
51*a58d3d2aSXin Li double ansr = 0;
52*a58d3d2aSXin Li double difr;
53*a58d3d2aSXin Li
54*a58d3d2aSXin Li for (k=0;k<nfft;++k) {
55*a58d3d2aSXin Li double phase = 2*M_PI*(k+.5+.25*nfft)*(bin+.5)/nfft;
56*a58d3d2aSXin Li double re = cos(phase);
57*a58d3d2aSXin Li
58*a58d3d2aSXin Li re /= nfft/4;
59*a58d3d2aSXin Li
60*a58d3d2aSXin Li ansr += in[k] * re;
61*a58d3d2aSXin Li }
62*a58d3d2aSXin Li /*printf ("%f %f\n", ansr, out[bin]);*/
63*a58d3d2aSXin Li difr = ansr - out[bin];
64*a58d3d2aSXin Li errpow += difr*difr;
65*a58d3d2aSXin Li sigpow += ansr*ansr;
66*a58d3d2aSXin Li }
67*a58d3d2aSXin Li snr = 10*log10(sigpow/errpow);
68*a58d3d2aSXin Li printf("nfft=%d inverse=%d,snr = %f\n",nfft,isinverse,snr );
69*a58d3d2aSXin Li if (snr<60) {
70*a58d3d2aSXin Li printf( "** poor snr: %f **\n", snr);
71*a58d3d2aSXin Li ret = 1;
72*a58d3d2aSXin Li }
73*a58d3d2aSXin Li }
74*a58d3d2aSXin Li
check_inv(kiss_fft_scalar * in,kiss_fft_scalar * out,int nfft,int isinverse)75*a58d3d2aSXin Li void check_inv(kiss_fft_scalar * in,kiss_fft_scalar * out,int nfft,int isinverse)
76*a58d3d2aSXin Li {
77*a58d3d2aSXin Li int bin,k;
78*a58d3d2aSXin Li double errpow=0,sigpow=0;
79*a58d3d2aSXin Li double snr;
80*a58d3d2aSXin Li for (bin=0;bin<nfft;++bin) {
81*a58d3d2aSXin Li double ansr = 0;
82*a58d3d2aSXin Li double difr;
83*a58d3d2aSXin Li
84*a58d3d2aSXin Li for (k=0;k<nfft/2;++k) {
85*a58d3d2aSXin Li double phase = 2*M_PI*(bin+.5+.25*nfft)*(k+.5)/nfft;
86*a58d3d2aSXin Li double re = cos(phase);
87*a58d3d2aSXin Li
88*a58d3d2aSXin Li /*re *= 2;*/
89*a58d3d2aSXin Li
90*a58d3d2aSXin Li ansr += in[k] * re;
91*a58d3d2aSXin Li }
92*a58d3d2aSXin Li /*printf ("%f %f\n", ansr, out[bin]);*/
93*a58d3d2aSXin Li difr = ansr - out[bin];
94*a58d3d2aSXin Li errpow += difr*difr;
95*a58d3d2aSXin Li sigpow += ansr*ansr;
96*a58d3d2aSXin Li }
97*a58d3d2aSXin Li snr = 10*log10(sigpow/errpow);
98*a58d3d2aSXin Li printf("nfft=%d inverse=%d,snr = %f\n",nfft,isinverse,snr );
99*a58d3d2aSXin Li if (snr<60) {
100*a58d3d2aSXin Li printf( "** poor snr: %f **\n", snr);
101*a58d3d2aSXin Li ret = 1;
102*a58d3d2aSXin Li }
103*a58d3d2aSXin Li }
104*a58d3d2aSXin Li
105*a58d3d2aSXin Li
test1d(int nfft,int isinverse,int arch)106*a58d3d2aSXin Li void test1d(int nfft,int isinverse,int arch)
107*a58d3d2aSXin Li {
108*a58d3d2aSXin Li size_t buflen = sizeof(kiss_fft_scalar)*nfft;
109*a58d3d2aSXin Li kiss_fft_scalar *in;
110*a58d3d2aSXin Li kiss_fft_scalar *in_copy;
111*a58d3d2aSXin Li kiss_fft_scalar *out;
112*a58d3d2aSXin Li opus_val16 *window;
113*a58d3d2aSXin Li int k;
114*a58d3d2aSXin Li
115*a58d3d2aSXin Li #ifdef CUSTOM_MODES
116*a58d3d2aSXin Li int shift = 0;
117*a58d3d2aSXin Li const mdct_lookup *cfg;
118*a58d3d2aSXin Li mdct_lookup _cfg;
119*a58d3d2aSXin Li clt_mdct_init(&_cfg, nfft, 0, arch);
120*a58d3d2aSXin Li cfg = &_cfg;
121*a58d3d2aSXin Li #else
122*a58d3d2aSXin Li int shift;
123*a58d3d2aSXin Li const mdct_lookup *cfg;
124*a58d3d2aSXin Li CELTMode *mode = opus_custom_mode_create(48000, 960, NULL);
125*a58d3d2aSXin Li if (nfft == 1920) shift = 0;
126*a58d3d2aSXin Li else if (nfft == 960) shift = 1;
127*a58d3d2aSXin Li else if (nfft == 480) shift = 2;
128*a58d3d2aSXin Li else if (nfft == 240) shift = 3;
129*a58d3d2aSXin Li else return;
130*a58d3d2aSXin Li cfg = &mode->mdct;
131*a58d3d2aSXin Li #endif
132*a58d3d2aSXin Li
133*a58d3d2aSXin Li in = (kiss_fft_scalar*)malloc(buflen);
134*a58d3d2aSXin Li in_copy = (kiss_fft_scalar*)malloc(buflen);
135*a58d3d2aSXin Li out = (kiss_fft_scalar*)malloc(buflen);
136*a58d3d2aSXin Li window = (opus_val16*)malloc(sizeof(opus_val16)*nfft/2);
137*a58d3d2aSXin Li
138*a58d3d2aSXin Li for (k=0;k<nfft;++k) {
139*a58d3d2aSXin Li in[k] = (rand() % 32768) - 16384;
140*a58d3d2aSXin Li }
141*a58d3d2aSXin Li
142*a58d3d2aSXin Li for (k=0;k<nfft/2;++k) {
143*a58d3d2aSXin Li window[k] = Q15ONE;
144*a58d3d2aSXin Li }
145*a58d3d2aSXin Li for (k=0;k<nfft;++k) {
146*a58d3d2aSXin Li in[k] *= 32768;
147*a58d3d2aSXin Li }
148*a58d3d2aSXin Li
149*a58d3d2aSXin Li if (isinverse)
150*a58d3d2aSXin Li {
151*a58d3d2aSXin Li for (k=0;k<nfft;++k) {
152*a58d3d2aSXin Li in[k] /= nfft;
153*a58d3d2aSXin Li }
154*a58d3d2aSXin Li }
155*a58d3d2aSXin Li
156*a58d3d2aSXin Li for (k=0;k<nfft;++k)
157*a58d3d2aSXin Li in_copy[k] = in[k];
158*a58d3d2aSXin Li /*for (k=0;k<nfft;++k) printf("%d %d ", in[k].r, in[k].i);printf("\n");*/
159*a58d3d2aSXin Li
160*a58d3d2aSXin Li if (isinverse)
161*a58d3d2aSXin Li {
162*a58d3d2aSXin Li for (k=0;k<nfft;++k)
163*a58d3d2aSXin Li out[k] = 0;
164*a58d3d2aSXin Li clt_mdct_backward(cfg,in,out, window, nfft/2, shift, 1, arch);
165*a58d3d2aSXin Li /* apply TDAC because clt_mdct_backward() no longer does that */
166*a58d3d2aSXin Li for (k=0;k<nfft/4;++k)
167*a58d3d2aSXin Li out[nfft-k-1] = out[nfft/2+k];
168*a58d3d2aSXin Li check_inv(in,out,nfft,isinverse);
169*a58d3d2aSXin Li } else {
170*a58d3d2aSXin Li clt_mdct_forward(cfg,in,out,window, nfft/2, shift, 1, arch);
171*a58d3d2aSXin Li check(in_copy,out,nfft,isinverse);
172*a58d3d2aSXin Li }
173*a58d3d2aSXin Li /*for (k=0;k<nfft;++k) printf("%d %d ", out[k].r, out[k].i);printf("\n");*/
174*a58d3d2aSXin Li
175*a58d3d2aSXin Li
176*a58d3d2aSXin Li free(in);
177*a58d3d2aSXin Li free(in_copy);
178*a58d3d2aSXin Li free(out);
179*a58d3d2aSXin Li free(window);
180*a58d3d2aSXin Li #ifdef CUSTOM_MODES
181*a58d3d2aSXin Li clt_mdct_clear(&_cfg, arch);
182*a58d3d2aSXin Li #endif
183*a58d3d2aSXin Li }
184*a58d3d2aSXin Li
main(int argc,char ** argv)185*a58d3d2aSXin Li int main(int argc,char ** argv)
186*a58d3d2aSXin Li {
187*a58d3d2aSXin Li int arch;
188*a58d3d2aSXin Li ALLOC_STACK;
189*a58d3d2aSXin Li arch = opus_select_arch();
190*a58d3d2aSXin Li
191*a58d3d2aSXin Li if (argc>1) {
192*a58d3d2aSXin Li int k;
193*a58d3d2aSXin Li for (k=1;k<argc;++k) {
194*a58d3d2aSXin Li test1d(atoi(argv[k]),0,arch);
195*a58d3d2aSXin Li test1d(atoi(argv[k]),1,arch);
196*a58d3d2aSXin Li }
197*a58d3d2aSXin Li }else{
198*a58d3d2aSXin Li test1d(32,0,arch);
199*a58d3d2aSXin Li test1d(32,1,arch);
200*a58d3d2aSXin Li test1d(256,0,arch);
201*a58d3d2aSXin Li test1d(256,1,arch);
202*a58d3d2aSXin Li test1d(512,0,arch);
203*a58d3d2aSXin Li test1d(512,1,arch);
204*a58d3d2aSXin Li test1d(1024,0,arch);
205*a58d3d2aSXin Li test1d(1024,1,arch);
206*a58d3d2aSXin Li test1d(2048,0,arch);
207*a58d3d2aSXin Li test1d(2048,1,arch);
208*a58d3d2aSXin Li #ifndef RADIX_TWO_ONLY
209*a58d3d2aSXin Li test1d(36,0,arch);
210*a58d3d2aSXin Li test1d(36,1,arch);
211*a58d3d2aSXin Li test1d(40,0,arch);
212*a58d3d2aSXin Li test1d(40,1,arch);
213*a58d3d2aSXin Li test1d(60,0,arch);
214*a58d3d2aSXin Li test1d(60,1,arch);
215*a58d3d2aSXin Li test1d(120,0,arch);
216*a58d3d2aSXin Li test1d(120,1,arch);
217*a58d3d2aSXin Li test1d(240,0,arch);
218*a58d3d2aSXin Li test1d(240,1,arch);
219*a58d3d2aSXin Li test1d(480,0,arch);
220*a58d3d2aSXin Li test1d(480,1,arch);
221*a58d3d2aSXin Li test1d(960,0,arch);
222*a58d3d2aSXin Li test1d(960,1,arch);
223*a58d3d2aSXin Li test1d(1920,0,arch);
224*a58d3d2aSXin Li test1d(1920,1,arch);
225*a58d3d2aSXin Li #endif
226*a58d3d2aSXin Li }
227*a58d3d2aSXin Li RESTORE_STACK;
228*a58d3d2aSXin Li return ret;
229*a58d3d2aSXin Li }
230