blob: 57a1cee7819fe0d7d5cc1008efecdb590df80fdc [file] [log] [blame]
/*
* Copyright (c) 2016, Alliance for Open Media. All rights reserved
*
* This source code is subject to the terms of the BSD 2 Clause License and
* the Alliance for Open Media Patent License 1.0. If the BSD 2 Clause License
* was not distributed with this source code in the LICENSE file, you can
* obtain it at www.aomedia.org/license/software. If the Alliance for Open
* Media Patent License 1.0 was not distributed with this source code in the
* PATENTS file, you can obtain it at www.aomedia.org/license/patent.
*/
#include <immintrin.h> // AVX2
#include "config/aom_dsp_rtcd.h"
#include "aom_ports/mem.h"
/* clang-format off */
DECLARE_ALIGNED(32, static const uint8_t, bilinear_filters_avx2[512]) = {
16, 0, 16, 0, 16, 0, 16, 0, 16, 0, 16, 0, 16, 0, 16, 0,
16, 0, 16, 0, 16, 0, 16, 0, 16, 0, 16, 0, 16, 0, 16, 0,
14, 2, 14, 2, 14, 2, 14, 2, 14, 2, 14, 2, 14, 2, 14, 2,
14, 2, 14, 2, 14, 2, 14, 2, 14, 2, 14, 2, 14, 2, 14, 2,
12, 4, 12, 4, 12, 4, 12, 4, 12, 4, 12, 4, 12, 4, 12, 4,
12, 4, 12, 4, 12, 4, 12, 4, 12, 4, 12, 4, 12, 4, 12, 4,
10, 6, 10, 6, 10, 6, 10, 6, 10, 6, 10, 6, 10, 6, 10, 6,
10, 6, 10, 6, 10, 6, 10, 6, 10, 6, 10, 6, 10, 6, 10, 6,
8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8,
8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8,
6, 10, 6, 10, 6, 10, 6, 10, 6, 10, 6, 10, 6, 10, 6, 10,
6, 10, 6, 10, 6, 10, 6, 10, 6, 10, 6, 10, 6, 10, 6, 10,
4, 12, 4, 12, 4, 12, 4, 12, 4, 12, 4, 12, 4, 12, 4, 12,
4, 12, 4, 12, 4, 12, 4, 12, 4, 12, 4, 12, 4, 12, 4, 12,
2, 14, 2, 14, 2, 14, 2, 14, 2, 14, 2, 14, 2, 14, 2, 14,
2, 14, 2, 14, 2, 14, 2, 14, 2, 14, 2, 14, 2, 14, 2, 14,
};
/* clang-format on */
#define FILTER_SRC(filter) \
/* filter the source */ \
exp_src_lo = _mm256_maddubs_epi16(exp_src_lo, filter); \
exp_src_hi = _mm256_maddubs_epi16(exp_src_hi, filter); \
\
/* add 8 to source */ \
exp_src_lo = _mm256_add_epi16(exp_src_lo, pw8); \
exp_src_hi = _mm256_add_epi16(exp_src_hi, pw8); \
\
/* divide source by 16 */ \
exp_src_lo = _mm256_srai_epi16(exp_src_lo, 4); \
exp_src_hi = _mm256_srai_epi16(exp_src_hi, 4);
#define MERGE_WITH_SRC(src_reg, reg) \
exp_src_lo = _mm256_unpacklo_epi8(src_reg, reg); \
exp_src_hi = _mm256_unpackhi_epi8(src_reg, reg);
#define LOAD_SRC_DST \
/* load source and destination */ \
src_reg = _mm256_loadu_si256((__m256i const *)(src)); \
dst_reg = _mm256_loadu_si256((__m256i const *)(dst));
#define AVG_NEXT_SRC(src_reg, size_stride) \
src_next_reg = _mm256_loadu_si256((__m256i const *)(src + size_stride)); \
/* average between current and next stride source */ \
src_reg = _mm256_avg_epu8(src_reg, src_next_reg);
#define MERGE_NEXT_SRC(src_reg, size_stride) \
src_next_reg = _mm256_loadu_si256((__m256i const *)(src + size_stride)); \
MERGE_WITH_SRC(src_reg, src_next_reg)
#define CALC_SUM_SSE_INSIDE_LOOP \
/* expand each byte to 2 bytes */ \
exp_dst_lo = _mm256_unpacklo_epi8(dst_reg, zero_reg); \
exp_dst_hi = _mm256_unpackhi_epi8(dst_reg, zero_reg); \
/* source - dest */ \
exp_src_lo = _mm256_sub_epi16(exp_src_lo, exp_dst_lo); \
exp_src_hi = _mm256_sub_epi16(exp_src_hi, exp_dst_hi); \
/* caculate sum */ \
sum_reg = _mm256_add_epi16(sum_reg, exp_src_lo); \
exp_src_lo = _mm256_madd_epi16(exp_src_lo, exp_src_lo); \
sum_reg = _mm256_add_epi16(sum_reg, exp_src_hi); \
exp_src_hi = _mm256_madd_epi16(exp_src_hi, exp_src_hi); \
/* calculate sse */ \
sse_reg = _mm256_add_epi32(sse_reg, exp_src_lo); \
sse_reg = _mm256_add_epi32(sse_reg, exp_src_hi);
// final calculation to sum and sse
#define CALC_SUM_AND_SSE \
res_cmp = _mm256_cmpgt_epi16(zero_reg, sum_reg); \
sse_reg_hi = _mm256_srli_si256(sse_reg, 8); \
sum_reg_lo = _mm256_unpacklo_epi16(sum_reg, res_cmp); \
sum_reg_hi = _mm256_unpackhi_epi16(sum_reg, res_cmp); \
sse_reg = _mm256_add_epi32(sse_reg, sse_reg_hi); \
sum_reg = _mm256_add_epi32(sum_reg_lo, sum_reg_hi); \
\
sse_reg_hi = _mm256_srli_si256(sse_reg, 4); \
sum_reg_hi = _mm256_srli_si256(sum_reg, 8); \
\
sse_reg = _mm256_add_epi32(sse_reg, sse_reg_hi); \
sum_reg = _mm256_add_epi32(sum_reg, sum_reg_hi); \
*((int *)sse) = _mm_cvtsi128_si32(_mm256_castsi256_si128(sse_reg)) + \
_mm_cvtsi128_si32(_mm256_extractf128_si256(sse_reg, 1)); \
sum_reg_hi = _mm256_srli_si256(sum_reg, 4); \
sum_reg = _mm256_add_epi32(sum_reg, sum_reg_hi); \
sum = _mm_cvtsi128_si32(_mm256_castsi256_si128(sum_reg)) + \
_mm_cvtsi128_si32(_mm256_extractf128_si256(sum_reg, 1));
// Functions related to sub pixel variance width 16
#define LOAD_SRC_DST_INSERT(src_stride, dst_stride) \
/* load source and destination of 2 rows and insert*/ \
src_reg = _mm256_inserti128_si256( \
_mm256_castsi128_si256(_mm_loadu_si128((__m128i *)(src))), \
_mm_loadu_si128((__m128i *)(src + src_stride)), 1); \
dst_reg = _mm256_inserti128_si256( \
_mm256_castsi128_si256(_mm_loadu_si128((__m128i *)(dst))), \
_mm_loadu_si128((__m128i *)(dst + dst_stride)), 1);
#define AVG_NEXT_SRC_INSERT(src_reg, size_stride) \
src_next_reg = _mm256_inserti128_si256( \
_mm256_castsi128_si256(_mm_loadu_si128((__m128i *)(src + size_stride))), \
_mm_loadu_si128((__m128i *)(src + (size_stride << 1))), 1); \
/* average between current and next stride source */ \
src_reg = _mm256_avg_epu8(src_reg, src_next_reg);
#define MERGE_NEXT_SRC_INSERT(src_reg, size_stride) \
src_next_reg = _mm256_inserti128_si256( \
_mm256_castsi128_si256(_mm_loadu_si128((__m128i *)(src + size_stride))), \
_mm_loadu_si128((__m128i *)(src + (src_stride + size_stride))), 1); \
MERGE_WITH_SRC(src_reg, src_next_reg)
#define LOAD_SRC_NEXT_BYTE_INSERT \
/* load source and another source from next row */ \
src_reg = _mm256_inserti128_si256( \
_mm256_castsi128_si256(_mm_loadu_si128((__m128i *)(src))), \
_mm_loadu_si128((__m128i *)(src + src_stride)), 1); \
/* load source and next row source from 1 byte onwards */ \
src_next_reg = _mm256_inserti128_si256( \
_mm256_castsi128_si256(_mm_loadu_si128((__m128i *)(src + 1))), \
_mm_loadu_si128((__m128i *)(src + src_stride + 1)), 1);
#define LOAD_DST_INSERT \
dst_reg = _mm256_inserti128_si256( \
_mm256_castsi128_si256(_mm_loadu_si128((__m128i *)(dst))), \
_mm_loadu_si128((__m128i *)(dst + dst_stride)), 1);
#define LOAD_SRC_MERGE_128BIT(filter) \
__m128i src_reg_0 = _mm_loadu_si128((__m128i *)(src)); \
__m128i src_reg_1 = _mm_loadu_si128((__m128i *)(src + 1)); \
__m128i src_lo = _mm_unpacklo_epi8(src_reg_0, src_reg_1); \
__m128i src_hi = _mm_unpackhi_epi8(src_reg_0, src_reg_1); \
__m128i filter_128bit = _mm256_castsi256_si128(filter); \
__m128i pw8_128bit = _mm256_castsi256_si128(pw8);
#define FILTER_SRC_128BIT(filter) \
/* filter the source */ \
src_lo = _mm_maddubs_epi16(src_lo, filter); \
src_hi = _mm_maddubs_epi16(src_hi, filter); \
\
/* add 8 to source */ \
src_lo = _mm_add_epi16(src_lo, pw8_128bit); \
src_hi = _mm_add_epi16(src_hi, pw8_128bit); \
\
/* divide source by 16 */ \
src_lo = _mm_srai_epi16(src_lo, 4); \
src_hi = _mm_srai_epi16(src_hi, 4);
// TODO(chiyotsai@google.com): These variance functions are macro-fied so we
// don't have to manually optimize the individual for-loops. We could save some
// binary size by optimizing the loops more carefully without duplicating the
// codes with a macro.
#define MAKE_SUB_PIXEL_VAR_32XH(height, log2height) \
static AOM_INLINE int aom_sub_pixel_variance32x##height##_imp_avx2( \
const uint8_t *src, int src_stride, int x_offset, int y_offset, \
const uint8_t *dst, int dst_stride, unsigned int *sse) { \
__m256i src_reg, dst_reg, exp_src_lo, exp_src_hi, exp_dst_lo, exp_dst_hi; \
__m256i sse_reg, sum_reg, sse_reg_hi, res_cmp, sum_reg_lo, sum_reg_hi; \
__m256i zero_reg; \
int i, sum; \
sum_reg = _mm256_setzero_si256(); \
sse_reg = _mm256_setzero_si256(); \
zero_reg = _mm256_setzero_si256(); \
\
/* x_offset = 0 and y_offset = 0 */ \
if (x_offset == 0) { \
if (y_offset == 0) { \
for (i = 0; i < height; i++) { \
LOAD_SRC_DST \
/* expend each byte to 2 bytes */ \
MERGE_WITH_SRC(src_reg, zero_reg) \
CALC_SUM_SSE_INSIDE_LOOP \
src += src_stride; \
dst += dst_stride; \
} \
/* x_offset = 0 and y_offset = 4 */ \
} else if (y_offset == 4) { \
__m256i src_next_reg; \
for (i = 0; i < height; i++) { \
LOAD_SRC_DST \
AVG_NEXT_SRC(src_reg, src_stride) \
/* expend each byte to 2 bytes */ \
MERGE_WITH_SRC(src_reg, zero_reg) \
CALC_SUM_SSE_INSIDE_LOOP \
src += src_stride; \
dst += dst_stride; \
} \
/* x_offset = 0 and y_offset = bilin interpolation */ \
} else { \
__m256i filter, pw8, src_next_reg; \
\
y_offset <<= 5; \
filter = _mm256_load_si256( \
(__m256i const *)(bilinear_filters_avx2 + y_offset)); \
pw8 = _mm256_set1_epi16(8); \
for (i = 0; i < height; i++) { \
LOAD_SRC_DST \
MERGE_NEXT_SRC(src_reg, src_stride) \
FILTER_SRC(filter) \
CALC_SUM_SSE_INSIDE_LOOP \
src += src_stride; \
dst += dst_stride; \
} \
} \
/* x_offset = 4 and y_offset = 0 */ \
} else if (x_offset == 4) { \
if (y_offset == 0) { \
__m256i src_next_reg; \
for (i = 0; i < height; i++) { \
LOAD_SRC_DST \
AVG_NEXT_SRC(src_reg, 1) \
/* expand each byte to 2 bytes */ \
MERGE_WITH_SRC(src_reg, zero_reg) \
CALC_SUM_SSE_INSIDE_LOOP \
src += src_stride; \
dst += dst_stride; \
} \
/* x_offset = 4 and y_offset = 4 */ \
} else if (y_offset == 4) { \
__m256i src_next_reg, src_avg; \
/* load source and another source starting from the next */ \
/* following byte */ \
src_reg = _mm256_loadu_si256((__m256i const *)(src)); \
AVG_NEXT_SRC(src_reg, 1) \
for (i = 0; i < height; i++) { \
src_avg = src_reg; \
src += src_stride; \
LOAD_SRC_DST \
AVG_NEXT_SRC(src_reg, 1) \
/* average between previous average to current average */ \
src_avg = _mm256_avg_epu8(src_avg, src_reg); \
/* expand each byte to 2 bytes */ \
MERGE_WITH_SRC(src_avg, zero_reg) \
/* save current source average */ \
CALC_SUM_SSE_INSIDE_LOOP \
dst += dst_stride; \
} \
/* x_offset = 4 and y_offset = bilin interpolation */ \
} else { \
__m256i filter, pw8, src_next_reg, src_avg; \
y_offset <<= 5; \
filter = _mm256_load_si256( \
(__m256i const *)(bilinear_filters_avx2 + y_offset)); \
pw8 = _mm256_set1_epi16(8); \
/* load source and another source starting from the next */ \
/* following byte */ \
src_reg = _mm256_loadu_si256((__m256i const *)(src)); \
AVG_NEXT_SRC(src_reg, 1) \
for (i = 0; i < height; i++) { \
/* save current source average */ \
src_avg = src_reg; \
src += src_stride; \
LOAD_SRC_DST \
AVG_NEXT_SRC(src_reg, 1) \
MERGE_WITH_SRC(src_avg, src_reg) \
FILTER_SRC(filter) \
CALC_SUM_SSE_INSIDE_LOOP \
dst += dst_stride; \
} \
} \
/* x_offset = bilin interpolation and y_offset = 0 */ \
} else { \
if (y_offset == 0) { \
__m256i filter, pw8, src_next_reg; \
x_offset <<= 5; \
filter = _mm256_load_si256( \
(__m256i const *)(bilinear_filters_avx2 + x_offset)); \
pw8 = _mm256_set1_epi16(8); \
for (i = 0; i < height; i++) { \
LOAD_SRC_DST \
MERGE_NEXT_SRC(src_reg, 1) \
FILTER_SRC(filter) \
CALC_SUM_SSE_INSIDE_LOOP \
src += src_stride; \
dst += dst_stride; \
} \
/* x_offset = bilin interpolation and y_offset = 4 */ \
} else if (y_offset == 4) { \
__m256i filter, pw8, src_next_reg, src_pack; \
x_offset <<= 5; \
filter = _mm256_load_si256( \
(__m256i const *)(bilinear_filters_avx2 + x_offset)); \
pw8 = _mm256_set1_epi16(8); \
src_reg = _mm256_loadu_si256((__m256i const *)(src)); \
MERGE_NEXT_SRC(src_reg, 1) \
FILTER_SRC(filter) \
/* convert each 16 bit to 8 bit to each low and high lane source */ \
src_pack = _mm256_packus_epi16(exp_src_lo, exp_src_hi); \
for (i = 0; i < height; i++) { \
src += src_stride; \
LOAD_SRC_DST \
MERGE_NEXT_SRC(src_reg, 1) \
FILTER_SRC(filter) \
src_reg = _mm256_packus_epi16(exp_src_lo, exp_src_hi); \
/* average between previous pack to the current */ \
src_pack = _mm256_avg_epu8(src_pack, src_reg); \
MERGE_WITH_SRC(src_pack, zero_reg) \
CALC_SUM_SSE_INSIDE_LOOP \
src_pack = src_reg; \
dst += dst_stride; \
} \
/* x_offset = bilin interpolation and y_offset = bilin interpolation \
*/ \
} else { \
__m256i xfilter, yfilter, pw8, src_next_reg, src_pack; \
x_offset <<= 5; \
xfilter = _mm256_load_si256( \
(__m256i const *)(bilinear_filters_avx2 + x_offset)); \
y_offset <<= 5; \
yfilter = _mm256_load_si256( \
(__m256i const *)(bilinear_filters_avx2 + y_offset)); \
pw8 = _mm256_set1_epi16(8); \
/* load source and another source starting from the next */ \
/* following byte */ \
src_reg = _mm256_loadu_si256((__m256i const *)(src)); \
MERGE_NEXT_SRC(src_reg, 1) \
\
FILTER_SRC(xfilter) \
/* convert each 16 bit to 8 bit to each low and high lane source */ \
src_pack = _mm256_packus_epi16(exp_src_lo, exp_src_hi); \
for (i = 0; i < height; i++) { \
src += src_stride; \
LOAD_SRC_DST \
MERGE_NEXT_SRC(src_reg, 1) \
FILTER_SRC(xfilter) \
src_reg = _mm256_packus_epi16(exp_src_lo, exp_src_hi); \
/* merge previous pack to current pack source */ \
MERGE_WITH_SRC(src_pack, src_reg) \
/* filter the source */ \
FILTER_SRC(yfilter) \
src_pack = src_reg; \
CALC_SUM_SSE_INSIDE_LOOP \
dst += dst_stride; \
} \
} \
} \
CALC_SUM_AND_SSE \
_mm256_zeroupper(); \
return sum; \
} \
unsigned int aom_sub_pixel_variance32x##height##_avx2( \
const uint8_t *src, int src_stride, int x_offset, int y_offset, \
const uint8_t *dst, int dst_stride, unsigned int *sse) { \
const int sum = aom_sub_pixel_variance32x##height##_imp_avx2( \
src, src_stride, x_offset, y_offset, dst, dst_stride, sse); \
return *sse - (unsigned int)(((int64_t)sum * sum) >> (5 + log2height)); \
}
MAKE_SUB_PIXEL_VAR_32XH(64, 6)
MAKE_SUB_PIXEL_VAR_32XH(32, 5)
MAKE_SUB_PIXEL_VAR_32XH(16, 4)
#define AOM_SUB_PIXEL_VAR_AVX2(w, h, wf, hf, wlog2, hlog2) \
unsigned int aom_sub_pixel_variance##w##x##h##_avx2( \
const uint8_t *src, int src_stride, int x_offset, int y_offset, \
const uint8_t *dst, int dst_stride, unsigned int *sse_ptr) { \
unsigned int sse = 0; \
int se = 0; \
for (int i = 0; i < (w / wf); ++i) { \
const uint8_t *src_ptr = src; \
const uint8_t *dst_ptr = dst; \
for (int j = 0; j < (h / hf); ++j) { \
unsigned int sse2; \
const int se2 = aom_sub_pixel_variance##wf##x##hf##_imp_avx2( \
src_ptr, src_stride, x_offset, y_offset, dst_ptr, dst_stride, \
&sse2); \
dst_ptr += hf * dst_stride; \
src_ptr += hf * src_stride; \
se += se2; \
sse += sse2; \
} \
src += wf; \
dst += wf; \
} \
*sse_ptr = sse; \
return sse - (unsigned int)(((int64_t)se * se) >> (wlog2 + hlog2)); \
}
// Note: hf = AOMMIN(h, 64) to avoid overflow in helper by capping height.
AOM_SUB_PIXEL_VAR_AVX2(128, 128, 32, 64, 7, 7)
AOM_SUB_PIXEL_VAR_AVX2(128, 64, 32, 64, 7, 6)
AOM_SUB_PIXEL_VAR_AVX2(64, 128, 32, 64, 6, 7)
AOM_SUB_PIXEL_VAR_AVX2(64, 64, 32, 64, 6, 6)
AOM_SUB_PIXEL_VAR_AVX2(64, 32, 32, 32, 6, 5)
#define MAKE_SUB_PIXEL_VAR_16XH(height, log2height) \
unsigned int aom_sub_pixel_variance16x##height##_avx2( \
const uint8_t *src, int src_stride, int x_offset, int y_offset, \
const uint8_t *dst, int dst_stride, unsigned int *sse) { \
__m256i src_reg, dst_reg, exp_src_lo, exp_src_hi, exp_dst_lo, exp_dst_hi; \
__m256i sse_reg, sum_reg, sse_reg_hi, res_cmp, sum_reg_lo, sum_reg_hi; \
__m256i zero_reg; \
int i, sum; \
sum_reg = _mm256_setzero_si256(); \
sse_reg = _mm256_setzero_si256(); \
zero_reg = _mm256_setzero_si256(); \
\
/* x_offset = 0 and y_offset = 0 */ \
if (x_offset == 0) { \
if (y_offset == 0) { \
for (i = 0; i < height; i += 2) { \
LOAD_SRC_DST_INSERT(src_stride, dst_stride) \
/* expend each byte to 2 bytes */ \
MERGE_WITH_SRC(src_reg, zero_reg) \
CALC_SUM_SSE_INSIDE_LOOP \
src += (src_stride << 1); \
dst += (dst_stride << 1); \
} \
/* x_offset = 0 and y_offset = 4 */ \
} else if (y_offset == 4) { \
__m256i src_next_reg; \
for (i = 0; i < height; i += 2) { \
LOAD_SRC_DST_INSERT(src_stride, dst_stride) \
AVG_NEXT_SRC_INSERT(src_reg, src_stride) \
/* expend each byte to 2 bytes */ \
MERGE_WITH_SRC(src_reg, zero_reg) \
CALC_SUM_SSE_INSIDE_LOOP \
src += (src_stride << 1); \
dst += (dst_stride << 1); \
} \
/* x_offset = 0 and y_offset = bilin interpolation */ \
} else { \
__m256i filter, pw8, src_next_reg; \
y_offset <<= 5; \
filter = _mm256_load_si256( \
(__m256i const *)(bilinear_filters_avx2 + y_offset)); \
pw8 = _mm256_set1_epi16(8); \
for (i = 0; i < height; i += 2) { \
LOAD_SRC_DST_INSERT(src_stride, dst_stride) \
MERGE_NEXT_SRC_INSERT(src_reg, src_stride) \
FILTER_SRC(filter) \
CALC_SUM_SSE_INSIDE_LOOP \
src += (src_stride << 1); \
dst += (dst_stride << 1); \
} \
} \
/* x_offset = 4 and y_offset = 0 */ \
} else if (x_offset == 4) { \
if (y_offset == 0) { \
__m256i src_next_reg; \
for (i = 0; i < height; i += 2) { \
LOAD_SRC_NEXT_BYTE_INSERT \
LOAD_DST_INSERT \
/* average between current and next stride source */ \
src_reg = _mm256_avg_epu8(src_reg, src_next_reg); \
/* expand each byte to 2 bytes */ \
MERGE_WITH_SRC(src_reg, zero_reg) \
CALC_SUM_SSE_INSIDE_LOOP \
src += (src_stride << 1); \
dst += (dst_stride << 1); \
} \
/* x_offset = 4 and y_offset = 4 */ \
} else if (y_offset == 4) { \
__m256i src_next_reg, src_avg, src_temp; \
/* load and insert source and next row source */ \
LOAD_SRC_NEXT_BYTE_INSERT \
src_avg = _mm256_avg_epu8(src_reg, src_next_reg); \
src += src_stride << 1; \
for (i = 0; i < height - 2; i += 2) { \
LOAD_SRC_NEXT_BYTE_INSERT \
src_next_reg = _mm256_avg_epu8(src_reg, src_next_reg); \
src_temp = _mm256_permute2x128_si256(src_avg, src_next_reg, 0x21); \
src_temp = _mm256_avg_epu8(src_avg, src_temp); \
LOAD_DST_INSERT \
/* expand each byte to 2 bytes */ \
MERGE_WITH_SRC(src_temp, zero_reg) \
/* save current source average */ \
src_avg = src_next_reg; \
CALC_SUM_SSE_INSIDE_LOOP \
dst += dst_stride << 1; \
src += src_stride << 1; \
} \
/* last 2 rows processing happens here */ \
__m128i src_reg_0 = _mm_loadu_si128((__m128i *)(src)); \
__m128i src_reg_1 = _mm_loadu_si128((__m128i *)(src + 1)); \
src_reg_0 = _mm_avg_epu8(src_reg_0, src_reg_1); \
src_next_reg = _mm256_permute2x128_si256( \
src_avg, _mm256_castsi128_si256(src_reg_0), 0x21); \
LOAD_DST_INSERT \
src_avg = _mm256_avg_epu8(src_avg, src_next_reg); \
MERGE_WITH_SRC(src_avg, zero_reg) \
CALC_SUM_SSE_INSIDE_LOOP \
} else { \
/* x_offset = 4 and y_offset = bilin interpolation */ \
__m256i filter, pw8, src_next_reg, src_avg, src_temp; \
y_offset <<= 5; \
filter = _mm256_load_si256( \
(__m256i const *)(bilinear_filters_avx2 + y_offset)); \
pw8 = _mm256_set1_epi16(8); \
/* load and insert source and next row source */ \
LOAD_SRC_NEXT_BYTE_INSERT \
src_avg = _mm256_avg_epu8(src_reg, src_next_reg); \
src += src_stride << 1; \
for (i = 0; i < height - 2; i += 2) { \
LOAD_SRC_NEXT_BYTE_INSERT \
src_next_reg = _mm256_avg_epu8(src_reg, src_next_reg); \
src_temp = _mm256_permute2x128_si256(src_avg, src_next_reg, 0x21); \
LOAD_DST_INSERT \
MERGE_WITH_SRC(src_avg, src_temp) \
/* save current source average */ \
src_avg = src_next_reg; \
FILTER_SRC(filter) \
CALC_SUM_SSE_INSIDE_LOOP \
dst += dst_stride << 1; \
src += src_stride << 1; \
} \
/* last 2 rows processing happens here */ \
__m128i src_reg_0 = _mm_loadu_si128((__m128i *)(src)); \
__m128i src_reg_1 = _mm_loadu_si128((__m128i *)(src + 1)); \
src_reg_0 = _mm_avg_epu8(src_reg_0, src_reg_1); \
src_next_reg = _mm256_permute2x128_si256( \
src_avg, _mm256_castsi128_si256(src_reg_0), 0x21); \
LOAD_DST_INSERT \
MERGE_WITH_SRC(src_avg, src_next_reg) \
FILTER_SRC(filter) \
CALC_SUM_SSE_INSIDE_LOOP \
} \
/* x_offset = bilin interpolation and y_offset = 0 */ \
} else { \
if (y_offset == 0) { \
__m256i filter, pw8, src_next_reg; \
x_offset <<= 5; \
filter = _mm256_load_si256( \
(__m256i const *)(bilinear_filters_avx2 + x_offset)); \
pw8 = _mm256_set1_epi16(8); \
for (i = 0; i < height; i += 2) { \
LOAD_SRC_DST_INSERT(src_stride, dst_stride) \
MERGE_NEXT_SRC_INSERT(src_reg, 1) \
FILTER_SRC(filter) \
CALC_SUM_SSE_INSIDE_LOOP \
src += (src_stride << 1); \
dst += (dst_stride << 1); \
} \
/* x_offset = bilin interpolation and y_offset = 4 */ \
} else if (y_offset == 4) { \
__m256i filter, pw8, src_next_reg, src_pack; \
x_offset <<= 5; \
filter = _mm256_load_si256( \
(__m256i const *)(bilinear_filters_avx2 + x_offset)); \
pw8 = _mm256_set1_epi16(8); \
/* load and insert source and next row source */ \
LOAD_SRC_NEXT_BYTE_INSERT \
MERGE_WITH_SRC(src_reg, src_next_reg) \
FILTER_SRC(filter) \
/* convert each 16 bit to 8 bit to each low and high lane source */ \
src_pack = _mm256_packus_epi16(exp_src_lo, exp_src_hi); \
src += src_stride << 1; \
for (i = 0; i < height - 2; i += 2) { \
LOAD_SRC_NEXT_BYTE_INSERT \
LOAD_DST_INSERT \
MERGE_WITH_SRC(src_reg, src_next_reg) \
FILTER_SRC(filter) \
src_reg = _mm256_packus_epi16(exp_src_lo, exp_src_hi); \
src_next_reg = _mm256_permute2x128_si256(src_pack, src_reg, 0x21); \
/* average between previous pack to the current */ \
src_pack = _mm256_avg_epu8(src_pack, src_next_reg); \
MERGE_WITH_SRC(src_pack, zero_reg) \
CALC_SUM_SSE_INSIDE_LOOP \
src_pack = src_reg; \
src += src_stride << 1; \
dst += dst_stride << 1; \
} \
/* last 2 rows processing happens here */ \
LOAD_SRC_MERGE_128BIT(filter) \
LOAD_DST_INSERT \
FILTER_SRC_128BIT(filter_128bit) \
src_reg_0 = _mm_packus_epi16(src_lo, src_hi); \
src_next_reg = _mm256_permute2x128_si256( \
src_pack, _mm256_castsi128_si256(src_reg_0), 0x21); \
/* average between previous pack to the current */ \
src_pack = _mm256_avg_epu8(src_pack, src_next_reg); \
MERGE_WITH_SRC(src_pack, zero_reg) \
CALC_SUM_SSE_INSIDE_LOOP \
} else { \
/* x_offset = bilin interpolation and y_offset = bilin interpolation \
*/ \
__m256i xfilter, yfilter, pw8, src_next_reg, src_pack; \
x_offset <<= 5; \
xfilter = _mm256_load_si256( \
(__m256i const *)(bilinear_filters_avx2 + x_offset)); \
y_offset <<= 5; \
yfilter = _mm256_load_si256( \
(__m256i const *)(bilinear_filters_avx2 + y_offset)); \
pw8 = _mm256_set1_epi16(8); \
/* load and insert source and next row source */ \
LOAD_SRC_NEXT_BYTE_INSERT \
MERGE_WITH_SRC(src_reg, src_next_reg) \
FILTER_SRC(xfilter) \
/* convert each 16 bit to 8 bit to each low and high lane source */ \
src_pack = _mm256_packus_epi16(exp_src_lo, exp_src_hi); \
src += src_stride << 1; \
for (i = 0; i < height - 2; i += 2) { \
LOAD_SRC_NEXT_BYTE_INSERT \
LOAD_DST_INSERT \
MERGE_WITH_SRC(src_reg, src_next_reg) \
FILTER_SRC(xfilter) \
src_reg = _mm256_packus_epi16(exp_src_lo, exp_src_hi); \
src_next_reg = _mm256_permute2x128_si256(src_pack, src_reg, 0x21); \
/* average between previous pack to the current */ \
MERGE_WITH_SRC(src_pack, src_next_reg) \
/* filter the source */ \
FILTER_SRC(yfilter) \
src_pack = src_reg; \
CALC_SUM_SSE_INSIDE_LOOP \
src += src_stride << 1; \
dst += dst_stride << 1; \
} \
/* last 2 rows processing happens here */ \
LOAD_SRC_MERGE_128BIT(xfilter) \
LOAD_DST_INSERT \
FILTER_SRC_128BIT(filter_128bit) \
src_reg_0 = _mm_packus_epi16(src_lo, src_hi); \
src_next_reg = _mm256_permute2x128_si256( \
src_pack, _mm256_castsi128_si256(src_reg_0), 0x21); \
MERGE_WITH_SRC(src_pack, src_next_reg) \
FILTER_SRC(yfilter) \
CALC_SUM_SSE_INSIDE_LOOP \
} \
} \
CALC_SUM_AND_SSE \
_mm256_zeroupper(); \
return *sse - (unsigned int)(((int64_t)sum * sum) >> (4 + log2height)); \
}
MAKE_SUB_PIXEL_VAR_16XH(32, 5)
MAKE_SUB_PIXEL_VAR_16XH(16, 4)
MAKE_SUB_PIXEL_VAR_16XH(8, 3)
#if !CONFIG_REALTIME_ONLY
MAKE_SUB_PIXEL_VAR_16XH(64, 6)
MAKE_SUB_PIXEL_VAR_16XH(4, 2)
#endif
#define MAKE_SUB_PIXEL_AVG_VAR_32XH(height, log2height) \
static int sub_pixel_avg_variance32x##height##_imp_avx2( \
const uint8_t *src, int src_stride, int x_offset, int y_offset, \
const uint8_t *dst, int dst_stride, const uint8_t *sec, int sec_stride, \
unsigned int *sse) { \
__m256i sec_reg; \
__m256i src_reg, dst_reg, exp_src_lo, exp_src_hi, exp_dst_lo, exp_dst_hi; \
__m256i sse_reg, sum_reg, sse_reg_hi, res_cmp, sum_reg_lo, sum_reg_hi; \
__m256i zero_reg; \
int i, sum; \
sum_reg = _mm256_setzero_si256(); \
sse_reg = _mm256_setzero_si256(); \
zero_reg = _mm256_setzero_si256(); \
\
/* x_offset = 0 and y_offset = 0 */ \
if (x_offset == 0) { \
if (y_offset == 0) { \
for (i = 0; i < height; i++) { \
LOAD_SRC_DST \
sec_reg = _mm256_loadu_si256((__m256i const *)(sec)); \
src_reg = _mm256_avg_epu8(src_reg, sec_reg); \
sec += sec_stride; \
/* expend each byte to 2 bytes */ \
MERGE_WITH_SRC(src_reg, zero_reg) \
CALC_SUM_SSE_INSIDE_LOOP \
src += src_stride; \
dst += dst_stride; \
} \
} else if (y_offset == 4) { \
__m256i src_next_reg; \
for (i = 0; i < height; i++) { \
LOAD_SRC_DST \
AVG_NEXT_SRC(src_reg, src_stride) \
sec_reg = _mm256_loadu_si256((__m256i const *)(sec)); \
src_reg = _mm256_avg_epu8(src_reg, sec_reg); \
sec += sec_stride; \
/* expend each byte to 2 bytes */ \
MERGE_WITH_SRC(src_reg, zero_reg) \
CALC_SUM_SSE_INSIDE_LOOP \
src += src_stride; \
dst += dst_stride; \
} \
/* x_offset = 0 and y_offset = bilin interpolation */ \
} else { \
__m256i filter, pw8, src_next_reg; \
\
y_offset <<= 5; \
filter = _mm256_load_si256( \
(__m256i const *)(bilinear_filters_avx2 + y_offset)); \
pw8 = _mm256_set1_epi16(8); \
for (i = 0; i < height; i++) { \
LOAD_SRC_DST \
MERGE_NEXT_SRC(src_reg, src_stride) \
FILTER_SRC(filter) \
src_reg = _mm256_packus_epi16(exp_src_lo, exp_src_hi); \
sec_reg = _mm256_loadu_si256((__m256i const *)(sec)); \
src_reg = _mm256_avg_epu8(src_reg, sec_reg); \
sec += sec_stride; \
MERGE_WITH_SRC(src_reg, zero_reg) \
CALC_SUM_SSE_INSIDE_LOOP \
src += src_stride; \
dst += dst_stride; \
} \
} \
/* x_offset = 4 and y_offset = 0 */ \
} else if (x_offset == 4) { \
if (y_offset == 0) { \
__m256i src_next_reg; \
for (i = 0; i < height; i++) { \
LOAD_SRC_DST \
AVG_NEXT_SRC(src_reg, 1) \
sec_reg = _mm256_loadu_si256((__m256i const *)(sec)); \
src_reg = _mm256_avg_epu8(src_reg, sec_reg); \
sec += sec_stride; \
/* expand each byte to 2 bytes */ \
MERGE_WITH_SRC(src_reg, zero_reg) \
CALC_SUM_SSE_INSIDE_LOOP \
src += src_stride; \
dst += dst_stride; \
} \
/* x_offset = 4 and y_offset = 4 */ \
} else if (y_offset == 4) { \
__m256i src_next_reg, src_avg; \
/* load source and another source starting from the next */ \
/* following byte */ \
src_reg = _mm256_loadu_si256((__m256i const *)(src)); \
AVG_NEXT_SRC(src_reg, 1) \
for (i = 0; i < height; i++) { \
/* save current source average */ \
src_avg = src_reg; \
src += src_stride; \
LOAD_SRC_DST \
AVG_NEXT_SRC(src_reg, 1) \
/* average between previous average to current average */ \
src_avg = _mm256_avg_epu8(src_avg, src_reg); \
sec_reg = _mm256_loadu_si256((__m256i const *)(sec)); \
src_avg = _mm256_avg_epu8(src_avg, sec_reg); \
sec += sec_stride; \
/* expand each byte to 2 bytes */ \
MERGE_WITH_SRC(src_avg, zero_reg) \
CALC_SUM_SSE_INSIDE_LOOP \
dst += dst_stride; \
} \
/* x_offset = 4 and y_offset = bilin interpolation */ \
} else { \
__m256i filter, pw8, src_next_reg, src_avg; \
y_offset <<= 5; \
filter = _mm256_load_si256( \
(__m256i const *)(bilinear_filters_avx2 + y_offset)); \
pw8 = _mm256_set1_epi16(8); \
/* load source and another source starting from the next */ \
/* following byte */ \
src_reg = _mm256_loadu_si256((__m256i const *)(src)); \
AVG_NEXT_SRC(src_reg, 1) \
for (i = 0; i < height; i++) { \
/* save current source average */ \
src_avg = src_reg; \
src += src_stride; \
LOAD_SRC_DST \
AVG_NEXT_SRC(src_reg, 1) \
MERGE_WITH_SRC(src_avg, src_reg) \
FILTER_SRC(filter) \
src_avg = _mm256_packus_epi16(exp_src_lo, exp_src_hi); \
sec_reg = _mm256_loadu_si256((__m256i const *)(sec)); \
src_avg = _mm256_avg_epu8(src_avg, sec_reg); \
/* expand each byte to 2 bytes */ \
MERGE_WITH_SRC(src_avg, zero_reg) \
sec += sec_stride; \
CALC_SUM_SSE_INSIDE_LOOP \
dst += dst_stride; \
} \
} \
/* x_offset = bilin interpolation and y_offset = 0 */ \
} else { \
if (y_offset == 0) { \
__m256i filter, pw8, src_next_reg; \
x_offset <<= 5; \
filter = _mm256_load_si256( \
(__m256i const *)(bilinear_filters_avx2 + x_offset)); \
pw8 = _mm256_set1_epi16(8); \
for (i = 0; i < height; i++) { \
LOAD_SRC_DST \
MERGE_NEXT_SRC(src_reg, 1) \
FILTER_SRC(filter) \
src_reg = _mm256_packus_epi16(exp_src_lo, exp_src_hi); \
sec_reg = _mm256_loadu_si256((__m256i const *)(sec)); \
src_reg = _mm256_avg_epu8(src_reg, sec_reg); \
MERGE_WITH_SRC(src_reg, zero_reg) \
sec += sec_stride; \
CALC_SUM_SSE_INSIDE_LOOP \
src += src_stride; \
dst += dst_stride; \
} \
/* x_offset = bilin interpolation and y_offset = 4 */ \
} else if (y_offset == 4) { \
__m256i filter, pw8, src_next_reg, src_pack; \
x_offset <<= 5; \
filter = _mm256_load_si256( \
(__m256i const *)(bilinear_filters_avx2 + x_offset)); \
pw8 = _mm256_set1_epi16(8); \
src_reg = _mm256_loadu_si256((__m256i const *)(src)); \
MERGE_NEXT_SRC(src_reg, 1) \
FILTER_SRC(filter) \
/* convert each 16 bit to 8 bit to each low and high lane source */ \
src_pack = _mm256_packus_epi16(exp_src_lo, exp_src_hi); \
for (i = 0; i < height; i++) { \
src += src_stride; \
LOAD_SRC_DST \
MERGE_NEXT_SRC(src_reg, 1) \
FILTER_SRC(filter) \
src_reg = _mm256_packus_epi16(exp_src_lo, exp_src_hi); \
/* average between previous pack to the current */ \
src_pack = _mm256_avg_epu8(src_pack, src_reg); \
sec_reg = _mm256_loadu_si256((__m256i const *)(sec)); \
src_pack = _mm256_avg_epu8(src_pack, sec_reg); \
sec += sec_stride; \
MERGE_WITH_SRC(src_pack, zero_reg) \
src_pack = src_reg; \
CALC_SUM_SSE_INSIDE_LOOP \
dst += dst_stride; \
} \
/* x_offset = bilin interpolation and y_offset = bilin interpolation \
*/ \
} else { \
__m256i xfilter, yfilter, pw8, src_next_reg, src_pack; \
x_offset <<= 5; \
xfilter = _mm256_load_si256( \
(__m256i const *)(bilinear_filters_avx2 + x_offset)); \
y_offset <<= 5; \
yfilter = _mm256_load_si256( \
(__m256i const *)(bilinear_filters_avx2 + y_offset)); \
pw8 = _mm256_set1_epi16(8); \
/* load source and another source starting from the next */ \
/* following byte */ \
src_reg = _mm256_loadu_si256((__m256i const *)(src)); \
MERGE_NEXT_SRC(src_reg, 1) \
\
FILTER_SRC(xfilter) \
/* convert each 16 bit to 8 bit to each low and high lane source */ \
src_pack = _mm256_packus_epi16(exp_src_lo, exp_src_hi); \
for (i = 0; i < height; i++) { \
src += src_stride; \
LOAD_SRC_DST \
MERGE_NEXT_SRC(src_reg, 1) \
FILTER_SRC(xfilter) \
src_reg = _mm256_packus_epi16(exp_src_lo, exp_src_hi); \
/* merge previous pack to current pack source */ \
MERGE_WITH_SRC(src_pack, src_reg) \
/* filter the source */ \
FILTER_SRC(yfilter) \
src_pack = _mm256_packus_epi16(exp_src_lo, exp_src_hi); \
sec_reg = _mm256_loadu_si256((__m256i const *)(sec)); \
src_pack = _mm256_avg_epu8(src_pack, sec_reg); \
MERGE_WITH_SRC(src_pack, zero_reg) \
src_pack = src_reg; \
sec += sec_stride; \
CALC_SUM_SSE_INSIDE_LOOP \
dst += dst_stride; \
} \
} \
} \
CALC_SUM_AND_SSE \
_mm256_zeroupper(); \
return sum; \
} \
unsigned int aom_sub_pixel_avg_variance32x##height##_avx2( \
const uint8_t *src, int src_stride, int x_offset, int y_offset, \
const uint8_t *dst, int dst_stride, unsigned int *sse, \
const uint8_t *sec_ptr) { \
const int sum = sub_pixel_avg_variance32x##height##_imp_avx2( \
src, src_stride, x_offset, y_offset, dst, dst_stride, sec_ptr, 32, \
sse); \
return *sse - (unsigned int)(((int64_t)sum * sum) >> (5 + log2height)); \
}
MAKE_SUB_PIXEL_AVG_VAR_32XH(64, 6)
MAKE_SUB_PIXEL_AVG_VAR_32XH(32, 5)
MAKE_SUB_PIXEL_AVG_VAR_32XH(16, 4)
#define AOM_SUB_PIXEL_AVG_VAR_AVX2(w, h, wf, hf, wlog2, hlog2) \
unsigned int aom_sub_pixel_avg_variance##w##x##h##_avx2( \
const uint8_t *src, int src_stride, int x_offset, int y_offset, \
const uint8_t *dst, int dst_stride, unsigned int *sse_ptr, \
const uint8_t *sec) { \
unsigned int sse = 0; \
int se = 0; \
for (int i = 0; i < (w / wf); ++i) { \
const uint8_t *src_ptr = src; \
const uint8_t *dst_ptr = dst; \
const uint8_t *sec_ptr = sec; \
for (int j = 0; j < (h / hf); ++j) { \
unsigned int sse2; \
const int se2 = sub_pixel_avg_variance##wf##x##hf##_imp_avx2( \
src_ptr, src_stride, x_offset, y_offset, dst_ptr, dst_stride, \
sec_ptr, w, &sse2); \
dst_ptr += hf * dst_stride; \
src_ptr += hf * src_stride; \
sec_ptr += hf * w; \
se += se2; \
sse += sse2; \
} \
src += wf; \
dst += wf; \
sec += wf; \
} \
*sse_ptr = sse; \
return sse - (unsigned int)(((int64_t)se * se) >> (wlog2 + hlog2)); \
}
// Note: hf = AOMMIN(h, 64) to avoid overflow in helper by capping height.
AOM_SUB_PIXEL_AVG_VAR_AVX2(128, 128, 32, 64, 7, 7)
AOM_SUB_PIXEL_AVG_VAR_AVX2(128, 64, 32, 64, 7, 6)
AOM_SUB_PIXEL_AVG_VAR_AVX2(64, 128, 32, 64, 6, 7)
AOM_SUB_PIXEL_AVG_VAR_AVX2(64, 64, 32, 64, 6, 6)
AOM_SUB_PIXEL_AVG_VAR_AVX2(64, 32, 32, 32, 6, 5)