/*
 *  Copyright (c) 2015 The WebM 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.
 */

#include <stdio.h>
#include <stdlib.h>
#include <memory.h>
#include <math.h>
#include <assert.h>

#include "vp10/common/warped_motion.h"


typedef void (*projectPointsType)(int *mat,
                                  int *points,
                                  int *proj,
                                  const int n,
                                  const int stride_points,
                                  const int stride_proj,
                                  const int subsampling_x,
                                  const int subsampling_y);

static void projectPointsHomography(int *mat,
                                    int *points,
                                    int *proj,
                                    const int n,
                                    const int stride_points,
                                    const int stride_proj,
                                    const int subsampling_x,
                                    const int subsampling_y);
static void projectPointsAffine(int *mat,
                                int *points,
                                int *proj,
                                const int n,
                                const int stride_points,
                                const int stride_proj,
                                const int subsampling_x,
                                const int subsampling_y);
static void projectPointsRotZoom(int *mat,
                                 int *points,
                                 int *proj,
                                 const int n,
                                 const int stride_points,
                                 const int stride_proj,
                                 const int subsampling_x,
                                 const int subsampling_y);
static void projectPointsTranslation(int *mat,
                                     int *points,
                                     int *proj,
                                     const int n,
                                     const int stride_points,
                                     const int stride_proj,
                                     const int subsampling_x,
                                     const int subsampling_y);

static projectPointsType get_projectPointsType(TransformationType type) {
  switch (type) {
    case HOMOGRAPHY:
      return projectPointsHomography;
    case AFFINE:
      return projectPointsAffine;
    case ROTZOOM:
      return projectPointsRotZoom;
    case TRANSLATION:
      return projectPointsTranslation;
    default:
      assert(0);
      return NULL;
  }
}

static void projectPointsTranslation(int *mat, int *points, int *proj,
                                     const int n,
                                     const int stride_points,
                                     const int stride_proj,
                                     const int subsampling_x,
                                     const int subsampling_y) {
  int i;
  for (i = 0; i < n; ++i) {
    const int x = *(points++), y = *(points++);
    if (subsampling_x)
      *(proj++) = ROUND_POWER_OF_TWO_SIGNED(
          ((x << (WARPEDMODEL_PREC_BITS + 1)) + mat[0]),
          WARPEDPIXEL_PREC_BITS + 1);
    else
      *(proj++) = ROUND_POWER_OF_TWO_SIGNED(
          ((x << WARPEDMODEL_PREC_BITS)) + mat[0],
          WARPEDPIXEL_PREC_BITS);
    if (subsampling_y)
      *(proj++) = ROUND_POWER_OF_TWO_SIGNED(
          ((y << (WARPEDMODEL_PREC_BITS + 1)) + mat[1]),
          WARPEDPIXEL_PREC_BITS + 1);
    else
      *(proj++) = ROUND_POWER_OF_TWO_SIGNED(
          ((y << WARPEDMODEL_PREC_BITS)) + mat[1],
          WARPEDPIXEL_PREC_BITS);
    points += stride_points - 2;
    proj += stride_proj - 2;
  }
}

void projectPointsRotZoom(int *mat, int *points, int *proj,
                          const int n,
                          const int stride_points,
                          const int stride_proj,
                          const int subsampling_x,
                          const int subsampling_y) {
  int i;
  for (i = 0; i < n; ++i) {
    const int x = *(points++), y = *(points++);
    if (subsampling_x)
      *(proj++) = ROUND_POWER_OF_TWO_SIGNED(
          mat[0] * 2 * x + mat[1] * 2 * y + mat[2] +
          (mat[0] + mat[1] - (1 << WARPEDMODEL_PREC_BITS)) / 2,
          WARPEDDIFF_PREC_BITS + 1);
    else
      *(proj++) = ROUND_POWER_OF_TWO_SIGNED(mat[0] * x + mat[1] * y + mat[2],
                                            WARPEDDIFF_PREC_BITS);
    if (subsampling_y)
      *(proj++) = ROUND_POWER_OF_TWO_SIGNED(
          -mat[1] * 2 * x + mat[0] * 2 * y + mat[3] +
          (-mat[1] + mat[0] - (1 << WARPEDMODEL_PREC_BITS)) / 2,
          WARPEDDIFF_PREC_BITS + 1);
    else
      *(proj++) = ROUND_POWER_OF_TWO_SIGNED(-mat[1] * x + mat[0] * y + mat[3],
                                            WARPEDDIFF_PREC_BITS);
    points += stride_points - 2;
    proj += stride_proj - 2;
  }
}

