cannam@154
|
1 /* Copyright (c) 2015 Xiph.Org Foundation
|
cannam@154
|
2 Written by Viswanath Puttagunta */
|
cannam@154
|
3 /**
|
cannam@154
|
4 @file celt_mdct_ne10.c
|
cannam@154
|
5 @brief ARM Neon optimizations for mdct using NE10 library
|
cannam@154
|
6 */
|
cannam@154
|
7
|
cannam@154
|
8 /*
|
cannam@154
|
9 Redistribution and use in source and binary forms, with or without
|
cannam@154
|
10 modification, are permitted provided that the following conditions
|
cannam@154
|
11 are met:
|
cannam@154
|
12
|
cannam@154
|
13 - Redistributions of source code must retain the above copyright
|
cannam@154
|
14 notice, this list of conditions and the following disclaimer.
|
cannam@154
|
15
|
cannam@154
|
16 - Redistributions in binary form must reproduce the above copyright
|
cannam@154
|
17 notice, this list of conditions and the following disclaimer in the
|
cannam@154
|
18 documentation and/or other materials provided with the distribution.
|
cannam@154
|
19
|
cannam@154
|
20 THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
cannam@154
|
21 ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
cannam@154
|
22 LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
|
cannam@154
|
23 A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER
|
cannam@154
|
24 OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
|
cannam@154
|
25 EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
|
cannam@154
|
26 PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
|
cannam@154
|
27 PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
|
cannam@154
|
28 LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
cannam@154
|
29 NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
|
cannam@154
|
30 SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
cannam@154
|
31 */
|
cannam@154
|
32
|
cannam@154
|
33 #ifndef SKIP_CONFIG_H
|
cannam@154
|
34 #ifdef HAVE_CONFIG_H
|
cannam@154
|
35 #include "config.h"
|
cannam@154
|
36 #endif
|
cannam@154
|
37 #endif
|
cannam@154
|
38
|
cannam@154
|
39 #include "kiss_fft.h"
|
cannam@154
|
40 #include "_kiss_fft_guts.h"
|
cannam@154
|
41 #include "mdct.h"
|
cannam@154
|
42 #include "stack_alloc.h"
|
cannam@154
|
43
|
cannam@154
|
44 void clt_mdct_forward_neon(const mdct_lookup *l,
|
cannam@154
|
45 kiss_fft_scalar *in,
|
cannam@154
|
46 kiss_fft_scalar * OPUS_RESTRICT out,
|
cannam@154
|
47 const opus_val16 *window,
|
cannam@154
|
48 int overlap, int shift, int stride, int arch)
|
cannam@154
|
49 {
|
cannam@154
|
50 int i;
|
cannam@154
|
51 int N, N2, N4;
|
cannam@154
|
52 VARDECL(kiss_fft_scalar, f);
|
cannam@154
|
53 VARDECL(kiss_fft_cpx, f2);
|
cannam@154
|
54 const kiss_fft_state *st = l->kfft[shift];
|
cannam@154
|
55 const kiss_twiddle_scalar *trig;
|
cannam@154
|
56
|
cannam@154
|
57 SAVE_STACK;
|
cannam@154
|
58
|
cannam@154
|
59 N = l->n;
|
cannam@154
|
60 trig = l->trig;
|
cannam@154
|
61 for (i=0;i<shift;i++)
|
cannam@154
|
62 {
|
cannam@154
|
63 N >>= 1;
|
cannam@154
|
64 trig += N;
|
cannam@154
|
65 }
|
cannam@154
|
66 N2 = N>>1;
|
cannam@154
|
67 N4 = N>>2;
|
cannam@154
|
68
|
cannam@154
|
69 ALLOC(f, N2, kiss_fft_scalar);
|
cannam@154
|
70 ALLOC(f2, N4, kiss_fft_cpx);
|
cannam@154
|
71
|
cannam@154
|
72 /* Consider the input to be composed of four blocks: [a, b, c, d] */
|
cannam@154
|
73 /* Window, shuffle, fold */
|
cannam@154
|
74 {
|
cannam@154
|
75 /* Temp pointers to make it really clear to the compiler what we're doing */
|
cannam@154
|
76 const kiss_fft_scalar * OPUS_RESTRICT xp1 = in+(overlap>>1);
|
cannam@154
|
77 const kiss_fft_scalar * OPUS_RESTRICT xp2 = in+N2-1+(overlap>>1);
|
cannam@154
|
78 kiss_fft_scalar * OPUS_RESTRICT yp = f;
|
cannam@154
|
79 const opus_val16 * OPUS_RESTRICT wp1 = window+(overlap>>1);
|
cannam@154
|
80 const opus_val16 * OPUS_RESTRICT wp2 = window+(overlap>>1)-1;
|
cannam@154
|
81 for(i=0;i<((overlap+3)>>2);i++)
|
cannam@154
|
82 {
|
cannam@154
|
83 /* Real part arranged as -d-cR, Imag part arranged as -b+aR*/
|
cannam@154
|
84 *yp++ = MULT16_32_Q15(*wp2, xp1[N2]) + MULT16_32_Q15(*wp1,*xp2);
|
cannam@154
|
85 *yp++ = MULT16_32_Q15(*wp1, *xp1) - MULT16_32_Q15(*wp2, xp2[-N2]);
|
cannam@154
|
86 xp1+=2;
|
cannam@154
|
87 xp2-=2;
|
cannam@154
|
88 wp1+=2;
|
cannam@154
|
89 wp2-=2;
|
cannam@154
|
90 }
|
cannam@154
|
91 wp1 = window;
|
cannam@154
|
92 wp2 = window+overlap-1;
|
cannam@154
|
93 for(;i<N4-((overlap+3)>>2);i++)
|
cannam@154
|
94 {
|
cannam@154
|
95 /* Real part arranged as a-bR, Imag part arranged as -c-dR */
|
cannam@154
|
96 *yp++ = *xp2;
|
cannam@154
|
97 *yp++ = *xp1;
|
cannam@154
|
98 xp1+=2;
|
cannam@154
|
99 xp2-=2;
|
cannam@154
|
100 }
|
cannam@154
|
101 for(;i<N4;i++)
|
cannam@154
|
102 {
|
cannam@154
|
103 /* Real part arranged as a-bR, Imag part arranged as -c-dR */
|
cannam@154
|
104 *yp++ = -MULT16_32_Q15(*wp1, xp1[-N2]) + MULT16_32_Q15(*wp2, *xp2);
|
cannam@154
|
105 *yp++ = MULT16_32_Q15(*wp2, *xp1) + MULT16_32_Q15(*wp1, xp2[N2]);
|
cannam@154
|
106 xp1+=2;
|
cannam@154
|
107 xp2-=2;
|
cannam@154
|
108 wp1+=2;
|
cannam@154
|
109 wp2-=2;
|
cannam@154
|
110 }
|
cannam@154
|
111 }
|
cannam@154
|
112 /* Pre-rotation */
|
cannam@154
|
113 {
|
cannam@154
|
114 kiss_fft_scalar * OPUS_RESTRICT yp = f;
|
cannam@154
|
115 const kiss_twiddle_scalar *t = &trig[0];
|
cannam@154
|
116 for(i=0;i<N4;i++)
|
cannam@154
|
117 {
|
cannam@154
|
118 kiss_fft_cpx yc;
|
cannam@154
|
119 kiss_twiddle_scalar t0, t1;
|
cannam@154
|
120 kiss_fft_scalar re, im, yr, yi;
|
cannam@154
|
121 t0 = t[i];
|
cannam@154
|
122 t1 = t[N4+i];
|
cannam@154
|
123 re = *yp++;
|
cannam@154
|
124 im = *yp++;
|
cannam@154
|
125 yr = S_MUL(re,t0) - S_MUL(im,t1);
|
cannam@154
|
126 yi = S_MUL(im,t0) + S_MUL(re,t1);
|
cannam@154
|
127 yc.r = yr;
|
cannam@154
|
128 yc.i = yi;
|
cannam@154
|
129 f2[i] = yc;
|
cannam@154
|
130 }
|
cannam@154
|
131 }
|
cannam@154
|
132
|
cannam@154
|
133 opus_fft(st, f2, (kiss_fft_cpx *)f, arch);
|
cannam@154
|
134
|
cannam@154
|
135 /* Post-rotate */
|
cannam@154
|
136 {
|
cannam@154
|
137 /* Temp pointers to make it really clear to the compiler what we're doing */
|
cannam@154
|
138 const kiss_fft_cpx * OPUS_RESTRICT fp = (kiss_fft_cpx *)f;
|
cannam@154
|
139 kiss_fft_scalar * OPUS_RESTRICT yp1 = out;
|
cannam@154
|
140 kiss_fft_scalar * OPUS_RESTRICT yp2 = out+stride*(N2-1);
|
cannam@154
|
141 const kiss_twiddle_scalar *t = &trig[0];
|
cannam@154
|
142 /* Temp pointers to make it really clear to the compiler what we're doing */
|
cannam@154
|
143 for(i=0;i<N4;i++)
|
cannam@154
|
144 {
|
cannam@154
|
145 kiss_fft_scalar yr, yi;
|
cannam@154
|
146 yr = S_MUL(fp->i,t[N4+i]) - S_MUL(fp->r,t[i]);
|
cannam@154
|
147 yi = S_MUL(fp->r,t[N4+i]) + S_MUL(fp->i,t[i]);
|
cannam@154
|
148 *yp1 = yr;
|
cannam@154
|
149 *yp2 = yi;
|
cannam@154
|
150 fp++;
|
cannam@154
|
151 yp1 += 2*stride;
|
cannam@154
|
152 yp2 -= 2*stride;
|
cannam@154
|
153 }
|
cannam@154
|
154 }
|
cannam@154
|
155 RESTORE_STACK;
|
cannam@154
|
156 }
|
cannam@154
|
157
|
cannam@154
|
158 void clt_mdct_backward_neon(const mdct_lookup *l,
|
cannam@154
|
159 kiss_fft_scalar *in,
|
cannam@154
|
160 kiss_fft_scalar * OPUS_RESTRICT out,
|
cannam@154
|
161 const opus_val16 * OPUS_RESTRICT window,
|
cannam@154
|
162 int overlap, int shift, int stride, int arch)
|
cannam@154
|
163 {
|
cannam@154
|
164 int i;
|
cannam@154
|
165 int N, N2, N4;
|
cannam@154
|
166 VARDECL(kiss_fft_scalar, f);
|
cannam@154
|
167 const kiss_twiddle_scalar *trig;
|
cannam@154
|
168 const kiss_fft_state *st = l->kfft[shift];
|
cannam@154
|
169
|
cannam@154
|
170 N = l->n;
|
cannam@154
|
171 trig = l->trig;
|
cannam@154
|
172 for (i=0;i<shift;i++)
|
cannam@154
|
173 {
|
cannam@154
|
174 N >>= 1;
|
cannam@154
|
175 trig += N;
|
cannam@154
|
176 }
|
cannam@154
|
177 N2 = N>>1;
|
cannam@154
|
178 N4 = N>>2;
|
cannam@154
|
179
|
cannam@154
|
180 ALLOC(f, N2, kiss_fft_scalar);
|
cannam@154
|
181
|
cannam@154
|
182 /* Pre-rotate */
|
cannam@154
|
183 {
|
cannam@154
|
184 /* Temp pointers to make it really clear to the compiler what we're doing */
|
cannam@154
|
185 const kiss_fft_scalar * OPUS_RESTRICT xp1 = in;
|
cannam@154
|
186 const kiss_fft_scalar * OPUS_RESTRICT xp2 = in+stride*(N2-1);
|
cannam@154
|
187 kiss_fft_scalar * OPUS_RESTRICT yp = f;
|
cannam@154
|
188 const kiss_twiddle_scalar * OPUS_RESTRICT t = &trig[0];
|
cannam@154
|
189 for(i=0;i<N4;i++)
|
cannam@154
|
190 {
|
cannam@154
|
191 kiss_fft_scalar yr, yi;
|
cannam@154
|
192 yr = S_MUL(*xp2, t[i]) + S_MUL(*xp1, t[N4+i]);
|
cannam@154
|
193 yi = S_MUL(*xp1, t[i]) - S_MUL(*xp2, t[N4+i]);
|
cannam@154
|
194 yp[2*i] = yr;
|
cannam@154
|
195 yp[2*i+1] = yi;
|
cannam@154
|
196 xp1+=2*stride;
|
cannam@154
|
197 xp2-=2*stride;
|
cannam@154
|
198 }
|
cannam@154
|
199 }
|
cannam@154
|
200
|
cannam@154
|
201 opus_ifft(st, (kiss_fft_cpx *)f, (kiss_fft_cpx*)(out+(overlap>>1)), arch);
|
cannam@154
|
202
|
cannam@154
|
203 /* Post-rotate and de-shuffle from both ends of the buffer at once to make
|
cannam@154
|
204 it in-place. */
|
cannam@154
|
205 {
|
cannam@154
|
206 kiss_fft_scalar * yp0 = out+(overlap>>1);
|
cannam@154
|
207 kiss_fft_scalar * yp1 = out+(overlap>>1)+N2-2;
|
cannam@154
|
208 const kiss_twiddle_scalar *t = &trig[0];
|
cannam@154
|
209 /* Loop to (N4+1)>>1 to handle odd N4. When N4 is odd, the
|
cannam@154
|
210 middle pair will be computed twice. */
|
cannam@154
|
211 for(i=0;i<(N4+1)>>1;i++)
|
cannam@154
|
212 {
|
cannam@154
|
213 kiss_fft_scalar re, im, yr, yi;
|
cannam@154
|
214 kiss_twiddle_scalar t0, t1;
|
cannam@154
|
215 re = yp0[0];
|
cannam@154
|
216 im = yp0[1];
|
cannam@154
|
217 t0 = t[i];
|
cannam@154
|
218 t1 = t[N4+i];
|
cannam@154
|
219 /* We'd scale up by 2 here, but instead it's done when mixing the windows */
|
cannam@154
|
220 yr = S_MUL(re,t0) + S_MUL(im,t1);
|
cannam@154
|
221 yi = S_MUL(re,t1) - S_MUL(im,t0);
|
cannam@154
|
222 re = yp1[0];
|
cannam@154
|
223 im = yp1[1];
|
cannam@154
|
224 yp0[0] = yr;
|
cannam@154
|
225 yp1[1] = yi;
|
cannam@154
|
226
|
cannam@154
|
227 t0 = t[(N4-i-1)];
|
cannam@154
|
228 t1 = t[(N2-i-1)];
|
cannam@154
|
229 /* We'd scale up by 2 here, but instead it's done when mixing the windows */
|
cannam@154
|
230 yr = S_MUL(re,t0) + S_MUL(im,t1);
|
cannam@154
|
231 yi = S_MUL(re,t1) - S_MUL(im,t0);
|
cannam@154
|
232 yp1[0] = yr;
|
cannam@154
|
233 yp0[1] = yi;
|
cannam@154
|
234 yp0 += 2;
|
cannam@154
|
235 yp1 -= 2;
|
cannam@154
|
236 }
|
cannam@154
|
237 }
|
cannam@154
|
238
|
cannam@154
|
239 /* Mirror on both sides for TDAC */
|
cannam@154
|
240 {
|
cannam@154
|
241 kiss_fft_scalar * OPUS_RESTRICT xp1 = out+overlap-1;
|
cannam@154
|
242 kiss_fft_scalar * OPUS_RESTRICT yp1 = out;
|
cannam@154
|
243 const opus_val16 * OPUS_RESTRICT wp1 = window;
|
cannam@154
|
244 const opus_val16 * OPUS_RESTRICT wp2 = window+overlap-1;
|
cannam@154
|
245
|
cannam@154
|
246 for(i = 0; i < overlap/2; i++)
|
cannam@154
|
247 {
|
cannam@154
|
248 kiss_fft_scalar x1, x2;
|
cannam@154
|
249 x1 = *xp1;
|
cannam@154
|
250 x2 = *yp1;
|
cannam@154
|
251 *yp1++ = MULT16_32_Q15(*wp2, x2) - MULT16_32_Q15(*wp1, x1);
|
cannam@154
|
252 *xp1-- = MULT16_32_Q15(*wp1, x2) + MULT16_32_Q15(*wp2, x1);
|
cannam@154
|
253 wp1++;
|
cannam@154
|
254 wp2--;
|
cannam@154
|
255 }
|
cannam@154
|
256 }
|
cannam@154
|
257 RESTORE_STACK;
|
cannam@154
|
258 }
|