/*
 * Copyright (c) 2016, Alliance for Open Media. All rights reserved
 *
 * This source code is subject to the terms of the BSD 2 Clause License and
 * the Alliance for Open Media Patent License 1.0. If the BSD 2 Clause License
 * was not distributed with this source code in the LICENSE file, you can
 * obtain it at www.aomedia.org/license/software. If the Alliance for Open
 * Media Patent License 1.0 was not distributed with this source code in the
 * PATENTS file, you can obtain it at www.aomedia.org/license/patent.
 */

#include "./aom_dsp_rtcd.h"

#include "aom_ports/mem.h"

DECLARE_ALIGNED(16, static const int16_t, bilinear_filters_mmx[8][8]) = {
  { 128, 128, 128, 128, 0, 0, 0, 0 }, { 112, 112, 112, 112, 16, 16, 16, 16 },
  { 96, 96, 96, 96, 32, 32, 32, 32 }, { 80, 80, 80, 80, 48, 48, 48, 48 },
  { 64, 64, 64, 64, 64, 64, 64, 64 }, { 48, 48, 48, 48, 80, 80, 80, 80 },
  { 32, 32, 32, 32, 96, 96, 96, 96 }, { 16, 16, 16, 16, 112, 112, 112, 112 }
};

extern void aom_get4x4var_mmx(const uint8_t *a, int a_stride, const uint8_t *b,
                              int b_stride, unsigned int *sse, int *sum);

extern void aom_filter_block2d_bil4x4_var_mmx(const unsigned char *ref_ptr,
                                              int ref_pixels_per_line,
                                              const unsigned char *src_ptr,
                                              int src_pixels_per_line,
                                              const int16_t *HFilter,
                                              const int16_t *VFilter, int *sum,
                                              unsigned int *sumsquared);

extern void aom_filter_block2d_bil_var_mmx(
    const unsigned char *ref_ptr, int ref_pixels_per_line,
    const unsigned char *src_ptr, int src_pixels_per_line, unsigned int Height,
    const int16_t *HFilter, const int16_t *VFilter, int *sum,
    unsigned int *sumsquared);

unsigned int aom_variance4x4_mmx(const unsigned char *a, int a_stride,
                                 const unsigned char *b, int b_stride,
                                 unsigned int *sse) {
  unsigned int var;
  int avg;

  aom_get4x4var_mmx(a, a_stride, b, b_stride, &var, &avg);
  *sse = var;
  return (var - (((unsigned int)avg * avg) >> 4));
}

unsigned int aom_variance8x8_mmx(const unsigned char *a, int a_stride,
                                 const unsigned char *b, int b_stride,
                                 unsigned int *sse) {
  unsigned int var;
  int avg;

  aom_get8x8var_mmx(a, a_stride, b, b_stride, &var, &avg);
  *sse = var;

  return (var - (((unsigned int)avg * avg) >> 6));
}

unsigned int aom_mse16x16_mmx(const unsigned char *a, int a_stride,
                              const unsigned char *b, int b_stride,
                              unsigned int *sse) {
  unsigned int sse0, sse1, sse2, sse3, var;
  int sum0, sum1, sum2, sum3;

  aom_get8x8var_mmx(a, a_stride, b, b_stride, &sse0, &sum0);
  aom_get8x8var_mmx(a + 8, a_stride, b + 8, b_stride, &sse1, &sum1);
  aom_get8x8var_mmx(a + 8 * a_stride, a_stride, b + 8 * b_stride, b_stride,
                    &sse2, &sum2);
  aom_get8x8var_mmx(a + 8 * a_stride + 8, a_stride, b + 8 * b_stride + 8,
                    b_stride, &sse3, &sum3);

  var = sse0 + sse1 + sse2 + sse3;
  *sse = var;
  return var;
}

unsigned int aom_variance16x16_mmx(const unsigned char *a, int a_stride,
                                   const unsigned char *b, int b_stride,
                                   unsigned int *sse) {
  unsigned int sse0, sse1, sse2, sse3, var;
  int sum0, sum1, sum2, sum3, avg;

  aom_get8x8var_mmx(a, a_stride, b, b_stride, &sse0, &sum0);
  aom_get8x8var_mmx(a + 8, a_stride, b + 8, b_stride, &sse1, &sum1);
  aom_get8x8var_mmx(a + 8 * a_stride, a_stride, b + 8 * b_stride, b_stride,
                    &sse2, &sum2);
  aom_get8x8var_mmx(a + 8 * a_stride + 8, a_stride, b + 8 * b_stride + 8,
                    b_stride, &sse3, &sum3);

  var = sse0 + sse1 + sse2 + sse3;
  avg = sum0 + sum1 + sum2 + sum3;
  *sse = var;
  return (var - (((unsigned int)avg * avg) >> 8));
}

unsigned int aom_variance16x8_mmx(const unsigned char *a, int a_stride,
                                  const unsigned char *b, int b_stride,
                                  unsigned int *sse) {
  unsigned int sse0, sse1, var;
  int sum0, sum1, avg;

  aom_get8x8var_mmx(a, a_stride, b, b_stride, &sse0, &sum0);
  aom_get8x8var_mmx(a + 8, a_stride, b + 8, b_stride, &sse1, &sum1);

  var = sse0 + sse1;
  avg = sum0 + sum1;
  *sse = var;
  return (var - (((unsigned int)avg * avg) >> 7));
}

