blob: 727ff1681d79aad3a11e59ec1208584b78ab650a [file] [log] [blame] [edit]
/*
* Copyright (c) 2021, Alliance for Open Media. All rights reserved
*
* This source code is subject to the terms of the BSD 3-Clause Clear License
* and the Alliance for Open Media Patent License 1.0. If the BSD 3-Clause Clear
* License was not distributed with this source code in the LICENSE file, you
* can obtain it at aomedia.org/license/software-license/bsd-3-c-c/. 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
* aomedia.org/license/patent-license/.
*/
#include <assert.h>
#include <smmintrin.h>
#include "config/av1_rtcd.h"
#include "av1/common/convolve.h"
#include "av1/common/resize.h"
#include "aom_dsp/x86/synonyms.h"
// Note: If the crop width is not a multiple of 4, then, unlike the C version,
// this function will overwrite some of the padding on the right hand side of
// the frame. This padding appears to be trashed anyway, so this should not
// affect the running of the decoder.
void av1_convolve_horiz_rs_sse4_1(const uint8_t *src, int src_stride,
uint8_t *dst, int dst_stride, int w, int h,
const int16_t *x_filters, int x0_qn,
int x_step_qn) {
assert(UPSCALE_NORMATIVE_TAPS == 8);
src -= UPSCALE_NORMATIVE_TAPS / 2 - 1;
const __m128i round_add = _mm_set1_epi32((1 << FILTER_BITS) >> 1);
const __m128i zero = _mm_setzero_si128();
const uint8_t *src_y;
uint8_t *dst_y;
int x_qn = x0_qn;
for (int x = 0; x < w; x += 4, x_qn += 4 * x_step_qn) {
const int x_filter_idx0 =
((x_qn + 0 * x_step_qn) & RS_SCALE_SUBPEL_MASK) >> RS_SCALE_EXTRA_BITS;
const int x_filter_idx1 =
((x_qn + 1 * x_step_qn) & RS_SCALE_SUBPEL_MASK) >> RS_SCALE_EXTRA_BITS;
const int x_filter_idx2 =
((x_qn + 2 * x_step_qn) & RS_SCALE_SUBPEL_MASK) >> RS_SCALE_EXTRA_BITS;
const int x_filter_idx3 =
((x_qn + 3 * x_step_qn) & RS_SCALE_SUBPEL_MASK) >> RS_SCALE_EXTRA_BITS;
assert(x_filter_idx0 <= RS_SUBPEL_MASK);
assert(x_filter_idx1 <= RS_SUBPEL_MASK);
assert(x_filter_idx2 <= RS_SUBPEL_MASK);
assert(x_filter_idx3 <= RS_SUBPEL_MASK);
const int16_t *const x_filter0 =
&x_filters[x_filter_idx0 * UPSCALE_NORMATIVE_TAPS];
const int16_t *const x_filter1 =
&x_filters[x_filter_idx1 * UPSCALE_NORMATIVE_TAPS];
const int16_t *const x_filter2 =
&x_filters[x_filter_idx2 * UPSCALE_NORMATIVE_TAPS];
const int16_t *const x_filter3 =
&x_filters[x_filter_idx3 * UPSCALE_NORMATIVE_TAPS];
const __m128i fil0_16 = xx_loadu_128(x_filter0);
const __m128i fil1_16 = xx_loadu_128(x_filter1);
const __m128i fil2_16 = xx_loadu_128(x_filter2);
const __m128i fil3_16 = xx_loadu_128(x_filter3);
src_y = src;
dst_y = dst;
for (int y = 0; y < h; y++, src_y += src_stride, dst_y += dst_stride) {
const uint8_t *const src_x0 =
&src_y[(x_qn + 0 * x_step_qn) >> RS_SCALE_SUBPEL_BITS];
const uint8_t *const src_x1 =
&src_y[(x_qn + 1 * x_step_qn) >> RS_SCALE_SUBPEL_BITS];
const uint8_t *const src_x2 =
&src_y[(x_qn + 2 * x_step_qn) >> RS_SCALE_SUBPEL_BITS];
const uint8_t *const src_x3 =
&src_y[(x_qn + 3 * x_step_qn) >> RS_SCALE_SUBPEL_BITS];
// Load up the source data. This is 8-bit input data, so each load
// gets 8 pixels.
const __m128i src0_8 = xx_loadl_64(src_x0);
const __m128i src1_8 = xx_loadl_64(src_x1);
const __m128i src2_8 = xx_loadl_64(src_x2);
const __m128i src3_8 = xx_loadl_64(src_x3);
// Now zero-extend up to 16-bit precision, i.e.
// [ 00 00 00 00 hg fe dc ba ] -> [ 0h 0g 0f 0e 0d 0c 0b 0a ]
const __m128i src0_16 = _mm_cvtepu8_epi16(src0_8);
const __m128i src1_16 = _mm_cvtepu8_epi16(src1_8);
const __m128i src2_16 = _mm_cvtepu8_epi16(src2_8);
const __m128i src3_16 = _mm_cvtepu8_epi16(src3_8);
// Multiply by filter coefficients (results in a 32-bit value),
// and add adjacent pairs, i.e.
// ([ s7 s6 s5 s4 s3 s2 s1 s0], [ f7 f6 f5 f4 f3 f2 f1 f0 ])
// -> [ {s7*f7+s6*f6} {s5*f5+s4*f4} {s3*f3+s2*f2} {s1*f1+s0*f0} ]
const __m128i conv0_32 = _mm_madd_epi16(src0_16, fil0_16);
const __m128i conv1_32 = _mm_madd_epi16(src1_16, fil1_16);
const __m128i conv2_32 = _mm_madd_epi16(src2_16, fil2_16);
const __m128i conv3_32 = _mm_madd_epi16(src3_16, fil3_16);
// Reduce horizontally and add, i.e.
// ([ D C B A ], [ S R Q P ]) -> [ S+R Q+P D+C B+A ]
const __m128i conv01_32 = _mm_hadd_epi32(conv0_32, conv1_32);
const __m128i conv23_32 = _mm_hadd_epi32(conv2_32, conv3_32);
const __m128i conv0123_32 = _mm_hadd_epi32(conv01_32, conv23_32);
// Divide down by (1 << FILTER_BITS), rounding to nearest.
const __m128i shifted_32 =
_mm_srai_epi32(_mm_add_epi32(conv0123_32, round_add), FILTER_BITS);
// Pack 32-bit values into 16-bit values, i.e.
// ([ D C B A ], [ 0 0 0 0 ]) -> [ 0 0 0 0 D C B A ]
const __m128i shifted_16 = _mm_packus_epi32(shifted_32, zero);
// Pack 16-bit values into 8-bit values, i.e.
// ([ 0 0 0 0 D C B A ], [ 0 0 0 0 0 0 0 0 ])
// -> [ 0 0 0 0 0 0 DC BA ]
const __m128i shifted_8 = _mm_packus_epi16(shifted_16, zero);
// Write to the output
xx_storel_32(&dst_y[x], shifted_8);
}
}
}
// Note: If the crop width is not a multiple of 4, then, unlike the C version,
// this function will overwrite some of the padding on the right hand side of
// the frame. This padding appears to be trashed anyway, so this should not
// affect the running of the decoder.
void av1_highbd_convolve_horiz_rs_sse4_1(const uint16_t *src, int src_stride,
uint16_t *dst, int dst_stride, int w,
int h, const int16_t *x_filters,
int x0_qn, int x_step_qn, int bd) {
assert(UPSCALE_NORMATIVE_TAPS == 8);
assert(bd == 8 || bd == 10 || bd == 12);
src -= UPSCALE_NORMATIVE_TAPS / 2 - 1;
const __m128i round_add = _mm_set1_epi32((1 << FILTER_BITS) >> 1);
const __m128i zero = _mm_setzero_si128();
const __m128i clip_maximum = _mm_set1_epi16((1 << bd) - 1);
const uint16_t *src_y;
uint16_t *dst_y;
int x_qn = x0_qn;
for (int x = 0; x < w; x += 4, x_qn += 4 * x_step_qn) {
const int x_filter_idx0 =
((x_qn + 0 * x_step_qn) & RS_SCALE_SUBPEL_MASK) >> RS_SCALE_EXTRA_BITS;
const int x_filter_idx1 =
((x_qn + 1 * x_step_qn) & RS_SCALE_SUBPEL_MASK) >> RS_SCALE_EXTRA_BITS;
const int x_filter_idx2 =
((x_qn + 2 * x_step_qn) & RS_SCALE_SUBPEL_MASK) >> RS_SCALE_EXTRA_BITS;
const int x_filter_idx3 =
((x_qn + 3 * x_step_qn) & RS_SCALE_SUBPEL_MASK) >> RS_SCALE_EXTRA_BITS;
assert(x_filter_idx0 <= RS_SUBPEL_MASK);
assert(x_filter_idx1 <= RS_SUBPEL_MASK);
assert(x_filter_idx2 <= RS_SUBPEL_MASK);
assert(x_filter_idx3 <= RS_SUBPEL_MASK);
const int16_t *const x_filter0 =
&x_filters[x_filter_idx0 * UPSCALE_NORMATIVE_TAPS];
const int16_t *const x_filter1 =
&x_filters[x_filter_idx1 * UPSCALE_NORMATIVE_TAPS];
const int16_t *const x_filter2 =
&x_filters[x_filter_idx2 * UPSCALE_NORMATIVE_TAPS];
const int16_t *const x_filter3 =
&x_filters[x_filter_idx3 * UPSCALE_NORMATIVE_TAPS];
const __m128i fil0_16 = xx_loadu_128(x_filter0);
const __m128i fil1_16 = xx_loadu_128(x_filter1);
const __m128i fil2_16 = xx_loadu_128(x_filter2);
const __m128i fil3_16 = xx_loadu_128(x_filter3);
src_y = src;
dst_y = dst;
for (int y = 0; y < h; y++, src_y += src_stride, dst_y += dst_stride) {
const uint16_t *const src_x0 =
&src_y[(x_qn + 0 * x_step_qn) >> RS_SCALE_SUBPEL_BITS];
const uint16_t *const src_x1 =
&src_y[(x_qn + 1 * x_step_qn) >> RS_SCALE_SUBPEL_BITS];
const uint16_t *const src_x2 =
&src_y[(x_qn + 2 * x_step_qn) >> RS_SCALE_SUBPEL_BITS];
const uint16_t *const src_x3 =
&src_y[(x_qn + 3 * x_step_qn) >> RS_SCALE_SUBPEL_BITS];
// Load up the source data. This is 16-bit input data, so each load
// gets 8 pixels.
const __m128i src0_16 = xx_loadu_128(src_x0);
const __m128i src1_16 = xx_loadu_128(src_x1);
const __m128i src2_16 = xx_loadu_128(src_x2);
const __m128i src3_16 = xx_loadu_128(src_x3);
// Multiply by filter coefficients (results in a 32-bit value),
// and add adjacent pairs, i.e.
// ([ s7 s6 s5 s4 s3 s2 s1 s0], [ f7 f6 f5 f4 f3 f2 f1 f0 ])
// -> [ {s7*f7+s6*f6} {s5*f5+s4*f4} {s3*f3+s2*f2} {s1*f1+s0*f0} ]
const __m128i conv0_32 = _mm_madd_epi16(src0_16, fil0_16);
const __m128i conv1_32 = _mm_madd_epi16(src1_16, fil1_16);
const __m128i conv2_32 = _mm_madd_epi16(src2_16, fil2_16);
const __m128i conv3_32 = _mm_madd_epi16(src3_16, fil3_16);
// Reduce horizontally and add, i.e.
// ([ D C B A ], [ S R Q P ]) -> [ S+R Q+P D+C B+A ]
const __m128i conv01_32 = _mm_hadd_epi32(conv0_32, conv1_32);
const __m128i conv23_32 = _mm_hadd_epi32(conv2_32, conv3_32);
const __m128i conv0123_32 = _mm_hadd_epi32(conv01_32, conv23_32);
// Divide down by (1 << FILTER_BITS), rounding to nearest.
const __m128i shifted_32 =
_mm_srai_epi32(_mm_add_epi32(conv0123_32, round_add), FILTER_BITS);
// Pack 32-bit values into 16-bit values, i.e.
// ([ D C B A ], [ 0 0 0 0 ]) -> [ 0 0 0 0 D C B A ]
const __m128i shifted_16 = _mm_packus_epi32(shifted_32, zero);
// Clip the values at (1 << bd) - 1
const __m128i clipped_16 = _mm_min_epi16(shifted_16, clip_maximum);
// Write to the output
xx_storel_64(&dst_y[x], clipped_16);
}
}
}