static void projectPointsAffine(int *mat, int *points, int *proj,
                                const int n,
                                const int stride_points,
                                const int stride_proj,
                                const int subsampling_x,
                                const int subsampling_y) {
  int i;
  for (i = 0; i < n; ++i) {
    const int x = *(points++), y = *(points++);
    if (subsampling_x)
      *(proj++) = ROUND_POWER_OF_TWO_SIGNED(
          mat[0] * 2 * x + mat[1] * 2 * y + mat[4] +
          (mat[0] + mat[1] - (1 << WARPEDMODEL_PREC_BITS)) / 2,
          WARPEDDIFF_PREC_BITS + 1);
    else
      *(proj++) = ROUND_POWER_OF_TWO_SIGNED(mat[0] * x + mat[1] * y + mat[4],
                                            WARPEDDIFF_PREC_BITS);
    if (subsampling_y)
      *(proj++) = ROUND_POWER_OF_TWO_SIGNED(
          mat[2] * 2 * x + mat[3] * 2 * y + mat[5] +
          (mat[2] + mat[3] - (1 << WARPEDMODEL_PREC_BITS)) / 2,
          WARPEDDIFF_PREC_BITS + 1);
    else
      *(proj++) = ROUND_POWER_OF_TWO_SIGNED(mat[2] * x + mat[3] * y + mat[5],
                                            WARPEDDIFF_PREC_BITS);
    points += stride_points - 2;
    proj += stride_proj - 2;
  }
}

static void projectPointsHomography(int *mat, int *points, int *proj,
                                    const int n,
                                    const int stride_points,
                                    const int stride_proj,
                                    const int subsampling_x,
                                    const int subsampling_y) {
  int i;
  int64_t x, y, Z;
  int64_t xp, yp;
  for (i = 0; i < n; ++i) {
    x = *(points++), y = *(points++);
    x = (subsampling_x ? 4 * x + 1 : 2 * x);
    y = (subsampling_y ? 4 * y + 1 : 2 * y);

    Z = (mat[6] * x + mat[7] * y + (1 << (WARPEDMODEL_ROW3HOMO_PREC_BITS + 1)));
    xp = (mat[0] * x + mat[1] * y + 2 * mat[2])
        << (WARPEDPIXEL_PREC_BITS +
        WARPEDMODEL_ROW3HOMO_PREC_BITS - WARPEDMODEL_PREC_BITS);
    yp = (mat[3] * x + mat[4] * y + 2 * mat[5])
        << (WARPEDPIXEL_PREC_BITS +
        WARPEDMODEL_ROW3HOMO_PREC_BITS - WARPEDMODEL_PREC_BITS);

    xp = xp > 0 ? (xp + Z / 2) / Z : (xp - Z / 2) / Z;
    yp = yp > 0 ? (yp + Z / 2) / Z : (yp - Z / 2) / Z;

    if (subsampling_x)
      xp = (xp - (1 << (WARPEDPIXEL_PREC_BITS - 1))) / 2;
    if (subsampling_y)
      yp = (yp - (1 << (WARPEDPIXEL_PREC_BITS - 1))) / 2;
    *(proj++) = xp;
    *(proj++) = yp;

    points += stride_points - 2;
    proj += stride_proj - 2;
  }
}