unsigned int aom_variance8x16_mmx(const unsigned char *a, int a_stride,
                                  const unsigned char *b, int b_stride,
                                  unsigned int *sse) {
  unsigned int sse0, sse1, var;
  int sum0, sum1, avg;

  aom_get8x8var_mmx(a, a_stride, b, b_stride, &sse0, &sum0);
  aom_get8x8var_mmx(a + 8 * a_stride, a_stride, b + 8 * b_stride, b_stride,
                    &sse1, &sum1);

  var = sse0 + sse1;
  avg = sum0 + sum1;
  *sse = var;

  return (var - (((unsigned int)avg * avg) >> 7));
}

uint32_t aom_sub_pixel_variance4x4_mmx(const uint8_t *a, int a_stride,
                                       int xoffset, int yoffset,
                                       const uint8_t *b, int b_stride,
                                       uint32_t *sse) {
  int xsum;
  unsigned int xxsum;
  aom_filter_block2d_bil4x4_var_mmx(
      a, a_stride, b, b_stride, bilinear_filters_mmx[xoffset],
      bilinear_filters_mmx[yoffset], &xsum, &xxsum);
  *sse = xxsum;
  return (xxsum - (((unsigned int)xsum * xsum) >> 4));
}

uint32_t aom_sub_pixel_variance8x8_mmx(const uint8_t *a, int a_stride,
                                       int xoffset, int yoffset,
                                       const uint8_t *b, int b_stride,
                                       uint32_t *sse) {
  int xsum;
  uint32_t xxsum;
  aom_filter_block2d_bil_var_mmx(a, a_stride, b, b_stride, 8,
                                 bilinear_filters_mmx[xoffset],
                                 bilinear_filters_mmx[yoffset], &xsum, &xxsum);
  *sse = xxsum;
  return (xxsum - (((uint32_t)xsum * xsum) >> 6));
}

uint32_t aom_sub_pixel_variance16x16_mmx(const uint8_t *a, int a_stride,
                                         int xoffset, int yoffset,
                                         const uint8_t *b, int b_stride,
                                         uint32_t *sse) {
  int xsum0, xsum1;
  unsigned int xxsum0, xxsum1;

  aom_filter_block2d_bil_var_mmx(
      a, a_stride, b, b_stride, 16, bilinear_filters_mmx[xoffset],
      bilinear_filters_mmx[yoffset], &xsum0, &xxsum0);

  aom_filter_block2d_bil_var_mmx(
      a + 8, a_stride, b + 8, b_stride, 16, bilinear_filters_mmx[xoffset],
      bilinear_filters_mmx[yoffset], &xsum1, &xxsum1);

  xsum0 += xsum1;
  xxsum0 += xxsum1;

  *sse = xxsum0;
  return (xxsum0 - (((uint32_t)xsum0 * xsum0) >> 8));
}

uint32_t aom_sub_pixel_variance16x8_mmx(const uint8_t *a, int a_stride,
                                        int xoffset, int yoffset,
                                        const uint8_t *b, int b_stride,
                                        uint32_t *sse) {
  int xsum0, xsum1;
  unsigned int xxsum0, xxsum1;

  aom_filter_block2d_bil_var_mmx(
      a, a_stride, b, b_stride, 8, bilinear_filters_mmx[xoffset],
      bilinear_filters_mmx[yoffset], &xsum0, &xxsum0);

  aom_filter_block2d_bil_var_mmx(
      a + 8, a_stride, b + 8, b_stride, 8, bilinear_filters_mmx[xoffset],
      bilinear_filters_mmx[yoffset], &xsum1, &xxsum1);

  xsum0 += xsum1;
  xxsum0 += xxsum1;

  *sse = xxsum0;
  return (xxsum0 - (((uint32_t)xsum0 * xsum0) >> 7));
}

uint32_t aom_sub_pixel_variance8x16_mmx(const uint8_t *a, int a_stride,
                                        int xoffset, int yoffset,
                                        const uint8_t *b, int b_stride,
                                        uint32_t *sse) {
  int xsum;
  unsigned int xxsum;
  aom_filter_block2d_bil_var_mmx(a, a_stride, b, b_stride, 16,
                                 bilinear_filters_mmx[xoffset],
                                 bilinear_filters_mmx[yoffset], &xsum, &xxsum);
  *sse = xxsum;
  return (xxsum - (((uint32_t)xsum * xsum) >> 7));
}

uint32_t aom_variance_halfpixvar16x16_h_mmx(const uint8_t *a, int a_stride,
                                            const uint8_t *b, int b_stride,
                                            uint32_t *sse) {
  return aom_sub_pixel_variance16x16_mmx(a, a_stride, 4, 0, b, b_stride, sse);
}

uint32_t aom_variance_halfpixvar16x16_v_mmx(const uint8_t *a, int a_stride,
                                            const uint8_t *b, int b_stride,
                                            uint32_t *sse) {
  return aom_sub_pixel_variance16x16_mmx(a, a_stride, 0, 4, b, b_stride, sse);
}

uint32_t aom_variance_halfpixvar16x16_hv_mmx(const uint8_t *a, int a_stride,
                                             const uint8_t *b, int b_stride,
                                             uint32_t *sse) {
  return aom_sub_pixel_variance16x16_mmx(a, a_stride, 4, 4, b, b_stride, sse);
}