avcodec: loongson remove useless macros in mipsfpu optimization
[ffmpeg.git] / libavcodec / mips / sbrdsp_mips.c
1 /*
2  * Copyright (c) 2012
3  *      MIPS Technologies, Inc., California.
4  *
5  * Redistribution and use in source and binary forms, with or without
6  * modification, are permitted provided that the following conditions
7  * are met:
8  * 1. Redistributions of source code must retain the above copyright
9  *    notice, this list of conditions and the following disclaimer.
10  * 2. Redistributions in binary form must reproduce the above copyright
11  *    notice, this list of conditions and the following disclaimer in the
12  *    documentation and/or other materials provided with the distribution.
13  * 3. Neither the name of the MIPS Technologies, Inc., nor the names of its
14  *    contributors may be used to endorse or promote products derived from
15  *    this software without specific prior written permission.
16  *
17  * THIS SOFTWARE IS PROVIDED BY THE MIPS TECHNOLOGIES, INC. ``AS IS'' AND
18  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
19  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
20  * ARE DISCLAIMED.  IN NO EVENT SHALL THE MIPS TECHNOLOGIES, INC. BE LIABLE
21  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
22  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
23  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
24  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
25  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
26  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
27  * SUCH DAMAGE.
28  *
29  * Authors:  Darko Laus      (darko@mips.com)
30  *           Djordje Pesut   (djordje@mips.com)
31  *           Mirjana Vulin   (mvulin@mips.com)
32  *
33  * AAC Spectral Band Replication decoding functions optimized for MIPS
34  *
35  * This file is part of FFmpeg.
36  *
37  * FFmpeg is free software; you can redistribute it and/or
38  * modify it under the terms of the GNU Lesser General Public
39  * License as published by the Free Software Foundation; either
40  * version 2.1 of the License, or (at your option) any later version.
41  *
42  * FFmpeg is distributed in the hope that it will be useful,
43  * but WITHOUT ANY WARRANTY; without even the implied warranty of
44  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
45  * Lesser General Public License for more details.
46  *
47  * You should have received a copy of the GNU Lesser General Public
48  * License along with FFmpeg; if not, write to the Free Software
49  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
50  */
51
52 /**
53  * @file
54  * Reference: libavcodec/sbrdsp.c
55  */
56
57 #include "config.h"
58 #include "libavcodec/sbrdsp.h"
59 #include "libavutil/mips/asmdefs.h"
60
61 #if HAVE_INLINE_ASM
62 static void sbr_qmf_pre_shuffle_mips(float *z)
63 {
64     int Temp1, Temp2, Temp3, Temp4, Temp5, Temp6;
65     float *z1 = &z[66];
66     float *z2 = &z[59];
67     float *z3 = &z[2];
68     float *z4 = z1 + 60;
69
70     /* loop unrolled 5 times */
71     __asm__ volatile (
72         "lui    %[Temp6],   0x8000                  \n\t"
73     "1:                                             \n\t"
74         "lw     %[Temp1],   0(%[z2])                \n\t"
75         "lw     %[Temp2],   4(%[z2])                \n\t"
76         "lw     %[Temp3],   8(%[z2])                \n\t"
77         "lw     %[Temp4],   12(%[z2])               \n\t"
78         "lw     %[Temp5],   16(%[z2])               \n\t"
79         "xor    %[Temp1],   %[Temp1],   %[Temp6]    \n\t"
80         "xor    %[Temp2],   %[Temp2],   %[Temp6]    \n\t"
81         "xor    %[Temp3],   %[Temp3],   %[Temp6]    \n\t"
82         "xor    %[Temp4],   %[Temp4],   %[Temp6]    \n\t"
83         "xor    %[Temp5],   %[Temp5],   %[Temp6]    \n\t"
84         PTR_ADDIU "%[z2],   %[z2],      -20         \n\t"
85         "sw     %[Temp1],   32(%[z1])               \n\t"
86         "sw     %[Temp2],   24(%[z1])               \n\t"
87         "sw     %[Temp3],   16(%[z1])               \n\t"
88         "sw     %[Temp4],   8(%[z1])                \n\t"
89         "sw     %[Temp5],   0(%[z1])                \n\t"
90         "lw     %[Temp1],   0(%[z3])                \n\t"
91         "lw     %[Temp2],   4(%[z3])                \n\t"
92         "lw     %[Temp3],   8(%[z3])                \n\t"
93         "lw     %[Temp4],   12(%[z3])               \n\t"
94         "lw     %[Temp5],   16(%[z3])               \n\t"
95         "sw     %[Temp1],   4(%[z1])                \n\t"
96         "sw     %[Temp2],   12(%[z1])               \n\t"
97         "sw     %[Temp3],   20(%[z1])               \n\t"
98         "sw     %[Temp4],   28(%[z1])               \n\t"
99         "sw     %[Temp5],   36(%[z1])               \n\t"
100         PTR_ADDIU "%[z3],   %[z3],      20          \n\t"
101         PTR_ADDIU "%[z1],   %[z1],      40          \n\t"
102         "bne    %[z1],      %[z4],      1b          \n\t"
103         "lw     %[Temp1],   132(%[z])               \n\t"
104         "lw     %[Temp2],   128(%[z])               \n\t"
105         "lw     %[Temp3],   0(%[z])                 \n\t"
106         "lw     %[Temp4],   4(%[z])                 \n\t"
107         "xor    %[Temp1],   %[Temp1],   %[Temp6]    \n\t"
108         "sw     %[Temp1],   504(%[z])               \n\t"
109         "sw     %[Temp2],   508(%[z])               \n\t"
110         "sw     %[Temp3],   256(%[z])               \n\t"
111         "sw     %[Temp4],   260(%[z])               \n\t"
112
113         : [Temp1]"=&r"(Temp1), [Temp2]"=&r"(Temp2),
114           [Temp3]"=&r"(Temp3), [Temp4]"=&r"(Temp4),
115           [Temp5]"=&r"(Temp5), [Temp6]"=&r"(Temp6),
116           [z1]"+r"(z1), [z2]"+r"(z2), [z3]"+r"(z3)
117         : [z4]"r"(z4), [z]"r"(z)
118         : "memory"
119     );
120 }
121
122 static void sbr_qmf_post_shuffle_mips(float W[32][2], const float *z)
123 {
124     int Temp1, Temp2, Temp3, Temp4, Temp5;
125     float *W_ptr = (float *)W;
126     float *z1    = (float *)z;
127     float *z2    = (float *)&z[60];
128     float *z_end = z1 + 32;
129
130      /* loop unrolled 4 times */
131     __asm__ volatile (
132         "lui    %[Temp5],   0x8000                  \n\t"
133     "1:                                             \n\t"
134         "lw     %[Temp1],   0(%[z2])                \n\t"
135         "lw     %[Temp2],   4(%[z2])                \n\t"
136         "lw     %[Temp3],   8(%[z2])                \n\t"
137         "lw     %[Temp4],   12(%[z2])               \n\t"
138         "xor    %[Temp1],   %[Temp1],   %[Temp5]    \n\t"
139         "xor    %[Temp2],   %[Temp2],   %[Temp5]    \n\t"
140         "xor    %[Temp3],   %[Temp3],   %[Temp5]    \n\t"
141         "xor    %[Temp4],   %[Temp4],   %[Temp5]    \n\t"
142         PTR_ADDIU "%[z2],   %[z2],      -16         \n\t"
143         "sw     %[Temp1],   24(%[W_ptr])            \n\t"
144         "sw     %[Temp2],   16(%[W_ptr])            \n\t"
145         "sw     %[Temp3],   8(%[W_ptr])             \n\t"
146         "sw     %[Temp4],   0(%[W_ptr])             \n\t"
147         "lw     %[Temp1],   0(%[z1])                \n\t"
148         "lw     %[Temp2],   4(%[z1])                \n\t"
149         "lw     %[Temp3],   8(%[z1])                \n\t"
150         "lw     %[Temp4],   12(%[z1])               \n\t"
151         "sw     %[Temp1],   4(%[W_ptr])             \n\t"
152         "sw     %[Temp2],   12(%[W_ptr])            \n\t"
153         "sw     %[Temp3],   20(%[W_ptr])            \n\t"
154         "sw     %[Temp4],   28(%[W_ptr])            \n\t"
155         PTR_ADDIU "%[z1],   %[z1],      16          \n\t"
156         PTR_ADDIU "%[W_ptr],%[W_ptr],   32          \n\t"
157         "bne    %[z1],      %[z_end],   1b          \n\t"
158
159         : [Temp1]"=&r"(Temp1), [Temp2]"=&r"(Temp2),
160           [Temp3]"=&r"(Temp3), [Temp4]"=&r"(Temp4),
161           [Temp5]"=&r"(Temp5), [z1]"+r"(z1),
162           [z2]"+r"(z2), [W_ptr]"+r"(W_ptr)
163         : [z_end]"r"(z_end)
164         : "memory"
165     );
166 }
167
168 #if HAVE_MIPSFPU
169 static void sbr_sum64x5_mips(float *z)
170 {
171     int k;
172     float *z1;
173     float f1, f2, f3, f4, f5, f6, f7, f8;
174     for (k = 0; k < 64; k += 8) {
175
176         z1 = &z[k];
177
178          /* loop unrolled 8 times */
179         __asm__ volatile (
180             "lwc1   $f0,    0(%[z1])        \n\t"
181             "lwc1   $f1,    256(%[z1])      \n\t"
182             "lwc1   $f2,    4(%[z1])        \n\t"
183             "lwc1   $f3,    260(%[z1])      \n\t"
184             "lwc1   $f4,    8(%[z1])        \n\t"
185             "add.s  %[f1],  $f0,    $f1     \n\t"
186             "lwc1   $f5,    264(%[z1])      \n\t"
187             "add.s  %[f2],  $f2,    $f3     \n\t"
188             "lwc1   $f6,    12(%[z1])       \n\t"
189             "lwc1   $f7,    268(%[z1])      \n\t"
190             "add.s  %[f3],  $f4,    $f5     \n\t"
191             "lwc1   $f8,    16(%[z1])       \n\t"
192             "lwc1   $f9,    272(%[z1])      \n\t"
193             "add.s  %[f4],  $f6,    $f7     \n\t"
194             "lwc1   $f10,   20(%[z1])       \n\t"
195             "lwc1   $f11,   276(%[z1])      \n\t"
196             "add.s  %[f5],  $f8,    $f9     \n\t"
197             "lwc1   $f12,   24(%[z1])       \n\t"
198             "lwc1   $f13,   280(%[z1])      \n\t"
199             "add.s  %[f6],  $f10,   $f11    \n\t"
200             "lwc1   $f14,   28(%[z1])       \n\t"
201             "lwc1   $f15,   284(%[z1])      \n\t"
202             "add.s  %[f7],  $f12,   $f13    \n\t"
203             "lwc1   $f0,    512(%[z1])      \n\t"
204             "lwc1   $f1,    516(%[z1])      \n\t"
205             "add.s  %[f8],  $f14,   $f15    \n\t"
206             "lwc1   $f2,    520(%[z1])      \n\t"
207             "add.s  %[f1],  %[f1],  $f0     \n\t"
208             "add.s  %[f2],  %[f2],  $f1     \n\t"
209             "lwc1   $f3,    524(%[z1])      \n\t"
210             "add.s  %[f3],  %[f3],  $f2     \n\t"
211             "lwc1   $f4,    528(%[z1])      \n\t"
212             "lwc1   $f5,    532(%[z1])      \n\t"
213             "add.s  %[f4],  %[f4],  $f3     \n\t"
214             "lwc1   $f6,    536(%[z1])      \n\t"
215             "add.s  %[f5],  %[f5],  $f4     \n\t"
216             "add.s  %[f6],  %[f6],  $f5     \n\t"
217             "lwc1   $f7,    540(%[z1])      \n\t"
218             "add.s  %[f7],  %[f7],  $f6     \n\t"
219             "lwc1   $f0,    768(%[z1])      \n\t"
220             "lwc1   $f1,    772(%[z1])      \n\t"
221             "add.s  %[f8],  %[f8],  $f7     \n\t"
222             "lwc1   $f2,    776(%[z1])      \n\t"
223             "add.s  %[f1],  %[f1],  $f0     \n\t"
224             "add.s  %[f2],  %[f2],  $f1     \n\t"
225             "lwc1   $f3,    780(%[z1])      \n\t"
226             "add.s  %[f3],  %[f3],  $f2     \n\t"
227             "lwc1   $f4,    784(%[z1])      \n\t"
228             "lwc1   $f5,    788(%[z1])      \n\t"
229             "add.s  %[f4],  %[f4],  $f3     \n\t"
230             "lwc1   $f6,    792(%[z1])      \n\t"
231             "add.s  %[f5],  %[f5],  $f4     \n\t"
232             "add.s  %[f6],  %[f6],  $f5     \n\t"
233             "lwc1   $f7,    796(%[z1])      \n\t"
234             "add.s  %[f7],  %[f7],  $f6     \n\t"
235             "lwc1   $f0,    1024(%[z1])     \n\t"
236             "lwc1   $f1,    1028(%[z1])     \n\t"
237             "add.s  %[f8],  %[f8],  $f7     \n\t"
238             "lwc1   $f2,    1032(%[z1])     \n\t"
239             "add.s  %[f1],  %[f1],  $f0     \n\t"
240             "add.s  %[f2],  %[f2],  $f1     \n\t"
241             "lwc1   $f3,    1036(%[z1])     \n\t"
242             "add.s  %[f3],  %[f3],  $f2     \n\t"
243             "lwc1   $f4,    1040(%[z1])     \n\t"
244             "lwc1   $f5,    1044(%[z1])     \n\t"
245             "add.s  %[f4],  %[f4],  $f3     \n\t"
246             "lwc1   $f6,    1048(%[z1])     \n\t"
247             "add.s  %[f5],  %[f5],  $f4     \n\t"
248             "add.s  %[f6],  %[f6],  $f5     \n\t"
249             "lwc1   $f7,    1052(%[z1])     \n\t"
250             "add.s  %[f7],  %[f7],  $f6     \n\t"
251             "swc1   %[f1],  0(%[z1])        \n\t"
252             "swc1   %[f2],  4(%[z1])        \n\t"
253             "add.s  %[f8],  %[f8],  $f7     \n\t"
254             "swc1   %[f3],  8(%[z1])        \n\t"
255             "swc1   %[f4],  12(%[z1])       \n\t"
256             "swc1   %[f5],  16(%[z1])       \n\t"
257             "swc1   %[f6],  20(%[z1])       \n\t"
258             "swc1   %[f7],  24(%[z1])       \n\t"
259             "swc1   %[f8],  28(%[z1])       \n\t"
260
261             : [f1]"=&f"(f1), [f2]"=&f"(f2), [f3]"=&f"(f3),
262               [f4]"=&f"(f4), [f5]"=&f"(f5), [f6]"=&f"(f6),
263               [f7]"=&f"(f7), [f8]"=&f"(f8)
264             : [z1]"r"(z1)
265             : "$f0", "$f1", "$f2", "$f3", "$f4", "$f5",
266               "$f6", "$f7", "$f8", "$f9", "$f10", "$f11",
267               "$f12", "$f13", "$f14", "$f15",
268               "memory"
269         );
270     }
271 }
272
273 static float sbr_sum_square_mips(float (*x)[2], int n)
274 {
275     float sum0 = 0.0f, sum1 = 0.0f;
276     float *p_x;
277     float temp0, temp1, temp2, temp3;
278     float *loop_end;
279     p_x = &x[0][0];
280     loop_end = p_x + (n >> 1)*4 - 4;
281
282     __asm__ volatile (
283         ".set      push                                             \n\t"
284         ".set      noreorder                                        \n\t"
285         "lwc1      %[temp0],   0(%[p_x])                            \n\t"
286         "lwc1      %[temp1],   4(%[p_x])                            \n\t"
287         "lwc1      %[temp2],   8(%[p_x])                            \n\t"
288         "lwc1      %[temp3],   12(%[p_x])                           \n\t"
289     "1:                                                             \n\t"
290         PTR_ADDIU "%[p_x],     %[p_x],       16                     \n\t"
291         "madd.s    %[sum0],    %[sum0],      %[temp0],   %[temp0]   \n\t"
292         "lwc1      %[temp0],   0(%[p_x])                            \n\t"
293         "madd.s    %[sum1],    %[sum1],      %[temp1],   %[temp1]   \n\t"
294         "lwc1      %[temp1],   4(%[p_x])                            \n\t"
295         "madd.s    %[sum0],    %[sum0],      %[temp2],   %[temp2]   \n\t"
296         "lwc1      %[temp2],   8(%[p_x])                            \n\t"
297         "madd.s    %[sum1],    %[sum1],      %[temp3],   %[temp3]   \n\t"
298         "bne       %[p_x],     %[loop_end],  1b                     \n\t"
299         " lwc1     %[temp3],   12(%[p_x])                           \n\t"
300         "madd.s    %[sum0],    %[sum0],      %[temp0],   %[temp0]   \n\t"
301         "madd.s    %[sum1],    %[sum1],      %[temp1],   %[temp1]   \n\t"
302         "madd.s    %[sum0],    %[sum0],      %[temp2],   %[temp2]   \n\t"
303         "madd.s    %[sum1],    %[sum1],      %[temp3],   %[temp3]   \n\t"
304         ".set      pop                                              \n\t"
305
306         : [temp0]"=&f"(temp0), [temp1]"=&f"(temp1), [temp2]"=&f"(temp2),
307           [temp3]"=&f"(temp3), [sum0]"+f"(sum0), [sum1]"+f"(sum1),
308           [p_x]"+r"(p_x)
309         : [loop_end]"r"(loop_end)
310         : "memory"
311     );
312     return sum0 + sum1;
313 }
314
315 static void sbr_qmf_deint_bfly_mips(float *v, const float *src0, const float *src1)
316 {
317     int i;
318     float temp0, temp1, temp2, temp3, temp4, temp5;
319     float temp6, temp7, temp8, temp9, temp10, temp11;
320     float *v0 = v;
321     float *v1 = &v[127];
322     float *psrc0 = (float*)src0;
323     float *psrc1 = (float*)&src1[63];
324
325     for (i = 0; i < 4; i++) {
326
327          /* loop unrolled 16 times */
328         __asm__ volatile(
329             "lwc1       %[temp0],   0(%[src0])             \n\t"
330             "lwc1       %[temp1],   0(%[src1])             \n\t"
331             "lwc1       %[temp3],   4(%[src0])             \n\t"
332             "lwc1       %[temp4],   -4(%[src1])            \n\t"
333             "lwc1       %[temp6],   8(%[src0])             \n\t"
334             "lwc1       %[temp7],   -8(%[src1])            \n\t"
335             "lwc1       %[temp9],   12(%[src0])            \n\t"
336             "lwc1       %[temp10],  -12(%[src1])           \n\t"
337             "add.s      %[temp2],   %[temp0],   %[temp1]   \n\t"
338             "add.s      %[temp5],   %[temp3],   %[temp4]   \n\t"
339             "add.s      %[temp8],   %[temp6],   %[temp7]   \n\t"
340             "add.s      %[temp11],  %[temp9],   %[temp10]  \n\t"
341             "sub.s      %[temp0],   %[temp0],   %[temp1]   \n\t"
342             "sub.s      %[temp3],   %[temp3],   %[temp4]   \n\t"
343             "sub.s      %[temp6],   %[temp6],   %[temp7]   \n\t"
344             "sub.s      %[temp9],   %[temp9],   %[temp10]  \n\t"
345             "swc1       %[temp2],   0(%[v1])               \n\t"
346             "swc1       %[temp0],   0(%[v0])               \n\t"
347             "swc1       %[temp5],   -4(%[v1])              \n\t"
348             "swc1       %[temp3],   4(%[v0])               \n\t"
349             "swc1       %[temp8],   -8(%[v1])              \n\t"
350             "swc1       %[temp6],   8(%[v0])               \n\t"
351             "swc1       %[temp11],  -12(%[v1])             \n\t"
352             "swc1       %[temp9],   12(%[v0])              \n\t"
353             "lwc1       %[temp0],   16(%[src0])            \n\t"
354             "lwc1       %[temp1],   -16(%[src1])           \n\t"
355             "lwc1       %[temp3],   20(%[src0])            \n\t"
356             "lwc1       %[temp4],   -20(%[src1])           \n\t"
357             "lwc1       %[temp6],   24(%[src0])            \n\t"
358             "lwc1       %[temp7],   -24(%[src1])           \n\t"
359             "lwc1       %[temp9],   28(%[src0])            \n\t"
360             "lwc1       %[temp10],  -28(%[src1])           \n\t"
361             "add.s      %[temp2],   %[temp0],   %[temp1]   \n\t"
362             "add.s      %[temp5],   %[temp3],   %[temp4]   \n\t"
363             "add.s      %[temp8],   %[temp6],   %[temp7]   \n\t"
364             "add.s      %[temp11],  %[temp9],   %[temp10]  \n\t"
365             "sub.s      %[temp0],   %[temp0],   %[temp1]   \n\t"
366             "sub.s      %[temp3],   %[temp3],   %[temp4]   \n\t"
367             "sub.s      %[temp6],   %[temp6],   %[temp7]   \n\t"
368             "sub.s      %[temp9],   %[temp9],   %[temp10]  \n\t"
369             "swc1       %[temp2],   -16(%[v1])             \n\t"
370             "swc1       %[temp0],   16(%[v0])              \n\t"
371             "swc1       %[temp5],   -20(%[v1])             \n\t"
372             "swc1       %[temp3],   20(%[v0])              \n\t"
373             "swc1       %[temp8],   -24(%[v1])             \n\t"
374             "swc1       %[temp6],   24(%[v0])              \n\t"
375             "swc1       %[temp11],  -28(%[v1])             \n\t"
376             "swc1       %[temp9],   28(%[v0])              \n\t"
377             "lwc1       %[temp0],   32(%[src0])            \n\t"
378             "lwc1       %[temp1],   -32(%[src1])           \n\t"
379             "lwc1       %[temp3],   36(%[src0])            \n\t"
380             "lwc1       %[temp4],   -36(%[src1])           \n\t"
381             "lwc1       %[temp6],   40(%[src0])            \n\t"
382             "lwc1       %[temp7],   -40(%[src1])           \n\t"
383             "lwc1       %[temp9],   44(%[src0])            \n\t"
384             "lwc1       %[temp10],  -44(%[src1])           \n\t"
385             "add.s      %[temp2],   %[temp0],   %[temp1]   \n\t"
386             "add.s      %[temp5],   %[temp3],   %[temp4]   \n\t"
387             "add.s      %[temp8],   %[temp6],   %[temp7]   \n\t"
388             "add.s      %[temp11],  %[temp9],   %[temp10]  \n\t"
389             "sub.s      %[temp0],   %[temp0],   %[temp1]   \n\t"
390             "sub.s      %[temp3],   %[temp3],   %[temp4]   \n\t"
391             "sub.s      %[temp6],   %[temp6],   %[temp7]   \n\t"
392             "sub.s      %[temp9],   %[temp9],   %[temp10]  \n\t"
393             "swc1       %[temp2],   -32(%[v1])             \n\t"
394             "swc1       %[temp0],   32(%[v0])              \n\t"
395             "swc1       %[temp5],   -36(%[v1])             \n\t"
396             "swc1       %[temp3],   36(%[v0])              \n\t"
397             "swc1       %[temp8],   -40(%[v1])             \n\t"
398             "swc1       %[temp6],   40(%[v0])              \n\t"
399             "swc1       %[temp11],  -44(%[v1])             \n\t"
400             "swc1       %[temp9],   44(%[v0])              \n\t"
401             "lwc1       %[temp0],   48(%[src0])            \n\t"
402             "lwc1       %[temp1],   -48(%[src1])           \n\t"
403             "lwc1       %[temp3],   52(%[src0])            \n\t"
404             "lwc1       %[temp4],   -52(%[src1])           \n\t"
405             "lwc1       %[temp6],   56(%[src0])            \n\t"
406             "lwc1       %[temp7],   -56(%[src1])           \n\t"
407             "lwc1       %[temp9],   60(%[src0])            \n\t"
408             "lwc1       %[temp10],  -60(%[src1])           \n\t"
409             "add.s      %[temp2],   %[temp0],   %[temp1]   \n\t"
410             "add.s      %[temp5],   %[temp3],   %[temp4]   \n\t"
411             "add.s      %[temp8],   %[temp6],   %[temp7]   \n\t"
412             "add.s      %[temp11],  %[temp9],   %[temp10]  \n\t"
413             "sub.s      %[temp0],   %[temp0],   %[temp1]   \n\t"
414             "sub.s      %[temp3],   %[temp3],   %[temp4]   \n\t"
415             "sub.s      %[temp6],   %[temp6],   %[temp7]   \n\t"
416             "sub.s      %[temp9],   %[temp9],   %[temp10]  \n\t"
417             "swc1       %[temp2],   -48(%[v1])             \n\t"
418             "swc1       %[temp0],   48(%[v0])              \n\t"
419             "swc1       %[temp5],   -52(%[v1])             \n\t"
420             "swc1       %[temp3],   52(%[v0])              \n\t"
421             "swc1       %[temp8],   -56(%[v1])             \n\t"
422             "swc1       %[temp6],   56(%[v0])              \n\t"
423             "swc1       %[temp11],  -60(%[v1])             \n\t"
424             "swc1       %[temp9],   60(%[v0])              \n\t"
425             PTR_ADDIU " %[src0],    %[src0],    64         \n\t"
426             PTR_ADDIU " %[src1],    %[src1],    -64        \n\t"
427             PTR_ADDIU " %[v0],      %[v0],      64         \n\t"
428             PTR_ADDIU " %[v1],      %[v1],      -64        \n\t"
429
430             : [v0]"+r"(v0), [v1]"+r"(v1), [src0]"+r"(psrc0), [src1]"+r"(psrc1),
431               [temp0]"=&f"(temp0), [temp1]"=&f"(temp1), [temp2]"=&f"(temp2),
432               [temp3]"=&f"(temp3), [temp4]"=&f"(temp4), [temp5]"=&f"(temp5),
433               [temp6]"=&f"(temp6), [temp7]"=&f"(temp7), [temp8]"=&f"(temp8),
434               [temp9]"=&f"(temp9), [temp10]"=&f"(temp10), [temp11]"=&f"(temp11)
435             :
436             :"memory"
437         );
438     }
439 }
440
441 static void sbr_autocorrelate_mips(const float x[40][2], float phi[3][2][2])
442 {
443     int i;
444     float real_sum_0 = 0.0f;
445     float real_sum_1 = 0.0f;
446     float real_sum_2 = 0.0f;
447     float imag_sum_1 = 0.0f;
448     float imag_sum_2 = 0.0f;
449     float *p_x, *p_phi;
450     float temp0, temp1, temp2, temp3, temp4, temp5, temp6;
451     float temp7, temp_r, temp_r1, temp_r2, temp_r3, temp_r4;
452     p_x = (float*)&x[0][0];
453     p_phi = &phi[0][0][0];
454
455     __asm__ volatile (
456         "lwc1    %[temp0],      8(%[p_x])                           \n\t"
457         "lwc1    %[temp1],      12(%[p_x])                          \n\t"
458         "lwc1    %[temp2],      16(%[p_x])                          \n\t"
459         "lwc1    %[temp3],      20(%[p_x])                          \n\t"
460         "lwc1    %[temp4],      24(%[p_x])                          \n\t"
461         "lwc1    %[temp5],      28(%[p_x])                          \n\t"
462         "mul.s   %[temp_r],     %[temp1],      %[temp1]             \n\t"
463         "mul.s   %[temp_r1],    %[temp1],      %[temp3]             \n\t"
464         "mul.s   %[temp_r2],    %[temp1],      %[temp2]             \n\t"
465         "mul.s   %[temp_r3],    %[temp1],      %[temp5]             \n\t"
466         "mul.s   %[temp_r4],    %[temp1],      %[temp4]             \n\t"
467         "madd.s  %[temp_r],     %[temp_r],     %[temp0],  %[temp0]  \n\t"
468         "madd.s  %[temp_r1],    %[temp_r1],    %[temp0],  %[temp2]  \n\t"
469         "msub.s  %[temp_r2],    %[temp_r2],    %[temp0],  %[temp3]  \n\t"
470         "madd.s  %[temp_r3],    %[temp_r3],    %[temp0],  %[temp4]  \n\t"
471         "msub.s  %[temp_r4],    %[temp_r4],    %[temp0],  %[temp5]  \n\t"
472         "add.s   %[real_sum_0], %[real_sum_0], %[temp_r]            \n\t"
473         "add.s   %[real_sum_1], %[real_sum_1], %[temp_r1]           \n\t"
474         "add.s   %[imag_sum_1], %[imag_sum_1], %[temp_r2]           \n\t"
475         "add.s   %[real_sum_2], %[real_sum_2], %[temp_r3]           \n\t"
476         "add.s   %[imag_sum_2], %[imag_sum_2], %[temp_r4]           \n\t"
477         PTR_ADDIU "%[p_x],      %[p_x],        8                    \n\t"
478
479         : [temp0]"=&f"(temp0), [temp1]"=&f"(temp1), [temp2]"=&f"(temp2),
480           [temp3]"=&f"(temp3), [temp4]"=&f"(temp4), [temp5]"=&f"(temp5),
481           [real_sum_0]"+f"(real_sum_0), [real_sum_1]"+f"(real_sum_1),
482           [imag_sum_1]"+f"(imag_sum_1), [real_sum_2]"+f"(real_sum_2),
483           [temp_r]"=&f"(temp_r), [temp_r1]"=&f"(temp_r1), [temp_r2]"=&f"(temp_r2),
484           [temp_r3]"=&f"(temp_r3), [temp_r4]"=&f"(temp_r4),
485           [p_x]"+r"(p_x), [imag_sum_2]"+f"(imag_sum_2)
486         :
487         : "memory"
488     );
489
490     for (i = 0; i < 12; i++) {
491         __asm__ volatile (
492             "lwc1    %[temp0],      8(%[p_x])                           \n\t"
493             "lwc1    %[temp1],      12(%[p_x])                          \n\t"
494             "lwc1    %[temp2],      16(%[p_x])                          \n\t"
495             "lwc1    %[temp3],      20(%[p_x])                          \n\t"
496             "lwc1    %[temp4],      24(%[p_x])                          \n\t"
497             "lwc1    %[temp5],      28(%[p_x])                          \n\t"
498             "mul.s   %[temp_r],     %[temp1],      %[temp1]             \n\t"
499             "mul.s   %[temp_r1],    %[temp1],      %[temp3]             \n\t"
500             "mul.s   %[temp_r2],    %[temp1],      %[temp2]             \n\t"
501             "mul.s   %[temp_r3],    %[temp1],      %[temp5]             \n\t"
502             "mul.s   %[temp_r4],    %[temp1],      %[temp4]             \n\t"
503             "madd.s  %[temp_r],     %[temp_r],     %[temp0],  %[temp0]  \n\t"
504             "madd.s  %[temp_r1],    %[temp_r1],    %[temp0],  %[temp2]  \n\t"
505             "msub.s  %[temp_r2],    %[temp_r2],    %[temp0],  %[temp3]  \n\t"
506             "madd.s  %[temp_r3],    %[temp_r3],    %[temp0],  %[temp4]  \n\t"
507             "msub.s  %[temp_r4],    %[temp_r4],    %[temp0],  %[temp5]  \n\t"
508             "add.s   %[real_sum_0], %[real_sum_0], %[temp_r]            \n\t"
509             "add.s   %[real_sum_1], %[real_sum_1], %[temp_r1]           \n\t"
510             "add.s   %[imag_sum_1], %[imag_sum_1], %[temp_r2]           \n\t"
511             "add.s   %[real_sum_2], %[real_sum_2], %[temp_r3]           \n\t"
512             "add.s   %[imag_sum_2], %[imag_sum_2], %[temp_r4]           \n\t"
513             "lwc1    %[temp0],      32(%[p_x])                          \n\t"
514             "lwc1    %[temp1],      36(%[p_x])                          \n\t"
515             "mul.s   %[temp_r],     %[temp3],      %[temp3]             \n\t"
516             "mul.s   %[temp_r1],    %[temp3],      %[temp5]             \n\t"
517             "mul.s   %[temp_r2],    %[temp3],      %[temp4]             \n\t"
518             "mul.s   %[temp_r3],    %[temp3],      %[temp1]             \n\t"
519             "mul.s   %[temp_r4],    %[temp3],      %[temp0]             \n\t"
520             "madd.s  %[temp_r],     %[temp_r],     %[temp2],  %[temp2]  \n\t"
521             "madd.s  %[temp_r1],    %[temp_r1],    %[temp2],  %[temp4]  \n\t"
522             "msub.s  %[temp_r2],    %[temp_r2],    %[temp2],  %[temp5]  \n\t"
523             "madd.s  %[temp_r3],    %[temp_r3],    %[temp2],  %[temp0]  \n\t"
524             "msub.s  %[temp_r4],    %[temp_r4],    %[temp2],  %[temp1]  \n\t"
525             "add.s   %[real_sum_0], %[real_sum_0], %[temp_r]            \n\t"
526             "add.s   %[real_sum_1], %[real_sum_1], %[temp_r1]           \n\t"
527             "add.s   %[imag_sum_1], %[imag_sum_1], %[temp_r2]           \n\t"
528             "add.s   %[real_sum_2], %[real_sum_2], %[temp_r3]           \n\t"
529             "add.s   %[imag_sum_2], %[imag_sum_2], %[temp_r4]           \n\t"
530             "lwc1    %[temp2],      40(%[p_x])                          \n\t"
531             "lwc1    %[temp3],      44(%[p_x])                          \n\t"
532             "mul.s   %[temp_r],     %[temp5],      %[temp5]             \n\t"
533             "mul.s   %[temp_r1],    %[temp5],      %[temp1]             \n\t"
534             "mul.s   %[temp_r2],    %[temp5],      %[temp0]             \n\t"
535             "mul.s   %[temp_r3],    %[temp5],      %[temp3]             \n\t"
536             "mul.s   %[temp_r4],    %[temp5],      %[temp2]             \n\t"
537             "madd.s  %[temp_r],     %[temp_r],     %[temp4],  %[temp4]  \n\t"
538             "madd.s  %[temp_r1],    %[temp_r1],    %[temp4],  %[temp0]  \n\t"
539             "msub.s  %[temp_r2],    %[temp_r2],    %[temp4],  %[temp1]  \n\t"
540             "madd.s  %[temp_r3],    %[temp_r3],    %[temp4],  %[temp2]  \n\t"
541             "msub.s  %[temp_r4],    %[temp_r4],    %[temp4],  %[temp3]  \n\t"
542             "add.s   %[real_sum_0], %[real_sum_0], %[temp_r]            \n\t"
543             "add.s   %[real_sum_1], %[real_sum_1], %[temp_r1]           \n\t"
544             "add.s   %[imag_sum_1], %[imag_sum_1], %[temp_r2]           \n\t"
545             "add.s   %[real_sum_2], %[real_sum_2], %[temp_r3]           \n\t"
546             "add.s   %[imag_sum_2], %[imag_sum_2], %[temp_r4]           \n\t"
547             PTR_ADDIU "%[p_x],      %[p_x],        24                   \n\t"
548
549             : [temp0]"=&f"(temp0), [temp1]"=&f"(temp1), [temp2]"=&f"(temp2),
550               [temp3]"=&f"(temp3), [temp4]"=&f"(temp4), [temp5]"=&f"(temp5),
551               [real_sum_0]"+f"(real_sum_0), [real_sum_1]"+f"(real_sum_1),
552               [imag_sum_1]"+f"(imag_sum_1), [real_sum_2]"+f"(real_sum_2),
553               [temp_r]"=&f"(temp_r), [temp_r1]"=&f"(temp_r1),
554               [temp_r2]"=&f"(temp_r2), [temp_r3]"=&f"(temp_r3),
555               [temp_r4]"=&f"(temp_r4), [p_x]"+r"(p_x),
556               [imag_sum_2]"+f"(imag_sum_2)
557             :
558             : "memory"
559         );
560     }
561     __asm__ volatile (
562         "lwc1    %[temp0],    -296(%[p_x])                        \n\t"
563         "lwc1    %[temp1],    -292(%[p_x])                        \n\t"
564         "lwc1    %[temp2],    8(%[p_x])                           \n\t"
565         "lwc1    %[temp3],    12(%[p_x])                          \n\t"
566         "lwc1    %[temp4],    -288(%[p_x])                        \n\t"
567         "lwc1    %[temp5],    -284(%[p_x])                        \n\t"
568         "lwc1    %[temp6],    -280(%[p_x])                        \n\t"
569         "lwc1    %[temp7],    -276(%[p_x])                        \n\t"
570         "madd.s  %[temp_r],   %[real_sum_0], %[temp0],  %[temp0]  \n\t"
571         "madd.s  %[temp_r1],  %[real_sum_0], %[temp2],  %[temp2]  \n\t"
572         "madd.s  %[temp_r2],  %[real_sum_1], %[temp0],  %[temp4]  \n\t"
573         "madd.s  %[temp_r3],  %[imag_sum_1], %[temp0],  %[temp5]  \n\t"
574         "madd.s  %[temp_r],   %[temp_r],     %[temp1],  %[temp1]  \n\t"
575         "madd.s  %[temp_r1],  %[temp_r1],    %[temp3],  %[temp3]  \n\t"
576         "madd.s  %[temp_r2],  %[temp_r2],    %[temp1],  %[temp5]  \n\t"
577         "nmsub.s  %[temp_r3], %[temp_r3],    %[temp1],  %[temp4]  \n\t"
578         "lwc1    %[temp4],    16(%[p_x])                          \n\t"
579         "lwc1    %[temp5],    20(%[p_x])                          \n\t"
580         "swc1    %[temp_r],   40(%[p_phi])                        \n\t"
581         "swc1    %[temp_r1],  16(%[p_phi])                        \n\t"
582         "swc1    %[temp_r2],  24(%[p_phi])                        \n\t"
583         "swc1    %[temp_r3],  28(%[p_phi])                        \n\t"
584         "madd.s  %[temp_r],   %[real_sum_1], %[temp2],  %[temp4]  \n\t"
585         "madd.s  %[temp_r1],  %[imag_sum_1], %[temp2],  %[temp5]  \n\t"
586         "madd.s  %[temp_r2],  %[real_sum_2], %[temp0],  %[temp6]  \n\t"
587         "madd.s  %[temp_r3],  %[imag_sum_2], %[temp0],  %[temp7]  \n\t"
588         "madd.s  %[temp_r],   %[temp_r],     %[temp3],  %[temp5]  \n\t"
589         "nmsub.s %[temp_r1],  %[temp_r1],    %[temp3],  %[temp4]  \n\t"
590         "madd.s  %[temp_r2],  %[temp_r2],    %[temp1],  %[temp7]  \n\t"
591         "nmsub.s %[temp_r3],  %[temp_r3],    %[temp1],  %[temp6]  \n\t"
592         "swc1    %[temp_r],   0(%[p_phi])                         \n\t"
593         "swc1    %[temp_r1],  4(%[p_phi])                         \n\t"
594         "swc1    %[temp_r2],  8(%[p_phi])                         \n\t"
595         "swc1    %[temp_r3],  12(%[p_phi])                        \n\t"
596
597         : [temp0]"=&f"(temp0), [temp1]"=&f"(temp1), [temp2]"=&f"(temp2),
598           [temp3]"=&f"(temp3), [temp4]"=&f"(temp4), [temp5]"=&f"(temp5),
599           [temp6]"=&f"(temp6), [temp7]"=&f"(temp7), [temp_r]"=&f"(temp_r),
600           [real_sum_0]"+f"(real_sum_0), [real_sum_1]"+f"(real_sum_1),
601           [real_sum_2]"+f"(real_sum_2), [imag_sum_1]"+f"(imag_sum_1),
602           [temp_r2]"=&f"(temp_r2), [temp_r3]"=&f"(temp_r3),
603           [temp_r1]"=&f"(temp_r1), [p_phi]"+r"(p_phi),
604           [imag_sum_2]"+f"(imag_sum_2)
605         : [p_x]"r"(p_x)
606         : "memory"
607     );
608 }
609
610 static void sbr_hf_gen_mips(float (*X_high)[2], const float (*X_low)[2],
611                          const float alpha0[2], const float alpha1[2],
612                          float bw, int start, int end)
613 {
614     float alpha[4];
615     int i;
616     float *p_x_low = (float*)&X_low[0][0] + 2*start;
617     float *p_x_high = &X_high[0][0] + 2*start;
618     float temp0, temp1, temp2, temp3, temp4, temp5, temp6;
619     float temp7, temp8, temp9, temp10, temp11, temp12;
620
621     alpha[0] = alpha1[0] * bw * bw;
622     alpha[1] = alpha1[1] * bw * bw;
623     alpha[2] = alpha0[0] * bw;
624     alpha[3] = alpha0[1] * bw;
625
626     for (i = start; i < end; i++) {
627         __asm__ volatile (
628             "lwc1    %[temp0],    -16(%[p_x_low])                        \n\t"
629             "lwc1    %[temp1],    -12(%[p_x_low])                        \n\t"
630             "lwc1    %[temp2],    -8(%[p_x_low])                         \n\t"
631             "lwc1    %[temp3],    -4(%[p_x_low])                         \n\t"
632             "lwc1    %[temp5],    0(%[p_x_low])                          \n\t"
633             "lwc1    %[temp6],    4(%[p_x_low])                          \n\t"
634             "lwc1    %[temp7],    0(%[alpha])                            \n\t"
635             "lwc1    %[temp8],    4(%[alpha])                            \n\t"
636             "lwc1    %[temp9],    8(%[alpha])                            \n\t"
637             "lwc1    %[temp10],   12(%[alpha])                           \n\t"
638             PTR_ADDIU "%[p_x_high], %[p_x_high],   8                     \n\t"
639             PTR_ADDIU "%[p_x_low],  %[p_x_low],    8                     \n\t"
640             "mul.s   %[temp11],   %[temp1],        %[temp8]              \n\t"
641             "msub.s  %[temp11],   %[temp11],       %[temp0],  %[temp7]   \n\t"
642             "madd.s  %[temp11],   %[temp11],       %[temp2],  %[temp9]   \n\t"
643             "nmsub.s %[temp11],   %[temp11],       %[temp3],  %[temp10]  \n\t"
644             "add.s   %[temp11],   %[temp11],       %[temp5]              \n\t"
645             "swc1    %[temp11],   -8(%[p_x_high])                        \n\t"
646             "mul.s   %[temp12],   %[temp1],        %[temp7]              \n\t"
647             "madd.s  %[temp12],   %[temp12],       %[temp0],  %[temp8]   \n\t"
648             "madd.s  %[temp12],   %[temp12],       %[temp3],  %[temp9]   \n\t"
649             "madd.s  %[temp12],   %[temp12],       %[temp2],  %[temp10]  \n\t"
650             "add.s   %[temp12],   %[temp12],       %[temp6]              \n\t"
651             "swc1    %[temp12],   -4(%[p_x_high])                        \n\t"
652
653             : [temp0]"=&f"(temp0), [temp1]"=&f"(temp1), [temp2]"=&f"(temp2),
654               [temp3]"=&f"(temp3), [temp4]"=&f"(temp4), [temp5]"=&f"(temp5),
655               [temp6]"=&f"(temp6), [temp7]"=&f"(temp7), [temp8]"=&f"(temp8),
656               [temp9]"=&f"(temp9), [temp10]"=&f"(temp10), [temp11]"=&f"(temp11),
657               [temp12]"=&f"(temp12), [p_x_high]"+r"(p_x_high),
658               [p_x_low]"+r"(p_x_low)
659             : [alpha]"r"(alpha)
660             : "memory"
661         );
662     }
663 }
664
665 static void sbr_hf_g_filt_mips(float (*Y)[2], const float (*X_high)[40][2],
666                             const float *g_filt, int m_max, intptr_t ixh)
667 {
668     const float *p_x, *p_g, *loop_end;
669     float *p_y;
670     float temp0, temp1, temp2;
671
672     p_g = &g_filt[0];
673     p_y = &Y[0][0];
674     p_x = &X_high[0][ixh][0];
675     loop_end = p_g + m_max;
676
677     __asm__ volatile(
678         ".set    push                                \n\t"
679         ".set    noreorder                           \n\t"
680     "1:                                              \n\t"
681         "lwc1    %[temp0],   0(%[p_g])               \n\t"
682         "lwc1    %[temp1],   0(%[p_x])               \n\t"
683         "lwc1    %[temp2],   4(%[p_x])               \n\t"
684         "mul.s   %[temp1],   %[temp1],     %[temp0]  \n\t"
685         "mul.s   %[temp2],   %[temp2],     %[temp0]  \n\t"
686         PTR_ADDIU "%[p_g],   %[p_g],       4         \n\t"
687         PTR_ADDIU "%[p_x],   %[p_x],       320       \n\t"
688         "swc1    %[temp1],   0(%[p_y])               \n\t"
689         "swc1    %[temp2],   4(%[p_y])               \n\t"
690         "bne     %[p_g],     %[loop_end],  1b        \n\t"
691         PTR_ADDIU "%[p_y],   %[p_y],       8         \n\t"
692         ".set    pop                                 \n\t"
693
694         : [temp0]"=&f"(temp0), [temp1]"=&f"(temp1),
695           [temp2]"=&f"(temp2), [p_x]"+r"(p_x),
696           [p_y]"+r"(p_y), [p_g]"+r"(p_g)
697         : [loop_end]"r"(loop_end)
698         : "memory"
699     );
700 }
701
702 static void sbr_hf_apply_noise_0_mips(float (*Y)[2], const float *s_m,
703                                  const float *q_filt, int noise,
704                                  int kx, int m_max)
705 {
706     int m;
707
708     for (m = 0; m < m_max; m++){
709
710         float *Y1=&Y[m][0];
711         float *ff_table;
712         float y0,y1, temp1, temp2, temp4, temp5;
713         int temp0, temp3;
714         const float *s_m1=&s_m[m];
715         const float *q_filt1= &q_filt[m];
716
717         __asm__ volatile(
718             "lwc1    %[y0],       0(%[Y1])                                    \n\t"
719             "lwc1    %[temp1],    0(%[s_m1])                                  \n\t"
720             "addiu   %[noise],    %[noise],              1                    \n\t"
721             "andi    %[noise],    %[noise],              0x1ff                \n\t"
722             "sll     %[temp0],    %[noise], 3                                 \n\t"
723             PTR_ADDU "%[ff_table],%[ff_sbr_noise_table], %[temp0]             \n\t"
724             "add.s   %[y0],       %[y0],                 %[temp1]             \n\t"
725             "mfc1    %[temp3],    %[temp1]                                    \n\t"
726             "bne     %[temp3],    $0,                    1f                   \n\t"
727             "lwc1    %[y1],       4(%[Y1])                                    \n\t"
728             "lwc1    %[temp2],    0(%[q_filt1])                               \n\t"
729             "lwc1    %[temp4],    0(%[ff_table])                              \n\t"
730             "lwc1    %[temp5],    4(%[ff_table])                              \n\t"
731             "madd.s  %[y0],       %[y0],                 %[temp2],  %[temp4]  \n\t"
732             "madd.s  %[y1],       %[y1],                 %[temp2],  %[temp5]  \n\t"
733             "swc1    %[y1],       4(%[Y1])                                    \n\t"
734         "1:                                                                   \n\t"
735             "swc1    %[y0],       0(%[Y1])                                    \n\t"
736
737             : [ff_table]"=&r"(ff_table), [y0]"=&f"(y0), [y1]"=&f"(y1),
738               [temp0]"=&r"(temp0), [temp1]"=&f"(temp1), [temp2]"=&f"(temp2),
739               [temp3]"=&r"(temp3), [temp4]"=&f"(temp4), [temp5]"=&f"(temp5)
740             : [ff_sbr_noise_table]"r"(ff_sbr_noise_table), [noise]"r"(noise),
741               [Y1]"r"(Y1), [s_m1]"r"(s_m1), [q_filt1]"r"(q_filt1)
742             : "memory"
743         );
744     }
745 }
746
747 static void sbr_hf_apply_noise_1_mips(float (*Y)[2], const float *s_m,
748                                  const float *q_filt, int noise,
749                                  int kx, int m_max)
750 {
751     float y0,y1,temp1, temp2, temp4, temp5;
752     int temp0, temp3, m;
753     float phi_sign = 1 - 2 * (kx & 1);
754
755     for (m = 0; m < m_max; m++) {
756
757         float *ff_table;
758         float *Y1=&Y[m][0];
759         const float *s_m1=&s_m[m];
760         const float *q_filt1= &q_filt[m];
761
762         __asm__ volatile(
763             "lwc1   %[y1],       4(%[Y1])                                     \n\t"
764             "lwc1   %[temp1],    0(%[s_m1])                                   \n\t"
765             "lw     %[temp3],    0(%[s_m1])                                   \n\t"
766             "addiu  %[noise],    %[noise],               1                    \n\t"
767             "andi   %[noise],    %[noise],               0x1ff                \n\t"
768             "sll    %[temp0],    %[noise],               3                    \n\t"
769             PTR_ADDU "%[ff_table],%[ff_sbr_noise_table],%[temp0]              \n\t"
770             "madd.s %[y1],       %[y1],                 %[temp1], %[phi_sign] \n\t"
771             "bne    %[temp3],    $0,                    1f                    \n\t"
772             "lwc1   %[y0],       0(%[Y1])                                     \n\t"
773             "lwc1   %[temp2],    0(%[q_filt1])                                \n\t"
774             "lwc1   %[temp4],    0(%[ff_table])                               \n\t"
775             "lwc1   %[temp5],    4(%[ff_table])                               \n\t"
776             "madd.s %[y0],       %[y0],                 %[temp2], %[temp4]    \n\t"
777             "madd.s %[y1],       %[y1],                 %[temp2], %[temp5]    \n\t"
778             "swc1   %[y0],       0(%[Y1])                                     \n\t"
779         "1:                                                                   \n\t"
780             "swc1   %[y1],       4(%[Y1])                                     \n\t"
781
782             : [ff_table] "=&r" (ff_table), [y0] "=&f" (y0), [y1] "=&f" (y1),
783               [temp0] "=&r" (temp0), [temp1] "=&f" (temp1), [temp2] "=&f" (temp2),
784               [temp3] "=&r" (temp3), [temp4] "=&f" (temp4), [temp5] "=&f" (temp5)
785             : [ff_sbr_noise_table] "r" (ff_sbr_noise_table), [noise] "r" (noise),
786               [Y1] "r" (Y1), [s_m1] "r" (s_m1), [q_filt1] "r" (q_filt1),
787               [phi_sign] "f" (phi_sign)
788             : "memory"
789         );
790         phi_sign = -phi_sign;
791     }
792 }
793
794 static void sbr_hf_apply_noise_2_mips(float (*Y)[2], const float *s_m,
795                                  const float *q_filt, int noise,
796                                  int kx, int m_max)
797 {
798     int m;
799     float *ff_table;
800     float y0,y1, temp0, temp1, temp2, temp3, temp4, temp5;
801
802     for (m = 0; m < m_max; m++) {
803
804         float *Y1=&Y[m][0];
805         const float *s_m1=&s_m[m];
806         const float *q_filt1= &q_filt[m];
807
808         __asm__ volatile(
809             "lwc1   %[y0],       0(%[Y1])                                  \n\t"
810             "lwc1   %[temp1],    0(%[s_m1])                                \n\t"
811             "addiu  %[noise],    %[noise],              1                  \n\t"
812             "andi   %[noise],    %[noise],              0x1ff              \n\t"
813             "sll    %[temp0],    %[noise],              3                  \n\t"
814             PTR_ADDU "%[ff_table],%[ff_sbr_noise_table],%[temp0]           \n\t"
815             "sub.s  %[y0],       %[y0],                 %[temp1]           \n\t"
816             "mfc1   %[temp3],    %[temp1]                                  \n\t"
817             "bne    %[temp3],    $0,                    1f                 \n\t"
818             "lwc1   %[y1],       4(%[Y1])                                  \n\t"
819             "lwc1   %[temp2],    0(%[q_filt1])                             \n\t"
820             "lwc1   %[temp4],    0(%[ff_table])                            \n\t"
821             "lwc1   %[temp5],    4(%[ff_table])                            \n\t"
822             "madd.s %[y0],       %[y0],                 %[temp2], %[temp4] \n\t"
823             "madd.s %[y1],       %[y1],                 %[temp2], %[temp5] \n\t"
824             "swc1   %[y1],       4(%[Y1])                                  \n\t"
825         "1:                                                                \n\t"
826             "swc1   %[y0],       0(%[Y1])                                  \n\t"
827
828             : [temp0]"=&r"(temp0), [ff_table]"=&r"(ff_table), [y0]"=&f"(y0),
829               [y1]"=&f"(y1), [temp1]"=&f"(temp1), [temp2]"=&f"(temp2),
830               [temp3]"=&r"(temp3), [temp4]"=&f"(temp4), [temp5]"=&f"(temp5)
831             : [ff_sbr_noise_table]"r"(ff_sbr_noise_table), [noise]"r"(noise),
832               [Y1]"r"(Y1), [s_m1]"r"(s_m1), [q_filt1]"r"(q_filt1)
833             : "memory"
834         );
835     }
836 }
837
838 static void sbr_hf_apply_noise_3_mips(float (*Y)[2], const float *s_m,
839                                  const float *q_filt, int noise,
840                                  int kx, int m_max)
841 {
842     float phi_sign = 1 - 2 * (kx & 1);
843     int m;
844
845     for (m = 0; m < m_max; m++) {
846
847         float *Y1=&Y[m][0];
848         float *ff_table;
849         float y0,y1, temp1, temp2, temp4, temp5;
850         int temp0, temp3;
851         const float *s_m1=&s_m[m];
852         const float *q_filt1= &q_filt[m];
853
854         __asm__ volatile(
855             "lwc1    %[y1],       4(%[Y1])                                     \n\t"
856             "lwc1    %[temp1],    0(%[s_m1])                                   \n\t"
857             "addiu   %[noise],    %[noise],              1                     \n\t"
858             "andi    %[noise],    %[noise],              0x1ff                 \n\t"
859             "sll     %[temp0],    %[noise],              3                     \n\t"
860             PTR_ADDU "%[ff_table],%[ff_sbr_noise_table], %[temp0]              \n\t"
861             "nmsub.s %[y1],       %[y1],                 %[temp1], %[phi_sign] \n\t"
862             "mfc1    %[temp3],    %[temp1]                                     \n\t"
863             "bne     %[temp3],    $0,                    1f                    \n\t"
864             "lwc1    %[y0],       0(%[Y1])                                     \n\t"
865             "lwc1    %[temp2],    0(%[q_filt1])                                \n\t"
866             "lwc1    %[temp4],    0(%[ff_table])                               \n\t"
867             "lwc1    %[temp5],    4(%[ff_table])                               \n\t"
868             "madd.s  %[y0],       %[y0],                 %[temp2], %[temp4]    \n\t"
869             "madd.s  %[y1],       %[y1],                 %[temp2], %[temp5]    \n\t"
870             "swc1    %[y0],       0(%[Y1])                                     \n\t"
871             "1:                                                                \n\t"
872             "swc1    %[y1],       4(%[Y1])                                     \n\t"
873
874             : [ff_table]"=&r"(ff_table), [y0]"=&f"(y0), [y1]"=&f"(y1),
875               [temp0]"=&r"(temp0), [temp1]"=&f"(temp1), [temp2]"=&f"(temp2),
876               [temp3]"=&r"(temp3), [temp4]"=&f"(temp4), [temp5]"=&f"(temp5)
877             : [ff_sbr_noise_table]"r"(ff_sbr_noise_table), [noise]"r"(noise),
878               [Y1]"r"(Y1), [s_m1]"r"(s_m1), [q_filt1]"r"(q_filt1),
879               [phi_sign]"f"(phi_sign)
880             : "memory"
881         );
882        phi_sign = -phi_sign;
883     }
884 }
885 #endif /* HAVE_MIPSFPU */
886 #endif /* HAVE_INLINE_ASM */
887
888 void ff_sbrdsp_init_mips(SBRDSPContext *s)
889 {
890 #if HAVE_INLINE_ASM
891     s->qmf_pre_shuffle = sbr_qmf_pre_shuffle_mips;
892     s->qmf_post_shuffle = sbr_qmf_post_shuffle_mips;
893 #if HAVE_MIPSFPU
894     s->sum64x5 = sbr_sum64x5_mips;
895     s->sum_square = sbr_sum_square_mips;
896     s->qmf_deint_bfly = sbr_qmf_deint_bfly_mips;
897     s->autocorrelate = sbr_autocorrelate_mips;
898     s->hf_gen = sbr_hf_gen_mips;
899     s->hf_g_filt = sbr_hf_g_filt_mips;
900
901     s->hf_apply_noise[0] = sbr_hf_apply_noise_0_mips;
902     s->hf_apply_noise[1] = sbr_hf_apply_noise_1_mips;
903     s->hf_apply_noise[2] = sbr_hf_apply_noise_2_mips;
904     s->hf_apply_noise[3] = sbr_hf_apply_noise_3_mips;
905 #endif /* HAVE_MIPSFPU */
906 #endif /* HAVE_INLINE_ASM */
907 }