static const int16_t
filter_4tap[WARPEDPIXEL_PREC_SHIFTS][4] = {
  {0, 128,   0, 0},
  {-1, 127,   2, 0},
  {-2, 127,   4, -1},
  {-3, 126,   6, -1},
  {-3, 125,   8, -2},
  {-4, 124,  11, -3},
  {-5, 123,  13, -3},
  {-5, 121,  15, -3},
  {-6, 120,  18, -4},
  {-7, 119,  20, -4},
  {-7, 118,  22, -5},
  {-8, 116,  25, -5},
  {-8, 115,  27, -6},
  {-9, 113,  30, -6},
  {-9, 112,  32, -7},
  {-9, 110,  34, -7},
  {-10, 108,  37, -7},
  {-10, 107,  39, -8},
  {-10, 105,  41, -8},
  {-11, 103,  44, -8},
  {-11, 101,  47, -9},
  {-11,  99,  49, -9},
  {-11,  97,  51, -9},
  {-11,  95,  54, -10},
  {-11,  93,  56, -10},
  {-12,  91,  59, -10},
  {-12,  89,  61, -10},
  {-12,  87,  64, -11},
  {-12,  85,  66, -11},
  {-12,  82,  69, -11},
  {-12,  80,  71, -11},
  {-12,  78,  73, -11},
  {-11,  75,  75, -11},
  {-11,  73,  78, -12},
  {-11,  71,  80, -12},
  {-11,  69,  82, -12},
  {-11,  66,  85, -12},
  {-11,  64,  87, -12},
  {-10,  61,  89, -12},
  {-10,  59,  91, -12},
  {-10,  56,  93, -11},
  {-10,  54,  95, -11},
  {-9, 51, 97, -11},
  {-9, 49, 99, -11},
  {-9,  47, 101, -11},
  {-8,  44, 103, -11},
  {-8,  41, 105, -10},
  {-8,  39, 107, -10},
  {-7,  37, 108, -10},
  {-7,  34, 110, -9},
  {-7,  32, 112, -9},
  {-6,  30, 113, -9},
  {-6,  27, 115, -8},
  {-5,  25, 116, -8},
  {-5,  22, 118, -7},
  {-4,  20, 119, -7},
  {-4,  18, 120, -6},
  {-3,  15, 121, -5},
  {-3,  13, 123, -5},
  {-3,  11, 124, -4},
  {-2,   8, 125, -3},
  {-1,   6, 126, -3},
  {-1,   4, 127, -2},
  {0,   2, 127, -1},
};

static const int16_t
filter_ntap[WARPEDPIXEL_PREC_SHIFTS][WARPEDPIXEL_FILTER_TAPS] = {
  {0,   0, 128,   0,   0, 0},
  {0,  -1, 128,   2,  -1, 0},
  {1,  -3, 127,   4,  -1, 0},
  {1,  -4, 126,   6,  -2, 1},
  {1,  -5, 126,   8,  -3, 1},
  {1,  -6, 125,  11,  -4, 1},
  {1,  -7, 124,  13,  -4, 1},
  {2,  -8, 123,  15,  -5, 1},
  {2,  -9, 122,  18,  -6, 1},
  {2, -10, 121,  20,  -6, 1},
  {2, -11, 120,  22,  -7, 2},
  {2, -12, 119,  25,  -8, 2},
  {3, -13, 117,  27,  -8, 2},
  {3, -13, 116,  29,  -9, 2},
  {3, -14, 114,  32, -10, 3},
  {3, -15, 113,  35, -10, 2},
  {3, -15, 111,  37, -11, 3},
  {3, -16, 109,  40, -11, 3},
  {3, -16, 108,  42, -12, 3},
  {4, -17, 106,  45, -13, 3},
  {4, -17, 104,  47, -13, 3},
  {4, -17, 102,  50, -14, 3},
  {4, -17, 100,  52, -14, 3},
  {4, -18,  98,  55, -15, 4},
  {4, -18,  96,  58, -15, 3},
  {4, -18,  94,  60, -16, 4},
  {4, -18,  91,  63, -16, 4},
  {4, -18,  89,  65, -16, 4},
  {4, -18,  87,  68, -17, 4},
  {4, -18,  85,  70, -17, 4},
  {4, -18,  82,  73, -17, 4},
  {4, -18,  80,  75, -17, 4},
  {4, -18,  78,  78, -18, 4},
  {4, -17,  75,  80, -18, 4},
  {4, -17,  73,  82, -18, 4},
  {4, -17,  70,  85, -18, 4},
  {4, -17,  68,  87, -18, 4},
  {4, -16,  65,  89, -18, 4},
  {4, -16,  63,  91, -18, 4},
  {4, -16,  60,  94, -18, 4},
  {3, -15,  58,  96, -18, 4},
  {4, -15,  55,  98, -18, 4},
  {3, -14,  52, 100, -17, 4},
  {3, -14,  50, 102, -17, 4},
  {3, -13,  47, 104, -17, 4},
  {3, -13,  45, 106, -17, 4},
  {3, -12,  42, 108, -16, 3},
  {3, -11,  40, 109, -16, 3},
  {3, -11,  37, 111, -15, 3},
  {2, -10,  35, 113, -15, 3},
  {3, -10,  32, 114, -14, 3},
  {2,  -9,  29, 116, -13, 3},
  {2,  -8,  27, 117, -13, 3},
  {2,  -8,  25, 119, -12, 2},
  {2,  -7,  22, 120, -11, 2},
  {1,  -6,  20, 121, -10, 2},
  {1,  -6,  18, 122,  -9, 2},
  {1,  -5,  15, 123,  -8, 2},
  {1,  -4,  13, 124,  -7, 1},
  {1,  -4,  11, 125,  -6, 1},
  {1,  -3,   8, 126,  -5, 1},
  {1,  -2,   6, 126,  -4, 1},
  {0,  -1,   4, 127,  -3, 1},
  {0,  -1,   2, 128,  -1, 0},
};

