/*
 *  Copyright (c) 2013 The WebRTC project authors. All Rights Reserved.
 *
 *  Use of this source code is governed by a BSD-style license
 *  that can be found in the LICENSE file in the root of the source
 *  tree. An additional intellectual property rights grant can be found
 *  in the file PATENTS.  All contributing project authors may
 *  be found in the AUTHORS file in the root of the source tree.
 */

/*
 * The core AEC algorithm, which is presented with time-aligned signals.
 */

#include "modules/audio_processing/aec/aec_core.h"

#include <math.h>

extern "C" {
#include "common_audio/signal_processing/include/signal_processing_library.h"
}
#include "modules/audio_processing/aec/aec_core_optimized_methods.h"
#include "modules/audio_processing/utility/ooura_fft.h"

namespace webrtc {

extern const float WebRtcAec_weightCurve[65];
extern const float WebRtcAec_overDriveCurve[65];

void WebRtcAec_FilterFar_mips(
    int num_partitions,
    int x_fft_buf_block_pos,
    float x_fft_buf[2][kExtendedNumPartitions * PART_LEN1],
    float h_fft_buf[2][kExtendedNumPartitions * PART_LEN1],
    float y_fft[2][PART_LEN1]) {
  int i;
  for (i = 0; i < num_partitions; i++) {
    int xPos = (i + x_fft_buf_block_pos) * PART_LEN1;
    int pos = i * PART_LEN1;
    // Check for wrap
    if (i + x_fft_buf_block_pos >= num_partitions) {
      xPos -= num_partitions * (PART_LEN1);
    }
    float* yf0 = y_fft[0];
    float* yf1 = y_fft[1];
    float* aRe = x_fft_buf[0] + xPos;
    float* aIm = x_fft_buf[1] + xPos;
    float* bRe = h_fft_buf[0] + pos;
    float* bIm = h_fft_buf[1] + pos;
    float f0, f1, f2, f3, f4, f5, f6, f7, f8, f9, f10, f11, f12, f13;
    int len = PART_LEN1 >> 1;

    __asm __volatile(
        ".set       push                                                \n\t"
        ".set       noreorder                                           \n\t"
        "1:                                                             \n\t"
        "lwc1       %[f0],      0(%[aRe])                               \n\t"
        "lwc1       %[f1],      0(%[bRe])                               \n\t"
        "lwc1       %[f2],      0(%[bIm])                               \n\t"
        "lwc1       %[f3],      0(%[aIm])                               \n\t"
        "lwc1       %[f4],      4(%[aRe])                               \n\t"
        "lwc1       %[f5],      4(%[bRe])                               \n\t"
        "lwc1       %[f6],      4(%[bIm])                               \n\t"
        "mul.s      %[f8],      %[f0],          %[f1]                   \n\t"
        "mul.s      %[f0],      %[f0],          %[f2]                   \n\t"
        "mul.s      %[f9],      %[f4],          %[f5]                   \n\t"
        "mul.s      %[f4],      %[f4],          %[f6]                   \n\t"
        "lwc1       %[f7],      4(%[aIm])                               \n\t"
#if !defined(MIPS32_R2_LE)
        "mul.s      %[f12],     %[f2],          %[f3]                   \n\t"
        "mul.s      %[f1],      %[f3],          %[f1]                   \n\t"
        "mul.s      %[f11],     %[f6],          %[f7]                   \n\t"
        "addiu      %[aRe],     %[aRe],         8                       \n\t"
        "addiu      %[aIm],     %[aIm],         8                       \n\t"
        "addiu      %[len],     %[len],         -1                      \n\t"
        "sub.s      %[f8],      %[f8],          %[f12]                  \n\t"
        "mul.s      %[f12],     %[f7],          %[f5]                   \n\t"
        "lwc1       %[f2],      0(%[yf0])                               \n\t"
        "add.s      %[f1],      %[f0],          %[f1]                   \n\t"
        "lwc1       %[f3],      0(%[yf1])                               \n\t"
        "sub.s      %[f9],      %[f9],          %[f11]                  \n\t"
        "lwc1       %[f6],      4(%[yf0])                               \n\t"
        "add.s      %[f4],      %[f4],          %[f12]                  \n\t"
#else   // #if !defined(MIPS32_R2_LE)
        "addiu      %[aRe],     %[aRe],         8                       \n\t"
        "addiu      %[aIm],     %[aIm],         8                       \n\t"
        "addiu      %[len],     %[len],         -1                      \n\t"
        "nmsub.s    %[f8],      %[f8],          %[f2],      %[f3]       \n\t"
        "lwc1       %[f2],      0(%[yf0])                               \n\t"
        "madd.s     %[f1],      %[f0],          %[f3],      %[f1]       \n\t"
        "lwc1       %[f3],      0(%[yf1])                               \n\t"
        "nmsub.s    %[f9],      %[f9],          %[f6],      %[f7]       \n\t"
        "lwc1       %[f6],      4(%[yf0])                               \n\t"
        "madd.s     %[f4],      %[f4],          %[f7],      %[f5]       \n\t"
#endif  // #if !defined(MIPS32_R2_LE)
        "lwc1       %[f5],      4(%[yf1])                               \n\t"
        "add.s      %[f2],      %[f2],          %[f8]                   \n\t"
        "addiu      %[bRe],     %[bRe],         8                       \n\t"
        "addiu      %[bIm],     %[bIm],         8                       \n\t"
        "add.s      %[f3],      %[f3],          %[f1]                   \n\t"
        "add.s      %[f6],      %[f6],          %[f9]                   \n\t"
        "add.s      %[f5],      %[f5],          %[f4]                   \n\t"
        "swc1       %[f2],      0(%[yf0])                               \n\t"
        "swc1       %[f3],      0(%[yf1])                               \n\t"
        "swc1       %[f6],      4(%[yf0])                               \n\t"
        "swc1       %[f5],      4(%[yf1])                               \n\t"
        "addiu      %[yf0],     %[yf0],         8                       \n\t"
        "bgtz       %[len],     1b                                      \n\t"
        " addiu     %[yf1],     %[yf1],         8                       \n\t"
        "lwc1       %[f0],      0(%[aRe])                               \n\t"
        "lwc1       %[f1],      0(%[bRe])                               \n\t"
        "lwc1       %[f2],      0(%[bIm])                               \n\t"
        "lwc1       %[f3],      0(%[aIm])                               \n\t"
        "mul.s      %[f8],      %[f0],          %[f1]                   \n\t"
        "mul.s      %[f0],      %[f0],          %[f2]                   \n\t"
#if !defined(MIPS32_R2_LE)
        "mul.s      %[f12],     %[f2],          %[f3]                   \n\t"
        "mul.s      %[f1],      %[f3],          %[f1]                   \n\t"
        "sub.s      %[f8],      %[f8],          %[f12]                  \n\t"
        "lwc1       %[f2],      0(%[yf0])                               \n\t"
        "add.s      %[f1],      %[f0],          %[f1]                   \n\t"
        "lwc1       %[f3],      0(%[yf1])                               \n\t"
#else   // #if !defined(MIPS32_R2_LE)
        "nmsub.s    %[f8],      %[f8],          %[f2],      %[f3]       \n\t"
        "lwc1       %[f2],      0(%[yf0])                               \n\t"
        "madd.s     %[f1],      %[f0],          %[f3],      %[f1]       \n\t"
        "lwc1       %[f3],      0(%[yf1])                               \n\t"
#endif  // #if !defined(MIPS32_R2_LE)
        "add.s      %[f2],      %[f2],          %[f8]                   \n\t"
        "add.s      %[f3],      %[f3],          %[f1]                   \n\t"
        "swc1       %[f2],      0(%[yf0])                               \n\t"
        "swc1       %[f3],      0(%[yf1])                               \n\t"
        ".set       pop                                                 \n\t"
        : [f0] "=&f"(f0), [f1] "=&f"(f1), [f2] "=&f"(f2), [f3] "=&f"(f3),
          [f4] "=&f"(f4), [f5] "=&f"(f5), [f6] "=&f"(f6), [f7] "=&f"(f7),
          [f8] "=&f"(f8), [f9] "=&f"(f9), [f10] "=&f"(f10), [f11] "=&f"(f11),
          [f12] "=&f"(f12), [f13] "=&f"(f13), [aRe] "+r"(aRe), [aIm] "+r"(aIm),
          [bRe] "+r"(bRe), [bIm] "+r"(bIm), [yf0] "+r"(yf0), [yf1] "+r"(yf1),
          [len] "+r"(len)
        :
        : "memory");
  }
}

void WebRtcAec_FilterAdaptation_mips(
    const OouraFft& ooura_fft,
    int num_partitions,
    int x_fft_buf_block_pos,
    float x_fft_buf[2][kExtendedNumPartitions * PART_LEN1],
    float e_fft[2][PART_LEN1],
    float h_fft_buf[2][kExtendedNumPartitions * PART_LEN1]) {
  float fft[PART_LEN2];
  int i;
  for (i = 0; i < num_partitions; i++) {
    int xPos = (i + x_fft_buf_block_pos) * (PART_LEN1);
    int pos;
    // Check for wrap
    if (i + x_fft_buf_block_pos >= num_partitions) {
      xPos -= num_partitions * PART_LEN1;
    }

    pos = i * PART_LEN1;
    float* aRe = x_fft_buf[0] + xPos;
    float* aIm = x_fft_buf[1] + xPos;
    float* bRe = e_fft[0];
    float* bIm = e_fft[1];
    float* fft_tmp;

    float f0, f1, f2, f3, f4, f5, f6, f7, f8, f9, f10, f11, f12;
    int len = PART_LEN >> 1;

    __asm __volatile(
        ".set       push                                                \n\t"
        ".set       noreorder                                           \n\t"
        "addiu      %[fft_tmp], %[fft],         0                       \n\t"
        "1:                                                             \n\t"
        "lwc1       %[f0],      0(%[aRe])                               \n\t"
        "lwc1       %[f1],      0(%[bRe])                               \n\t"
        "lwc1       %[f2],      0(%[bIm])                               \n\t"
        "lwc1       %[f4],      4(%[aRe])                               \n\t"
        "lwc1       %[f5],      4(%[bRe])                               \n\t"
        "lwc1       %[f6],      4(%[bIm])                               \n\t"
        "addiu      %[aRe],     %[aRe],         8                       \n\t"
        "addiu      %[bRe],     %[bRe],         8                       \n\t"
        "mul.s      %[f8],      %[f0],          %[f1]                   \n\t"
        "mul.s      %[f0],      %[f0],          %[f2]                   \n\t"
        "lwc1       %[f3],      0(%[aIm])                               \n\t"
        "mul.s      %[f9],      %[f4],          %[f5]                   \n\t"
        "lwc1       %[f7],      4(%[aIm])                               \n\t"
        "mul.s      %[f4],      %[f4],          %[f6]                   \n\t"
#if !defined(MIPS32_R2_LE)
        "mul.s      %[f10],     %[f3],          %[f2]                   \n\t"
        "mul.s      %[f1],      %[f3],          %[f1]                   \n\t"
        "mul.s      %[f11],     %[f7],          %[f6]                   \n\t"
        "mul.s      %[f5],      %[f7],          %[f5]                   \n\t"
        "addiu      %[aIm],     %[aIm],         8                       \n\t"
        "addiu      %[bIm],     %[bIm],         8                       \n\t"
        "addiu      %[len],     %[len],         -1                      \n\t"
        "add.s      %[f8],      %[f8],          %[f10]                  \n\t"
        "sub.s      %[f1],      %[f0],          %[f1]                   \n\t"
        "add.s      %[f9],      %[f9],          %[f11]                  \n\t"
        "sub.s      %[f5],      %[f4],          %[f5]                   \n\t"
#else   // #if !defined(MIPS32_R2_LE)
        "addiu      %[aIm],     %[aIm],         8                       \n\t"
        "addiu      %[bIm],     %[bIm],         8                       \n\t"
        "addiu      %[len],     %[len],         -1                      \n\t"
        "madd.s     %[f8],      %[f8],          %[f3],      %[f2]       \n\t"
        "nmsub.s    %[f1],      %[f0],          %[f3],      %[f1]       \n\t"
        "madd.s     %[f9],      %[f9],          %[f7],      %[f6]       \n\t"
        "nmsub.s    %[f5],      %[f4],          %[f7],      %[f5]       \n\t"
#endif  // #if !defined(MIPS32_R2_LE)
        "swc1       %[f8],      0(%[fft_tmp])                           \n\t"
        "swc1       %[f1],      4(%[fft_tmp])                           \n\t"
        "swc1       %[f9],      8(%[fft_tmp])                           \n\t"
        "swc1       %[f5],      12(%[fft_tmp])                          \n\t"
        "bgtz       %[len],     1b                                      \n\t"
        " addiu     %[fft_tmp], %[fft_tmp],     16                      \n\t"
        "lwc1       %[f0],      0(%[aRe])                               \n\t"
        "lwc1       %[f1],      0(%[bRe])                               \n\t"
        "lwc1       %[f2],      0(%[bIm])                               \n\t"
        "lwc1       %[f3],      0(%[aIm])                               \n\t"
        "mul.s      %[f8],      %[f0],          %[f1]                   \n\t"
#if !defined(MIPS32_R2_LE)
        "mul.s      %[f10],     %[f3],          %[f2]                   \n\t"
        "add.s      %[f8],      %[f8],          %[f10]                  \n\t"
#else   // #if !defined(MIPS32_R2_LE)
        "madd.s     %[f8],      %[f8],          %[f3],      %[f2]       \n\t"
#endif  // #if !defined(MIPS32_R2_LE)
        "swc1       %[f8],      4(%[fft])                               \n\t"
        ".set       pop                                                 \n\t"
        : [f0] "=&f"(f0), [f1] "=&f"(f1), [f2] "=&f"(f2), [f3] "=&f"(f3),
          [f4] "=&f"(f4), [f5] "=&f"(f5), [f6] "=&f"(f6), [f7] "=&f"(f7),
          [f8] "=&f"(f8), [f9] "=&f"(f9), [f10] "=&f"(f10), [f11] "=&f"(f11),
          [f12] "=&f"(f12), [aRe] "+r"(aRe), [aIm] "+r"(aIm), [bRe] "+r"(bRe),
          [bIm] "+r"(bIm), [fft_tmp] "=&r"(fft_tmp), [len] "+r"(len)
        : [fft] "r"(fft)
        : "memory");

    ooura_fft.InverseFft(fft);
    memset(fft + PART_LEN, 0, sizeof(float) * PART_LEN);

    // fft scaling
    {
      float scale = 2.0f / PART_LEN2;
      __asm __volatile(
          ".set     push                                    \n\t"
          ".set     noreorder                               \n\t"
          "addiu    %[fft_tmp], %[fft],        0            \n\t"
          "addiu    %[len],     $zero,         8            \n\t"
          "1:                                               \n\t"
          "addiu    %[len],     %[len],        -1           \n\t"
          "lwc1     %[f0],      0(%[fft_tmp])               \n\t"
          "lwc1     %[f1],      4(%[fft_tmp])               \n\t"
          "lwc1     %[f2],      8(%[fft_tmp])               \n\t"
          "lwc1     %[f3],      12(%[fft_tmp])              \n\t"
          "mul.s    %[f0],      %[f0],         %[scale]     \n\t"
          "mul.s    %[f1],      %[f1],         %[scale]     \n\t"
          "mul.s    %[f2],      %[f2],         %[scale]     \n\t"
          "mul.s    %[f3],      %[f3],         %[scale]     \n\t"
          "lwc1     %[f4],      16(%[fft_tmp])              \n\t"
          "lwc1     %[f5],      20(%[fft_tmp])              \n\t"
          "lwc1     %[f6],      24(%[fft_tmp])              \n\t"
          "lwc1     %[f7],      28(%[fft_tmp])              \n\t"
          "mul.s    %[f4],      %[f4],         %[scale]     \n\t"
          "mul.s    %[f5],      %[f5],         %[scale]     \n\t"
          "mul.s    %[f6],      %[f6],         %[scale]     \n\t"
          "mul.s    %[f7],      %[f7],         %[scale]     \n\t"
          "swc1     %[f0],      0(%[fft_tmp])               \n\t"
          "swc1     %[f1],      4(%[fft_tmp])               \n\t"
          "swc1     %[f2],      8(%[fft_tmp])               \n\t"
          "swc1     %[f3],      12(%[fft_tmp])              \n\t"
          "swc1     %[f4],      16(%[fft_tmp])              \n\t"
          "swc1     %[f5],      20(%[fft_tmp])              \n\t"
          "swc1     %[f6],      24(%[fft_tmp])              \n\t"
          "swc1     %[f7],      28(%[fft_tmp])              \n\t"
          "bgtz     %[len],     1b                          \n\t"
          " addiu   %[fft_tmp], %[fft_tmp],    32           \n\t"
          ".set     pop                                     \n\t"
          : [f0] "=&f"(f0), [f1] "=&f"(f1), [f2] "=&f"(f2), [f3] "=&f"(f3),
            [f4] "=&f"(f4), [f5] "=&f"(f5), [f6] "=&f"(f6), [f7] "=&f"(f7),
            [len] "=&r"(len), [fft_tmp] "=&r"(fft_tmp)
          : [scale] "f"(scale), [fft] "r"(fft)
          : "memory");
    }
    ooura_fft.Fft(fft);
    aRe = h_fft_buf[0] + pos;
    aIm = h_fft_buf[1] + pos;
    __asm __volatile(
        ".set     push                                    \n\t"
        ".set     noreorder                               \n\t"
        "addiu    %[fft_tmp], %[fft],        0            \n\t"
        "addiu    %[len],     $zero,         31           \n\t"
        "lwc1     %[f0],      0(%[aRe])                   \n\t"
        "lwc1     %[f1],      0(%[fft_tmp])               \n\t"
        "lwc1     %[f2],      256(%[aRe])                 \n\t"
        "lwc1     %[f3],      4(%[fft_tmp])               \n\t"
        "lwc1     %[f4],      4(%[aRe])                   \n\t"
        "lwc1     %[f5],      8(%[fft_tmp])               \n\t"
        "lwc1     %[f6],      4(%[aIm])                   \n\t"
        "lwc1     %[f7],      12(%[fft_tmp])              \n\t"
        "add.s    %[f0],      %[f0],         %[f1]        \n\t"
        "add.s    %[f2],      %[f2],         %[f3]        \n\t"
        "add.s    %[f4],      %[f4],         %[f5]        \n\t"
        "add.s    %[f6],      %[f6],         %[f7]        \n\t"
        "addiu    %[fft_tmp], %[fft_tmp],    16           \n\t"
        "swc1     %[f0],      0(%[aRe])                   \n\t"
        "swc1     %[f2],      256(%[aRe])                 \n\t"
        "swc1     %[f4],      4(%[aRe])                   \n\t"
        "addiu    %[aRe],     %[aRe],        8            \n\t"
        "swc1     %[f6],      4(%[aIm])                   \n\t"
        "addiu    %[aIm],     %[aIm],        8            \n\t"
        "1:                                               \n\t"
        "lwc1     %[f0],      0(%[aRe])                   \n\t"
        "lwc1     %[f1],      0(%[fft_tmp])               \n\t"
        "lwc1     %[f2],      0(%[aIm])                   \n\t"
        "lwc1     %[f3],      4(%[fft_tmp])               \n\t"
        "lwc1     %[f4],      4(%[aRe])                   \n\t"
        "lwc1     %[f5],      8(%[fft_tmp])               \n\t"
        "lwc1     %[f6],      4(%[aIm])                   \n\t"
        "lwc1     %[f7],      12(%[fft_tmp])              \n\t"
        "add.s    %[f0],      %[f0],         %[f1]        \n\t"
        "add.s    %[f2],      %[f2],         %[f3]        \n\t"
        "add.s    %[f4],      %[f4],         %[f5]        \n\t"
        "add.s    %[f6],      %[f6],         %[f7]        \n\t"
        "addiu    %[len],     %[len],        -1           \n\t"
        "addiu    %[fft_tmp], %[fft_tmp],    16           \n\t"
        "swc1     %[f0],      0(%[aRe])                   \n\t"
        "swc1     %[f2],      0(%[aIm])                   \n\t"
        "swc1     %[f4],      4(%[aRe])                   \n\t"
        "addiu    %[aRe],     %[aRe],        8            \n\t"
        "swc1     %[f6],      4(%[aIm])                   \n\t"
        "bgtz     %[len],     1b                          \n\t"
        " addiu   %[aIm],     %[aIm],        8            \n\t"
        ".set     pop                                     \n\t"
        : [f0] "=&f"(f0), [f1] "=&f"(f1), [f2] "=&f"(f2), [f3] "=&f"(f3),
          [f4] "=&f"(f4), [f5] "=&f"(f5), [f6] "=&f"(f6), [f7] "=&f"(f7),
          [len] "=&r"(len), [fft_tmp] "=&r"(fft_tmp), [aRe] "+r"(aRe),
          [aIm] "+r"(aIm)
        : [fft] "r"(fft)
        : "memory");
  }
}

void WebRtcAec_Overdrive_mips(float overdrive_scaling,
                              float hNlFb,
                              float hNl[PART_LEN1]) {
  const float one = 1.0;
  float* p_hNl;
  const float* p_WebRtcAec_wC;
  float temp1, temp2, temp3, temp4;

  p_hNl = &hNl[0];
  p_WebRtcAec_wC = &WebRtcAec_weightCurve[0];

  for (int i = 0; i < PART_LEN1; ++i) {
    // Weight subbands
    __asm __volatile(
        ".set      push                                              \n\t"
        ".set      noreorder                                         \n\t"
        "lwc1      %[temp1],    0(%[p_hNl])                          \n\t"
        "lwc1      %[temp2],    0(%[p_wC])                           \n\t"
        "c.lt.s    %[hNlFb],    %[temp1]                             \n\t"
        "bc1f      1f                                                \n\t"
        " mul.s    %[temp3],    %[temp2],     %[hNlFb]               \n\t"
        "sub.s     %[temp4],    %[one],       %[temp2]               \n\t"
#if !defined(MIPS32_R2_LE)
        "mul.s     %[temp1],    %[temp1],     %[temp4]               \n\t"
        "add.s     %[temp1],    %[temp3],     %[temp1]               \n\t"
#else   // #if !defined(MIPS32_R2_LE)
        "madd.s    %[temp1],    %[temp3],     %[temp1],   %[temp4]   \n\t"
#endif  // #if !defined(MIPS32_R2_LE)
        "swc1      %[temp1],    0(%[p_hNl])                          \n\t"
        "1:                                                           \n\t"
        "addiu     %[p_wC],     %[p_wC],      4                      \n\t"
        ".set      pop                                               \n\t"
        : [temp1] "=&f"(temp1), [temp2] "=&f"(temp2), [temp3] "=&f"(temp3),
          [temp4] "=&f"(temp4), [p_wC] "+r"(p_WebRtcAec_wC)
        : [hNlFb] "f"(hNlFb), [one] "f"(one), [p_hNl] "r"(p_hNl)
        : "memory");

    hNl[i] = powf(hNl[i], overdrive_scaling * WebRtcAec_overDriveCurve[i]);
  }
}

void WebRtcAec_Suppress_mips(const float hNl[PART_LEN1],
                             float efw[2][PART_LEN1]) {
  const float* p_hNl;
  float* p_efw0;
  float* p_efw1;
  float temp1, temp2, temp3, temp4;

  p_hNl = &hNl[0];
  p_efw0 = &efw[0][0];
  p_efw1 = &efw[1][0];

  for (int i = 0; i < PART_LEN1; ++i) {
    __asm __volatile(
        "lwc1      %[temp1],    0(%[p_hNl])              \n\t"
        "lwc1      %[temp3],    0(%[p_efw1])             \n\t"
        "lwc1      %[temp2],    0(%[p_efw0])             \n\t"
        "addiu     %[p_hNl],    %[p_hNl],     4          \n\t"
        "mul.s     %[temp3],    %[temp3],     %[temp1]   \n\t"
        "mul.s     %[temp2],    %[temp2],     %[temp1]   \n\t"
        "addiu     %[p_efw0],   %[p_efw0],    4          \n\t"
        "addiu     %[p_efw1],   %[p_efw1],    4          \n\t"
        "neg.s     %[temp4],    %[temp3]                 \n\t"
        "swc1      %[temp2],    -4(%[p_efw0])            \n\t"
        "swc1      %[temp4],    -4(%[p_efw1])            \n\t"
        : [temp1] "=&f"(temp1), [temp2] "=&f"(temp2), [temp3] "=&f"(temp3),
          [temp4] "=&f"(temp4), [p_efw0] "+r"(p_efw0), [p_efw1] "+r"(p_efw1),
          [p_hNl] "+r"(p_hNl)
        :
        : "memory");
  }
}

void WebRtcAec_ScaleErrorSignal_mips(float mu,
                                     float error_threshold,
                                     float x_pow[PART_LEN1],
                                     float ef[2][PART_LEN1]) {
  int len = (PART_LEN1);
  float* ef0 = ef[0];
  float* ef1 = ef[1];
  float fac1 = 1e-10f;
  float err_th2 = error_threshold * error_threshold;
  float f0, f1, f2;
#if !defined(MIPS32_R2_LE)
  float f3;
#endif

  __asm __volatile(
      ".set       push                                   \n\t"
      ".set       noreorder                              \n\t"
      "1:                                                \n\t"
      "lwc1       %[f0],     0(%[x_pow])                 \n\t"
      "lwc1       %[f1],     0(%[ef0])                   \n\t"
      "lwc1       %[f2],     0(%[ef1])                   \n\t"
      "add.s      %[f0],     %[f0],       %[fac1]        \n\t"
      "div.s      %[f1],     %[f1],       %[f0]          \n\t"
      "div.s      %[f2],     %[f2],       %[f0]          \n\t"
      "mul.s      %[f0],     %[f1],       %[f1]          \n\t"
#if defined(MIPS32_R2_LE)
      "madd.s     %[f0],     %[f0],       %[f2],   %[f2] \n\t"
#else
      "mul.s      %[f3],     %[f2],       %[f2]          \n\t"
      "add.s      %[f0],     %[f0],       %[f3]          \n\t"
#endif
      "c.le.s     %[f0],     %[err_th2]                  \n\t"
      "nop                                               \n\t"
      "bc1t       2f                                     \n\t"
      " nop                                              \n\t"
      "sqrt.s     %[f0],     %[f0]                       \n\t"
      "add.s      %[f0],     %[f0],       %[fac1]        \n\t"
      "div.s      %[f0],     %[err_th],   %[f0]          \n\t"
      "mul.s      %[f1],     %[f1],       %[f0]          \n\t"
      "mul.s      %[f2],     %[f2],       %[f0]          \n\t"
      "2:                                                \n\t"
      "mul.s      %[f1],     %[f1],       %[mu]          \n\t"
      "mul.s      %[f2],     %[f2],       %[mu]          \n\t"
      "swc1       %[f1],     0(%[ef0])                   \n\t"
      "swc1       %[f2],     0(%[ef1])                   \n\t"
      "addiu      %[len],    %[len],      -1             \n\t"
      "addiu      %[x_pow],  %[x_pow],    4              \n\t"
      "addiu      %[ef0],    %[ef0],      4              \n\t"
      "bgtz       %[len],    1b                          \n\t"
      " addiu     %[ef1],    %[ef1],      4              \n\t"
      ".set       pop                                    \n\t"
      : [f0] "=&f"(f0), [f1] "=&f"(f1), [f2] "=&f"(f2),
#if !defined(MIPS32_R2_LE)
        [f3] "=&f"(f3),
#endif
        [x_pow] "+r"(x_pow), [ef0] "+r"(ef0), [ef1] "+r"(ef1), [len] "+r"(len)
      : [fac1] "f"(fac1), [err_th2] "f"(err_th2), [mu] "f"(mu),
        [err_th] "f"(error_threshold)
      : "memory");
}

void WebRtcAec_InitAec_mips(void) {
  WebRtcAec_FilterFar = WebRtcAec_FilterFar_mips;
  WebRtcAec_FilterAdaptation = WebRtcAec_FilterAdaptation_mips;
  WebRtcAec_ScaleErrorSignal = WebRtcAec_ScaleErrorSignal_mips;
  WebRtcAec_Overdrive = WebRtcAec_Overdrive_mips;
  WebRtcAec_Suppress = WebRtcAec_Suppress_mips;
}
}  // namespace webrtc