/*
* 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/blend_neon.h"
#include "aom_dsp/arm/mem_neon.h"
#include "aom_dsp/arm/sum_neon.h"
#include "aom_dsp/blend.h"
static inline uint16x8_t masked_sad_8x1_neon(uint16x8_t sad,
const uint16_t *src,
const uint16_t *a,
const uint16_t *b,
const uint8_t *m) {
const uint16x8_t s0 = vld1q_u16(src);
const uint16x8_t a0 = vld1q_u16(a);
const uint16x8_t b0 = vld1q_u16(b);
const uint16x8_t m0 = vmovl_u8(vld1_u8(m));
uint16x8_t blend_u16 = alpha_blend_a64_u16x8(m0, a0, b0);
return vaddq_u16(sad, vabdq_u16(blend_u16, s0));
}
static inline uint16x8_t masked_sad_16x1_neon(uint16x8_t sad,
const uint16_t *src,
const uint16_t *a,
const uint16_t *b,
const uint8_t *m) {
sad = masked_sad_8x1_neon(sad, src, a, b, m);
return masked_sad_8x1_neon(sad, &src[8], &a[8], &b[8], &m[8]);
}
static inline uint16x8_t masked_sad_32x1_neon(uint16x8_t sad,
const uint16_t *src,
const uint16_t *a,
const uint16_t *b,
const uint8_t *m) {
sad = masked_sad_16x1_neon(sad, src, a, b, m);
return masked_sad_16x1_neon(sad, &src[16], &a[16], &b[16], &m[16]);
}
static inline unsigned int masked_sad_128xh_large_neon(
const uint8_t *src8,
int src_stride,
const uint8_t *a8,
int a_stride,
const uint8_t *b8,
int b_stride,
const uint8_t *m,
int m_stride,
int height) {
const uint16_t *src = CONVERT_TO_SHORTPTR(src8);
const uint16_t *a = CONVERT_TO_SHORTPTR(a8);
const uint16_t *b = CONVERT_TO_SHORTPTR(b8);
uint32x4_t sad_u32[] = { vdupq_n_u32(0), vdupq_n_u32(0), vdupq_n_u32(0),
vdupq_n_u32(0) };
do {
uint16x8_t sad[] = { vdupq_n_u16(0), vdupq_n_u16(0), vdupq_n_u16(0),
vdupq_n_u16(0) };
for (
int h = 0; h < 4; ++h) {
sad[0] = masked_sad_32x1_neon(sad[0], src, a, b, m);
sad[1] = masked_sad_32x1_neon(sad[1], &src[32], &a[32], &b[32], &m[32]);
sad[2] = masked_sad_32x1_neon(sad[2], &src[64], &a[64], &b[64], &m[64]);
sad[3] = masked_sad_32x1_neon(sad[3], &src[96], &a[96], &b[96], &m[96]);
src += src_stride;
a += a_stride;
b += b_stride;
m += m_stride;
}
sad_u32[0] = vpadalq_u16(sad_u32[0], sad[0]);
sad_u32[1] = vpadalq_u16(sad_u32[1], sad[1]);
sad_u32[2] = vpadalq_u16(sad_u32[2], sad[2]);
sad_u32[3] = vpadalq_u16(sad_u32[3], sad[3]);
height -= 4;
}
while (height != 0);
sad_u32[0] = vaddq_u32(sad_u32[0], sad_u32[1]);
sad_u32[2] = vaddq_u32(sad_u32[2], sad_u32[3]);
sad_u32[0] = vaddq_u32(sad_u32[0], sad_u32[2]);
return horizontal_add_u32x4(sad_u32[0]);
}
static inline unsigned int masked_sad_64xh_large_neon(
const uint8_t *src8,
int src_stride,
const uint8_t *a8,
int a_stride,
const uint8_t *b8,
int b_stride,
const uint8_t *m,
int m_stride,
int height) {
const uint16_t *src = CONVERT_TO_SHORTPTR(src8);
const uint16_t *a = CONVERT_TO_SHORTPTR(a8);
const uint16_t *b = CONVERT_TO_SHORTPTR(b8);
uint32x4_t sad_u32[] = { vdupq_n_u32(0), vdupq_n_u32(0) };
do {
uint16x8_t sad[] = { vdupq_n_u16(0), vdupq_n_u16(0) };
for (
int h = 0; h < 4; ++h) {
sad[0] = masked_sad_32x1_neon(sad[0], src, a, b, m);
sad[1] = masked_sad_32x1_neon(sad[1], &src[32], &a[32], &b[32], &m[32]);
src += src_stride;
a += a_stride;
b += b_stride;
m += m_stride;
}
sad_u32[0] = vpadalq_u16(sad_u32[0], sad[0]);
sad_u32[1] = vpadalq_u16(sad_u32[1], sad[1]);
height -= 4;
}
while (height != 0);
return horizontal_add_u32x4(vaddq_u32(sad_u32[0], sad_u32[1]));
}
static inline unsigned int masked_sad_32xh_large_neon(
const uint8_t *src8,
int src_stride,
const uint8_t *a8,
int a_stride,
const uint8_t *b8,
int b_stride,
const uint8_t *m,
int m_stride,
int height) {
const uint16_t *src = CONVERT_TO_SHORTPTR(src8);
const uint16_t *a = CONVERT_TO_SHORTPTR(a8);
const uint16_t *b = CONVERT_TO_SHORTPTR(b8);
uint32x4_t sad_u32 = vdupq_n_u32(0);
do {
uint16x8_t sad = vdupq_n_u16(0);
for (
int h = 0; h < 4; ++h) {
sad = masked_sad_32x1_neon(sad, src, a, b, m);
src += src_stride;
a += a_stride;
b += b_stride;
m += m_stride;
}
sad_u32 = vpadalq_u16(sad_u32, sad);
height -= 4;
}
while (height != 0);
return horizontal_add_u32x4(sad_u32);
}
static inline unsigned int masked_sad_16xh_large_neon(
const uint8_t *src8,
int src_stride,
const uint8_t *a8,
int a_stride,
const uint8_t *b8,
int b_stride,
const uint8_t *m,
int m_stride,
int height) {
const uint16_t *src = CONVERT_TO_SHORTPTR(src8);
const uint16_t *a = CONVERT_TO_SHORTPTR(a8);
const uint16_t *b = CONVERT_TO_SHORTPTR(b8);
uint32x4_t sad_u32 = vdupq_n_u32(0);
do {
uint16x8_t sad_u16 = vdupq_n_u16(0);
for (
int h = 0; h < 8; ++h) {
sad_u16 = masked_sad_16x1_neon(sad_u16, src, a, b, m);
src += src_stride;
a += a_stride;
b += b_stride;
m += m_stride;
}
sad_u32 = vpadalq_u16(sad_u32, sad_u16);
height -= 8;
}
while (height != 0);
return horizontal_add_u32x4(sad_u32);
}
#if !CONFIG_REALTIME_ONLY
static inline unsigned int masked_sad_8xh_large_neon(
const uint8_t *src8,
int src_stride,
const uint8_t *a8,
int a_stride,
const uint8_t *b8,
int b_stride,
const uint8_t *m,
int m_stride,
int height) {
const uint16_t *src = CONVERT_TO_SHORTPTR(src8);
const uint16_t *a = CONVERT_TO_SHORTPTR(a8);
const uint16_t *b = CONVERT_TO_SHORTPTR(b8);
uint32x4_t sad_u32 = vdupq_n_u32(0);
do {
uint16x8_t sad_u16 = vdupq_n_u16(0);
for (
int h = 0; h < 16; ++h) {
sad_u16 = masked_sad_8x1_neon(sad_u16, src, a, b, m);
src += src_stride;
a += a_stride;
b += b_stride;
m += m_stride;
}
sad_u32 = vpadalq_u16(sad_u32, sad_u16);
height -= 16;
}
while (height != 0);
return horizontal_add_u32x4(sad_u32);
}
#endif // !CONFIG_REALTIME_ONLY
static inline unsigned int masked_sad_16xh_small_neon(
const uint8_t *src8,
int src_stride,
const uint8_t *a8,
int a_stride,
const uint8_t *b8,
int b_stride,
const uint8_t *m,
int m_stride,
int height) {
// For 12-bit data, we can only accumulate up to 128 elements in the
// uint16x8_t type sad accumulator, so we can only process up to 8 rows
// before we have to accumulate into 32-bit elements.
assert(height <= 8);
const uint16_t *src = CONVERT_TO_SHORTPTR(src8);
const uint16_t *a = CONVERT_TO_SHORTPTR(a8);
const uint16_t *b = CONVERT_TO_SHORTPTR(b8);
uint16x8_t sad = vdupq_n_u16(0);
do {
sad = masked_sad_16x1_neon(sad, src, a, b, m);
src += src_stride;
a += a_stride;
b += b_stride;
m += m_stride;
}
while (--height != 0);
return horizontal_add_u16x8(sad);
}
static inline unsigned int masked_sad_8xh_small_neon(
const uint8_t *src8,
int src_stride,
const uint8_t *a8,
int a_stride,
const uint8_t *b8,
int b_stride,
const uint8_t *m,
int m_stride,
int height) {
// For 12-bit data, we can only accumulate up to 128 elements in the
// uint16x8_t type sad accumulator, so we can only process up to 16 rows
// before we have to accumulate into 32-bit elements.
assert(height <= 16);
const uint16_t *src = CONVERT_TO_SHORTPTR(src8);
const uint16_t *a = CONVERT_TO_SHORTPTR(a8);
const uint16_t *b = CONVERT_TO_SHORTPTR(b8);
uint16x8_t sad = vdupq_n_u16(0);
do {
sad = masked_sad_8x1_neon(sad, src, a, b, m);
src += src_stride;
a += a_stride;
b += b_stride;
m += m_stride;
}
while (--height != 0);
return horizontal_add_u16x8(sad);
}
static inline unsigned int masked_sad_4xh_small_neon(
const uint8_t *src8,
int src_stride,
const uint8_t *a8,
int a_stride,
const uint8_t *b8,
int b_stride,
const uint8_t *m,
int m_stride,
int height) {
// For 12-bit data, we can only accumulate up to 64 elements in the
// uint16x4_t type sad accumulator, so we can only process up to 16 rows
// before we have to accumulate into 32-bit elements.
assert(height <= 16);
const uint16_t *src = CONVERT_TO_SHORTPTR(src8);
const uint16_t *a = CONVERT_TO_SHORTPTR(a8);
const uint16_t *b = CONVERT_TO_SHORTPTR(b8);
uint16x4_t sad = vdup_n_u16(0);
do {
uint16x4_t m0 = vget_low_u16(vmovl_u8(load_unaligned_u8_4x1(m)));
uint16x4_t a0 = load_unaligned_u16_4x1(a);
uint16x4_t b0 = load_unaligned_u16_4x1(b);
uint16x4_t s0 = load_unaligned_u16_4x1(src);
uint16x4_t blend_u16 = alpha_blend_a64_u16x4(m0, a0, b0);
sad = vadd_u16(sad, vabd_u16(blend_u16, s0));
src += src_stride;
a += a_stride;
b += b_stride;
m += m_stride;
}
while (--height != 0);
return horizontal_add_u16x4(sad);
}
#define HIGHBD_MASKED_SAD_WXH_SMALL_NEON(w, h) \
unsigned int aom_highbd_masked_sad
##w
##x
##h
##_neon( \
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_
##w
##xh_small_neon(src, src_stride, ref, ref_stride, \
second_pred, w, msk, msk_stride, \
h); \
else \
return masked_sad_
##w
##xh_small_neon(src, src_stride, second_pred, w, \
ref, ref_stride, msk, msk_stride, \
h); \
}
#define HIGHBD_MASKED_SAD_WXH_LARGE_NEON(w, h) \
unsigned int aom_highbd_masked_sad
##w
##x
##h
##_neon( \
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_
##w
##xh_large_neon(src, src_stride, ref, ref_stride, \
second_pred, w, msk, msk_stride, \
h); \
else \
return masked_sad_
##w
##xh_large_neon(src, src_stride, second_pred, w, \
ref, ref_stride, msk, msk_stride, \
h); \
}
HIGHBD_MASKED_SAD_WXH_SMALL_NEON(4, 4)
HIGHBD_MASKED_SAD_WXH_SMALL_NEON(4, 8)
HIGHBD_MASKED_SAD_WXH_SMALL_NEON(8, 4)
HIGHBD_MASKED_SAD_WXH_SMALL_NEON(8, 8)
HIGHBD_MASKED_SAD_WXH_SMALL_NEON(8, 16)
HIGHBD_MASKED_SAD_WXH_SMALL_NEON(16, 8)
HIGHBD_MASKED_SAD_WXH_LARGE_NEON(16, 16)
HIGHBD_MASKED_SAD_WXH_LARGE_NEON(16, 32)
HIGHBD_MASKED_SAD_WXH_LARGE_NEON(32, 16)
HIGHBD_MASKED_SAD_WXH_LARGE_NEON(32, 32)
HIGHBD_MASKED_SAD_WXH_LARGE_NEON(32, 64)
HIGHBD_MASKED_SAD_WXH_LARGE_NEON(64, 32)
HIGHBD_MASKED_SAD_WXH_LARGE_NEON(64, 64)
HIGHBD_MASKED_SAD_WXH_LARGE_NEON(64, 128)
HIGHBD_MASKED_SAD_WXH_LARGE_NEON(128, 64)
HIGHBD_MASKED_SAD_WXH_LARGE_NEON(128, 128)
#if !CONFIG_REALTIME_ONLY
HIGHBD_MASKED_SAD_WXH_SMALL_NEON(4, 16)
HIGHBD_MASKED_SAD_WXH_LARGE_NEON(8, 32)
HIGHBD_MASKED_SAD_WXH_SMALL_NEON(16, 4)
HIGHBD_MASKED_SAD_WXH_LARGE_NEON(16, 64)
HIGHBD_MASKED_SAD_WXH_LARGE_NEON(32, 8)
HIGHBD_MASKED_SAD_WXH_LARGE_NEON(64, 16)
#endif // !CONFIG_REALTIME_ONLY