static int32_t do_ntap_filter(int32_t *p, int x) {
  int i;
  int32_t sum = 0;
  for (i = 0; i < WARPEDPIXEL_FILTER_TAPS; ++i) {
    sum += p[i - WARPEDPIXEL_FILTER_TAPS / 2 + 1] * filter_ntap[x][i];
  }
  return sum;
}

static int32_t do_cubic_filter(int32_t *p, int x) {
  if (x == 0)  {
    return p[0];
  } else if (x == (1 << WARPEDPIXEL_PREC_BITS)) {
    return p[1];
  } else {
    const int64_t v1 = x * x * x * (3 * (p[0] - p[1]) + p[2] - p[-1]);
    const int64_t v2 = x * x * (2 * p[-1] - 5 * p[0] + 4 * p[1] - p[2]);
    const int64_t v3 = x * (p[1] - p[-1]);
    const int64_t v4 = 2 * p[0];
    return (int32_t)ROUND_POWER_OF_TWO_SIGNED(
        (v4 << (3 * WARPEDPIXEL_PREC_BITS)) +
        (v3 << (2 * WARPEDPIXEL_PREC_BITS)) +
        (v2 << WARPEDPIXEL_PREC_BITS) + v1,
        3 * WARPEDPIXEL_PREC_BITS + 1 - WARPEDPIXEL_FILTER_BITS);
  }
}

/*
static int32_t do_linear_filter(int32_t *p, int x) {
  int32_t sum = 0;
  sum = p[0] * (WARPEDPIXEL_PREC_SHIFTS - x) + p[1] * x;
  sum <<= (WARPEDPIXEL_FILTER_BITS - WARPEDPIXEL_PREC_BITS);
  return sum;
}

static int32_t do_4tap_filter(int32_t *p, int x) {
  int i;
  int32_t sum = 0;
  for (i = 0; i < 4; ++i) {
    sum += p[i - 1] * filter_4tap[x][i];
  }
  return sum;
}
*/

static INLINE void get_subcolumn(int taps, uint8_t *ref, int32_t *col,
                                 int stride, int x, int y_start) {
  int i;
  for (i = 0; i < taps; ++i) {
    col[i] = ref[(i + y_start) * stride + x];
  }
}

