| /* | 
 |  * 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) |