git.sesse.net Git - ffmpeg/blob - 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 }