static uint8_t bi_ntap_filter(uint8_t *ref, int x, int y, int stride) {
  int32_t val, arr[WARPEDPIXEL_FILTER_TAPS];
  int k;
  int i = (int) x >> WARPEDPIXEL_PREC_BITS;
  int j = (int) y >> WARPEDPIXEL_PREC_BITS;
  for (k = 0; k < WARPEDPIXEL_FILTER_TAPS; ++k) {
    int32_t arr_temp[WARPEDPIXEL_FILTER_TAPS];
    get_subcolumn(WARPEDPIXEL_FILTER_TAPS, ref, arr_temp, stride,
                  i + k + 1 - WARPEDPIXEL_FILTER_TAPS / 2,
                  j + 1 - WARPEDPIXEL_FILTER_TAPS / 2);
    arr[k] = do_ntap_filter(arr_temp + WARPEDPIXEL_FILTER_TAPS / 2 - 1,
                            y - (j << WARPEDPIXEL_PREC_BITS));
  }
  val = do_ntap_filter(arr + WARPEDPIXEL_FILTER_TAPS / 2 - 1,
                       x - (i << WARPEDPIXEL_PREC_BITS));
  val = ROUND_POWER_OF_TWO_SIGNED(val, WARPEDPIXEL_FILTER_BITS * 2);
  return (uint8_t)clip_pixel(val);
}

static uint8_t bi_cubic_filter(uint8_t *ref, int x, int y, int stride) {
  int32_t val, arr[4];
  int k;
  int i = (int) x >> WARPEDPIXEL_PREC_BITS;
  int j = (int) y >> WARPEDPIXEL_PREC_BITS;
  for (k = 0; k < 4; ++k) {
    int32_t arr_temp[4];
    get_subcolumn(4, ref, arr_temp, stride,
                  i + k - 1, j - 1);
    arr[k] = do_cubic_filter(arr_temp + 1, y - (j << WARPEDPIXEL_PREC_BITS));
  }
  val = do_cubic_filter(arr + 1, x - (i << WARPEDPIXEL_PREC_BITS));
  val = ROUND_POWER_OF_TWO_SIGNED(val, WARPEDPIXEL_FILTER_BITS * 2);
  return (uint8_t)clip_pixel(val);
}

static uint8_t bi_linear_filter(uint8_t *ref, int x, int y, int stride) {
  const int ix = x >> WARPEDPIXEL_PREC_BITS;
  const int iy = y >> WARPEDPIXEL_PREC_BITS;
  const int sx = x - (ix << WARPEDPIXEL_PREC_BITS);
  const int sy = y - (iy << WARPEDPIXEL_PREC_BITS);
  int32_t val;
  val = ROUND_POWER_OF_TWO_SIGNED(
      ref[iy * stride + ix] * (WARPEDPIXEL_PREC_SHIFTS - sy) *
                              (WARPEDPIXEL_PREC_SHIFTS - sx) +
      ref[iy * stride + ix + 1] * (WARPEDPIXEL_PREC_SHIFTS - sy) * sx +
      ref[(iy + 1) * stride + ix] * sy * (WARPEDPIXEL_PREC_SHIFTS - sx) +
      ref[(iy + 1) * stride + ix + 1] * sy * sx,
      WARPEDPIXEL_PREC_BITS * 2);
  return (uint8_t)clip_pixel(val);
}

