|  | /* | 
|  | * 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 <arm_neon.h> | 
|  |  | 
|  | #include "config/aom_config.h" | 
|  | #include "config/aom_dsp_rtcd.h" | 
|  |  | 
|  | #include "aom/aom_integer.h" | 
|  | #include "aom_dsp/arm/mem_neon.h" | 
|  | #include "aom_dsp/arm/sum_neon.h" | 
|  |  | 
|  | static inline void highbd_obmc_variance_8x1_s16_neon(uint16x8_t pre, | 
|  | const int32_t *wsrc, | 
|  | const int32_t *mask, | 
|  | uint32x4_t *sse, | 
|  | int32x4_t *sum) { | 
|  | int16x8_t pre_s16 = vreinterpretq_s16_u16(pre); | 
|  | int32x4_t wsrc_lo = vld1q_s32(&wsrc[0]); | 
|  | int32x4_t wsrc_hi = vld1q_s32(&wsrc[4]); | 
|  |  | 
|  | int32x4_t mask_lo = vld1q_s32(&mask[0]); | 
|  | int32x4_t mask_hi = vld1q_s32(&mask[4]); | 
|  |  | 
|  | int16x8_t mask_s16 = vcombine_s16(vmovn_s32(mask_lo), vmovn_s32(mask_hi)); | 
|  |  | 
|  | int32x4_t diff_lo = vmull_s16(vget_low_s16(pre_s16), vget_low_s16(mask_s16)); | 
|  | int32x4_t diff_hi = | 
|  | vmull_s16(vget_high_s16(pre_s16), vget_high_s16(mask_s16)); | 
|  |  | 
|  | diff_lo = vsubq_s32(wsrc_lo, diff_lo); | 
|  | diff_hi = vsubq_s32(wsrc_hi, diff_hi); | 
|  |  | 
|  | // ROUND_POWER_OF_TWO_SIGNED(value, 12) rounds to nearest with ties away | 
|  | // from zero, however vrshrq_n_s32 rounds to nearest with ties rounded up. | 
|  | // This difference only affects the bit patterns at the rounding breakpoints | 
|  | // exactly, so we can add -1 to all negative numbers to move the breakpoint | 
|  | // one value across and into the correct rounding region. | 
|  | diff_lo = vsraq_n_s32(diff_lo, diff_lo, 31); | 
|  | diff_hi = vsraq_n_s32(diff_hi, diff_hi, 31); | 
|  | int32x4_t round_lo = vrshrq_n_s32(diff_lo, 12); | 
|  | int32x4_t round_hi = vrshrq_n_s32(diff_hi, 12); | 
|  |  | 
|  | *sum = vaddq_s32(*sum, round_lo); | 
|  | *sum = vaddq_s32(*sum, round_hi); | 
|  | *sse = vmlaq_u32(*sse, vreinterpretq_u32_s32(round_lo), | 
|  | vreinterpretq_u32_s32(round_lo)); | 
|  | *sse = vmlaq_u32(*sse, vreinterpretq_u32_s32(round_hi), | 
|  | vreinterpretq_u32_s32(round_hi)); | 
|  | } | 
|  |  | 
|  | // For 12-bit data, we can only accumulate up to 256 elements in the unsigned | 
|  | // 32-bit elements (4095*4095*256 = 4292870400) before we have to accumulate | 
|  | // into 64-bit elements. Therefore blocks of size 32x64, 64x32, 64x64, 64x128, | 
|  | // 128x64, 128x128 are processed in a different helper function. | 
|  | static inline void highbd_obmc_variance_xlarge_neon( | 
|  | const uint8_t *pre, int pre_stride, const int32_t *wsrc, | 
|  | const int32_t *mask, int width, int h, int h_limit, uint64_t *sse, | 
|  | int64_t *sum) { | 
|  | uint16_t *pre_ptr = CONVERT_TO_SHORTPTR(pre); | 
|  | int32x4_t sum_s32 = vdupq_n_s32(0); | 
|  | uint64x2_t sse_u64 = vdupq_n_u64(0); | 
|  |  | 
|  | // 'h_limit' is the number of 'w'-width rows we can process before our 32-bit | 
|  | // accumulator overflows. After hitting this limit we accumulate into 64-bit | 
|  | // elements. | 
|  | int h_tmp = h > h_limit ? h_limit : h; | 
|  |  | 
|  | do { | 
|  | uint32x4_t sse_u32[2] = { vdupq_n_u32(0), vdupq_n_u32(0) }; | 
|  | int j = 0; | 
|  |  | 
|  | do { | 
|  | int i = 0; | 
|  |  | 
|  | do { | 
|  | uint16x8_t pre0 = vld1q_u16(pre_ptr + i); | 
|  | highbd_obmc_variance_8x1_s16_neon(pre0, wsrc, mask, &sse_u32[0], | 
|  | &sum_s32); | 
|  |  | 
|  | uint16x8_t pre1 = vld1q_u16(pre_ptr + i + 8); | 
|  | highbd_obmc_variance_8x1_s16_neon(pre1, wsrc + 8, mask + 8, &sse_u32[1], | 
|  | &sum_s32); | 
|  |  | 
|  | i += 16; | 
|  | wsrc += 16; | 
|  | mask += 16; | 
|  | } while (i < width); | 
|  |  | 
|  | pre_ptr += pre_stride; | 
|  | j++; | 
|  | } while (j < h_tmp); | 
|  |  | 
|  | sse_u64 = vpadalq_u32(sse_u64, sse_u32[0]); | 
|  | sse_u64 = vpadalq_u32(sse_u64, sse_u32[1]); | 
|  | h -= h_tmp; | 
|  | } while (h != 0); | 
|  |  | 
|  | *sse = horizontal_add_u64x2(sse_u64); | 
|  | *sum = horizontal_long_add_s32x4(sum_s32); | 
|  | } | 
|  |  | 
|  | static inline void highbd_obmc_variance_xlarge_neon_128xh( | 
|  | const uint8_t *pre, int pre_stride, const int32_t *wsrc, | 
|  | const int32_t *mask, int h, uint64_t *sse, int64_t *sum) { | 
|  | highbd_obmc_variance_xlarge_neon(pre, pre_stride, wsrc, mask, 128, h, 16, sse, | 
|  | sum); | 
|  | } | 
|  |  | 
|  | static inline void highbd_obmc_variance_xlarge_neon_64xh( | 
|  | const uint8_t *pre, int pre_stride, const int32_t *wsrc, | 
|  | const int32_t *mask, int h, uint64_t *sse, int64_t *sum) { | 
|  | highbd_obmc_variance_xlarge_neon(pre, pre_stride, wsrc, mask, 64, h, 32, sse, | 
|  | sum); | 
|  | } | 
|  |  | 
|  | static inline void highbd_obmc_variance_xlarge_neon_32xh( | 
|  | const uint8_t *pre, int pre_stride, const int32_t *wsrc, | 
|  | const int32_t *mask, int h, uint64_t *sse, int64_t *sum) { | 
|  | highbd_obmc_variance_xlarge_neon(pre, pre_stride, wsrc, mask, 32, h, 64, sse, | 
|  | sum); | 
|  | } | 
|  |  | 
|  | static inline void highbd_obmc_variance_large_neon( | 
|  | const uint8_t *pre, int pre_stride, const int32_t *wsrc, | 
|  | const int32_t *mask, int width, int h, uint64_t *sse, int64_t *sum) { | 
|  | uint16_t *pre_ptr = CONVERT_TO_SHORTPTR(pre); | 
|  | uint32x4_t sse_u32 = vdupq_n_u32(0); | 
|  | int32x4_t sum_s32 = vdupq_n_s32(0); | 
|  |  | 
|  | do { | 
|  | int i = 0; | 
|  | do { | 
|  | uint16x8_t pre0 = vld1q_u16(pre_ptr + i); | 
|  | highbd_obmc_variance_8x1_s16_neon(pre0, wsrc, mask, &sse_u32, &sum_s32); | 
|  |  | 
|  | uint16x8_t pre1 = vld1q_u16(pre_ptr + i + 8); | 
|  | highbd_obmc_variance_8x1_s16_neon(pre1, wsrc + 8, mask + 8, &sse_u32, | 
|  | &sum_s32); | 
|  |  | 
|  | i += 16; | 
|  | wsrc += 16; | 
|  | mask += 16; | 
|  | } while (i < width); | 
|  |  | 
|  | pre_ptr += pre_stride; | 
|  | } while (--h != 0); | 
|  |  | 
|  | *sse = horizontal_long_add_u32x4(sse_u32); | 
|  | *sum = horizontal_long_add_s32x4(sum_s32); | 
|  | } | 
|  |  | 
|  | static inline void highbd_obmc_variance_neon_128xh( | 
|  | const uint8_t *pre, int pre_stride, const int32_t *wsrc, | 
|  | const int32_t *mask, int h, uint64_t *sse, int64_t *sum) { | 
|  | highbd_obmc_variance_large_neon(pre, pre_stride, wsrc, mask, 128, h, sse, | 
|  | sum); | 
|  | } | 
|  |  | 
|  | static inline void highbd_obmc_variance_neon_64xh(const uint8_t *pre, | 
|  | int pre_stride, | 
|  | const int32_t *wsrc, | 
|  | const int32_t *mask, int h, | 
|  | uint64_t *sse, int64_t *sum) { | 
|  | highbd_obmc_variance_large_neon(pre, pre_stride, wsrc, mask, 64, h, sse, sum); | 
|  | } | 
|  |  | 
|  | static inline void highbd_obmc_variance_neon_32xh(const uint8_t *pre, | 
|  | int pre_stride, | 
|  | const int32_t *wsrc, | 
|  | const int32_t *mask, int h, | 
|  | uint64_t *sse, int64_t *sum) { | 
|  | highbd_obmc_variance_large_neon(pre, pre_stride, wsrc, mask, 32, h, sse, sum); | 
|  | } | 
|  |  | 
|  | static inline void highbd_obmc_variance_neon_16xh(const uint8_t *pre, | 
|  | int pre_stride, | 
|  | const int32_t *wsrc, | 
|  | const int32_t *mask, int h, | 
|  | uint64_t *sse, int64_t *sum) { | 
|  | highbd_obmc_variance_large_neon(pre, pre_stride, wsrc, mask, 16, h, sse, sum); | 
|  | } | 
|  |  | 
|  | static inline void highbd_obmc_variance_neon_8xh(const uint8_t *pre8, | 
|  | int pre_stride, | 
|  | const int32_t *wsrc, | 
|  | const int32_t *mask, int h, | 
|  | uint64_t *sse, int64_t *sum) { | 
|  | uint16_t *pre = CONVERT_TO_SHORTPTR(pre8); | 
|  | uint32x4_t sse_u32 = vdupq_n_u32(0); | 
|  | int32x4_t sum_s32 = vdupq_n_s32(0); | 
|  |  | 
|  | do { | 
|  | uint16x8_t pre_u16 = vld1q_u16(pre); | 
|  |  | 
|  | highbd_obmc_variance_8x1_s16_neon(pre_u16, wsrc, mask, &sse_u32, &sum_s32); | 
|  |  | 
|  | pre += pre_stride; | 
|  | wsrc += 8; | 
|  | mask += 8; | 
|  | } while (--h != 0); | 
|  |  | 
|  | *sse = horizontal_long_add_u32x4(sse_u32); | 
|  | *sum = horizontal_long_add_s32x4(sum_s32); | 
|  | } | 
|  |  | 
|  | static inline void highbd_obmc_variance_neon_4xh(const uint8_t *pre8, | 
|  | int pre_stride, | 
|  | const int32_t *wsrc, | 
|  | const int32_t *mask, int h, | 
|  | uint64_t *sse, int64_t *sum) { | 
|  | assert(h % 2 == 0); | 
|  | uint16_t *pre = CONVERT_TO_SHORTPTR(pre8); | 
|  | uint32x4_t sse_u32 = vdupq_n_u32(0); | 
|  | int32x4_t sum_s32 = vdupq_n_s32(0); | 
|  |  | 
|  | do { | 
|  | uint16x8_t pre_u16 = load_unaligned_u16_4x2(pre, pre_stride); | 
|  |  | 
|  | highbd_obmc_variance_8x1_s16_neon(pre_u16, wsrc, mask, &sse_u32, &sum_s32); | 
|  |  | 
|  | pre += 2 * pre_stride; | 
|  | wsrc += 8; | 
|  | mask += 8; | 
|  | h -= 2; | 
|  | } while (h != 0); | 
|  |  | 
|  | *sse = horizontal_long_add_u32x4(sse_u32); | 
|  | *sum = horizontal_long_add_s32x4(sum_s32); | 
|  | } | 
|  |  | 
|  | static inline void highbd_8_obmc_variance_cast(int64_t sum64, uint64_t sse64, | 
|  | int *sum, unsigned int *sse) { | 
|  | *sum = (int)sum64; | 
|  | *sse = (unsigned int)sse64; | 
|  | } | 
|  |  | 
|  | static inline void highbd_10_obmc_variance_cast(int64_t sum64, uint64_t sse64, | 
|  | int *sum, unsigned int *sse) { | 
|  | *sum = (int)ROUND_POWER_OF_TWO(sum64, 2); | 
|  | *sse = (unsigned int)ROUND_POWER_OF_TWO(sse64, 4); | 
|  | } | 
|  |  | 
|  | static inline void highbd_12_obmc_variance_cast(int64_t sum64, uint64_t sse64, | 
|  | int *sum, unsigned int *sse) { | 
|  | *sum = (int)ROUND_POWER_OF_TWO(sum64, 4); | 
|  | *sse = (unsigned int)ROUND_POWER_OF_TWO(sse64, 8); | 
|  | } | 
|  |  | 
|  | #define HIGHBD_OBMC_VARIANCE_WXH_NEON(w, h, bitdepth)                         \ | 
|  | unsigned int aom_highbd_##bitdepth##_obmc_variance##w##x##h##_neon(         \ | 
|  | const uint8_t *pre, int pre_stride, const int32_t *wsrc,                \ | 
|  | const int32_t *mask, unsigned int *sse) {                               \ | 
|  | int sum;                                                                  \ | 
|  | int64_t sum64;                                                            \ | 
|  | uint64_t sse64;                                                           \ | 
|  | highbd_obmc_variance_neon_##w##xh(pre, pre_stride, wsrc, mask, h, &sse64, \ | 
|  | &sum64);                                \ | 
|  | highbd_##bitdepth##_obmc_variance_cast(sum64, sse64, &sum, sse);          \ | 
|  | return *sse - (unsigned int)(((int64_t)sum * sum) / (w * h));             \ | 
|  | } | 
|  |  | 
|  | #define HIGHBD_OBMC_VARIANCE_WXH_XLARGE_NEON(w, h, bitdepth)                 \ | 
|  | unsigned int aom_highbd_##bitdepth##_obmc_variance##w##x##h##_neon(        \ | 
|  | const uint8_t *pre, int pre_stride, const int32_t *wsrc,               \ | 
|  | const int32_t *mask, unsigned int *sse) {                              \ | 
|  | int sum;                                                                 \ | 
|  | int64_t sum64;                                                           \ | 
|  | uint64_t sse64;                                                          \ | 
|  | highbd_obmc_variance_xlarge_neon_##w##xh(pre, pre_stride, wsrc, mask, h, \ | 
|  | &sse64, &sum64);                \ | 
|  | highbd_##bitdepth##_obmc_variance_cast(sum64, sse64, &sum, sse);         \ | 
|  | return *sse - (unsigned int)(((int64_t)sum * sum) / (w * h));            \ | 
|  | } | 
|  |  | 
|  | // 8-bit | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(4, 4, 8) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(4, 8, 8) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(4, 16, 8) | 
|  |  | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(8, 4, 8) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(8, 8, 8) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(8, 16, 8) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(8, 32, 8) | 
|  |  | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(16, 4, 8) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(16, 8, 8) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(16, 16, 8) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(16, 32, 8) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(16, 64, 8) | 
|  |  | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(32, 8, 8) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(32, 16, 8) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(32, 32, 8) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(32, 64, 8) | 
|  |  | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(64, 16, 8) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(64, 32, 8) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(64, 64, 8) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(64, 128, 8) | 
|  |  | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(128, 64, 8) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(128, 128, 8) | 
|  |  | 
|  | // 10-bit | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(4, 4, 10) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(4, 8, 10) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(4, 16, 10) | 
|  |  | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(8, 4, 10) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(8, 8, 10) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(8, 16, 10) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(8, 32, 10) | 
|  |  | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(16, 4, 10) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(16, 8, 10) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(16, 16, 10) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(16, 32, 10) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(16, 64, 10) | 
|  |  | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(32, 8, 10) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(32, 16, 10) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(32, 32, 10) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(32, 64, 10) | 
|  |  | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(64, 16, 10) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(64, 32, 10) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(64, 64, 10) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(64, 128, 10) | 
|  |  | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(128, 64, 10) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(128, 128, 10) | 
|  |  | 
|  | // 12-bit | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(4, 4, 12) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(4, 8, 12) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(4, 16, 12) | 
|  |  | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(8, 4, 12) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(8, 8, 12) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(8, 16, 12) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(8, 32, 12) | 
|  |  | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(16, 4, 12) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(16, 8, 12) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(16, 16, 12) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(16, 32, 12) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(16, 64, 12) | 
|  |  | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(32, 8, 12) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(32, 16, 12) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(32, 32, 12) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_XLARGE_NEON(32, 64, 12) | 
|  |  | 
|  | HIGHBD_OBMC_VARIANCE_WXH_NEON(64, 16, 12) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_XLARGE_NEON(64, 32, 12) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_XLARGE_NEON(64, 64, 12) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_XLARGE_NEON(64, 128, 12) | 
|  |  | 
|  | HIGHBD_OBMC_VARIANCE_WXH_XLARGE_NEON(128, 64, 12) | 
|  | HIGHBD_OBMC_VARIANCE_WXH_XLARGE_NEON(128, 128, 12) |