| /* | |
| * 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 <stdio.h> | |
| #include <tmmintrin.h> | |
| #include "config/aom_config.h" | |
| #include "config/aom_dsp_rtcd.h" | |
| #include "aom_dsp/blend.h" | |
| #include "aom/aom_integer.h" | |
| #include "aom_dsp/x86/synonyms.h" | |
| #include "aom_dsp/x86/masked_sad_intrin_ssse3.h" | |
| // For width a multiple of 16 | |
| static INLINE unsigned int masked_sad_ssse3(const uint8_t *src_ptr, | |
| int src_stride, | |
| const uint8_t *a_ptr, int a_stride, | |
| const uint8_t *b_ptr, int b_stride, | |
| const uint8_t *m_ptr, int m_stride, | |
| int width, int height); | |
| #define MASKSADMXN_SSSE3(m, n) \ | |
| unsigned int aom_masked_sad##m##x##n##_ssse3( \ | |
| const uint8_t *src, int src_stride, const uint8_t *ref, int ref_stride, \ | |
| const uint8_t *second_pred, const uint8_t *msk, int msk_stride, \ | |
| int invert_mask) { \ | |
| if (!invert_mask) \ | |
| return masked_sad_ssse3(src, src_stride, ref, ref_stride, second_pred, \ | |
| m, msk, msk_stride, m, n); \ | |
| else \ | |
| return masked_sad_ssse3(src, src_stride, second_pred, m, ref, \ | |
| ref_stride, msk, msk_stride, m, n); \ | |
| } | |
| #define MASKSAD8XN_SSSE3(n) \ | |
| unsigned int aom_masked_sad8x##n##_ssse3( \ | |
| const uint8_t *src, int src_stride, const uint8_t *ref, int ref_stride, \ | |
| const uint8_t *second_pred, const uint8_t *msk, int msk_stride, \ | |
| int invert_mask) { \ | |
| if (!invert_mask) \ | |
| return aom_masked_sad8xh_ssse3(src, src_stride, ref, ref_stride, \ | |
| second_pred, 8, msk, msk_stride, n); \ | |
| else \ | |
| return aom_masked_sad8xh_ssse3(src, src_stride, second_pred, 8, ref, \ | |
| ref_stride, msk, msk_stride, n); \ | |
| } | |
| #define MASKSAD4XN_SSSE3(n) \ | |
| unsigned int aom_masked_sad4x##n##_ssse3( \ | |
| const uint8_t *src, int src_stride, const uint8_t *ref, int ref_stride, \ | |
| const uint8_t *second_pred, const uint8_t *msk, int msk_stride, \ | |
| int invert_mask) { \ | |
| if (!invert_mask) \ | |
| return aom_masked_sad4xh_ssse3(src, src_stride, ref, ref_stride, \ | |
| second_pred, 4, msk, msk_stride, n); \ | |
| else \ | |
| return aom_masked_sad4xh_ssse3(src, src_stride, second_pred, 4, ref, \ | |
| ref_stride, msk, msk_stride, n); \ | |
| } | |
| MASKSADMXN_SSSE3(128, 128) | |
| MASKSADMXN_SSSE3(128, 64) | |
| MASKSADMXN_SSSE3(64, 128) | |
| MASKSADMXN_SSSE3(64, 64) | |
| MASKSADMXN_SSSE3(64, 32) | |
| MASKSADMXN_SSSE3(32, 64) | |
| MASKSADMXN_SSSE3(32, 32) | |
| MASKSADMXN_SSSE3(32, 16) | |
| MASKSADMXN_SSSE3(16, 32) | |
| MASKSADMXN_SSSE3(16, 16) | |
| MASKSADMXN_SSSE3(16, 8) | |
| MASKSAD8XN_SSSE3(16) | |
| MASKSAD8XN_SSSE3(8) | |
| MASKSAD8XN_SSSE3(4) | |
| MASKSAD4XN_SSSE3(8) | |
| MASKSAD4XN_SSSE3(4) | |
| MASKSAD4XN_SSSE3(16) | |
| MASKSADMXN_SSSE3(16, 4) | |
| MASKSAD8XN_SSSE3(32) | |
| MASKSADMXN_SSSE3(32, 8) | |
| MASKSADMXN_SSSE3(16, 64) | |
| MASKSADMXN_SSSE3(64, 16) | |
| #if CONFIG_FLEX_PARTITION | |
| MASKSAD4XN_SSSE3(32) | |
| MASKSADMXN_SSSE3(32, 4) | |
| MASKSAD8XN_SSSE3(64) | |
| MASKSADMXN_SSSE3(64, 8) | |
| MASKSAD4XN_SSSE3(64) | |
| MASKSADMXN_SSSE3(64, 4) | |
| #endif // CONFIG_FLEX_PARTITION | |
| static INLINE unsigned int masked_sad_ssse3(const uint8_t *src_ptr, | |
| int src_stride, | |
| const uint8_t *a_ptr, int a_stride, | |
| const uint8_t *b_ptr, int b_stride, | |
| const uint8_t *m_ptr, int m_stride, | |
| int width, int height) { | |
| int x, y; | |
| __m128i res = _mm_setzero_si128(); | |
| const __m128i mask_max = _mm_set1_epi8((1 << AOM_BLEND_A64_ROUND_BITS)); | |
| for (y = 0; y < height; y++) { | |
| for (x = 0; x < width; x += 16) { | |
| const __m128i src = _mm_loadu_si128((const __m128i *)&src_ptr[x]); | |
| const __m128i a = _mm_loadu_si128((const __m128i *)&a_ptr[x]); | |
| const __m128i b = _mm_loadu_si128((const __m128i *)&b_ptr[x]); | |
| const __m128i m = _mm_loadu_si128((const __m128i *)&m_ptr[x]); | |
| const __m128i m_inv = _mm_sub_epi8(mask_max, m); | |
| // Calculate 16 predicted pixels. | |
| // Note that the maximum value of any entry of 'pred_l' or 'pred_r' | |
| // is 64 * 255, so we have plenty of space to add rounding constants. | |
| const __m128i data_l = _mm_unpacklo_epi8(a, b); | |
| const __m128i mask_l = _mm_unpacklo_epi8(m, m_inv); | |
| __m128i pred_l = _mm_maddubs_epi16(data_l, mask_l); | |
| pred_l = xx_roundn_epu16(pred_l, AOM_BLEND_A64_ROUND_BITS); | |
| const __m128i data_r = _mm_unpackhi_epi8(a, b); | |
| const __m128i mask_r = _mm_unpackhi_epi8(m, m_inv); | |
| __m128i pred_r = _mm_maddubs_epi16(data_r, mask_r); | |
| pred_r = xx_roundn_epu16(pred_r, AOM_BLEND_A64_ROUND_BITS); | |
| const __m128i pred = _mm_packus_epi16(pred_l, pred_r); | |
| res = _mm_add_epi32(res, _mm_sad_epu8(pred, src)); | |
| } | |
| src_ptr += src_stride; | |
| a_ptr += a_stride; | |
| b_ptr += b_stride; | |
| m_ptr += m_stride; | |
| } | |
| // At this point, we have two 32-bit partial SADs in lanes 0 and 2 of 'res'. | |
| int32_t sad = | |
| _mm_cvtsi128_si32(res) + _mm_cvtsi128_si32(_mm_srli_si128(res, 8)); | |
| return sad; | |
| } | |
| unsigned int aom_masked_sad8xh_ssse3(const uint8_t *src_ptr, int src_stride, | |
| const uint8_t *a_ptr, int a_stride, | |
| const uint8_t *b_ptr, int b_stride, | |
| const uint8_t *m_ptr, int m_stride, | |
| int height) { | |
| int y; | |
| __m128i res = _mm_setzero_si128(); | |
| const __m128i mask_max = _mm_set1_epi8((1 << AOM_BLEND_A64_ROUND_BITS)); | |
| for (y = 0; y < height; y += 2) { | |
| const __m128i src = _mm_unpacklo_epi64( | |
| _mm_loadl_epi64((const __m128i *)src_ptr), | |
| _mm_loadl_epi64((const __m128i *)&src_ptr[src_stride])); | |
| const __m128i a0 = _mm_loadl_epi64((const __m128i *)a_ptr); | |
| const __m128i a1 = _mm_loadl_epi64((const __m128i *)&a_ptr[a_stride]); | |
| const __m128i b0 = _mm_loadl_epi64((const __m128i *)b_ptr); | |
| const __m128i b1 = _mm_loadl_epi64((const __m128i *)&b_ptr[b_stride]); | |
| const __m128i m = | |
| _mm_unpacklo_epi64(_mm_loadl_epi64((const __m128i *)m_ptr), | |
| _mm_loadl_epi64((const __m128i *)&m_ptr[m_stride])); | |
| const __m128i m_inv = _mm_sub_epi8(mask_max, m); | |
| const __m128i data_l = _mm_unpacklo_epi8(a0, b0); | |
| const __m128i mask_l = _mm_unpacklo_epi8(m, m_inv); | |
| __m128i pred_l = _mm_maddubs_epi16(data_l, mask_l); | |
| pred_l = xx_roundn_epu16(pred_l, AOM_BLEND_A64_ROUND_BITS); | |
| const __m128i data_r = _mm_unpacklo_epi8(a1, b1); | |
| const __m128i mask_r = _mm_unpackhi_epi8(m, m_inv); | |
| __m128i pred_r = _mm_maddubs_epi16(data_r, mask_r); | |
| pred_r = xx_roundn_epu16(pred_r, AOM_BLEND_A64_ROUND_BITS); | |
| const __m128i pred = _mm_packus_epi16(pred_l, pred_r); | |
| res = _mm_add_epi32(res, _mm_sad_epu8(pred, src)); | |
| src_ptr += src_stride * 2; | |
| a_ptr += a_stride * 2; | |
| b_ptr += b_stride * 2; | |
| m_ptr += m_stride * 2; | |
| } | |
| int32_t sad = | |
| _mm_cvtsi128_si32(res) + _mm_cvtsi128_si32(_mm_srli_si128(res, 8)); | |
| return sad; | |
| } | |
| unsigned int aom_masked_sad4xh_ssse3(const uint8_t *src_ptr, int src_stride, | |
| const uint8_t *a_ptr, int a_stride, | |
| const uint8_t *b_ptr, int b_stride, | |
| const uint8_t *m_ptr, int m_stride, | |
| int height) { | |
| int y; | |
| __m128i res = _mm_setzero_si128(); | |
| const __m128i mask_max = _mm_set1_epi8((1 << AOM_BLEND_A64_ROUND_BITS)); | |
| for (y = 0; y < height; y += 2) { | |
| // Load two rows at a time, this seems to be a bit faster | |
| // than four rows at a time in this case. | |
| const __m128i src = _mm_unpacklo_epi32( | |
| _mm_cvtsi32_si128(*(uint32_t *)src_ptr), | |
| _mm_cvtsi32_si128(*(uint32_t *)&src_ptr[src_stride])); | |
| const __m128i a = | |
| _mm_unpacklo_epi32(_mm_cvtsi32_si128(*(uint32_t *)a_ptr), | |
| _mm_cvtsi32_si128(*(uint32_t *)&a_ptr[a_stride])); | |
| const __m128i b = | |
| _mm_unpacklo_epi32(_mm_cvtsi32_si128(*(uint32_t *)b_ptr), | |
| _mm_cvtsi32_si128(*(uint32_t *)&b_ptr[b_stride])); | |
| const __m128i m = | |
| _mm_unpacklo_epi32(_mm_cvtsi32_si128(*(uint32_t *)m_ptr), | |
| _mm_cvtsi32_si128(*(uint32_t *)&m_ptr[m_stride])); | |
| const __m128i m_inv = _mm_sub_epi8(mask_max, m); | |
| const __m128i data = _mm_unpacklo_epi8(a, b); | |
| const __m128i mask = _mm_unpacklo_epi8(m, m_inv); | |
| __m128i pred_16bit = _mm_maddubs_epi16(data, mask); | |
| pred_16bit = xx_roundn_epu16(pred_16bit, AOM_BLEND_A64_ROUND_BITS); | |
| const __m128i pred = _mm_packus_epi16(pred_16bit, _mm_setzero_si128()); | |
| res = _mm_add_epi32(res, _mm_sad_epu8(pred, src)); | |
| src_ptr += src_stride * 2; | |
| a_ptr += a_stride * 2; | |
| b_ptr += b_stride * 2; | |
| m_ptr += m_stride * 2; | |
| } | |
| // At this point, the SAD is stored in lane 0 of 'res' | |
| int32_t sad = _mm_cvtsi128_si32(res); | |
| return sad; | |
| } | |
| // For width a multiple of 8 | |
| static INLINE unsigned int highbd_masked_sad_ssse3( | |
| const uint16_t *src, int src_stride, const uint16_t *a, int a_stride, | |
| const uint16_t *b, int b_stride, const uint8_t *m_ptr, int m_stride, | |
| int width, int height); | |
| #define HIGHBD_MASKSADMXN_SSSE3(m, n) \ | |
| unsigned int aom_highbd_masked_sad##m##x##n##_ssse3( \ | |
| const uint16_t *src, int src_stride, const uint16_t *ref, \ | |
| int ref_stride, const uint16_t *second_pred, const uint8_t *msk, \ | |
| int msk_stride, int invert_mask) { \ | |
| if (!invert_mask) \ | |
| return highbd_masked_sad_ssse3(src, src_stride, ref, ref_stride, \ | |
| second_pred, m, msk, msk_stride, m, n); \ | |
| else \ | |
| return highbd_masked_sad_ssse3(src, src_stride, second_pred, m, ref, \ | |
| ref_stride, msk, msk_stride, m, n); \ | |
| } | |
| #define HIGHBD_MASKSAD4XN_SSSE3(n) \ | |
| unsigned int aom_highbd_masked_sad4x##n##_ssse3( \ | |
| const uint16_t *src, int src_stride, const uint16_t *ref, \ | |
| int ref_stride, const uint16_t *second_pred, const uint8_t *msk, \ | |
| int msk_stride, int invert_mask) { \ | |
| if (!invert_mask) \ | |
| return aom_highbd_masked_sad4xh_ssse3(src, src_stride, ref, ref_stride, \ | |
| second_pred, 4, msk, msk_stride, \ | |
| n); \ | |
| else \ | |
| return aom_highbd_masked_sad4xh_ssse3(src, src_stride, second_pred, 4, \ | |
| ref, ref_stride, msk, msk_stride, \ | |
| n); \ | |
| } | |
| HIGHBD_MASKSADMXN_SSSE3(128, 128) | |
| HIGHBD_MASKSADMXN_SSSE3(128, 64) | |
| HIGHBD_MASKSADMXN_SSSE3(64, 128) | |
| HIGHBD_MASKSADMXN_SSSE3(64, 64) | |
| HIGHBD_MASKSADMXN_SSSE3(64, 32) | |
| HIGHBD_MASKSADMXN_SSSE3(32, 64) | |
| HIGHBD_MASKSADMXN_SSSE3(32, 32) | |
| HIGHBD_MASKSADMXN_SSSE3(32, 16) | |
| HIGHBD_MASKSADMXN_SSSE3(16, 32) | |
| HIGHBD_MASKSADMXN_SSSE3(16, 16) | |
| HIGHBD_MASKSADMXN_SSSE3(16, 8) | |
| HIGHBD_MASKSADMXN_SSSE3(8, 16) | |
| HIGHBD_MASKSADMXN_SSSE3(8, 8) | |
| HIGHBD_MASKSADMXN_SSSE3(8, 4) | |
| HIGHBD_MASKSAD4XN_SSSE3(8) | |
| HIGHBD_MASKSAD4XN_SSSE3(4) | |
| HIGHBD_MASKSAD4XN_SSSE3(16) | |
| HIGHBD_MASKSADMXN_SSSE3(16, 4) | |
| HIGHBD_MASKSADMXN_SSSE3(8, 32) | |
| HIGHBD_MASKSADMXN_SSSE3(32, 8) | |
| HIGHBD_MASKSADMXN_SSSE3(16, 64) | |
| HIGHBD_MASKSADMXN_SSSE3(64, 16) | |
| #if CONFIG_FLEX_PARTITION | |
| HIGHBD_MASKSAD4XN_SSSE3(32) | |
| HIGHBD_MASKSADMXN_SSSE3(32, 4) | |
| HIGHBD_MASKSADMXN_SSSE3(8, 64) | |
| HIGHBD_MASKSADMXN_SSSE3(64, 8) | |
| HIGHBD_MASKSAD4XN_SSSE3(64) | |
| HIGHBD_MASKSADMXN_SSSE3(64, 4) | |
| #endif // CONFIG_FLEX_PARTITION | |
| static INLINE unsigned int highbd_masked_sad_ssse3( | |
| const uint16_t *src_ptr, int src_stride, const uint16_t *a_ptr, | |
| int a_stride, const uint16_t *b_ptr, int b_stride, const uint8_t *m_ptr, | |
| int m_stride, int width, int height) { | |
| int x, y; | |
| __m128i res = _mm_setzero_si128(); | |
| const __m128i mask_max = _mm_set1_epi16((1 << AOM_BLEND_A64_ROUND_BITS)); | |
| const __m128i round_const = | |
| _mm_set1_epi32((1 << AOM_BLEND_A64_ROUND_BITS) >> 1); | |
| const __m128i one = _mm_set1_epi16(1); | |
| for (y = 0; y < height; y++) { | |
| for (x = 0; x < width; x += 8) { | |
| const __m128i src = _mm_loadu_si128((const __m128i *)&src_ptr[x]); | |
| const __m128i a = _mm_loadu_si128((const __m128i *)&a_ptr[x]); | |
| const __m128i b = _mm_loadu_si128((const __m128i *)&b_ptr[x]); | |
| // Zero-extend mask to 16 bits | |
| const __m128i m = _mm_unpacklo_epi8( | |
| _mm_loadl_epi64((const __m128i *)&m_ptr[x]), _mm_setzero_si128()); | |
| const __m128i m_inv = _mm_sub_epi16(mask_max, m); | |
| const __m128i data_l = _mm_unpacklo_epi16(a, b); | |
| const __m128i mask_l = _mm_unpacklo_epi16(m, m_inv); | |
| __m128i pred_l = _mm_madd_epi16(data_l, mask_l); | |
| pred_l = _mm_srai_epi32(_mm_add_epi32(pred_l, round_const), | |
| AOM_BLEND_A64_ROUND_BITS); | |
| const __m128i data_r = _mm_unpackhi_epi16(a, b); | |
| const __m128i mask_r = _mm_unpackhi_epi16(m, m_inv); | |
| __m128i pred_r = _mm_madd_epi16(data_r, mask_r); | |
| pred_r = _mm_srai_epi32(_mm_add_epi32(pred_r, round_const), | |
| AOM_BLEND_A64_ROUND_BITS); | |
| // Note: the maximum value in pred_l/r is (2^bd)-1 < 2^15, | |
| // so it is safe to do signed saturation here. | |
| const __m128i pred = _mm_packs_epi32(pred_l, pred_r); | |
| // There is no 16-bit SAD instruction, so we have to synthesize | |
| // an 8-element SAD. We do this by storing 4 32-bit partial SADs, | |
| // and accumulating them at the end | |
| const __m128i diff = _mm_abs_epi16(_mm_sub_epi16(pred, src)); | |
| res = _mm_add_epi32(res, _mm_madd_epi16(diff, one)); | |
| } | |
| src_ptr += src_stride; | |
| a_ptr += a_stride; | |
| b_ptr += b_stride; | |
| m_ptr += m_stride; | |
| } | |
| // At this point, we have four 32-bit partial SADs stored in 'res'. | |
| res = _mm_hadd_epi32(res, res); | |
| res = _mm_hadd_epi32(res, res); | |
| int sad = _mm_cvtsi128_si32(res); | |
| return sad; | |
| } | |
| unsigned int aom_highbd_masked_sad4xh_ssse3(const uint16_t *src_ptr, | |
| int src_stride, | |
| const uint16_t *a_ptr, int a_stride, | |
| const uint16_t *b_ptr, int b_stride, | |
| const uint8_t *m_ptr, int m_stride, | |
| int height) { | |
| int y; | |
| __m128i res = _mm_setzero_si128(); | |
| const __m128i mask_max = _mm_set1_epi16((1 << AOM_BLEND_A64_ROUND_BITS)); | |
| const __m128i round_const = | |
| _mm_set1_epi32((1 << AOM_BLEND_A64_ROUND_BITS) >> 1); | |
| const __m128i one = _mm_set1_epi16(1); | |
| for (y = 0; y < height; y += 2) { | |
| const __m128i src = _mm_unpacklo_epi64( | |
| _mm_loadl_epi64((const __m128i *)src_ptr), | |
| _mm_loadl_epi64((const __m128i *)&src_ptr[src_stride])); | |
| const __m128i a = | |
| _mm_unpacklo_epi64(_mm_loadl_epi64((const __m128i *)a_ptr), | |
| _mm_loadl_epi64((const __m128i *)&a_ptr[a_stride])); | |
| const __m128i b = | |
| _mm_unpacklo_epi64(_mm_loadl_epi64((const __m128i *)b_ptr), | |
| _mm_loadl_epi64((const __m128i *)&b_ptr[b_stride])); | |
| // Zero-extend mask to 16 bits | |
| const __m128i m = _mm_unpacklo_epi8( | |
| _mm_unpacklo_epi32( | |
| _mm_cvtsi32_si128(*(const uint32_t *)m_ptr), | |
| _mm_cvtsi32_si128(*(const uint32_t *)&m_ptr[m_stride])), | |
| _mm_setzero_si128()); | |
| const __m128i m_inv = _mm_sub_epi16(mask_max, m); | |
| const __m128i data_l = _mm_unpacklo_epi16(a, b); | |
| const __m128i mask_l = _mm_unpacklo_epi16(m, m_inv); | |
| __m128i pred_l = _mm_madd_epi16(data_l, mask_l); | |
| pred_l = _mm_srai_epi32(_mm_add_epi32(pred_l, round_const), | |
| AOM_BLEND_A64_ROUND_BITS); | |
| const __m128i data_r = _mm_unpackhi_epi16(a, b); | |
| const __m128i mask_r = _mm_unpackhi_epi16(m, m_inv); | |
| __m128i pred_r = _mm_madd_epi16(data_r, mask_r); | |
| pred_r = _mm_srai_epi32(_mm_add_epi32(pred_r, round_const), | |
| AOM_BLEND_A64_ROUND_BITS); | |
| const __m128i pred = _mm_packs_epi32(pred_l, pred_r); | |
| const __m128i diff = _mm_abs_epi16(_mm_sub_epi16(pred, src)); | |
| res = _mm_add_epi32(res, _mm_madd_epi16(diff, one)); | |
| src_ptr += src_stride * 2; | |
| a_ptr += a_stride * 2; | |
| b_ptr += b_stride * 2; | |
| m_ptr += m_stride * 2; | |
| } | |
| res = _mm_hadd_epi32(res, res); | |
| res = _mm_hadd_epi32(res, res); | |
| int sad = _mm_cvtsi128_si32(res); | |
| return sad; | |
| } |