static uint8_t warp_interpolate(uint8_t *ref, int x, int y,
                                int width, int height, int stride) {
  int ix = x >> WARPEDPIXEL_PREC_BITS;
  int iy = y >> WARPEDPIXEL_PREC_BITS;
  int sx = x - (ix << WARPEDPIXEL_PREC_BITS);
  int sy = y - (iy << WARPEDPIXEL_PREC_BITS);
  int32_t v;

  if (ix < 0 && iy < 0) return ref[0];
  else if (ix < 0 && iy > height - 1)
    return ref[(height - 1) * stride];
  else if (ix > width - 1 && iy < 0)
    return ref[width - 1];
  else if (ix > width - 1 && iy > height - 1)
    return ref[(height - 1) * stride + (width - 1)];
  else if (ix < 0) {
    v = ROUND_POWER_OF_TWO_SIGNED(
        ref[iy * stride] * (WARPEDPIXEL_PREC_SHIFTS - sy) +
        ref[(iy + 1) * stride] * sy,
        WARPEDPIXEL_PREC_BITS);
    return clip_pixel(v);
  } else if (iy < 0) {
    v = ROUND_POWER_OF_TWO_SIGNED(
        ref[ix] * (WARPEDPIXEL_PREC_SHIFTS - sx) +
        ref[ix + 1] * sx,
        WARPEDPIXEL_PREC_BITS);
    return clip_pixel(v);
  } else if (ix > width - 1) {
    v = ROUND_POWER_OF_TWO_SIGNED(
        ref[iy * stride + width - 1] * (WARPEDPIXEL_PREC_SHIFTS - sy) +
        ref[(iy + 1) * stride + width - 1] * sy,
        WARPEDPIXEL_PREC_BITS);
    return clip_pixel(v);
  } else if (iy > height - 1) {
    v = ROUND_POWER_OF_TWO_SIGNED(
        ref[(height - 1) * stride + ix] * (WARPEDPIXEL_PREC_SHIFTS - sx) +
        ref[(height - 1) * stride + ix + 1] * sx,
        WARPEDPIXEL_PREC_BITS);
    return clip_pixel(v);
  } else if (ix >= WARPEDPIXEL_FILTER_TAPS / 2 - 1 &&
             iy >= WARPEDPIXEL_FILTER_TAPS / 2 - 1 &&
             ix < width - WARPEDPIXEL_FILTER_TAPS / 2 &&
             iy < height - WARPEDPIXEL_FILTER_TAPS / 2) {
    return bi_ntap_filter(ref, x, y, stride);
  } else if (ix >= 1 && iy >= 1 &&
             ix < width - 2 && iy < height - 2) {
    return bi_cubic_filter(ref, x, y, stride);
  } else {
    return bi_linear_filter(ref, x, y, stride);
  }
}

void vp10_warp_plane(WarpedMotionParams *wm,
                     uint8_t *ref,
                     int width, int height, int stride,
                     uint8_t *pred,
                     int p_col, int p_row,
                     int p_width, int p_height, int p_stride,
                     int subsampling_x, int subsampling_y,
                     int x_scale, int y_scale) {
  int i, j;
  projectPointsType projectPoints = get_projectPointsType(wm->wmtype);
  if (projectPoints == NULL)
    return;
  for (i = p_row; i < p_row + p_height; ++i) {
    for (j = p_col; j < p_col + p_width; ++j) {
      int in[2], out[2];
      projectPoints(wm->wmmat, in, out, 1, 2, 2, subsampling_x, subsampling_y);
      out[0] = ROUND_POWER_OF_TWO_SIGNED(out[0] * x_scale, 4);
      out[1] = ROUND_POWER_OF_TWO_SIGNED(out[1] * y_scale, 4);
      pred[(j - p_col) + (i - p_row) * p_stride] =
          warp_interpolate(ref, out[0], out[1], width, height, stride);
    }
  }
}

#if CONFIG_VP9_HIGHBITDEPTH
static INLINE void highbd_get_subcolumn(int taps, uint16_t *ref, int32_t *col,
                                        int stride, int x, int y_start) {
  int i;
  for (i = 0; i < taps; ++i) {
    col[i] = ref[(i + y_start) * stride + x];
  }
}

static uint16_t highbd_bi_ntap_filter(uint16_t *ref,
                                      int x, int y, int stride,
                                      int bd) {
  int32_t val, arr[WARPEDPIXEL_FILTER_TAPS];
  int k;
  int i = (int) x >> WARPEDPIXEL_PREC_BITS;
  int j = (int) y >> WARPEDPIXEL_PREC_BITS;
  for (k = 0; k < WARPEDPIXEL_FILTER_TAPS; ++k) {
    int32_t arr_temp[WARPEDPIXEL_FILTER_TAPS];
    highbd_get_subcolumn(WARPEDPIXEL_FILTER_TAPS, ref, arr_temp, stride,
                         i + k + 1 - WARPEDPIXEL_FILTER_TAPS / 2,
                         j + 1 - WARPEDPIXEL_FILTER_TAPS / 2);
    arr[k] = do_ntap_filter(arr_temp + WARPEDPIXEL_FILTER_TAPS / 2 - 1,
                            y - (j << WARPEDPIXEL_PREC_BITS));
  }
  val = do_ntap_filter(arr + WARPEDPIXEL_FILTER_TAPS / 2 - 1,
                       x - (i << WARPEDPIXEL_PREC_BITS));
  val = ROUND_POWER_OF_TWO_SIGNED(val, WARPEDPIXEL_FILTER_BITS * 2);
  return (uint16_t)highbd_clip_pixel(val, bd);
}

