blob: a9cd9b816514ef8fe9820a7dbff52029c82257e4 [file] [log] [blame]
/*
* Copyright (c) 2023, 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 <assert.h>
#include <arm_neon.h>
#include "config/av1_rtcd.h"
#include "aom_dsp/aom_dsp_common.h"
#include "aom_dsp/arm/mem_neon.h"
#include "aom_dsp/arm/transpose_neon.h"
#include "aom_ports/mem.h"
#include "av1/common/convolve.h"
#include "av1/common/filter.h"
#include "av1/common/arm/highbd_convolve_neon.h"
static INLINE void highbd_convolve_y_sr_6tap_neon(
const uint16_t *src_ptr, int src_stride, uint16_t *dst_ptr, int dst_stride,
int w, int h, const int16_t *y_filter_ptr, const int bd) {
const uint16x8_t max = vdupq_n_u16((1 << bd) - 1);
const int16x8_t y_filter_0_7 = vld1q_s16(y_filter_ptr);
const int32x4_t zero_s32 = vdupq_n_s32(0);
if (w <= 4) {
int16x4_t s0, s1, s2, s3, s4, s5, s6, s7, s8;
uint16x4_t d0, d1, d2, d3;
uint16x8_t d01, d23;
const int16_t *s = (const int16_t *)(src_ptr + src_stride);
uint16_t *d = dst_ptr;
load_s16_4x5(s, src_stride, &s0, &s1, &s2, &s3, &s4);
s += 5 * src_stride;
do {
load_s16_4x4(s, src_stride, &s5, &s6, &s7, &s8);
d0 = highbd_convolve6_4_s32_s16(s0, s1, s2, s3, s4, s5, y_filter_0_7,
zero_s32);
d1 = highbd_convolve6_4_s32_s16(s1, s2, s3, s4, s5, s6, y_filter_0_7,
zero_s32);
d2 = highbd_convolve6_4_s32_s16(s2, s3, s4, s5, s6, s7, y_filter_0_7,
zero_s32);
d3 = highbd_convolve6_4_s32_s16(s3, s4, s5, s6, s7, s8, y_filter_0_7,
zero_s32);
d01 = vcombine_u16(d0, d1);
d23 = vcombine_u16(d2, d3);
d01 = vminq_u16(d01, max);
d23 = vminq_u16(d23, max);
if (w == 2) {
store_u16q_2x1(d + 0 * dst_stride, d01, 0);
store_u16q_2x1(d + 1 * dst_stride, d01, 2);
if (h != 2) {
store_u16q_2x1(d + 2 * dst_stride, d23, 0);
store_u16q_2x1(d + 3 * dst_stride, d23, 2);
}
} else {
vst1_u16(d + 0 * dst_stride, vget_low_u16(d01));
vst1_u16(d + 1 * dst_stride, vget_high_u16(d01));
if (h != 2) {
vst1_u16(d + 2 * dst_stride, vget_low_u16(d23));
vst1_u16(d + 3 * dst_stride, vget_high_u16(d23));
}
}
s0 = s4;
s1 = s5;
s2 = s6;
s3 = s7;
s4 = s8;
s += 4 * src_stride;
d += 4 * dst_stride;
h -= 4;
} while (h > 0);
} else {
// if width is a multiple of 8 & height is a multiple of 4
int16x8_t s0, s1, s2, s3, s4, s5, s6, s7, s8;
uint16x8_t d0, d1, d2, d3;
do {
int height = h;
const int16_t *s = (const int16_t *)(src_ptr + src_stride);
uint16_t *d = dst_ptr;
load_s16_8x5(s, src_stride, &s0, &s1, &s2, &s3, &s4);
s += 5 * src_stride;
do {
load_s16_8x4(s, src_stride, &s5, &s6, &s7, &s8);
d0 = highbd_convolve6_8_s32_s16(s0, s1, s2, s3, s4, s5, y_filter_0_7,
zero_s32);
d1 = highbd_convolve6_8_s32_s16(s1, s2, s3, s4, s5, s6, y_filter_0_7,
zero_s32);
d2 = highbd_convolve6_8_s32_s16(s2, s3, s4, s5, s6, s7, y_filter_0_7,
zero_s32);
d3 = highbd_convolve6_8_s32_s16(s3, s4, s5, s6, s7, s8, y_filter_0_7,
zero_s32);
d0 = vminq_u16(d0, max);
d1 = vminq_u16(d1, max);
d2 = vminq_u16(d2, max);
d3 = vminq_u16(d3, max);
if (h == 2) {
store_u16_8x2(d, dst_stride, d0, d1);
} else {
store_u16_8x4(d, dst_stride, d0, d1, d2, d3);
}
s0 = s4;
s1 = s5;
s2 = s6;
s3 = s7;
s4 = s8;
s += 4 * src_stride;
d += 4 * dst_stride;
height -= 4;
} while (height > 0);
src_ptr += 8;
dst_ptr += 8;
w -= 8;
} while (w > 0);
}
}
static INLINE void highbd_convolve_y_sr_8tap_neon(
const uint16_t *src_ptr, int src_stride, uint16_t *dst_ptr, int dst_stride,
int w, int h, const int16_t *y_filter_ptr, int bd) {
const uint16x8_t max = vdupq_n_u16((1 << bd) - 1);
const int16x8_t y_filter = vld1q_s16(y_filter_ptr);
const int32x4_t zero_s32 = vdupq_n_s32(0);
if (w <= 4) {
int16x4_t s0, s1, s2, s3, s4, s5, s6, s7, s8, s9, s10;
uint16x4_t d0, d1, d2, d3;
uint16x8_t d01, d23;
const int16_t *s = (const int16_t *)src_ptr;
uint16_t *d = dst_ptr;
load_s16_4x7(s, src_stride, &s0, &s1, &s2, &s3, &s4, &s5, &s6);
s += 7 * src_stride;
do {
load_s16_4x4(s, src_stride, &s7, &s8, &s9, &s10);
d0 = highbd_convolve8_4_s32_s16(s0, s1, s2, s3, s4, s5, s6, s7, y_filter,
zero_s32);
d1 = highbd_convolve8_4_s32_s16(s1, s2, s3, s4, s5, s6, s7, s8, y_filter,
zero_s32);
d2 = highbd_convolve8_4_s32_s16(s2, s3, s4, s5, s6, s7, s8, s9, y_filter,
zero_s32);
d3 = highbd_convolve8_4_s32_s16(s3, s4, s5, s6, s7, s8, s9, s10, y_filter,
zero_s32);
d01 = vcombine_u16(d0, d1);
d23 = vcombine_u16(d2, d3);
d01 = vminq_u16(d01, max);
d23 = vminq_u16(d23, max);
if (w == 2) {
store_u16q_2x1(d + 0 * dst_stride, d01, 0);
store_u16q_2x1(d + 1 * dst_stride, d01, 2);
if (h != 2) {
store_u16q_2x1(d + 2 * dst_stride, d23, 0);
store_u16q_2x1(d + 3 * dst_stride, d23, 2);
}
} else {
vst1_u16(d + 0 * dst_stride, vget_low_u16(d01));
vst1_u16(d + 1 * dst_stride, vget_high_u16(d01));
if (h != 2) {
vst1_u16(d + 2 * dst_stride, vget_low_u16(d23));
vst1_u16(d + 3 * dst_stride, vget_high_u16(d23));
}
}
s0 = s4;
s1 = s5;
s2 = s6;
s3 = s7;
s4 = s8;
s5 = s9;
s6 = s10;
s += 4 * src_stride;
d += 4 * dst_stride;
h -= 4;
} while (h > 0);
} else {
int16x8_t s0, s1, s2, s3, s4, s5, s6, s7, s8, s9, s10;
uint16x8_t d0, d1, d2, d3;
do {
int height = h;
const int16_t *s = (const int16_t *)src_ptr;
uint16_t *d = dst_ptr;
load_s16_8x7(s, src_stride, &s0, &s1, &s2, &s3, &s4, &s5, &s6);
s += 7 * src_stride;
do {
load_s16_8x4(s, src_stride, &s7, &s8, &s9, &s10);
d0 = highbd_convolve8_8_s32_s16(s0, s1, s2, s3, s4, s5, s6, s7,
y_filter, zero_s32);
d1 = highbd_convolve8_8_s32_s16(s1, s2, s3, s4, s5, s6, s7, s8,
y_filter, zero_s32);
d2 = highbd_convolve8_8_s32_s16(s2, s3, s4, s5, s6, s7, s8, s9,
y_filter, zero_s32);
d3 = highbd_convolve8_8_s32_s16(s3, s4, s5, s6, s7, s8, s9, s10,
y_filter, zero_s32);
d0 = vminq_u16(d0, max);
d1 = vminq_u16(d1, max);
d2 = vminq_u16(d2, max);
d3 = vminq_u16(d3, max);
if (h == 2) {
store_u16_8x2(d, dst_stride, d0, d1);
} else {
store_u16_8x4(d, dst_stride, d0, d1, d2, d3);
}
s0 = s4;
s1 = s5;
s2 = s6;
s3 = s7;
s4 = s8;
s5 = s9;
s6 = s10;
s += 4 * src_stride;
d += 4 * dst_stride;
height -= 4;
} while (height > 0);
src_ptr += 8;
dst_ptr += 8;
w -= 8;
} while (w > 0);
}
}
static INLINE void highbd_convolve_y_sr_12tap_neon(
const uint16_t *src_ptr, int src_stride, uint16_t *dst_ptr, int dst_stride,
int w, int h, const int16_t *y_filter_ptr, int bd) {
const uint16x8_t max = vdupq_n_u16((1 << bd) - 1);
const int16x8_t y_filter_0_7 = vld1q_s16(y_filter_ptr);
const int16x4_t y_filter_8_11 = vld1_s16(y_filter_ptr + 8);
const int32x4_t zero_s32 = vdupq_n_s32(0);
if (w <= 4) {
int16x4_t s0, s1, s2, s3, s4, s5, s6, s7, s8, s9, s10, s11, s12, s13, s14;
uint16x4_t d0, d1, d2, d3;
uint16x8_t d01, d23;
const int16_t *s = (const int16_t *)src_ptr;
uint16_t *d = dst_ptr;
load_s16_4x11(s, src_stride, &s0, &s1, &s2, &s3, &s4, &s5, &s6, &s7, &s8,
&s9, &s10);
s += 11 * src_stride;
do {
load_s16_4x4(s, src_stride, &s11, &s12, &s13, &s14);
d0 = highbd_convolve12_y_4_s32_s16(s0, s1, s2, s3, s4, s5, s6, s7, s8, s9,
s10, s11, y_filter_0_7, y_filter_8_11,
zero_s32);
d1 = highbd_convolve12_y_4_s32_s16(s1, s2, s3, s4, s5, s6, s7, s8, s9,
s10, s11, s12, y_filter_0_7,
y_filter_8_11, zero_s32);
d2 = highbd_convolve12_y_4_s32_s16(s2, s3, s4, s5, s6, s7, s8, s9, s10,
s11, s12, s13, y_filter_0_7,
y_filter_8_11, zero_s32);
d3 = highbd_convolve12_y_4_s32_s16(s3, s4, s5, s6, s7, s8, s9, s10, s11,
s12, s13, s14, y_filter_0_7,
y_filter_8_11, zero_s32);
d01 = vcombine_u16(d0, d1);
d23 = vcombine_u16(d2, d3);
d01 = vminq_u16(d01, max);
d23 = vminq_u16(d23, max);
if (w == 2) {
store_u16q_2x1(d + 0 * dst_stride, d01, 0);
store_u16q_2x1(d + 1 * dst_stride, d01, 2);
if (h != 2) {
store_u16q_2x1(d + 2 * dst_stride, d23, 0);
store_u16q_2x1(d + 3 * dst_stride, d23, 2);
}
} else {
vst1_u16(d + 0 * dst_stride, vget_low_u16(d01));
vst1_u16(d + 1 * dst_stride, vget_high_u16(d01));
if (h != 2) {
vst1_u16(d + 2 * dst_stride, vget_low_u16(d23));
vst1_u16(d + 3 * dst_stride, vget_high_u16(d23));
}
}
s0 = s4;
s1 = s5;
s2 = s6;
s3 = s7;
s4 = s8;
s5 = s9;
s6 = s10;
s7 = s11;
s8 = s12;
s9 = s13;
s10 = s14;
s += 4 * src_stride;
d += 4 * dst_stride;
h -= 4;
} while (h > 0);
} else {
uint16x8_t d0, d1, d2, d3;
int16x8_t s0, s1, s2, s3, s4, s5, s6, s7, s8, s9, s10, s11, s12, s13, s14;
do {
int height = h;
const int16_t *s = (const int16_t *)src_ptr;
uint16_t *d = dst_ptr;
load_s16_8x11(s, src_stride, &s0, &s1, &s2, &s3, &s4, &s5, &s6, &s7, &s8,
&s9, &s10);
s += 11 * src_stride;
do {
load_s16_8x4(s, src_stride, &s11, &s12, &s13, &s14);
d0 = highbd_convolve12_y_8_s32_s16(s0, s1, s2, s3, s4, s5, s6, s7, s8,
s9, s10, s11, y_filter_0_7,
y_filter_8_11, zero_s32);
d1 = highbd_convolve12_y_8_s32_s16(s1, s2, s3, s4, s5, s6, s7, s8, s9,
s10, s11, s12, y_filter_0_7,
y_filter_8_11, zero_s32);
d2 = highbd_convolve12_y_8_s32_s16(s2, s3, s4, s5, s6, s7, s8, s9, s10,
s11, s12, s13, y_filter_0_7,
y_filter_8_11, zero_s32);
d3 = highbd_convolve12_y_8_s32_s16(s3, s4, s5, s6, s7, s8, s9, s10, s11,
s12, s13, s14, y_filter_0_7,
y_filter_8_11, zero_s32);
d0 = vminq_u16(d0, max);
d1 = vminq_u16(d1, max);
d2 = vminq_u16(d2, max);
d3 = vminq_u16(d3, max);
if (h == 2) {
store_u16_8x2(d, dst_stride, d0, d1);
} else {
store_u16_8x4(d, dst_stride, d0, d1, d2, d3);
}
s0 = s4;
s1 = s5;
s2 = s6;
s3 = s7;
s4 = s8;
s5 = s9;
s6 = s10;
s7 = s11;
s8 = s12;
s9 = s13;
s10 = s14;
s += 4 * src_stride;
d += 4 * dst_stride;
height -= 4;
} while (height > 0);
src_ptr += 8;
dst_ptr += 8;
w -= 8;
} while (w > 0);
}
}
void av1_highbd_convolve_y_sr_neon(const uint16_t *src, int src_stride,
uint16_t *dst, int dst_stride, int w, int h,
const InterpFilterParams *filter_params_y,
const int subpel_y_qn, int bd) {
const int y_filter_taps = get_filter_tap(filter_params_y, subpel_y_qn);
const int vert_offset = filter_params_y->taps / 2 - 1;
const int16_t *y_filter_ptr = av1_get_interp_filter_subpel_kernel(
filter_params_y, subpel_y_qn & SUBPEL_MASK);
src -= vert_offset * src_stride;
if (y_filter_taps > 8) {
highbd_convolve_y_sr_12tap_neon(src, src_stride, dst, dst_stride, w, h,
y_filter_ptr, bd);
return;
}
if (y_filter_taps < 8) {
highbd_convolve_y_sr_6tap_neon(src, src_stride, dst, dst_stride, w, h,
y_filter_ptr, bd);
return;
}
highbd_convolve_y_sr_8tap_neon(src, src_stride, dst, dst_stride, w, h,
y_filter_ptr, bd);
}
static INLINE void highbd_convolve_x_sr_8tap_neon(
const uint16_t *src_ptr, int src_stride, uint16_t *dst_ptr, int dst_stride,
int w, int h, const int16_t *x_filter_ptr, ConvolveParams *conv_params,
int bd) {
const int16x8_t x_filter = vld1q_s16(x_filter_ptr);
const uint16x8_t max = vdupq_n_u16((1 << bd) - 1);
const int32x4_t shift_s32 = vdupq_n_s32(-conv_params->round_0);
const int bits = FILTER_BITS - conv_params->round_0;
const int16x8_t bits_s16 = vdupq_n_s16(-bits);
const int32x4_t zero_s32 = vdupq_n_s32(0);
if (w <= 4) {
int16x8_t s0, s1, s2, s3;
uint16x4_t d0, d1;
uint16x8_t d01;
const int16_t *s = (const int16_t *)src_ptr;
uint16_t *d = dst_ptr;
do {
load_s16_8x2(s, src_stride, &s0, &s2);
load_s16_8x2(s + 8, src_stride, &s1, &s3);
d0 = highbd_convolve8_horiz4_s32_s16(s0, s1, x_filter, shift_s32,
zero_s32);
d1 = highbd_convolve8_horiz4_s32_s16(s2, s3, x_filter, shift_s32,
zero_s32);
d01 = vcombine_u16(d0, d1);
d01 = vqrshlq_u16(d01, bits_s16);
d01 = vminq_u16(d01, max);
if (w == 2) {
store_u16q_2x1(d + 0 * dst_stride, d01, 0);
store_u16q_2x1(d + 1 * dst_stride, d01, 2);
} else {
vst1_u16(d + 0 * dst_stride, vget_low_u16(d01));
vst1_u16(d + 1 * dst_stride, vget_high_u16(d01));
}
s += 2 * src_stride;
d += 2 * dst_stride;
h -= 2;
} while (h > 0);
} else {
int height = h;
int16x8_t s0, s1, s2, s3, s4, s5, s6, s7;
uint16x8_t d0, d1, d2, d3;
do {
int width = w;
const int16_t *s = (const int16_t *)src_ptr;
uint16_t *d = dst_ptr;
load_s16_8x4(s, src_stride, &s0, &s2, &s4, &s6);
s += 8;
do {
load_s16_8x4(s, src_stride, &s1, &s3, &s5, &s7);
d0 = highbd_convolve8_horiz8_s32_s16(s0, s1, x_filter, shift_s32,
zero_s32);
d1 = highbd_convolve8_horiz8_s32_s16(s2, s3, x_filter, shift_s32,
zero_s32);
d2 = highbd_convolve8_horiz8_s32_s16(s4, s5, x_filter, shift_s32,
zero_s32);
d3 = highbd_convolve8_horiz8_s32_s16(s6, s7, x_filter, shift_s32,
zero_s32);
d0 = vqrshlq_u16(d0, bits_s16);
d1 = vqrshlq_u16(d1, bits_s16);
d2 = vqrshlq_u16(d2, bits_s16);
d3 = vqrshlq_u16(d3, bits_s16);
d0 = vminq_u16(d0, max);
d1 = vminq_u16(d1, max);
d2 = vminq_u16(d2, max);
d3 = vminq_u16(d3, max);
if (h == 2) {
store_u16_8x2(d, dst_stride, d0, d1);
} else {
store_u16_8x4(d, dst_stride, d0, d1, d2, d3);
}
s0 = s1;
s2 = s3;
s4 = s5;
s6 = s7;
s += 8;
d += 8;
width -= 8;
} while (width > 0);
src_ptr += 4 * src_stride;
dst_ptr += 4 * dst_stride;
height -= 4;
} while (height > 0);
}
}
static INLINE void highbd_convolve_x_sr_12tap_neon(
const uint16_t *src_ptr, int src_stride, uint16_t *dst_ptr, int dst_stride,
int w, int h, const int16_t *x_filter_ptr, ConvolveParams *conv_params,
int bd) {
const uint16x8_t max = vdupq_n_u16((1 << bd) - 1);
const int32x4_t shift_s32 = vdupq_n_s32(-conv_params->round_0);
const int bits = FILTER_BITS - conv_params->round_0;
const int16x8_t bits_s16 = vdupq_n_s16(-bits);
const int16x8_t x_filter_0_7 = vld1q_s16(x_filter_ptr);
const int16x4_t x_filter_8_11 = vld1_s16(x_filter_ptr + 8);
const int32x4_t zero_s32 = vdupq_n_s32(0);
if (w <= 4) {
int16x8_t s0, s1, s2, s3;
uint16x4_t d0, d1;
uint16x8_t d01;
const int16_t *s = (const int16_t *)src_ptr;
uint16_t *d = dst_ptr;
do {
load_s16_8x2(s, src_stride, &s0, &s2);
load_s16_8x2(s + 8, src_stride, &s1, &s3);
d0 = highbd_convolve12_horiz4_s32_s16(s0, s1, x_filter_0_7, x_filter_8_11,
shift_s32, zero_s32);
d1 = highbd_convolve12_horiz4_s32_s16(s2, s3, x_filter_0_7, x_filter_8_11,
shift_s32, zero_s32);
d01 = vcombine_u16(d0, d1);
d01 = vqrshlq_u16(d01, bits_s16);
d01 = vminq_u16(d01, max);
if (w == 2) {
store_u16q_2x1(d + 0 * dst_stride, d01, 0);
store_u16q_2x1(d + 1 * dst_stride, d01, 2);
} else {
vst1_u16(d + 0 * dst_stride, vget_low_u16(d01));
vst1_u16(d + 1 * dst_stride, vget_high_u16(d01));
}
s += 2 * src_stride;
d += 2 * dst_stride;
h -= 2;
} while (h > 0);
} else {
int height = h;
int16x8_t s0, s1, s2, s3, s4, s5, s6, s7, s8, s9, s10, s11;
uint16x8_t d0, d1, d2, d3;
do {
int width = w;
const int16_t *s = (const int16_t *)src_ptr;
uint16_t *d = dst_ptr;
load_s16_8x4(s, src_stride, &s0, &s3, &s6, &s9);
s += 8;
do {
load_s16_8x4(s, src_stride, &s1, &s4, &s7, &s10);
load_s16_8x4(s + 8, src_stride, &s2, &s5, &s8, &s11);
d0 = highbd_convolve12_horiz8_s32_s16(
s0, s1, s2, x_filter_0_7, x_filter_8_11, shift_s32, zero_s32);
d1 = highbd_convolve12_horiz8_s32_s16(
s3, s4, s5, x_filter_0_7, x_filter_8_11, shift_s32, zero_s32);
d2 = highbd_convolve12_horiz8_s32_s16(
s6, s7, s8, x_filter_0_7, x_filter_8_11, shift_s32, zero_s32);
d3 = highbd_convolve12_horiz8_s32_s16(
s9, s10, s11, x_filter_0_7, x_filter_8_11, shift_s32, zero_s32);
d0 = vqrshlq_u16(d0, bits_s16);
d1 = vqrshlq_u16(d1, bits_s16);
d2 = vqrshlq_u16(d2, bits_s16);
d3 = vqrshlq_u16(d3, bits_s16);
d0 = vminq_u16(d0, max);
d1 = vminq_u16(d1, max);
d2 = vminq_u16(d2, max);
d3 = vminq_u16(d3, max);
if (h == 2) {
store_u16_8x2(d, dst_stride, d0, d1);
} else {
store_u16_8x4(d, dst_stride, d0, d1, d2, d3);
}
s0 = s1;
s1 = s2;
s3 = s4;
s4 = s5;
s6 = s7;
s7 = s8;
s9 = s10;
s10 = s11;
s += 8;
d += 8;
width -= 8;
} while (width > 0);
src_ptr += 4 * src_stride;
dst_ptr += 4 * dst_stride;
height -= 4;
} while (height > 0);
}
}
void av1_highbd_convolve_x_sr_neon(const uint16_t *src, int src_stride,
uint16_t *dst, int dst_stride, int w, int h,
const InterpFilterParams *filter_params_x,
const int subpel_x_qn,
ConvolveParams *conv_params, int bd) {
const int x_filter_taps = get_filter_tap(filter_params_x, subpel_x_qn);
const int horiz_offset = filter_params_x->taps / 2 - 1;
const int16_t *x_filter_ptr = av1_get_interp_filter_subpel_kernel(
filter_params_x, subpel_x_qn & SUBPEL_MASK);
src -= horiz_offset;
if (x_filter_taps > 8) {
highbd_convolve_x_sr_12tap_neon(src, src_stride, dst, dst_stride, w, h,
x_filter_ptr, conv_params, bd);
return;
}
highbd_convolve_x_sr_8tap_neon(src, src_stride, dst, dst_stride, w, h,
x_filter_ptr, conv_params, bd);
}
static INLINE void highbd_convolve_2d_y_sr_8tap_neon(
const uint16_t *src_ptr, int src_stride, uint16_t *dst_ptr, int dst_stride,
int w, int h, const int16_t *y_filter_ptr, ConvolveParams *conv_params,
int bd, const int offset, const int correction) {
const uint16x8_t max = vdupq_n_u16((1 << bd) - 1);
const int16x8_t y_filter = vld1q_s16(y_filter_ptr);
const int32x4_t offset_s32 = vdupq_n_s32(offset);
const int round1_shift = conv_params->round_1;
const int32x4_t round1_shift_s32 = vdupq_n_s32(-round1_shift);
const int32x4_t correction_s32 = vdupq_n_s32(correction);
if (w <= 4) {
int16x4_t s0, s1, s2, s3, s4, s5, s6, s7, s8, s9, s10;
uint16x4_t d0, d1, d2, d3;
uint16x8_t d01, d23;
const int16_t *s = (const int16_t *)src_ptr;
uint16_t *d = dst_ptr;
load_s16_4x7(s, src_stride, &s0, &s1, &s2, &s3, &s4, &s5, &s6);
s += 7 * src_stride;
do {
load_s16_4x4(s, src_stride, &s7, &s8, &s9, &s10);
d0 = highbd_convolve8_4_sr_s32_s16(s0, s1, s2, s3, s4, s5, s6, s7,
y_filter, round1_shift_s32, offset_s32,
correction_s32);
d1 = highbd_convolve8_4_sr_s32_s16(s1, s2, s3, s4, s5, s6, s7, s8,
y_filter, round1_shift_s32, offset_s32,
correction_s32);
d2 = highbd_convolve8_4_sr_s32_s16(s2, s3, s4, s5, s6, s7, s8, s9,
y_filter, round1_shift_s32, offset_s32,
correction_s32);
d3 = highbd_convolve8_4_sr_s32_s16(s3, s4, s5, s6, s7, s8, s9, s10,
y_filter, round1_shift_s32, offset_s32,
correction_s32);
d01 = vcombine_u16(d0, d1);
d23 = vcombine_u16(d2, d3);
d01 = vminq_u16(d01, max);
d23 = vminq_u16(d23, max);
if (w == 2) {
store_u16q_2x1(d + 0 * dst_stride, d01, 0);
store_u16q_2x1(d + 1 * dst_stride, d01, 2);
if (h != 2) {
store_u16q_2x1(d + 2 * dst_stride, d23, 0);
store_u16q_2x1(d + 3 * dst_stride, d23, 2);
}
} else {
vst1_u16(d + 0 * dst_stride, vget_low_u16(d01));
vst1_u16(d + 1 * dst_stride, vget_high_u16(d01));
if (h != 2) {
vst1_u16(d + 2 * dst_stride, vget_low_u16(d23));
vst1_u16(d + 3 * dst_stride, vget_high_u16(d23));
}
}
s0 = s4;
s1 = s5;
s2 = s6;
s3 = s7;
s4 = s8;
s5 = s9;
s6 = s10;
s += 4 * src_stride;
d += 4 * dst_stride;
h -= 4;
} while (h > 0);
} else {
int16x8_t s0, s1, s2, s3, s4, s5, s6, s7, s8, s9, s10;
uint16x8_t d0, d1, d2, d3;
do {
int height = h;
const int16_t *s = (const int16_t *)src_ptr;
uint16_t *d = dst_ptr;
load_s16_8x7(s, src_stride, &s0, &s1, &s2, &s3, &s4, &s5, &s6);
s += 7 * src_stride;
do {
load_s16_8x4(s, src_stride, &s7, &s8, &s9, &s10);
d0 = highbd_convolve8_8_sr_s32_s16(s0, s1, s2, s3, s4, s5, s6, s7,
y_filter, round1_shift_s32,
offset_s32, correction_s32);
d1 = highbd_convolve8_8_sr_s32_s16(s1, s2, s3, s4, s5, s6, s7, s8,
y_filter, round1_shift_s32,
offset_s32, correction_s32);
d2 = highbd_convolve8_8_sr_s32_s16(s2, s3, s4, s5, s6, s7, s8, s9,
y_filter, round1_shift_s32,
offset_s32, correction_s32);
d3 = highbd_convolve8_8_sr_s32_s16(s3, s4, s5, s6, s7, s8, s9, s10,
y_filter, round1_shift_s32,
offset_s32, correction_s32);
d0 = vminq_u16(d0, max);
d1 = vminq_u16(d1, max);
d2 = vminq_u16(d2, max);
d3 = vminq_u16(d3, max);
if (h == 2) {
store_u16_8x2(d, dst_stride, d0, d1);
} else {
store_u16_8x4(d, dst_stride, d0, d1, d2, d3);
}
s0 = s4;
s1 = s5;
s2 = s6;
s3 = s7;
s4 = s8;
s5 = s9;
s6 = s10;
s += 4 * src_stride;
d += 4 * dst_stride;
height -= 4;
} while (height > 0);
src_ptr += 8;
dst_ptr += 8;
w -= 8;
} while (w > 0);
}
}
static INLINE void highbd_convolve_2d_y_sr_12tap_neon(
const uint16_t *src_ptr, int src_stride, uint16_t *dst_ptr, int dst_stride,
int w, int h, const int16_t *y_filter_ptr, ConvolveParams *conv_params,
const int bd, const int offset, const int correction) {
const uint16x8_t max = vdupq_n_u16((1 << bd) - 1);
const int16x8_t y_filter_0_7 = vld1q_s16(y_filter_ptr);
const int16x4_t y_filter_8_11 = vld1_s16(y_filter_ptr + 8);
const int32x4_t offset_s32 = vdupq_n_s32(offset);
const int round1_shift = conv_params->round_1;
const int32x4_t round1_shift_s32 = vdupq_n_s32(-round1_shift);
const int32x4_t correction_s32 = vdupq_n_s32(correction);
if (w <= 4) {
int16x4_t s0, s1, s2, s3, s4, s5, s6, s7, s8, s9, s10, s11, s12, s13, s14;
uint16x4_t d0, d1, d2, d3;
uint16x8_t d01, d23;
const int16_t *s = (const int16_t *)src_ptr;
uint16_t *d = dst_ptr;
load_s16_4x11(s, src_stride, &s0, &s1, &s2, &s3, &s4, &s5, &s6, &s7, &s8,
&s9, &s10);
s += 11 * src_stride;
do {
load_s16_4x4(s, src_stride, &s11, &s12, &s13, &s14);
d0 = highbd_convolve12_y_4_sr_s32_s16(
s0, s1, s2, s3, s4, s5, s6, s7, s8, s9, s10, s11, y_filter_0_7,
y_filter_8_11, round1_shift_s32, offset_s32, correction_s32);
d1 = highbd_convolve12_y_4_sr_s32_s16(
s1, s2, s3, s4, s5, s6, s7, s8, s9, s10, s11, s12, y_filter_0_7,
y_filter_8_11, round1_shift_s32, offset_s32, correction_s32);
d2 = highbd_convolve12_y_4_sr_s32_s16(
s2, s3, s4, s5, s6, s7, s8, s9, s10, s11, s12, s13, y_filter_0_7,
y_filter_8_11, round1_shift_s32, offset_s32, correction_s32);
d3 = highbd_convolve12_y_4_sr_s32_s16(
s3, s4, s5, s6, s7, s8, s9, s10, s11, s12, s13, s14, y_filter_0_7,
y_filter_8_11, round1_shift_s32, offset_s32, correction_s32);
d01 = vcombine_u16(d0, d1);
d23 = vcombine_u16(d2, d3);
d01 = vminq_u16(d01, max);
d23 = vminq_u16(d23, max);
if (w == 2) {
store_u16q_2x1(d + 0 * dst_stride, d01, 0);
store_u16q_2x1(d + 1 * dst_stride, d01, 2);
if (h != 2) {
store_u16q_2x1(d + 2 * dst_stride, d23, 0);
store_u16q_2x1(d + 3 * dst_stride, d23, 2);
}
} else {
vst1_u16(d + 0 * dst_stride, vget_low_u16(d01));
vst1_u16(d + 1 * dst_stride, vget_high_u16(d01));
if (h != 2) {
vst1_u16(d + 2 * dst_stride, vget_low_u16(d23));
vst1_u16(d + 3 * dst_stride, vget_high_u16(d23));
}
}
s0 = s4;
s1 = s5;
s2 = s6;
s3 = s7;
s4 = s8;
s5 = s9;
s6 = s10;
s7 = s11;
s8 = s12;
s9 = s13;
s10 = s14;
s += 4 * src_stride;
d += 4 * dst_stride;
h -= 4;
} while (h > 0);
} else {
uint16x8_t d0, d1, d2, d3;
int16x8_t s0, s1, s2, s3, s4, s5, s6, s7, s8, s9, s10, s11, s12, s13, s14;
do {
int height = h;
const int16_t *s = (const int16_t *)src_ptr;
uint16_t *d = dst_ptr;
load_s16_8x11(s, src_stride, &s0, &s1, &s2, &s3, &s4, &s5, &s6, &s7, &s8,
&s9, &s10);
s += 11 * src_stride;
do {
load_s16_8x4(s, src_stride, &s11, &s12, &s13, &s14);
d0 = highbd_convolve12_y_8_sr_s32_s16(
s0, s1, s2, s3, s4, s5, s6, s7, s8, s9, s10, s11, y_filter_0_7,
y_filter_8_11, round1_shift_s32, offset_s32, correction_s32);
d1 = highbd_convolve12_y_8_sr_s32_s16(
s1, s2, s3, s4, s5, s6, s7, s8, s9, s10, s11, s12, y_filter_0_7,
y_filter_8_11, round1_shift_s32, offset_s32, correction_s32);
d2 = highbd_convolve12_y_8_sr_s32_s16(
s2, s3, s4, s5, s6, s7, s8, s9, s10, s11, s12, s13, y_filter_0_7,
y_filter_8_11, round1_shift_s32, offset_s32, correction_s32);
d3 = highbd_convolve12_y_8_sr_s32_s16(
s3, s4, s5, s6, s7, s8, s9, s10, s11, s12, s13, s14, y_filter_0_7,
y_filter_8_11, round1_shift_s32, offset_s32, correction_s32);
d0 = vminq_u16(d0, max);
d1 = vminq_u16(d1, max);
d2 = vminq_u16(d2, max);
d3 = vminq_u16(d3, max);
if (h == 2) {
store_u16_8x2(d, dst_stride, d0, d1);
} else {
store_u16_8x4(d, dst_stride, d0, d1, d2, d3);
}
s0 = s4;
s1 = s5;
s2 = s6;
s3 = s7;
s4 = s8;
s5 = s9;
s6 = s10;
s7 = s11;
s8 = s12;
s9 = s13;
s10 = s14;
s += 4 * src_stride;
d += 4 * dst_stride;
height -= 4;
} while (height > 0);
src_ptr += 8;
dst_ptr += 8;
w -= 8;
} while (w > 0);
}
}
static INLINE void highbd_convolve_x_8tap_neon(
const uint16_t *src_ptr, int src_stride, uint16_t *dst_ptr, int dst_stride,
int w, int h, const int16_t *x_filter_ptr, ConvolveParams *conv_params,
const int offset) {
const int16x8_t x_filter = vld1q_s16(x_filter_ptr);
const int32x4_t shift_s32 = vdupq_n_s32(-conv_params->round_0);
const int32x4_t offset_s32 = vdupq_n_s32(offset);
if (w <= 4) {
int16x8_t s0, s1, s2, s3;
uint16x4_t d0, d1;
uint16x8_t d01;
const int16_t *s = (const int16_t *)src_ptr;
uint16_t *d = dst_ptr;
do {
load_s16_8x2(s, src_stride, &s0, &s2);
load_s16_8x2(s + 8, src_stride, &s1, &s3);
d0 = highbd_convolve8_horiz4_s32_s16(s0, s1, x_filter, shift_s32,
offset_s32);
d1 = highbd_convolve8_horiz4_s32_s16(s2, s3, x_filter, shift_s32,
offset_s32);
d01 = vcombine_u16(d0, d1);
if (w == 2) {
store_u16q_2x1(d + 0 * dst_stride, d01, 0);
store_u16q_2x1(d + 1 * dst_stride, d01, 2);
} else {
vst1_u16(d + 0 * dst_stride, vget_low_u16(d01));
vst1_u16(d + 1 * dst_stride, vget_high_u16(d01));
}
s += 2 * src_stride;
d += 2 * dst_stride;
h -= 2;
} while (h > 0);
} else {
int height = h;
int16x8_t s0, s1, s2, s3, s4, s5, s6, s7;
uint16x8_t d0, d1, d2, d3;
do {
int width = w;
const int16_t *s = (const int16_t *)src_ptr;
uint16_t *d = dst_ptr;
load_s16_8x4(s, src_stride, &s0, &s2, &s4, &s6);
s += 8;
do {
load_s16_8x4(s, src_stride, &s1, &s3, &s5, &s7);
d0 = highbd_convolve8_horiz8_s32_s16(s0, s1, x_filter, shift_s32,
offset_s32);
d1 = highbd_convolve8_horiz8_s32_s16(s2, s3, x_filter, shift_s32,
offset_s32);
d2 = highbd_convolve8_horiz8_s32_s16(s4, s5, x_filter, shift_s32,
offset_s32);
d3 = highbd_convolve8_horiz8_s32_s16(s6, s7, x_filter, shift_s32,
offset_s32);
if (h == 2) {
store_u16_8x2(d, dst_stride, d0, d1);
} else {
store_u16_8x4(d, dst_stride, d0, d1, d2, d3);
}
s0 = s1;
s2 = s3;
s4 = s5;
s6 = s7;
s += 8;
d += 8;
width -= 8;
} while (width > 0);
src_ptr += 4 * src_stride;
dst_ptr += 4 * dst_stride;
height -= 4;
} while (height > 0);
}
}
static INLINE void highbd_convolve_2d_x_sr_12tap_neon(
const uint16_t *src_ptr, int src_stride, uint16_t *dst_ptr, int dst_stride,
int w, int h, const int16_t *x_filter_ptr, ConvolveParams *conv_params,
const int offset) {
const int32x4_t shift_s32 = vdupq_n_s32(-conv_params->round_0);
const int16x8_t x_filter_0_7 = vld1q_s16(x_filter_ptr);
const int16x4_t x_filter_8_11 = vld1_s16(x_filter_ptr + 8);
const int32x4_t offset_s32 = vdupq_n_s32(offset);
if (w <= 4) {
int16x8_t s0, s1, s2, s3;
uint16x4_t d0, d1;
uint16x8_t d01;
const int16_t *s = (const int16_t *)src_ptr;
uint16_t *d = dst_ptr;
do {
load_s16_8x2(s, src_stride, &s0, &s2);
load_s16_8x2(s + 8, src_stride, &s1, &s3);
d0 = highbd_convolve12_horiz4_s32_s16(s0, s1, x_filter_0_7, x_filter_8_11,
shift_s32, offset_s32);
d1 = highbd_convolve12_horiz4_s32_s16(s2, s3, x_filter_0_7, x_filter_8_11,
shift_s32, offset_s32);
d01 = vcombine_u16(d0, d1);
if (w == 2) {
store_u16q_2x1(d + 0 * dst_stride, d01, 0);
store_u16q_2x1(d + 1 * dst_stride, d01, 2);
} else {
vst1_u16(d + 0 * dst_stride, vget_low_u16(d01));
vst1_u16(d + 1 * dst_stride, vget_high_u16(d01));
}
s += 2 * src_stride;
d += 2 * dst_stride;
h -= 2;
} while (h > 0);
} else {
int height = h;
int16x8_t s0, s1, s2, s3, s4, s5, s6, s7, s8, s9, s10, s11;
uint16x8_t d0, d1, d2, d3;
do {
int width = w;
const int16_t *s = (const int16_t *)src_ptr;
uint16_t *d = dst_ptr;
load_s16_8x4(s, src_stride, &s0, &s3, &s6, &s9);
s += 8;
do {
load_s16_8x4(s, src_stride, &s1, &s4, &s7, &s10);
load_s16_8x4(s + 8, src_stride, &s2, &s5, &s8, &s11);
d0 = highbd_convolve12_horiz8_s32_s16(
s0, s1, s2, x_filter_0_7, x_filter_8_11, shift_s32, offset_s32);
d1 = highbd_convolve12_horiz8_s32_s16(
s3, s4, s5, x_filter_0_7, x_filter_8_11, shift_s32, offset_s32);
d2 = highbd_convolve12_horiz8_s32_s16(
s6, s7, s8, x_filter_0_7, x_filter_8_11, shift_s32, offset_s32);
d3 = highbd_convolve12_horiz8_s32_s16(
s9, s10, s11, x_filter_0_7, x_filter_8_11, shift_s32, offset_s32);
if (h == 2) {
store_u16_8x2(d, dst_stride, d0, d1);
} else {
store_u16_8x4(d, dst_stride, d0, d1, d2, d3);
}
s0 = s1;
s1 = s2;
s3 = s4;
s4 = s5;
s6 = s7;
s7 = s8;
s9 = s10;
s10 = s11;
s += 8;
d += 8;
width -= 8;
} while (width > 0);
src_ptr += 4 * src_stride;
dst_ptr += 4 * dst_stride;
height -= 4;
} while (height > 0);
}
}
void av1_highbd_convolve_2d_sr_neon(const uint16_t *src, int src_stride,
uint16_t *dst, int dst_stride, int w, int h,
const InterpFilterParams *filter_params_x,
const InterpFilterParams *filter_params_y,
const int subpel_x_qn,
const int subpel_y_qn,
ConvolveParams *conv_params, int bd) {
DECLARE_ALIGNED(16, uint16_t,
im_block[(MAX_SB_SIZE + MAX_FILTER_TAP) * MAX_SB_SIZE]);
const int im_h = h + filter_params_y->taps - 1;
const int im_stride = MAX_SB_SIZE;
const int vert_offset = filter_params_y->taps / 2 - 1;
const int horiz_offset = filter_params_x->taps / 2 - 1;
const int x_offset_initial = (1 << (bd + FILTER_BITS - 1));
const int y_offset_bits = bd + 2 * FILTER_BITS - conv_params->round_0;
const int y_offset_initial = (1 << y_offset_bits);
const int y_offset_correction =
((1 << (y_offset_bits - conv_params->round_1)) +
(1 << (y_offset_bits - conv_params->round_1 - 1)));
const uint16_t *src_ptr = src - vert_offset * src_stride - horiz_offset;
const int16_t *x_filter_ptr = av1_get_interp_filter_subpel_kernel(
filter_params_x, subpel_x_qn & SUBPEL_MASK);
const int16_t *y_filter_ptr = av1_get_interp_filter_subpel_kernel(
filter_params_y, subpel_y_qn & SUBPEL_MASK);
if (filter_params_x->taps > 8) {
highbd_convolve_2d_x_sr_12tap_neon(src_ptr, src_stride, im_block, im_stride,
w, im_h, x_filter_ptr, conv_params,
x_offset_initial);
highbd_convolve_2d_y_sr_12tap_neon(im_block, im_stride, dst, dst_stride, w,
h, y_filter_ptr, conv_params, bd,
y_offset_initial, y_offset_correction);
} else {
highbd_convolve_x_8tap_neon(src_ptr, src_stride, im_block, im_stride, w,
im_h, x_filter_ptr, conv_params,
x_offset_initial);
highbd_convolve_2d_y_sr_8tap_neon(im_block, im_stride, dst, dst_stride, w,
h, y_filter_ptr, conv_params, bd,
y_offset_initial, y_offset_correction);
}
}
static INLINE void highbd_convolve_2d_x_scale_8tap_neon(
const uint16_t *src_ptr, int src_stride, uint16_t *dst_ptr, int dst_stride,
int w, int h, const int subpel_x_qn, const int x_step_qn,
const InterpFilterParams *filter_params, ConvolveParams *conv_params,
const int offset) {
const uint32x4_t idx = { 0, 1, 2, 3 };
const uint32x4_t subpel_mask = vdupq_n_u32(SCALE_SUBPEL_MASK);
const int32x4_t shift_s32 = vdupq_n_s32(-conv_params->round_0);
const int32x4_t offset_s32 = vdupq_n_s32(offset);
if (w <= 4) {
int height = h;
int16x8_t s0, s1, s2, s3;
uint16x4_t d0;
uint16_t *d = dst_ptr;
do {
int x_qn = subpel_x_qn;
// Load 4 src vectors at a time, they might be the same, but we have to
// calculate the indices anyway. Doing it in SIMD and then storing the
// indices is faster than having to calculate the expression
// &src_ptr[((x_qn + 0*x_step_qn) >> SCALE_SUBPEL_BITS)] 4 times
// Ideally this should be a gather using the indices, but NEON does not
// have that, so have to emulate
const uint32x4_t xqn_idx = vmlaq_n_u32(vdupq_n_u32(x_qn), idx, x_step_qn);
// We have to multiply x2 to get the actual pointer as sizeof(uint16_t) =
// 2
const uint32x4_t src_idx_u32 =
vshlq_n_u32(vshrq_n_u32(xqn_idx, SCALE_SUBPEL_BITS), 1);
#if defined(__aarch64__)
uint64x2_t src4[2];
src4[0] = vaddw_u32(vdupq_n_u64((const uint64_t)src_ptr),
vget_low_u32(src_idx_u32));
src4[1] = vaddw_u32(vdupq_n_u64((const uint64_t)src_ptr),
vget_high_u32(src_idx_u32));
int16_t *src4_ptr[4];
uint64_t *tmp_ptr = (uint64_t *)&src4_ptr;
vst1q_u64(tmp_ptr, src4[0]);
vst1q_u64(tmp_ptr + 2, src4[1]);
#else
uint32x4_t src4;
src4 = vaddq_u32(vdupq_n_u32((const uint32_t)src_ptr), src_idx_u32);
int16_t *src4_ptr[4];
uint32_t *tmp_ptr = (uint32_t *)&src4_ptr;
vst1q_u32(tmp_ptr, src4);
#endif // defined(__aarch64__)
// Same for the filter vectors
const int32x4_t filter_idx_s32 = vreinterpretq_s32_u32(
vshrq_n_u32(vandq_u32(xqn_idx, subpel_mask), SCALE_EXTRA_BITS));
int32_t x_filter4_idx[4];
vst1q_s32(x_filter4_idx, filter_idx_s32);
const int16_t *x_filter4_ptr[4];
// Load source
s0 = vld1q_s16(src4_ptr[0]);
s1 = vld1q_s16(src4_ptr[1]);
s2 = vld1q_s16(src4_ptr[2]);
s3 = vld1q_s16(src4_ptr[3]);
// We could easily do this using SIMD as well instead of calling the
// inline function 4 times.
x_filter4_ptr[0] =
av1_get_interp_filter_subpel_kernel(filter_params, x_filter4_idx[0]);
x_filter4_ptr[1] =
av1_get_interp_filter_subpel_kernel(filter_params, x_filter4_idx[1]);
x_filter4_ptr[2] =
av1_get_interp_filter_subpel_kernel(filter_params, x_filter4_idx[2]);
x_filter4_ptr[3] =
av1_get_interp_filter_subpel_kernel(filter_params, x_filter4_idx[3]);
// Actually load the filters
const int16x8_t x_filter0 = vld1q_s16(x_filter4_ptr[0]);
const int16x8_t x_filter1 = vld1q_s16(x_filter4_ptr[1]);
const int16x8_t x_filter2 = vld1q_s16(x_filter4_ptr[2]);
const int16x8_t x_filter3 = vld1q_s16(x_filter4_ptr[3]);
// Group low and high parts and transpose
int16x4_t filters_lo[] = { vget_low_s16(x_filter0),
vget_low_s16(x_filter1),
vget_low_s16(x_filter2),
vget_low_s16(x_filter3) };
int16x4_t filters_hi[] = { vget_high_s16(x_filter0),
vget_high_s16(x_filter1),
vget_high_s16(x_filter2),
vget_high_s16(x_filter3) };
transpose_u16_4x4((uint16x4_t *)filters_lo);
transpose_u16_4x4((uint16x4_t *)filters_hi);
// Run the 2D Scale convolution
d0 = highbd_convolve8_2d_scale_horiz4x8_s32_s16(
s0, s1, s2, s3, filters_lo, filters_hi, shift_s32, offset_s32);
if (w == 2) {
store_u16_2x1(d + 0 * dst_stride, d0, 0);
} else {
vst1_u16(d + 0 * dst_stride, d0);
}
src_ptr += src_stride;
d += dst_stride;
height--;
} while (height > 0);
} else {
int height = h;
int16x8_t s0, s1, s2, s3;
uint16x4_t d0;
do {
int width = w;
int x_qn = subpel_x_qn;
uint16_t *d = dst_ptr;
const uint16_t *s = src_ptr;
do {
// Load 4 src vectors at a time, they might be the same, but we have to
// calculate the indices anyway. Doing it in SIMD and then storing the
// indices is faster than having to calculate the expression
// &src_ptr[((x_qn + 0*x_step_qn) >> SCALE_SUBPEL_BITS)] 4 times
// Ideally this should be a gather using the indices, but NEON does not
// have that, so have to emulate
const uint32x4_t xqn_idx =
vmlaq_n_u32(vdupq_n_u32(x_qn), idx, x_step_qn);
// We have to multiply x2 to get the actual pointer as sizeof(uint16_t)
// = 2
const uint32x4_t src_idx_u32 =
vshlq_n_u32(vshrq_n_u32(xqn_idx, SCALE_SUBPEL_BITS), 1);
#if defined(__aarch64__)
uint64x2_t src4[2];
src4[0] = vaddw_u32(vdupq_n_u64((const uint64_t)s),
vget_low_u32(src_idx_u32));
src4[1] = vaddw_u32(vdupq_n_u64((const uint64_t)s),
vget_high_u32(src_idx_u32));
int16_t *src4_ptr[4];
uint64_t *tmp_ptr = (uint64_t *)&src4_ptr;
vst1q_u64(tmp_ptr, src4[0]);
vst1q_u64(tmp_ptr + 2, src4[1]);
#else
uint32x4_t src4;
src4 = vaddq_u32(vdupq_n_u32((const uint32_t)s), src_idx_u32);
int16_t *src4_ptr[4];
uint32_t *tmp_ptr = (uint32_t *)&src4_ptr;
vst1q_u32(tmp_ptr, src4);
#endif // defined(__aarch64__)
// Same for the filter vectors
const int32x4_t filter_idx_s32 = vreinterpretq_s32_u32(
vshrq_n_u32(vandq_u32(xqn_idx, subpel_mask), SCALE_EXTRA_BITS));
int32_t x_filter4_idx[4];
vst1q_s32(x_filter4_idx, filter_idx_s32);
const int16_t *x_filter4_ptr[4];
// Load source
s0 = vld1q_s16(src4_ptr[0]);
s1 = vld1q_s16(src4_ptr[1]);
s2 = vld1q_s16(src4_ptr[2]);
s3 = vld1q_s16(src4_ptr[3]);
// We could easily do this using SIMD as well instead of calling the
// inline function 4 times.
x_filter4_ptr[0] = av1_get_interp_filter_subpel_kernel(
filter_params, x_filter4_idx[0]);
x_filter4_ptr[1] = av1_get_interp_filter_subpel_kernel(
filter_params, x_filter4_idx[1]);
x_filter4_ptr[2] = av1_get_interp_filter_subpel_kernel(
filter_params, x_filter4_idx[2]);
x_filter4_ptr[3] = av1_get_interp_filter_subpel_kernel(
filter_params, x_filter4_idx[3]);
// Actually load the filters
const int16x8_t x_filter0 = vld1q_s16(x_filter4_ptr[0]);
const int16x8_t x_filter1 = vld1q_s16(x_filter4_ptr[1]);
const int16x8_t x_filter2 = vld1q_s16(x_filter4_ptr[2]);
const int16x8_t x_filter3 = vld1q_s16(x_filter4_ptr[3]);
// Group low and high parts and transpose
int16x4_t filters_lo[] = { vget_low_s16(x_filter0),
vget_low_s16(x_filter1),
vget_low_s16(x_filter2),
vget_low_s16(x_filter3) };
int16x4_t filters_hi[] = { vget_high_s16(x_filter0),
vget_high_s16(x_filter1),
vget_high_s16(x_filter2),
vget_high_s16(x_filter3) };
transpose_u16_4x4((uint16x4_t *)filters_lo);
transpose_u16_4x4((uint16x4_t *)filters_hi);
// Run the 2D Scale X convolution
d0 = highbd_convolve8_2d_scale_horiz4x8_s32_s16(
s0, s1, s2, s3, filters_lo, filters_hi, shift_s32, offset_s32);
vst1_u16(d, d0);
x_qn += 4 * x_step_qn;
d += 4;
width -= 4;
} while (width > 0);
src_ptr += src_stride;
dst_ptr += dst_stride;
height--;
} while (height > 0);
}
}
static INLINE void highbd_convolve_2d_y_scale_8tap_neon(
const uint16_t *src_ptr, int src_stride, uint16_t *dst_ptr, int dst_stride,
int w, int h, const int subpel_y_qn, const int y_step_qn,
const InterpFilterParams *filter_params, const int round1_bits,
const int offset) {
const int32x4_t offset_s32 = vdupq_n_s32(1 << offset);
const int32x4_t round1_shift_s32 = vdupq_n_s32(-round1_bits);
if (w <= 4) {
int height = h;
int16x4_t s0, s1, s2, s3, s4, s5, s6, s7;
uint16x4_t d0;
uint16_t *d = dst_ptr;
int y_qn = subpel_y_qn;
do {
const int16_t *s =
(const int16_t *)&src_ptr[(y_qn >> SCALE_SUBPEL_BITS) * src_stride];
load_s16_4x8(s, src_stride, &s0, &s1, &s2, &s3, &s4, &s5, &s6, &s7);
const int y_filter_idx = (y_qn & SCALE_SUBPEL_MASK) >> SCALE_EXTRA_BITS;
const int16_t *y_filter_ptr =
av1_get_interp_filter_subpel_kernel(filter_params, y_filter_idx);
const int16x8_t y_filter = vld1q_s16(y_filter_ptr);
d0 = highbd_convolve8_4_sr_s32_s16(s0, s1, s2, s3, s4, s5, s6, s7,
y_filter, round1_shift_s32, offset_s32,
vdupq_n_s32(0));
if (w == 2) {
store_u16_2x1(d, d0, 0);
} else {
vst1_u16(d, d0);
}
y_qn += y_step_qn;
d += dst_stride;
height--;
} while (height > 0);
} else {
int width = w;
int16x8_t s0, s1, s2, s3, s4, s5, s6, s7;
uint16x8_t d0;
do {
int height = h;
int y_qn = subpel_y_qn;
uint16_t *d = dst_ptr;
do {
const int16_t *s =
(const int16_t *)&src_ptr[(y_qn >> SCALE_SUBPEL_BITS) * src_stride];
load_s16_8x8(s, src_stride, &s0, &s1, &s2, &s3, &s4, &s5, &s6, &s7);
const int y_filter_idx = (y_qn & SCALE_SUBPEL_MASK) >> SCALE_EXTRA_BITS;
const int16_t *y_filter_ptr =
av1_get_interp_filter_subpel_kernel(filter_params, y_filter_idx);
const int16x8_t y_filter = vld1q_s16(y_filter_ptr);
d0 = highbd_convolve8_8_sr_s32_s16(s0, s1, s2, s3, s4, s5, s6, s7,
y_filter, round1_shift_s32,
offset_s32, vdupq_n_s32(0));
vst1q_u16(d, d0);
y_qn += y_step_qn;
d += dst_stride;
height--;
} while (height > 0);
src_ptr += 8;
dst_ptr += 8;
width -= 8;
} while (width > 0);
}
}
static INLINE void highbd_dist_wtd_comp_avg_neon(
const uint16_t *src_ptr, int src_stride, uint16_t *dst_ptr, int dst_stride,
int w, int h, ConvolveParams *conv_params, const int round_bits,
const int offset, const int bd) {
CONV_BUF_TYPE *dst16 = conv_params->dst;
const int dst16_stride = conv_params->dst_stride;
const int32x4_t round_shift_s32 = vdupq_n_s32(-round_bits);
const int16x4_t offset_s16 = vdup_n_s16(offset);
const uint16x8_t max = vdupq_n_u16((1 << bd) - 1);
uint16x4_t fwd_offset_u16 = vdup_n_u16(conv_params->fwd_offset);
uint16x4_t bck_offset_u16 = vdup_n_u16(conv_params->bck_offset);
// Weighted averaging
if (w <= 4) {
for (int y = 0; y < h; ++y) {
const uint16x4_t s = vld1_u16(src_ptr + y * src_stride);
const uint16x4_t d16 = vld1_u16(dst16 + y * dst16_stride);
// We use vmull_u16/vmlal_u16 instead of of vmull_s16/vmlal_s16
// because the latter sign-extend and the values are non-negative.
// However, d0/d1 are signed-integers and we use vqmovun
// to do saturated narrowing to unsigned.
int32x4_t d0 = vreinterpretq_s32_u32(vmull_u16(d16, fwd_offset_u16));
d0 = vreinterpretq_s32_u32(
vmlal_u16(vreinterpretq_u32_s32(d0), s, bck_offset_u16));
d0 = vshrq_n_s32(d0, DIST_PRECISION_BITS);
// Subtract round offset and convolve round
d0 = vqrshlq_s32(vsubw_s16(d0, offset_s16), round_shift_s32);
uint16x4_t d = vqmovun_s32(d0);
d = vmin_u16(d, vget_low_u16(max));
if (w == 2) {
store_u16_2x1(dst_ptr + y * dst_stride, d, 0);
} else {
vst1_u16(dst_ptr + y * dst_stride, d);
}
}
} else {
for (int y = 0; y < h; ++y) {
for (int x = 0; x < w; x += 8) {
const uint16x8_t s = vld1q_u16(src_ptr + y * src_stride + x);
const uint16x8_t d16 = vld1q_u16(dst16 + y * dst16_stride + x);
// We use vmull_u16/vmlal_u16 instead of of vmull_s16/vmlal_s16
// because the latter sign-extend and the values are non-negative.
// However, d0/d1 are signed-integers and we use vqmovun
// to do saturated narrowing to unsigned.
int32x4_t d0 =
vreinterpretq_s32_u32(vmull_u16(vget_low_u16(d16), fwd_offset_u16));
int32x4_t d1 = vreinterpretq_s32_u32(
vmull_u16(vget_high_u16(d16), fwd_offset_u16));
d0 = vreinterpretq_s32_u32(vmlal_u16(vreinterpretq_u32_s32(d0),
vget_low_u16(s), bck_offset_u16));
d1 = vreinterpretq_s32_u32(vmlal_u16(vreinterpretq_u32_s32(d1),
vget_high_u16(s), bck_offset_u16));
d0 = vshrq_n_s32(d0, DIST_PRECISION_BITS);
d1 = vshrq_n_s32(d1, DIST_PRECISION_BITS);
d0 = vqrshlq_s32(vsubw_s16(d0, offset_s16), round_shift_s32);
d1 = vqrshlq_s32(vsubw_s16(d1, offset_s16), round_shift_s32);
uint16x8_t d01 = vcombine_u16(vqmovun_s32(d0), vqmovun_s32(d1));
d01 = vminq_u16(d01, max);
vst1q_u16(dst_ptr + y * dst_stride + x, d01);
}
}
}
}
static INLINE void highbd_comp_avg_neon(const uint16_t *src_ptr, int src_stride,
uint16_t *dst_ptr, int dst_stride,
int w, int h,
ConvolveParams *conv_params,
const int round_bits, const int offset,
const int bd) {
CONV_BUF_TYPE *dst16 = conv_params->dst;
const int dst16_stride = conv_params->dst_stride;
const int32x4_t round_shift_s32 = vdupq_n_s32(-round_bits);
const int16x4_t offset_s16 = vdup_n_s16(offset);
const uint16x8_t max = vdupq_n_u16((1 << bd) - 1);
if (w <= 4) {
for (int y = 0; y < h; ++y) {
const uint16x4_t s = vld1_u16(src_ptr + y * src_stride);
const uint16x4_t d16 = vld1_u16(dst16 + y * dst16_stride);
int32x4_t s_s32 = vreinterpretq_s32_u32(vmovl_u16(s));
int32x4_t d16_s32 = vreinterpretq_s32_u32(vmovl_u16(d16));
int32x4_t d0 = vhaddq_s32(s_s32, d16_s32);
d0 = vsubw_s16(d0, offset_s16);
d0 = vqrshlq_s32(d0, round_shift_s32);
uint16x4_t d = vqmovun_s32(d0);
d = vmin_u16(d, vget_low_u16(max));
if (w == 2) {
store_u16_2x1(dst_ptr + y * dst_stride, d, 0);
} else {
vst1_u16(dst_ptr + y * dst_stride, d);
}
}
} else {
for (int y = 0; y < h; ++y) {
for (int x = 0; x < w; x += 8) {
const uint16x8_t s = vld1q_u16(src_ptr + y * src_stride + x);
const uint16x8_t d16 = vld1q_u16(dst16 + y * dst16_stride + x);
int32x4_t s_lo = vreinterpretq_s32_u32(vmovl_u16(vget_low_u16(s)));
int32x4_t s_hi = vreinterpretq_s32_u32(vmovl_u16(vget_high_u16(s)));
int32x4_t d16_lo = vreinterpretq_s32_u32(vmovl_u16(vget_low_u16(d16)));
int32x4_t d16_hi = vreinterpretq_s32_u32(vmovl_u16(vget_high_u16(d16)));
int32x4_t d0 = vhaddq_s32(s_lo, d16_lo);
int32x4_t d1 = vhaddq_s32(s_hi, d16_hi);
d0 = vsubw_s16(d0, offset_s16);
d1 = vsubw_s16(d1, offset_s16);
d0 = vqrshlq_s32(d0, round_shift_s32);
d1 = vqrshlq_s32(d1, round_shift_s32);
uint16x8_t d01 = vcombine_u16(vqmovun_s32(d0), vqmovun_s32(d1));
d01 = vminq_u16(d01, max);
vst1q_u16(dst_ptr + y * dst_stride + x, d01);
}
}
}
}
static INLINE void highbd_convolve_correct_offset_neon(
const uint16_t *src_ptr, int src_stride, uint16_t *dst_ptr, int dst_stride,
int w, int h, const int round_bits, const int offset, const int bd) {
const int32x4_t round_shift_s32 = vdupq_n_s32(-round_bits);
const int16x4_t offset_s16 = vdup_n_s16(offset);
const uint16x8_t max = vdupq_n_u16((1 << bd) - 1);
if (w <= 4) {
for (int y = 0; y < h; ++y) {
const int16x4_t s = vld1_s16((const int16_t *)src_ptr + y * src_stride);
const int32x4_t d0 =
vqrshlq_s32(vsubl_s16(s, offset_s16), round_shift_s32);
uint16x4_t d = vqmovun_s32(d0);
d = vmin_u16(d, vget_low_u16(max));
if (w == 2) {
store_u16_2x1(dst_ptr + y * dst_stride, d, 0);
} else {
vst1_u16(dst_ptr + y * dst_stride, d);
}
}
} else {
for (int y = 0; y < h; ++y) {
for (int x = 0; x < w; x += 8) {
// Subtract round offset and convolve round
const int16x8_t s =
vld1q_s16((const int16_t *)src_ptr + y * src_stride + x);
const int32x4_t d0 = vqrshlq_s32(vsubl_s16(vget_low_s16(s), offset_s16),
round_shift_s32);
const int32x4_t d1 = vqrshlq_s32(
vsubl_s16(vget_high_s16(s), offset_s16), round_shift_s32);
uint16x8_t d01 = vcombine_u16(vqmovun_s32(d0), vqmovun_s32(d1));
d01 = vminq_u16(d01, max);
vst1q_u16(dst_ptr + y * dst_stride + x, d01);
}
}
}
}
void av1_highbd_convolve_2d_scale_neon(
const uint16_t *src, int src_stride, uint16_t *dst, int dst_stride, int w,
int h, const InterpFilterParams *filter_params_x,
const InterpFilterParams *filter_params_y, const int subpel_x_qn,
const int x_step_qn, const int subpel_y_qn, const int y_step_qn,
ConvolveParams *conv_params, int bd) {
uint16_t *im_block = (uint16_t *)aom_memalign(
16, 2 * sizeof(uint16_t) * MAX_SB_SIZE * (MAX_SB_SIZE + MAX_FILTER_TAP));
if (!im_block) return;
uint16_t *im_block2 = (uint16_t *)aom_memalign(
16, 2 * sizeof(uint16_t) * MAX_SB_SIZE * (MAX_SB_SIZE + MAX_FILTER_TAP));
if (!im_block2) {
aom_free(im_block); // free the first block and return.
return;
}
int im_h = (((h - 1) * y_step_qn + subpel_y_qn) >> SCALE_SUBPEL_BITS) +
filter_params_y->taps;
const int im_stride = MAX_SB_SIZE;
const int bits =
FILTER_BITS * 2 - conv_params->round_0 - conv_params->round_1;
assert(bits >= 0);
const int vert_offset = filter_params_y->taps / 2 - 1;
const int horiz_offset = filter_params_x->taps / 2 - 1;
const int x_offset_bits = (1 << (bd + FILTER_BITS - 1));
const int y_offset_bits = bd + 2 * FILTER_BITS - conv_params->round_0;
const int y_offset_correction =
((1 << (y_offset_bits - conv_params->round_1)) +
(1 << (y_offset_bits - conv_params->round_1 - 1)));
CONV_BUF_TYPE *dst16 = conv_params->dst;
const int dst16_stride = conv_params->dst_stride;
const uint16_t *src_ptr = src - vert_offset * src_stride - horiz_offset;
highbd_convolve_2d_x_scale_8tap_neon(
src_ptr, src_stride, im_block, im_stride, w, im_h, subpel_x_qn, x_step_qn,
filter_params_x, conv_params, x_offset_bits);
if (conv_params->is_compound && !conv_params->do_average) {
highbd_convolve_2d_y_scale_8tap_neon(
im_block, im_stride, dst16, dst16_stride, w, h, subpel_y_qn, y_step_qn,
filter_params_y, conv_params->round_1, y_offset_bits);
} else {
highbd_convolve_2d_y_scale_8tap_neon(
im_block, im_stride, im_block2, im_stride, w, h, subpel_y_qn, y_step_qn,
filter_params_y, conv_params->round_1, y_offset_bits);
}
// Do the compound averaging outside the loop, avoids branching within the
// main loop
if (conv_params->is_compound) {
if (conv_params->do_average) {
if (conv_params->use_dist_wtd_comp_avg) {
highbd_dist_wtd_comp_avg_neon(im_block2, im_stride, dst, dst_stride, w,
h, conv_params, bits, y_offset_correction,
bd);
} else {
highbd_comp_avg_neon(im_block2, im_stride, dst, dst_stride, w, h,
conv_params, bits, y_offset_correction, bd);
}
}
} else {
highbd_convolve_correct_offset_neon(im_block2, im_stride, dst, dst_stride,
w, h, bits, y_offset_correction, bd);
}
aom_free(im_block);
aom_free(im_block2);
}
static INLINE void highbd_convolve_dist_wtd_x_8tap_neon(
const uint16_t *src_ptr, int src_stride, uint16_t *dst_ptr, int dst_stride,
int w, int h, const int16_t *x_filter_ptr, ConvolveParams *conv_params,
const int offset) {
const int16x8_t x_filter = vld1q_s16(x_filter_ptr);
const int32x4_t shift_s32 = vdupq_n_s32(-conv_params->round_0);
const int weight_bits = FILTER_BITS - conv_params->round_1;
const int32x4_t zero_s32 = vdupq_n_s32(0);
const int32x4_t weight_s32 = vdupq_n_s32(1 << weight_bits);
const int32x4_t offset_s32 = vdupq_n_s32(offset);
if (w <= 4) {
int16x8_t s0, s1, s2, s3;
uint16x4_t d0, d1;
uint16x8_t d01;
const int16_t *s = (const int16_t *)src_ptr;
uint16_t *d = dst_ptr;
do {
load_s16_8x2(s, src_stride, &s0, &s2);
load_s16_8x2(s + 8, src_stride, &s1, &s3);
d0 = highbd_convolve8_wtd_horiz4_s32_s16(
s0, s1, x_filter, shift_s32, zero_s32, weight_s32, offset_s32);
d1 = highbd_convolve8_wtd_horiz4_s32_s16(
s2, s3, x_filter, shift_s32, zero_s32, weight_s32, offset_s32);
d01 = vcombine_u16(d0, d1);
if (w == 2) {
store_u16q_2x1(d + 0 * dst_stride, d01, 0);
store_u16q_2x1(d + 1 * dst_stride, d01, 2);
} else {
vst1_u16(d + 0 * dst_stride, vget_low_u16(d01));
vst1_u16(d + 1 * dst_stride, vget_high_u16(d01));
}
s += 2 * src_stride;
d += 2 * dst_stride;
h -= 2;
} while (h > 0);
} else {
int height = h;
int16x8_t s0, s1, s2, s3;
uint16x8_t d0, d1;
do {
int width = w;
const int16_t *s = (const int16_t *)src_ptr;
uint16_t *d = dst_ptr;
load_s16_8x2(s, src_stride, &s0, &s2);
s += 8;
do {
load_s16_8x2(s, src_stride, &s1, &s3);
d0 = highbd_convolve8_wtd_horiz8_s32_s16(
s0, s1, x_filter, shift_s32, zero_s32, weight_s32, offset_s32);
d1 = highbd_convolve8_wtd_horiz8_s32_s16(
s2, s3, x_filter, shift_s32, zero_s32, weight_s32, offset_s32);
store_u16_8x2(d, dst_stride, d0, d1);
s0 = s1;
s2 = s3;
s += 8;
d += 8;
width -= 8;
} while (width > 0);
src_ptr += 2 * src_stride;
dst_ptr += 2 * dst_stride;
height -= 2;
} while (height > 0);
}
}
static INLINE void highbd_convolve_dist_wtd_y_8tap_neon(
const uint16_t *src_ptr, int src_stride, uint16_t *dst_ptr, int dst_stride,
int w, int h, const int16_t *y_filter_ptr, ConvolveParams *conv_params,
const int offset) {
const int16x8_t y_filter = vld1q_s16(y_filter_ptr);
const int32x4_t shift_s32 = vdupq_n_s32(-conv_params->round_0);
const int weight_bits = FILTER_BITS - conv_params->round_1;
const int32x4_t zero_s32 = vdupq_n_s32(0);
const int32x4_t weight_s32 = vdupq_n_s32(1 << weight_bits);
const int32x4_t offset_s32 = vdupq_n_s32(offset);
if (w <= 4) {
int16x4_t s0, s1, s2, s3, s4, s5, s6, s7, s8, s9, s10;
uint16x4_t d0, d1;
uint16x8_t d01;
const int16_t *s = (const int16_t *)src_ptr;
uint16_t *d = dst_ptr;
load_s16_4x7(s, src_stride, &s0, &s1, &s2, &s3, &s4, &s5, &s6);
s += 7 * src_stride;
do {
load_s16_4x4(s, src_stride, &s7, &s8, &s9, &s10);
d0 = highbd_convolve8_wtd_4_s32_s16(s0, s1, s2, s3, s4, s5, s6, s7,
y_filter, shift_s32, zero_s32,
weight_s32, offset_s32);
d1 = highbd_convolve8_wtd_4_s32_s16(s1, s2, s3, s4, s5, s6, s7, s8,
y_filter, shift_s32, zero_s32,
weight_s32, offset_s32);
d01 = vcombine_u16(d0, d1);
if (w == 2) {
store_u16q_2x1(d + 0 * dst_stride, d01, 0);
store_u16q_2x1(d + 1 * dst_stride, d01, 2);
} else {
vst1_u16(d + 0 * dst_stride, vget_low_u16(d01));
vst1_u16(d + 1 * dst_stride, vget_high_u16(d01));
}
s0 = s2;
s1 = s3;
s2 = s4;
s3 = s5;
s4 = s6;
s5 = s7;
s6 = s8;
s += 2 * src_stride;
d += 2 * dst_stride;
h -= 2;
} while (h > 0);
} else {
int16x8_t s0, s1, s2, s3, s4, s5, s6, s7, s8;
uint16x8_t d0, d1;
do {
int height = h;
const int16_t *s = (const int16_t *)src_ptr;
uint16_t *d = dst_ptr;
load_s16_8x7(s, src_stride, &s0, &s1, &s2, &s3, &s4, &s5, &s6);
s += 7 * src_stride;
do {
load_s16_8x2(s, src_stride, &s7, &s8);
d0 = highbd_convolve8_wtd_8_s32_s16(s0, s1, s2, s3, s4, s5, s6, s7,
y_filter, shift_s32, zero_s32,
weight_s32, offset_s32);
d1 = highbd_convolve8_wtd_8_s32_s16(s1, s2, s3, s4, s5, s6, s7, s8,
y_filter, shift_s32, zero_s32,
weight_s32, offset_s32);
store_u16_8x2(d, dst_stride, d0, d1);
s0 = s2;
s1 = s3;
s2 = s4;
s3 = s5;
s4 = s6;
s5 = s7;
s6 = s8;
s += 2 * src_stride;
d += 2 * dst_stride;
height -= 2;
} while (height > 0);
src_ptr += 8;
dst_ptr += 8;
w -= 8;
} while (w > 0);
}
}
void av1_highbd_dist_wtd_convolve_x_neon(
const uint16_t *src, int src_stride, uint16_t *dst, int dst_stride, int w,
int h, const InterpFilterParams *filter_params_x, const int subpel_x_qn,
ConvolveParams *conv_params, int bd) {
DECLARE_ALIGNED(16, uint16_t,
im_block[(MAX_SB_SIZE + MAX_FILTER_TAP) * MAX_SB_SIZE]);
CONV_BUF_TYPE *dst16 = conv_params->dst;
int dst16_stride = conv_params->dst_stride;
const int im_stride = MAX_SB_SIZE;
const int horiz_offset = filter_params_x->taps / 2 - 1;
const int offset_bits = bd + 2 * FILTER_BITS - conv_params->round_0;
const int round_offset = (1 << (offset_bits - conv_params->round_1)) +
(1 << (offset_bits - conv_params->round_1 - 1));
const int round_bits =
2 * FILTER_BITS - conv_params->round_0 - conv_params->round_1;
assert(round_bits >= 0);
const int16_t *x_filter_ptr = av1_get_interp_filter_subpel_kernel(
filter_params_x, subpel_x_qn & SUBPEL_MASK);
src -= horiz_offset;
// horizontal filter
if (conv_params->do_average) {
highbd_convolve_dist_wtd_x_8tap_neon(src, src_stride, im_block, im_stride,
w, h, x_filter_ptr, conv_params,
round_offset);
} else {
highbd_convolve_dist_wtd_x_8tap_neon(src, src_stride, dst16, dst16_stride,
w, h, x_filter_ptr, conv_params,
round_offset);
}
if (conv_params->do_average) {
if (conv_params->use_dist_wtd_comp_avg) {
highbd_dist_wtd_comp_avg_neon(im_block, im_stride, dst, dst_stride, w, h,
conv_params, round_bits, round_offset, bd);
} else {
highbd_comp_avg_neon(im_block, im_stride, dst, dst_stride, w, h,
conv_params, round_bits, round_offset, bd);
}
}
}
void av1_highbd_dist_wtd_convolve_y_neon(
const uint16_t *src, int src_stride, uint16_t *dst, int dst_stride, int w,
int h, const InterpFilterParams *filter_params_y, const int subpel_y_qn,
ConvolveParams *conv_params, int bd) {
DECLARE_ALIGNED(16, uint16_t,
im_block[(MAX_SB_SIZE + MAX_FILTER_TAP) * MAX_SB_SIZE]);
CONV_BUF_TYPE *dst16 = conv_params->dst;
int dst16_stride = conv_params->dst_stride;
const int im_stride = MAX_SB_SIZE;
const int vert_offset = filter_params_y->taps / 2 - 1;
const int offset_bits = bd + 2 * FILTER_BITS - conv_params->round_0;
const int round_offset = (1 << (offset_bits - conv_params->round_1)) +
(1 << (offset_bits - conv_params->round_1 - 1));
const int round_bits =
2 * FILTER_BITS - conv_params->round_0 - conv_params->round_1;
assert(round_bits >= 0);
const int16_t *y_filter_ptr = av1_get_interp_filter_subpel_kernel(
filter_params_y, subpel_y_qn & SUBPEL_MASK);
src -= vert_offset * src_stride;
// vertical filter
if (conv_params->do_average) {
highbd_convolve_dist_wtd_y_8tap_neon(src, src_stride, im_block, im_stride,
w, h, y_filter_ptr, conv_params,
round_offset);
} else {
highbd_convolve_dist_wtd_y_8tap_neon(src, src_stride, dst16, dst16_stride,
w, h, y_filter_ptr, conv_params,
round_offset);
}
if (conv_params->do_average) {
if (conv_params->use_dist_wtd_comp_avg) {
highbd_dist_wtd_comp_avg_neon(im_block, im_stride, dst, dst_stride, w, h,
conv_params, round_bits, round_offset, bd);
} else {
highbd_comp_avg_neon(im_block, im_stride, dst, dst_stride, w, h,
conv_params, round_bits, round_offset, bd);
}
}
}
static INLINE void highbd_2d_copy_neon(const uint16_t *src_ptr, int src_stride,
uint16_t *dst_ptr, int dst_stride, int w,
int h, const int round_bits,
const int offset) {
if (w <= 4) {
const int16x4_t round_shift_s16 = vdup_n_s16(round_bits);
const uint16x4_t offset_u16 = vdup_n_u16(offset);
for (int y = 0; y < h; ++y) {
const uint16x4_t s = vld1_u16(src_ptr + y * src_stride);
uint16x4_t d = vshl_u16(s, round_shift_s16);
d = vadd_u16(d, offset_u16);
if (w == 2) {
store_u16_2x1(dst_ptr + y * dst_stride, d, 0);
} else {
vst1_u16(dst_ptr + y * dst_stride, d);
}
}
} else {
const int16x8_t round_shift_s16 = vdupq_n_s16(round_bits);
const uint16x8_t offset_u16 = vdupq_n_u16(offset);
for (int y = 0; y < h; ++y) {
for (int x = 0; x < w; x += 8) {
const uint16x8_t s = vld1q_u16(src_ptr + y * src_stride + x);
uint16x8_t d = vshlq_u16(s, round_shift_s16);
d = vaddq_u16(d, offset_u16);
vst1q_u16(dst_ptr + y * dst_stride + x, d);
}
}
}
}
void av1_highbd_dist_wtd_convolve_2d_copy_neon(const uint16_t *src,
int src_stride, uint16_t *dst,
int dst_stride, int w, int h,
ConvolveParams *conv_params,
int bd) {
DECLARE_ALIGNED(16, uint16_t,
im_block[(MAX_SB_SIZE + MAX_FILTER_TAP) * MAX_SB_SIZE]);
const int im_stride = MAX_SB_SIZE;
CONV_BUF_TYPE *dst16 = conv_params->dst;
int dst16_stride = conv_params->dst_stride;
const int offset_bits = bd + 2 * FILTER_BITS - conv_params->round_0;
const int round_offset = (1 << (offset_bits - conv_params->round_1)) +
(1 << (offset_bits - conv_params->round_1 - 1));
const int round_bits =
2 * FILTER_BITS - conv_params->round_0 - conv_params->round_1;
assert(round_bits >= 0);
if (conv_params->do_average) {
highbd_2d_copy_neon(src, src_stride, im_block, im_stride, w, h, round_bits,
round_offset);
} else {
highbd_2d_copy_neon(src, src_stride, dst16, dst16_stride, w, h, round_bits,
round_offset);
}
if (conv_params->do_average) {
if (conv_params->use_dist_wtd_comp_avg) {
highbd_dist_wtd_comp_avg_neon(im_block, im_stride, dst, dst_stride, w, h,
conv_params, round_bits, round_offset, bd);
} else {
highbd_comp_avg_neon(im_block, im_stride, dst, dst_stride, w, h,
conv_params, round_bits, round_offset, bd);
}
}
}
static INLINE void highbd_convolve_y_8tap_neon(
const uint16_t *src_ptr, int src_stride, uint16_t *dst_ptr, int dst_stride,
int w, int h, const int16_t *y_filter_ptr, ConvolveParams *conv_params,
int offset) {
const int16x8_t y_filter = vld1q_s16(y_filter_ptr);
const int32x4_t offset_s32 = vdupq_n_s32(offset);
const int32x4_t shift_s32 = vdupq_n_s32(-conv_params->round_1);
if (w <= 4) {
int16x4_t s0, s1, s2, s3, s4, s5, s6, s7, s8, s9, s10;
uint16x4_t d0, d1, d2, d3;
uint16x8_t d01, d23;
const int16_t *s = (const int16_t *)src_ptr;
uint16_t *d = dst_ptr;
load_s16_4x7(s, src_stride, &s0, &s1, &s2, &s3, &s4, &s5, &s6);
s += 7 * src_stride;
do {
load_s16_4x4(s, src_stride, &s7, &s8, &s9, &s10);
d0 = highbd_convolve8_sr_4_s32_s16(s0, s1, s2, s3, s4, s5, s6, s7,
y_filter, shift_s32, offset_s32);
d1 = highbd_convolve8_sr_4_s32_s16(s1, s2, s3, s4, s5, s6, s7, s8,
y_filter, shift_s32, offset_s32);
d2 = highbd_convolve8_sr_4_s32_s16(s2, s3, s4, s5, s6, s7, s8, s9,
y_filter, shift_s32, offset_s32);
d3 = highbd_convolve8_sr_4_s32_s16(s3, s4, s5, s6, s7, s8, s9, s10,
y_filter, shift_s32, offset_s32);
d01 = vcombine_u16(d0, d1);
d23 = vcombine_u16(d2, d3);
if (w == 2) {
store_u16q_2x1(d + 0 * dst_stride, d01, 0);
store_u16q_2x1(d + 1 * dst_stride, d01, 2);
if (h != 2) {
store_u16q_2x1(d + 2 * dst_stride, d23, 0);
store_u16q_2x1(d + 3 * dst_stride, d23, 2);
}
} else {
vst1_u16(d + 0 * dst_stride, vget_low_u16(d01));
vst1_u16(d + 1 * dst_stride, vget_high_u16(d01));
if (h != 2) {
vst1_u16(d + 2 * dst_stride, vget_low_u16(d23));
vst1_u16(d + 3 * dst_stride, vget_high_u16(d23));
}
}
s0 = s4;
s1 = s5;
s2 = s6;
s3 = s7;
s4 = s8;
s5 = s9;
s6 = s10;
s += 4 * src_stride;
d += 4 * dst_stride;
h -= 4;
} while (h > 0);
} else {
int16x8_t s0, s1, s2, s3, s4, s5, s6, s7, s8, s9, s10;
uint16x8_t d0, d1, d2, d3;
do {
int height = h;
const int16_t *s = (const int16_t *)src_ptr;
uint16_t *d = dst_ptr;
load_s16_8x7(s, src_stride, &s0, &s1, &s2, &s3, &s4, &s5, &s6);
s += 7 * src_stride;
do {
load_s16_8x4(s, src_stride, &s7, &s8, &s9, &s10);
d0 = highbd_convolve8_8_s32_s16(s0, s1, s2, s3, s4, s5, s6, s7,
y_filter, offset_s32);
d1 = highbd_convolve8_8_s32_s16(s1, s2, s3, s4, s5, s6, s7, s8,
y_filter, offset_s32);
d2 = highbd_convolve8_8_s32_s16(s2, s3, s4, s5, s6, s7, s8, s9,
y_filter, offset_s32);
d3 = highbd_convolve8_8_s32_s16(s3, s4, s5, s6, s7, s8, s9, s10,
y_filter, offset_s32);
if (h == 2) {
store_u16_8x2(d, dst_stride, d0, d1);
} else {
store_u16_8x4(d, dst_stride, d0, d1, d2, d3);
}
s0 = s4;
s1 = s5;
s2 = s6;
s3 = s7;
s4 = s8;
s5 = s9;
s6 = s10;
s += 4 * src_stride;
d += 4 * dst_stride;
height -= 4;
} while (height > 0);
src_ptr += 8;
dst_ptr += 8;
w -= 8;
} while (w > 0);
}
}
void av1_highbd_dist_wtd_convolve_2d_neon(
const uint16_t *src, int src_stride, uint16_t *dst, int dst_stride, int w,
int h, const InterpFilterParams *filter_params_x,
const InterpFilterParams *filter_params_y, const int subpel_x_qn,
const int subpel_y_qn, ConvolveParams *conv_params, int bd) {
DECLARE_ALIGNED(16, uint16_t,
im_block[(MAX_SB_SIZE + MAX_FILTER_TAP) * MAX_SB_SIZE]);
DECLARE_ALIGNED(16, uint16_t,
im_block2[(MAX_SB_SIZE + MAX_FILTER_TAP) * MAX_SB_SIZE]);
CONV_BUF_TYPE *dst16 = conv_params->dst;
int dst16_stride = conv_params->dst_stride;
const int im_h = h + filter_params_y->taps - 1;
const int im_stride = MAX_SB_SIZE;
const int vert_offset = filter_params_y->taps / 2 - 1;
const int horiz_offset = filter_params_x->taps / 2 - 1;
const int round_bits =
2 * FILTER_BITS - conv_params->round_0 - conv_params->round_1;
const int x_offset_initial = (1 << (bd + FILTER_BITS - 1));
const int y_offset_bits = bd + 2 * FILTER_BITS - conv_params->round_0;
const int y_offset_initial = (1 << y_offset_bits);
const int y_offset_correction =
((1 << (y_offset_bits - conv_params->round_1)) +
(1 << (y_offset_bits - conv_params->round_1 - 1)));
const uint16_t *src_ptr = src - vert_offset * src_stride - horiz_offset;
const int16_t *x_filter_ptr = av1_get_interp_filter_subpel_kernel(
filter_params_x, subpel_x_qn & SUBPEL_MASK);
const int16_t *y_filter_ptr = av1_get_interp_filter_subpel_kernel(
filter_params_y, subpel_y_qn & SUBPEL_MASK);
// horizontal filter
highbd_convolve_x_8tap_neon(src_ptr, src_stride, im_block, im_stride, w, im_h,
x_filter_ptr, conv_params, x_offset_initial);
// vertical filter
if (conv_params->do_average) {
highbd_convolve_y_8tap_neon(im_block, im_stride, im_block2, im_stride, w, h,
y_filter_ptr, conv_params, y_offset_initial);
} else {
highbd_convolve_y_8tap_neon(im_block, im_stride, dst16, dst16_stride, w, h,
y_filter_ptr, conv_params, y_offset_initial);
}
// Do the compound averaging outside the loop, avoids branching within the
// main loop
if (conv_params->do_average) {
if (conv_params->use_dist_wtd_comp_avg) {
highbd_dist_wtd_comp_avg_neon(im_block2, im_stride, dst, dst_stride, w, h,
conv_params, round_bits,
y_offset_correction, bd);
} else {
highbd_comp_avg_neon(im_block2, im_stride, dst, dst_stride, w, h,
conv_params, round_bits, y_offset_correction, bd);
}
}
}