static uint16_t highbd_bi_cubic_filter(uint16_t *ref,
                                       int x, int y, int stride,
                                       int bd) {
  int32_t val, arr[4];
  int k;
  int i = (int) x >> WARPEDPIXEL_PREC_BITS;
  int j = (int) y >> WARPEDPIXEL_PREC_BITS;
  for (k = 0; k < 4; ++k) {
    int32_t arr_temp[4];
    highbd_get_subcolumn(4, ref, arr_temp, stride,
                         i + k - 1, j - 1);
    arr[k] = do_cubic_filter(arr_temp + 1, y - (j << WARPEDPIXEL_PREC_BITS));
  }
  val = do_cubic_filter(arr + 1, x - (i << WARPEDPIXEL_PREC_BITS));
  val = ROUND_POWER_OF_TWO_SIGNED(val, WARPEDPIXEL_FILTER_BITS * 2);
  return (uint16_t)highbd_clip_pixel(val, bd);
}

static uint16_t highbd_bi_linear_filter(uint16_t *ref,
                                        int x, int y, int stride,
                                        int bd) {
  const int ix = x >> WARPEDPIXEL_PREC_BITS;
  const int iy = y >> WARPEDPIXEL_PREC_BITS;
  const int sx = x - (ix << WARPEDPIXEL_PREC_BITS);
  const int sy = y - (iy << WARPEDPIXEL_PREC_BITS);
  int32_t val;
  val = ROUND_POWER_OF_TWO_SIGNED(
      ref[iy * stride + ix] * (WARPEDPIXEL_PREC_SHIFTS - sy) *
                              (WARPEDPIXEL_PREC_SHIFTS - sx) +
      ref[iy * stride + ix + 1] * (WARPEDPIXEL_PREC_SHIFTS - sy) * sx +
      ref[(iy + 1) * stride + ix] * sy * (WARPEDPIXEL_PREC_SHIFTS - sx) +
      ref[(iy + 1) * stride + ix + 1] * sy * sx,
      WARPEDPIXEL_PREC_BITS * 2);
  return (uint16_t)highbd_clip_pixel(val, bd);
}

static uint16_t highbd_warp_interpolate(uint16_t *ref,
                                        int x, int y,
                                        int width, int height, int stride,
                                        int bd) {
  int ix = x >> WARPEDPIXEL_PREC_BITS;
  int iy = y >> WARPEDPIXEL_PREC_BITS;
  int sx = x - (ix << WARPEDPIXEL_PREC_BITS);
  int sy = y - (iy << WARPEDPIXEL_PREC_BITS);
  int32_t v;

  if (ix < 0 && iy < 0) return ref[0];
  else if (ix < 0 && iy > height - 1)
    return ref[(height - 1) * stride];
  else if (ix > width - 1 && iy < 0)
    return ref[width - 1];
  else if (ix > width - 1 && iy > height - 1)
    return ref[(height - 1) * stride + (width - 1)];
  else if (ix < 0) {
    v = ROUND_POWER_OF_TWO_SIGNED(
        ref[iy * stride] * (WARPEDPIXEL_PREC_SHIFTS - sy) +
        ref[(iy + 1) * stride] * sy,
        WARPEDPIXEL_PREC_BITS);
    return highbd_clip_pixel(v, bd);
  } else if (iy < 0) {
    v = ROUND_POWER_OF_TWO_SIGNED(
        ref[ix] * (WARPEDPIXEL_PREC_SHIFTS - sx) +
        ref[ix + 1] * sx,
        WARPEDPIXEL_PREC_BITS);
    return highbd_clip_pixel(v, bd);
  } else if (ix > width - 1) {
    v = ROUND_POWER_OF_TWO_SIGNED(
        ref[iy * stride + width - 1] * (WARPEDPIXEL_PREC_SHIFTS - sy) +
        ref[(iy + 1) * stride + width - 1] * sy,
        WARPEDPIXEL_PREC_BITS);
    return highbd_clip_pixel(v, bd);
  } else if (iy > height - 1) {
    v = ROUND_POWER_OF_TWO_SIGNED(
        ref[(height - 1) * stride + ix] * (WARPEDPIXEL_PREC_SHIFTS - sx) +
        ref[(height - 1) * stride + ix + 1] * sx,
        WARPEDPIXEL_PREC_BITS);
    return highbd_clip_pixel(v, bd);
  } else if (ix >= WARPEDPIXEL_FILTER_TAPS / 2 - 1 &&
             iy >= WARPEDPIXEL_FILTER_TAPS / 2 - 1 &&
             ix < width - WARPEDPIXEL_FILTER_TAPS / 2 &&
             iy < height - WARPEDPIXEL_FILTER_TAPS / 2) {
    return highbd_bi_ntap_filter(ref, x, y, stride, bd);
  } else if (ix >= 1 && iy >= 1 &&
             ix < width - 2 && iy < height - 2) {
    return highbd_bi_cubic_filter(ref, x, y, stride, bd);
  } else {
    return highbd_bi_linear_filter(ref, x, y, stride, bd);
  }
}

void vp10_highbd_warp_plane(WarpedMotionParams *wm,
                            uint8_t *ref8,
                            int width, int height, int stride,
                            uint8_t *pred8,
                            int p_col, int p_row,
                            int p_width, int p_height, int p_stride,
                            int subsampling_col, int subsampling_row,
                            int x_scale, int y_scale,
                            int bd) {
  int i, j;
  projectPointsType projectPoints = get_projectPointsType(wm->wmtype);
  uint16_t *pred = CONVERT_TO_SHORTPTR(pred8);
  uint16_t *ref = CONVERT_TO_SHORTPTR(ref8);
  if (projectPoints == NULL)
    return;
  for (i = p_row; i < p_row + p_height; ++i) {
    for (j = p_col; j < p_col + p_width; ++j) {
      int in[2], out[2];
      projectPoints(wm->wmmat, in, out, 1, 2, 2, subsampling_x, subsampling_y);
      out[0] = ROUND_POWER_OF_TWO_SIGNED(out[0] * x_scale, 4);
      out[1] = ROUND_POWER_OF_TWO_SIGNED(out[1] * y_scale, 4);
      pred[(j - p_col) + (i - p_row) * p_stride] =
          highbd_warp_interpolate(
              ref, out[0], out[1], width, height, stride, bd);
    }
  }
}
#endif  // CONFIG_VP9_HIGHBITDEPTH

void vp10_integerize_model(double *H, TransformationType wmtype,
                           WarpedMotionParams *wm) {
  wm->wmtype = wmtype;
  switch (wmtype) {
    case HOMOGRAPHY:
      assert(fabs(H[8] - 1.0) < 1e-12);
      wm->wmmat[7] = rint(H[7] * (1 << WARPEDMODEL_ROW3HOMO_PREC_BITS));
      wm->wmmat[6] = rint(H[6] * (1 << WARPEDMODEL_ROW3HOMO_PREC_BITS));
    case AFFINE:
      wm->wmmat[5] = rint(H[5] * (1 << WARPEDMODEL_PREC_BITS));
      wm->wmmat[4] = rint(H[4] * (1 << WARPEDMODEL_PREC_BITS));
    case ROTZOOM:
      wm->wmmat[3] = rint(H[3] * (1 << WARPEDMODEL_PREC_BITS));
      wm->wmmat[2] = rint(H[2] * (1 << WARPEDMODEL_PREC_BITS));
    case TRANSLATION:
      wm->wmmat[1] = rint(H[1] * (1 << WARPEDMODEL_PREC_BITS));
      wm->wmmat[0] = rint(H[0] * (1 << WARPEDMODEL_PREC_BITS));
      break;
    default:
      assert(0);
  };
  return;
}