Source code
Revision control
Copy as Markdown
Other Tools
/*
* 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 <assert.h>
#include <stdint.h>
#include "aom_dsp/arm/mem_neon.h"
#include "aom_dsp/arm/sum_neon.h"
#include "aom_dsp/arm/transpose_neon.h"
#include "av1/encoder/arm/pickrst_neon.h"
#include "av1/encoder/pickrst.h"
static inline void highbd_calc_proj_params_r0_r1_neon(
const uint8_t *src8, int width, int height, int src_stride,
const uint8_t *dat8, int dat_stride, int32_t *flt0, int flt0_stride,
int32_t *flt1, int flt1_stride, int64_t H[2][2], int64_t C[2]) {
assert(width % 8 == 0);
const int size = width * height;
const uint16_t *src = CONVERT_TO_SHORTPTR(src8);
const uint16_t *dat = CONVERT_TO_SHORTPTR(dat8);
int64x2_t h00_lo = vdupq_n_s64(0);
int64x2_t h00_hi = vdupq_n_s64(0);
int64x2_t h11_lo = vdupq_n_s64(0);
int64x2_t h11_hi = vdupq_n_s64(0);
int64x2_t h01_lo = vdupq_n_s64(0);
int64x2_t h01_hi = vdupq_n_s64(0);
int64x2_t c0_lo = vdupq_n_s64(0);
int64x2_t c0_hi = vdupq_n_s64(0);
int64x2_t c1_lo = vdupq_n_s64(0);
int64x2_t c1_hi = vdupq_n_s64(0);
do {
const uint16_t *src_ptr = src;
const uint16_t *dat_ptr = dat;
int32_t *flt0_ptr = flt0;
int32_t *flt1_ptr = flt1;
int w = width;
do {
uint16x8_t s = vld1q_u16(src_ptr);
uint16x8_t d = vld1q_u16(dat_ptr);
int32x4_t f0_lo = vld1q_s32(flt0_ptr);
int32x4_t f0_hi = vld1q_s32(flt0_ptr + 4);
int32x4_t f1_lo = vld1q_s32(flt1_ptr);
int32x4_t f1_hi = vld1q_s32(flt1_ptr + 4);
int32x4_t u_lo =
vreinterpretq_s32_u32(vshll_n_u16(vget_low_u16(d), SGRPROJ_RST_BITS));
int32x4_t u_hi = vreinterpretq_s32_u32(
vshll_n_u16(vget_high_u16(d), SGRPROJ_RST_BITS));
int32x4_t s_lo =
vreinterpretq_s32_u32(vshll_n_u16(vget_low_u16(s), SGRPROJ_RST_BITS));
int32x4_t s_hi = vreinterpretq_s32_u32(
vshll_n_u16(vget_high_u16(s), SGRPROJ_RST_BITS));
s_lo = vsubq_s32(s_lo, u_lo);
s_hi = vsubq_s32(s_hi, u_hi);
f0_lo = vsubq_s32(f0_lo, u_lo);
f0_hi = vsubq_s32(f0_hi, u_hi);
f1_lo = vsubq_s32(f1_lo, u_lo);
f1_hi = vsubq_s32(f1_hi, u_hi);
h00_lo = vmlal_s32(h00_lo, vget_low_s32(f0_lo), vget_low_s32(f0_lo));
h00_lo = vmlal_s32(h00_lo, vget_high_s32(f0_lo), vget_high_s32(f0_lo));
h00_hi = vmlal_s32(h00_hi, vget_low_s32(f0_hi), vget_low_s32(f0_hi));
h00_hi = vmlal_s32(h00_hi, vget_high_s32(f0_hi), vget_high_s32(f0_hi));
h11_lo = vmlal_s32(h11_lo, vget_low_s32(f1_lo), vget_low_s32(f1_lo));
h11_lo = vmlal_s32(h11_lo, vget_high_s32(f1_lo), vget_high_s32(f1_lo));
h11_hi = vmlal_s32(h11_hi, vget_low_s32(f1_hi), vget_low_s32(f1_hi));
h11_hi = vmlal_s32(h11_hi, vget_high_s32(f1_hi), vget_high_s32(f1_hi));
h01_lo = vmlal_s32(h01_lo, vget_low_s32(f0_lo), vget_low_s32(f1_lo));
h01_lo = vmlal_s32(h01_lo, vget_high_s32(f0_lo), vget_high_s32(f1_lo));
h01_hi = vmlal_s32(h01_hi, vget_low_s32(f0_hi), vget_low_s32(f1_hi));
h01_hi = vmlal_s32(h01_hi, vget_high_s32(f0_hi), vget_high_s32(f1_hi));
c0_lo = vmlal_s32(c0_lo, vget_low_s32(f0_lo), vget_low_s32(s_lo));
c0_lo = vmlal_s32(c0_lo, vget_high_s32(f0_lo), vget_high_s32(s_lo));
c0_hi = vmlal_s32(c0_hi, vget_low_s32(f0_hi), vget_low_s32(s_hi));
c0_hi = vmlal_s32(c0_hi, vget_high_s32(f0_hi), vget_high_s32(s_hi));
c1_lo = vmlal_s32(c1_lo, vget_low_s32(f1_lo), vget_low_s32(s_lo));
c1_lo = vmlal_s32(c1_lo, vget_high_s32(f1_lo), vget_high_s32(s_lo));
c1_hi = vmlal_s32(c1_hi, vget_low_s32(f1_hi), vget_low_s32(s_hi));
c1_hi = vmlal_s32(c1_hi, vget_high_s32(f1_hi), vget_high_s32(s_hi));
src_ptr += 8;
dat_ptr += 8;
flt0_ptr += 8;
flt1_ptr += 8;
w -= 8;
} while (w != 0);
src += src_stride;
dat += dat_stride;
flt0 += flt0_stride;
flt1 += flt1_stride;
} while (--height != 0);
H[0][0] = horizontal_add_s64x2(vaddq_s64(h00_lo, h00_hi)) / size;
H[0][1] = horizontal_add_s64x2(vaddq_s64(h01_lo, h01_hi)) / size;
H[1][1] = horizontal_add_s64x2(vaddq_s64(h11_lo, h11_hi)) / size;
H[1][0] = H[0][1];
C[0] = horizontal_add_s64x2(vaddq_s64(c0_lo, c0_hi)) / size;
C[1] = horizontal_add_s64x2(vaddq_s64(c1_lo, c1_hi)) / size;
}
static inline void highbd_calc_proj_params_r0_neon(
const uint8_t *src8, int width, int height, int src_stride,
const uint8_t *dat8, int dat_stride, int32_t *flt0, int flt0_stride,
int64_t H[2][2], int64_t C[2]) {
assert(width % 8 == 0);
const int size = width * height;
const uint16_t *src = CONVERT_TO_SHORTPTR(src8);
const uint16_t *dat = CONVERT_TO_SHORTPTR(dat8);
int64x2_t h00_lo = vdupq_n_s64(0);
int64x2_t h00_hi = vdupq_n_s64(0);
int64x2_t c0_lo = vdupq_n_s64(0);
int64x2_t c0_hi = vdupq_n_s64(0);
do {
const uint16_t *src_ptr = src;
const uint16_t *dat_ptr = dat;
int32_t *flt0_ptr = flt0;
int w = width;
do {
uint16x8_t s = vld1q_u16(src_ptr);
uint16x8_t d = vld1q_u16(dat_ptr);
int32x4_t f0_lo = vld1q_s32(flt0_ptr);
int32x4_t f0_hi = vld1q_s32(flt0_ptr + 4);
int32x4_t u_lo =
vreinterpretq_s32_u32(vshll_n_u16(vget_low_u16(d), SGRPROJ_RST_BITS));
int32x4_t u_hi = vreinterpretq_s32_u32(
vshll_n_u16(vget_high_u16(d), SGRPROJ_RST_BITS));
int32x4_t s_lo =
vreinterpretq_s32_u32(vshll_n_u16(vget_low_u16(s), SGRPROJ_RST_BITS));
int32x4_t s_hi = vreinterpretq_s32_u32(
vshll_n_u16(vget_high_u16(s), SGRPROJ_RST_BITS));
s_lo = vsubq_s32(s_lo, u_lo);
s_hi = vsubq_s32(s_hi, u_hi);
f0_lo = vsubq_s32(f0_lo, u_lo);
f0_hi = vsubq_s32(f0_hi, u_hi);
h00_lo = vmlal_s32(h00_lo, vget_low_s32(f0_lo), vget_low_s32(f0_lo));
h00_lo = vmlal_s32(h00_lo, vget_high_s32(f0_lo), vget_high_s32(f0_lo));
h00_hi = vmlal_s32(h00_hi, vget_low_s32(f0_hi), vget_low_s32(f0_hi));
h00_hi = vmlal_s32(h00_hi, vget_high_s32(f0_hi), vget_high_s32(f0_hi));
c0_lo = vmlal_s32(c0_lo, vget_low_s32(f0_lo), vget_low_s32(s_lo));
c0_lo = vmlal_s32(c0_lo, vget_high_s32(f0_lo), vget_high_s32(s_lo));
c0_hi = vmlal_s32(c0_hi, vget_low_s32(f0_hi), vget_low_s32(s_hi));
c0_hi = vmlal_s32(c0_hi, vget_high_s32(f0_hi), vget_high_s32(s_hi));
src_ptr += 8;
dat_ptr += 8;
flt0_ptr += 8;
w -= 8;
} while (w != 0);
src += src_stride;
dat += dat_stride;
flt0 += flt0_stride;
} while (--height != 0);
H[0][0] = horizontal_add_s64x2(vaddq_s64(h00_lo, h00_hi)) / size;
C[0] = horizontal_add_s64x2(vaddq_s64(c0_lo, c0_hi)) / size;
}
static inline void highbd_calc_proj_params_r1_neon(
const uint8_t *src8, int width, int height, int src_stride,
const uint8_t *dat8, int dat_stride, int32_t *flt1, int flt1_stride,
int64_t H[2][2], int64_t C[2]) {
assert(width % 8 == 0);
const int size = width * height;
const uint16_t *src = CONVERT_TO_SHORTPTR(src8);
const uint16_t *dat = CONVERT_TO_SHORTPTR(dat8);
int64x2_t h11_lo = vdupq_n_s64(0);
int64x2_t h11_hi = vdupq_n_s64(0);
int64x2_t c1_lo = vdupq_n_s64(0);
int64x2_t c1_hi = vdupq_n_s64(0);
do {
const uint16_t *src_ptr = src;
const uint16_t *dat_ptr = dat;
int32_t *flt1_ptr = flt1;
int w = width;
do {
uint16x8_t s = vld1q_u16(src_ptr);
uint16x8_t d = vld1q_u16(dat_ptr);
int32x4_t f1_lo = vld1q_s32(flt1_ptr);
int32x4_t f1_hi = vld1q_s32(flt1_ptr + 4);
int32x4_t u_lo =
vreinterpretq_s32_u32(vshll_n_u16(vget_low_u16(d), SGRPROJ_RST_BITS));
int32x4_t u_hi = vreinterpretq_s32_u32(
vshll_n_u16(vget_high_u16(d), SGRPROJ_RST_BITS));
int32x4_t s_lo =
vreinterpretq_s32_u32(vshll_n_u16(vget_low_u16(s), SGRPROJ_RST_BITS));
int32x4_t s_hi = vreinterpretq_s32_u32(
vshll_n_u16(vget_high_u16(s), SGRPROJ_RST_BITS));
s_lo = vsubq_s32(s_lo, u_lo);
s_hi = vsubq_s32(s_hi, u_hi);
f1_lo = vsubq_s32(f1_lo, u_lo);
f1_hi = vsubq_s32(f1_hi, u_hi);
h11_lo = vmlal_s32(h11_lo, vget_low_s32(f1_lo), vget_low_s32(f1_lo));
h11_lo = vmlal_s32(h11_lo, vget_high_s32(f1_lo), vget_high_s32(f1_lo));
h11_hi = vmlal_s32(h11_hi, vget_low_s32(f1_hi), vget_low_s32(f1_hi));
h11_hi = vmlal_s32(h11_hi, vget_high_s32(f1_hi), vget_high_s32(f1_hi));
c1_lo = vmlal_s32(c1_lo, vget_low_s32(f1_lo), vget_low_s32(s_lo));
c1_lo = vmlal_s32(c1_lo, vget_high_s32(f1_lo), vget_high_s32(s_lo));
c1_hi = vmlal_s32(c1_hi, vget_low_s32(f1_hi), vget_low_s32(s_hi));
c1_hi = vmlal_s32(c1_hi, vget_high_s32(f1_hi), vget_high_s32(s_hi));
src_ptr += 8;
dat_ptr += 8;
flt1_ptr += 8;
w -= 8;
} while (w != 0);
src += src_stride;
dat += dat_stride;
flt1 += flt1_stride;
} while (--height != 0);
H[1][1] = horizontal_add_s64x2(vaddq_s64(h11_lo, h11_hi)) / size;
C[1] = horizontal_add_s64x2(vaddq_s64(c1_lo, c1_hi)) / size;
}
// The function calls 3 subfunctions for the following cases :
// 1) When params->r[0] > 0 and params->r[1] > 0. In this case all elements
// of C and H need to be computed.
// 2) When only params->r[0] > 0. In this case only H[0][0] and C[0] are
// non-zero and need to be computed.
// 3) When only params->r[1] > 0. In this case only H[1][1] and C[1] are
// non-zero and need to be computed.
void av1_calc_proj_params_high_bd_neon(const uint8_t *src8, int width,
int height, int src_stride,
const uint8_t *dat8, int dat_stride,
int32_t *flt0, int flt0_stride,
int32_t *flt1, int flt1_stride,
int64_t H[2][2], int64_t C[2],
const sgr_params_type *params) {
if ((params->r[0] > 0) && (params->r[1] > 0)) {
highbd_calc_proj_params_r0_r1_neon(src8, width, height, src_stride, dat8,
dat_stride, flt0, flt0_stride, flt1,
flt1_stride, H, C);
} else if (params->r[0] > 0) {
highbd_calc_proj_params_r0_neon(src8, width, height, src_stride, dat8,
dat_stride, flt0, flt0_stride, H, C);
} else if (params->r[1] > 0) {
highbd_calc_proj_params_r1_neon(src8, width, height, src_stride, dat8,
dat_stride, flt1, flt1_stride, H, C);
}
}
static inline void hadd_update_4_stats_neon(const int64_t *const src,
const int32x4_t *deltas,
int64_t *const dst) {
int64x2_t delta0_s64 = vpaddlq_s32(deltas[0]);
int64x2_t delta1_s64 = vpaddlq_s32(deltas[1]);
int64x2_t delta2_s64 = vpaddlq_s32(deltas[2]);
int64x2_t delta3_s64 = vpaddlq_s32(deltas[3]);
#if AOM_ARCH_AARCH64
int64x2_t delta01 = vpaddq_s64(delta0_s64, delta1_s64);
int64x2_t delta23 = vpaddq_s64(delta2_s64, delta3_s64);
int64x2_t src0 = vld1q_s64(src);
int64x2_t src1 = vld1q_s64(src + 2);
vst1q_s64(dst, vaddq_s64(src0, delta01));
vst1q_s64(dst + 2, vaddq_s64(src1, delta23));
#else
dst[0] = src[0] + horizontal_add_s64x2(delta0_s64);
dst[1] = src[1] + horizontal_add_s64x2(delta1_s64);
dst[2] = src[2] + horizontal_add_s64x2(delta2_s64);
dst[3] = src[3] + horizontal_add_s64x2(delta3_s64);
#endif
}
static inline void compute_stats_win5_highbd_neon(
const int16_t *const d, const int32_t d_stride, const int16_t *const s,
const int32_t s_stride, const int32_t width, const int32_t height,
int64_t *const M, int64_t *const H, aom_bit_depth_t bit_depth) {
const int32_t wiener_win = WIENER_WIN_CHROMA;
const int32_t wiener_win2 = wiener_win * wiener_win;
const int32_t w16 = width & ~15;
const int32_t h8 = height & ~7;
int16x8_t mask[2];
mask[0] = vld1q_s16(&(mask_16bit[16]) - width % 16);
mask[1] = vld1q_s16(&(mask_16bit[16]) - width % 16 + 8);
int32_t i, j, x, y;
const int32_t num_bit_left =
32 - 1 /* sign */ - 2 * bit_depth /* energy */ + 2 /* SIMD */;
const int32_t h_allowed =
(1 << num_bit_left) / (w16 + ((w16 != width) ? 16 : 0));
// Step 1: Calculate the top edge of the whole matrix, i.e., the top
// edge of each triangle and square on the top row.
j = 0;
do {
const int16_t *s_t = s;
const int16_t *d_t = d;
int32_t height_t = 0;
int64x2_t sum_m[WIENER_WIN_CHROMA] = { vdupq_n_s64(0) };
int64x2_t sum_h[WIENER_WIN_CHROMA] = { vdupq_n_s64(0) };
int16x8_t src[2], dgd[2];
do {
const int32_t h_t =
((height - height_t) < h_allowed) ? (height - height_t) : h_allowed;
int32x4_t row_m[WIENER_WIN_CHROMA] = { vdupq_n_s32(0) };
int32x4_t row_h[WIENER_WIN_CHROMA] = { vdupq_n_s32(0) };
y = h_t;
do {
x = 0;
while (x < w16) {
src[0] = vld1q_s16(s_t + x + 0);
src[1] = vld1q_s16(s_t + x + 8);
dgd[0] = vld1q_s16(d_t + x + 0);
dgd[1] = vld1q_s16(d_t + x + 8);
stats_top_win5_neon(src, dgd, d_t + j + x, d_stride, row_m, row_h);
x += 16;
}
if (w16 != width) {
src[0] = vld1q_s16(s_t + w16 + 0);
src[1] = vld1q_s16(s_t + w16 + 8);
dgd[0] = vld1q_s16(d_t + w16 + 0);
dgd[1] = vld1q_s16(d_t + w16 + 8);
src[0] = vandq_s16(src[0], mask[0]);
src[1] = vandq_s16(src[1], mask[1]);
dgd[0] = vandq_s16(dgd[0], mask[0]);
dgd[1] = vandq_s16(dgd[1], mask[1]);
stats_top_win5_neon(src, dgd, d_t + j + w16, d_stride, row_m, row_h);
}
s_t += s_stride;
d_t += d_stride;
} while (--y);
sum_m[0] = vpadalq_s32(sum_m[0], row_m[0]);
sum_m[1] = vpadalq_s32(sum_m[1], row_m[1]);
sum_m[2] = vpadalq_s32(sum_m[2], row_m[2]);
sum_m[3] = vpadalq_s32(sum_m[3], row_m[3]);
sum_m[4] = vpadalq_s32(sum_m[4], row_m[4]);
sum_h[0] = vpadalq_s32(sum_h[0], row_h[0]);
sum_h[1] = vpadalq_s32(sum_h[1], row_h[1]);
sum_h[2] = vpadalq_s32(sum_h[2], row_h[2]);
sum_h[3] = vpadalq_s32(sum_h[3], row_h[3]);
sum_h[4] = vpadalq_s32(sum_h[4], row_h[4]);
height_t += h_t;
} while (height_t < height);
#if AOM_ARCH_AARCH64
int64x2_t sum_m0 = vpaddq_s64(sum_m[0], sum_m[1]);
int64x2_t sum_m2 = vpaddq_s64(sum_m[2], sum_m[3]);
vst1q_s64(&M[wiener_win * j + 0], sum_m0);
vst1q_s64(&M[wiener_win * j + 2], sum_m2);
M[wiener_win * j + 4] = vaddvq_s64(sum_m[4]);
int64x2_t sum_h0 = vpaddq_s64(sum_h[0], sum_h[1]);
int64x2_t sum_h2 = vpaddq_s64(sum_h[2], sum_h[3]);
vst1q_s64(&H[wiener_win * j + 0], sum_h0);
vst1q_s64(&H[wiener_win * j + 2], sum_h2);
H[wiener_win * j + 4] = vaddvq_s64(sum_h[4]);
#else
M[wiener_win * j + 0] = horizontal_add_s64x2(sum_m[0]);
M[wiener_win * j + 1] = horizontal_add_s64x2(sum_m[1]);
M[wiener_win * j + 2] = horizontal_add_s64x2(sum_m[2]);
M[wiener_win * j + 3] = horizontal_add_s64x2(sum_m[3]);
M[wiener_win * j + 4] = horizontal_add_s64x2(sum_m[4]);
H[wiener_win * j + 0] = horizontal_add_s64x2(sum_h[0]);
H[wiener_win * j + 1] = horizontal_add_s64x2(sum_h[1]);
H[wiener_win * j + 2] = horizontal_add_s64x2(sum_h[2]);
H[wiener_win * j + 3] = horizontal_add_s64x2(sum_h[3]);
H[wiener_win * j + 4] = horizontal_add_s64x2(sum_h[4]);
#endif // AOM_ARCH_AARCH64
} while (++j < wiener_win);
// Step 2: Calculate the left edge of each square on the top row.
j = 1;
do {
const int16_t *d_t = d;
int32_t height_t = 0;
int64x2_t sum_h[WIENER_WIN_CHROMA - 1] = { vdupq_n_s64(0) };
int16x8_t dgd[2];
do {
const int32_t h_t =
((height - height_t) < h_allowed) ? (height - height_t) : h_allowed;
int32x4_t row_h[WIENER_WIN_CHROMA - 1] = { vdupq_n_s32(0) };
y = h_t;
do {
x = 0;
while (x < w16) {
dgd[0] = vld1q_s16(d_t + j + x + 0);
dgd[1] = vld1q_s16(d_t + j + x + 8);
stats_left_win5_neon(dgd, d_t + x, d_stride, row_h);
x += 16;
}
if (w16 != width) {
dgd[0] = vld1q_s16(d_t + j + x + 0);
dgd[1] = vld1q_s16(d_t + j + x + 8);
dgd[0] = vandq_s16(dgd[0], mask[0]);
dgd[1] = vandq_s16(dgd[1], mask[1]);
stats_left_win5_neon(dgd, d_t + x, d_stride, row_h);
}
d_t += d_stride;
} while (--y);
sum_h[0] = vpadalq_s32(sum_h[0], row_h[0]);
sum_h[1] = vpadalq_s32(sum_h[1], row_h[1]);
sum_h[2] = vpadalq_s32(sum_h[2], row_h[2]);
sum_h[3] = vpadalq_s32(sum_h[3], row_h[3]);
height_t += h_t;
} while (height_t < height);
#if AOM_ARCH_AARCH64
int64x2_t sum_h0 = vpaddq_s64(sum_h[0], sum_h[1]);
int64x2_t sum_h1 = vpaddq_s64(sum_h[2], sum_h[3]);
vst1_s64(&H[1 * wiener_win2 + j * wiener_win], vget_low_s64(sum_h0));
vst1_s64(&H[2 * wiener_win2 + j * wiener_win], vget_high_s64(sum_h0));
vst1_s64(&H[3 * wiener_win2 + j * wiener_win], vget_low_s64(sum_h1));
vst1_s64(&H[4 * wiener_win2 + j * wiener_win], vget_high_s64(sum_h1));
#else
H[1 * wiener_win2 + j * wiener_win] = horizontal_add_s64x2(sum_h[0]);
H[2 * wiener_win2 + j * wiener_win] = horizontal_add_s64x2(sum_h[1]);
H[3 * wiener_win2 + j * wiener_win] = horizontal_add_s64x2(sum_h[2]);
H[4 * wiener_win2 + j * wiener_win] = horizontal_add_s64x2(sum_h[3]);
#endif // AOM_ARCH_AARCH64
} while (++j < wiener_win);
// Step 3: Derive the top edge of each triangle along the diagonal. No
// triangle in top row.
{
const int16_t *d_t = d;
if (height % 2) {
int32x4_t deltas[(WIENER_WIN + 1) * 2] = { vdupq_n_s32(0) };
int32x4_t deltas_tr[(WIENER_WIN + 1) * 2] = { vdupq_n_s32(0) };
int16x8_t ds[WIENER_WIN * 2];
load_s16_8x4(d_t, d_stride, &ds[0], &ds[2], &ds[4], &ds[6]);
load_s16_8x4(d_t + width, d_stride, &ds[1], &ds[3], &ds[5], &ds[7]);
d_t += 4 * d_stride;
step3_win5_oneline_neon(&d_t, d_stride, width, height, ds, deltas);
transpose_arrays_s32_8x8(deltas, deltas_tr);
update_5_stats_neon(H + 0 * wiener_win * wiener_win2 + 0 * wiener_win,
deltas_tr[0], vgetq_lane_s32(deltas_tr[4], 0),
H + 1 * wiener_win * wiener_win2 + 1 * wiener_win);
update_5_stats_neon(H + 1 * wiener_win * wiener_win2 + 1 * wiener_win,
deltas_tr[1], vgetq_lane_s32(deltas_tr[5], 0),
H + 2 * wiener_win * wiener_win2 + 2 * wiener_win);
update_5_stats_neon(H + 2 * wiener_win * wiener_win2 + 2 * wiener_win,
deltas_tr[2], vgetq_lane_s32(deltas_tr[6], 0),
H + 3 * wiener_win * wiener_win2 + 3 * wiener_win);
update_5_stats_neon(H + 3 * wiener_win * wiener_win2 + 3 * wiener_win,
deltas_tr[3], vgetq_lane_s32(deltas_tr[7], 0),
H + 4 * wiener_win * wiener_win2 + 4 * wiener_win);
} else {
int32x4_t deltas[WIENER_WIN_CHROMA * 2] = { vdupq_n_s32(0) };
int16x8_t ds[WIENER_WIN_CHROMA * 2];
ds[0] = load_unaligned_s16_4x2(d_t + 0 * d_stride, width);
ds[1] = load_unaligned_s16_4x2(d_t + 1 * d_stride, width);
ds[2] = load_unaligned_s16_4x2(d_t + 2 * d_stride, width);
ds[3] = load_unaligned_s16_4x2(d_t + 3 * d_stride, width);
step3_win5_neon(d_t + 4 * d_stride, d_stride, width, height, ds, deltas);
transpose_elems_inplace_s32_4x4(&deltas[0], &deltas[1], &deltas[2],
&deltas[3]);
update_5_stats_neon(H + 0 * wiener_win * wiener_win2 + 0 * wiener_win,
deltas[0], vgetq_lane_s32(deltas[4], 0),
H + 1 * wiener_win * wiener_win2 + 1 * wiener_win);
update_5_stats_neon(H + 1 * wiener_win * wiener_win2 + 1 * wiener_win,
deltas[1], vgetq_lane_s32(deltas[4], 1),
H + 2 * wiener_win * wiener_win2 + 2 * wiener_win);
update_5_stats_neon(H + 2 * wiener_win * wiener_win2 + 2 * wiener_win,
deltas[2], vgetq_lane_s32(deltas[4], 2),
H + 3 * wiener_win * wiener_win2 + 3 * wiener_win);
update_5_stats_neon(H + 3 * wiener_win * wiener_win2 + 3 * wiener_win,
deltas[3], vgetq_lane_s32(deltas[4], 3),
H + 4 * wiener_win * wiener_win2 + 4 * wiener_win);
}
}
// Step 4: Derive the top and left edge of each square. No square in top and
// bottom row.
{
y = h8;
int16x4_t d_s[12];
int16x4_t d_e[12];
const int16_t *d_t = d;
int16x4_t zeros = vdup_n_s16(0);
load_s16_4x4(d_t, d_stride, &d_s[0], &d_s[1], &d_s[2], &d_s[3]);
load_s16_4x4(d_t + width, d_stride, &d_e[0], &d_e[1], &d_e[2], &d_e[3]);
int32x4_t deltas[6][18] = { { vdupq_n_s32(0) }, { vdupq_n_s32(0) } };
while (y >= 8) {
load_s16_4x8(d_t + 4 * d_stride, d_stride, &d_s[4], &d_s[5], &d_s[6],
&d_s[7], &d_s[8], &d_s[9], &d_s[10], &d_s[11]);
load_s16_4x8(d_t + width + 4 * d_stride, d_stride, &d_e[4], &d_e[5],
&d_e[6], &d_e[7], &d_e[8], &d_e[9], &d_e[10], &d_e[11]);
int16x8_t s_tr[8], e_tr[8];
transpose_elems_s16_4x8(d_s[0], d_s[1], d_s[2], d_s[3], d_s[4], d_s[5],
d_s[6], d_s[7], &s_tr[0], &s_tr[1], &s_tr[2],
&s_tr[3]);
transpose_elems_s16_4x8(d_s[8], d_s[9], d_s[10], d_s[11], zeros, zeros,
zeros, zeros, &s_tr[4], &s_tr[5], &s_tr[6],
&s_tr[7]);
transpose_elems_s16_4x8(d_e[0], d_e[1], d_e[2], d_e[3], d_e[4], d_e[5],
d_e[6], d_e[7], &e_tr[0], &e_tr[1], &e_tr[2],
&e_tr[3]);
transpose_elems_s16_4x8(d_e[8], d_e[9], d_e[10], d_e[11], zeros, zeros,
zeros, zeros, &e_tr[4], &e_tr[5], &e_tr[6],
&e_tr[7]);
int16x8_t start_col0[5], start_col1[5], start_col2[5], start_col3[5];
start_col0[0] = s_tr[0];
start_col0[1] = vextq_s16(s_tr[0], s_tr[4], 1);
start_col0[2] = vextq_s16(s_tr[0], s_tr[4], 2);
start_col0[3] = vextq_s16(s_tr[0], s_tr[4], 3);
start_col0[4] = vextq_s16(s_tr[0], s_tr[4], 4);
start_col1[0] = s_tr[1];
start_col1[1] = vextq_s16(s_tr[1], s_tr[5], 1);
start_col1[2] = vextq_s16(s_tr[1], s_tr[5], 2);
start_col1[3] = vextq_s16(s_tr[1], s_tr[5], 3);
start_col1[4] = vextq_s16(s_tr[1], s_tr[5], 4);
start_col2[0] = s_tr[2];
start_col2[1] = vextq_s16(s_tr[2], s_tr[6], 1);
start_col2[2] = vextq_s16(s_tr[2], s_tr[6], 2);
start_col2[3] = vextq_s16(s_tr[2], s_tr[6], 3);
start_col2[4] = vextq_s16(s_tr[2], s_tr[6], 4);
start_col3[0] = s_tr[3];
start_col3[1] = vextq_s16(s_tr[3], s_tr[7], 1);
start_col3[2] = vextq_s16(s_tr[3], s_tr[7], 2);
start_col3[3] = vextq_s16(s_tr[3], s_tr[7], 3);
start_col3[4] = vextq_s16(s_tr[3], s_tr[7], 4);
// i = 1, j = 2;
sub_deltas_step4(start_col0, start_col1, deltas[0]);
// i = 1, j = 3;
sub_deltas_step4(start_col0, start_col2, deltas[1]);
// i = 1, j = 4
sub_deltas_step4(start_col0, start_col3, deltas[2]);
// i = 2, j =3
sub_deltas_step4(start_col1, start_col2, deltas[3]);
// i = 2, j = 4
sub_deltas_step4(start_col1, start_col3, deltas[4]);
// i = 3, j = 4
sub_deltas_step4(start_col2, start_col3, deltas[5]);
int16x8_t end_col0[5], end_col1[5], end_col2[5], end_col3[5];
end_col0[0] = e_tr[0];
end_col0[1] = vextq_s16(e_tr[0], e_tr[4], 1);
end_col0[2] = vextq_s16(e_tr[0], e_tr[4], 2);
end_col0[3] = vextq_s16(e_tr[0], e_tr[4], 3);
end_col0[4] = vextq_s16(e_tr[0], e_tr[4], 4);
end_col1[0] = e_tr[1];
end_col1[1] = vextq_s16(e_tr[1], e_tr[5], 1);
end_col1[2] = vextq_s16(e_tr[1], e_tr[5], 2);
end_col1[3] = vextq_s16(e_tr[1], e_tr[5], 3);
end_col1[4] = vextq_s16(e_tr[1], e_tr[5], 4);
end_col2[0] = e_tr[2];
end_col2[1] = vextq_s16(e_tr[2], e_tr[6], 1);
end_col2[2] = vextq_s16(e_tr[2], e_tr[6], 2);
end_col2[3] = vextq_s16(e_tr[2], e_tr[6], 3);
end_col2[4] = vextq_s16(e_tr[2], e_tr[6], 4);
end_col3[0] = e_tr[3];
end_col3[1] = vextq_s16(e_tr[3], e_tr[7], 1);
end_col3[2] = vextq_s16(e_tr[3], e_tr[7], 2);
end_col3[3] = vextq_s16(e_tr[3], e_tr[7], 3);
end_col3[4] = vextq_s16(e_tr[3], e_tr[7], 4);
// i = 1, j = 2;
add_deltas_step4(end_col0, end_col1, deltas[0]);
// i = 1, j = 3;
add_deltas_step4(end_col0, end_col2, deltas[1]);
// i = 1, j = 4
add_deltas_step4(end_col0, end_col3, deltas[2]);
// i = 2, j =3
add_deltas_step4(end_col1, end_col2, deltas[3]);
// i = 2, j = 4
add_deltas_step4(end_col1, end_col3, deltas[4]);
// i = 3, j = 4
add_deltas_step4(end_col2, end_col3, deltas[5]);
d_s[0] = d_s[8];
d_s[1] = d_s[9];
d_s[2] = d_s[10];
d_s[3] = d_s[11];
d_e[0] = d_e[8];
d_e[1] = d_e[9];
d_e[2] = d_e[10];
d_e[3] = d_e[11];
d_t += 8 * d_stride;
y -= 8;
}
if (h8 != height) {
const int16x8_t mask_h = vld1q_s16(&mask_16bit[16] - (height % 8));
load_s16_4x8(d_t + 4 * d_stride, d_stride, &d_s[4], &d_s[5], &d_s[6],
&d_s[7], &d_s[8], &d_s[9], &d_s[10], &d_s[11]);
load_s16_4x8(d_t + width + 4 * d_stride, d_stride, &d_e[4], &d_e[5],
&d_e[6], &d_e[7], &d_e[8], &d_e[9], &d_e[10], &d_e[11]);
int16x8_t s_tr[8], e_tr[8];
transpose_elems_s16_4x8(d_s[0], d_s[1], d_s[2], d_s[3], d_s[4], d_s[5],
d_s[6], d_s[7], &s_tr[0], &s_tr[1], &s_tr[2],
&s_tr[3]);
transpose_elems_s16_4x8(d_s[8], d_s[9], d_s[10], d_s[11], zeros, zeros,
zeros, zeros, &s_tr[4], &s_tr[5], &s_tr[6],
&s_tr[7]);
transpose_elems_s16_4x8(d_e[0], d_e[1], d_e[2], d_e[3], d_e[4], d_e[5],
d_e[6], d_e[7], &e_tr[0], &e_tr[1], &e_tr[2],
&e_tr[3]);
transpose_elems_s16_4x8(d_e[8], d_e[9], d_e[10], d_e[11], zeros, zeros,
zeros, zeros, &e_tr[4], &e_tr[5], &e_tr[6],
&e_tr[7]);
int16x8_t start_col0[5], start_col1[5], start_col2[5], start_col3[5];
start_col0[0] = vandq_s16(s_tr[0], mask_h);
start_col0[1] = vandq_s16(vextq_s16(s_tr[0], s_tr[4], 1), mask_h);
start_col0[2] = vandq_s16(vextq_s16(s_tr[0], s_tr[4], 2), mask_h);
start_col0[3] = vandq_s16(vextq_s16(s_tr[0], s_tr[4], 3), mask_h);
start_col0[4] = vandq_s16(vextq_s16(s_tr[0], s_tr[4], 4), mask_h);
start_col1[0] = vandq_s16(s_tr[1], mask_h);
start_col1[1] = vandq_s16(vextq_s16(s_tr[1], s_tr[5], 1), mask_h);
start_col1[2] = vandq_s16(vextq_s16(s_tr[1], s_tr[5], 2), mask_h);
start_col1[3] = vandq_s16(vextq_s16(s_tr[1], s_tr[5], 3), mask_h);
start_col1[4] = vandq_s16(vextq_s16(s_tr[1], s_tr[5], 4), mask_h);
start_col2[0] = vandq_s16(s_tr[2], mask_h);
start_col2[1] = vandq_s16(vextq_s16(s_tr[2], s_tr[6], 1), mask_h);
start_col2[2] = vandq_s16(vextq_s16(s_tr[2], s_tr[6], 2), mask_h);
start_col2[3] = vandq_s16(vextq_s16(s_tr[2], s_tr[6], 3), mask_h);
start_col2[4] = vandq_s16(vextq_s16(s_tr[2], s_tr[6], 4), mask_h);
start_col3[0] = vandq_s16(s_tr[3], mask_h);
start_col3[1] = vandq_s16(vextq_s16(s_tr[3], s_tr[7], 1), mask_h);
start_col3[2] = vandq_s16(vextq_s16(s_tr[3], s_tr[7], 2), mask_h);
start_col3[3] = vandq_s16(vextq_s16(s_tr[3], s_tr[7], 3), mask_h);
start_col3[4] = vandq_s16(vextq_s16(s_tr[3], s_tr[7], 4), mask_h);
// i = 1, j = 2;
sub_deltas_step4(start_col0, start_col1, deltas[0]);
// i = 1, j = 3;
sub_deltas_step4(start_col0, start_col2, deltas[1]);
// i = 1, j = 4
sub_deltas_step4(start_col0, start_col3, deltas[2]);
// i = 2, j = 3
sub_deltas_step4(start_col1, start_col2, deltas[3]);
// i = 2, j = 4
sub_deltas_step4(start_col1, start_col3, deltas[4]);
// i = 3, j = 4
sub_deltas_step4(start_col2, start_col3, deltas[5]);
int16x8_t end_col0[5], end_col1[5], end_col2[5], end_col3[5];
end_col0[0] = vandq_s16(e_tr[0], mask_h);
end_col0[1] = vandq_s16(vextq_s16(e_tr[0], e_tr[4], 1), mask_h);
end_col0[2] = vandq_s16(vextq_s16(e_tr[0], e_tr[4], 2), mask_h);
end_col0[3] = vandq_s16(vextq_s16(e_tr[0], e_tr[4], 3), mask_h);
end_col0[4] = vandq_s16(vextq_s16(e_tr[0], e_tr[4], 4), mask_h);
end_col1[0] = vandq_s16(e_tr[1], mask_h);
end_col1[1] = vandq_s16(vextq_s16(e_tr[1], e_tr[5], 1), mask_h);
end_col1[2] = vandq_s16(vextq_s16(e_tr[1], e_tr[5], 2), mask_h);
end_col1[3] = vandq_s16(vextq_s16(e_tr[1], e_tr[5], 3), mask_h);
end_col1[4] = vandq_s16(vextq_s16(e_tr[1], e_tr[5], 4), mask_h);
end_col2[0] = vandq_s16(e_tr[2], mask_h);
end_col2[1] = vandq_s16(vextq_s16(e_tr[2], e_tr[6], 1), mask_h);
end_col2[2] = vandq_s16(vextq_s16(e_tr[2], e_tr[6], 2), mask_h);
end_col2[3] = vandq_s16(vextq_s16(e_tr[2], e_tr[6], 3), mask_h);
end_col2[4] = vandq_s16(vextq_s16(e_tr[2], e_tr[6], 4), mask_h);
end_col3[0] = vandq_s16(e_tr[3], mask_h);
end_col3[1] = vandq_s16(vextq_s16(e_tr[3], e_tr[7], 1), mask_h);
end_col3[2] = vandq_s16(vextq_s16(e_tr[3], e_tr[7], 2), mask_h);
end_col3[3] = vandq_s16(vextq_s16(e_tr[3], e_tr[7], 3), mask_h);
end_col3[4] = vandq_s16(vextq_s16(e_tr[3], e_tr[7], 4), mask_h);
// i = 1, j = 2;
add_deltas_step4(end_col0, end_col1, deltas[0]);
// i = 1, j = 3;
add_deltas_step4(end_col0, end_col2, deltas[1]);
// i = 1, j = 4
add_deltas_step4(end_col0, end_col3, deltas[2]);
// i = 2, j =3
add_deltas_step4(end_col1, end_col2, deltas[3]);
// i = 2, j = 4
add_deltas_step4(end_col1, end_col3, deltas[4]);
// i = 3, j = 4
add_deltas_step4(end_col2, end_col3, deltas[5]);
}
int32x4_t delta[6][2];
int32_t single_delta[6];
delta[0][0] = horizontal_add_4d_s32x4(&deltas[0][0]);
delta[1][0] = horizontal_add_4d_s32x4(&deltas[1][0]);
delta[2][0] = horizontal_add_4d_s32x4(&deltas[2][0]);
delta[3][0] = horizontal_add_4d_s32x4(&deltas[3][0]);
delta[4][0] = horizontal_add_4d_s32x4(&deltas[4][0]);
delta[5][0] = horizontal_add_4d_s32x4(&deltas[5][0]);
delta[0][1] = horizontal_add_4d_s32x4(&deltas[0][5]);
delta[1][1] = horizontal_add_4d_s32x4(&deltas[1][5]);
delta[2][1] = horizontal_add_4d_s32x4(&deltas[2][5]);
delta[3][1] = horizontal_add_4d_s32x4(&deltas[3][5]);
delta[4][1] = horizontal_add_4d_s32x4(&deltas[4][5]);
delta[5][1] = horizontal_add_4d_s32x4(&deltas[5][5]);
single_delta[0] = horizontal_add_s32x4(deltas[0][4]);
single_delta[1] = horizontal_add_s32x4(deltas[1][4]);
single_delta[2] = horizontal_add_s32x4(deltas[2][4]);
single_delta[3] = horizontal_add_s32x4(deltas[3][4]);
single_delta[4] = horizontal_add_s32x4(deltas[4][4]);
single_delta[5] = horizontal_add_s32x4(deltas[5][4]);
int idx = 0;
for (i = 1; i < wiener_win - 1; i++) {
for (j = i + 1; j < wiener_win; j++) {
update_4_stats_neon(
H + (i - 1) * wiener_win * wiener_win2 + (j - 1) * wiener_win,
delta[idx][0], H + i * wiener_win * wiener_win2 + j * wiener_win);
H[i * wiener_win * wiener_win2 + j * wiener_win + 4] =
H[(i - 1) * wiener_win * wiener_win2 + (j - 1) * wiener_win + 4] +
single_delta[idx];
H[(i * wiener_win + 1) * wiener_win2 + j * wiener_win] =
H[((i - 1) * wiener_win + 1) * wiener_win2 + (j - 1) * wiener_win] +
vgetq_lane_s32(delta[idx][1], 0);
H[(i * wiener_win + 2) * wiener_win2 + j * wiener_win] =
H[((i - 1) * wiener_win + 2) * wiener_win2 + (j - 1) * wiener_win] +
vgetq_lane_s32(delta[idx][1], 1);
H[(i * wiener_win + 3) * wiener_win2 + j * wiener_win] =
H[((i - 1) * wiener_win + 3) * wiener_win2 + (j - 1) * wiener_win] +
vgetq_lane_s32(delta[idx][1], 2);
H[(i * wiener_win + 4) * wiener_win2 + j * wiener_win] =
H[((i - 1) * wiener_win + 4) * wiener_win2 + (j - 1) * wiener_win] +
vgetq_lane_s32(delta[idx][1], 3);
idx++;
}
}
}
// Step 5: Derive other points of each square. No square in bottom row.
i = 0;
do {
const int16_t *const di = d + i;
j = i + 1;
do {
const int16_t *const dj = d + j;
int32x4_t deltas[WIENER_WIN_CHROMA - 1][WIENER_WIN_CHROMA - 1] = {
{ vdupq_n_s32(0) }, { vdupq_n_s32(0) }
};
int16x8_t d_is[WIN_CHROMA], d_ie[WIN_CHROMA];
int16x8_t d_js[WIN_CHROMA], d_je[WIN_CHROMA];
x = 0;
while (x < w16) {
load_square_win5_neon(di + x, dj + x, d_stride, height, d_is, d_ie,
d_js, d_je);
derive_square_win5_neon(d_is, d_ie, d_js, d_je, deltas);
x += 16;
}
if (w16 != width) {
load_square_win5_neon(di + x, dj + x, d_stride, height, d_is, d_ie,
d_js, d_je);
d_is[0] = vandq_s16(d_is[0], mask[0]);
d_is[1] = vandq_s16(d_is[1], mask[1]);
d_is[2] = vandq_s16(d_is[2], mask[0]);
d_is[3] = vandq_s16(d_is[3], mask[1]);
d_is[4] = vandq_s16(d_is[4], mask[0]);
d_is[5] = vandq_s16(d_is[5], mask[1]);
d_is[6] = vandq_s16(d_is[6], mask[0]);
d_is[7] = vandq_s16(d_is[7], mask[1]);
d_ie[0] = vandq_s16(d_ie[0], mask[0]);
d_ie[1] = vandq_s16(d_ie[1], mask[1]);
d_ie[2] = vandq_s16(d_ie[2], mask[0]);
d_ie[3] = vandq_s16(d_ie[3], mask[1]);
d_ie[4] = vandq_s16(d_ie[4], mask[0]);
d_ie[5] = vandq_s16(d_ie[5], mask[1]);
d_ie[6] = vandq_s16(d_ie[6], mask[0]);
d_ie[7] = vandq_s16(d_ie[7], mask[1]);
derive_square_win5_neon(d_is, d_ie, d_js, d_je, deltas);
}
hadd_update_4_stats_neon(
H + (i * wiener_win + 0) * wiener_win2 + j * wiener_win, deltas[0],
H + (i * wiener_win + 1) * wiener_win2 + j * wiener_win + 1);
hadd_update_4_stats_neon(
H + (i * wiener_win + 1) * wiener_win2 + j * wiener_win, deltas[1],
H + (i * wiener_win + 2) * wiener_win2 + j * wiener_win + 1);
hadd_update_4_stats_neon(
H + (i * wiener_win + 2) * wiener_win2 + j * wiener_win, deltas[2],
H + (i * wiener_win + 3) * wiener_win2 + j * wiener_win + 1);
hadd_update_4_stats_neon(
H + (i * wiener_win + 3) * wiener_win2 + j * wiener_win, deltas[3],
H + (i * wiener_win + 4) * wiener_win2 + j * wiener_win + 1);
} while (++j < wiener_win);
} while (++i < wiener_win - 1);
// Step 6: Derive other points of each upper triangle along the diagonal.
i = 0;
do {
const int16_t *const di = d + i;
int32x4_t deltas[WIENER_WIN_CHROMA * 2 + 1] = { vdupq_n_s32(0) };
int16x8_t d_is[WIN_CHROMA], d_ie[WIN_CHROMA];
x = 0;
while (x < w16) {
load_triangle_win5_neon(di + x, d_stride, height, d_is, d_ie);
derive_triangle_win5_neon(d_is, d_ie, deltas);
x += 16;
}
if (w16 != width) {
load_triangle_win5_neon(di + x, d_stride, height, d_is, d_ie);
d_is[0] = vandq_s16(d_is[0], mask[0]);
d_is[1] = vandq_s16(d_is[1], mask[1]);
d_is[2] = vandq_s16(d_is[2], mask[0]);
d_is[3] = vandq_s16(d_is[3], mask[1]);
d_is[4] = vandq_s16(d_is[4], mask[0]);
d_is[5] = vandq_s16(d_is[5], mask[1]);
d_is[6] = vandq_s16(d_is[6], mask[0]);
d_is[7] = vandq_s16(d_is[7], mask[1]);
d_ie[0] = vandq_s16(d_ie[0], mask[0]);
d_ie[1] = vandq_s16(d_ie[1], mask[1]);
d_ie[2] = vandq_s16(d_ie[2], mask[0]);
d_ie[3] = vandq_s16(d_ie[3], mask[1]);
d_ie[4] = vandq_s16(d_ie[4], mask[0]);
d_ie[5] = vandq_s16(d_ie[5], mask[1]);
d_ie[6] = vandq_s16(d_ie[6], mask[0]);
d_ie[7] = vandq_s16(d_ie[7], mask[1]);
derive_triangle_win5_neon(d_is, d_ie, deltas);
}
// Row 1: 4 points
hadd_update_4_stats_neon(
H + (i * wiener_win + 0) * wiener_win2 + i * wiener_win, deltas,
H + (i * wiener_win + 1) * wiener_win2 + i * wiener_win + 1);
// Row 2: 3 points
int64x2_t delta4_s64 = vpaddlq_s32(deltas[4]);
int64x2_t delta5_s64 = vpaddlq_s32(deltas[5]);
#if AOM_ARCH_AARCH64
int64x2_t deltas45 = vpaddq_s64(delta4_s64, delta5_s64);
int64x2_t src =
vld1q_s64(H + (i * wiener_win + 1) * wiener_win2 + i * wiener_win + 1);
int64x2_t dst = vaddq_s64(src, deltas45);
vst1q_s64(H + (i * wiener_win + 2) * wiener_win2 + i * wiener_win + 2, dst);
#else
H[(i * wiener_win + 2) * wiener_win2 + i * wiener_win + 2 + 0] =
H[(i * wiener_win + 1) * wiener_win2 + i * wiener_win + 1 + 0] +
horizontal_add_s64x2(delta4_s64);
H[(i * wiener_win + 2) * wiener_win2 + i * wiener_win + 2 + 1] =
H[(i * wiener_win + 1) * wiener_win2 + i * wiener_win + 1 + 1] +
horizontal_add_s64x2(delta5_s64);
#endif // AOM_ARCH_AARCH64
H[(i * wiener_win + 2) * wiener_win2 + i * wiener_win + 4] =
H[(i * wiener_win + 1) * wiener_win2 + i * wiener_win + 3] +
horizontal_long_add_s32x4(deltas[6]);
// Row 3: 2 points
int64x2_t delta7_s64 = vpaddlq_s32(deltas[7]);
int64x2_t delta8_s64 = vpaddlq_s32(deltas[8]);
#if AOM_ARCH_AARCH64
int64x2_t deltas78 = vpaddq_s64(delta7_s64, delta8_s64);
vst1q_s64(H + (i * wiener_win + 3) * wiener_win2 + i * wiener_win + 3,
vaddq_s64(dst, deltas78));
#else
H[(i * wiener_win + 3) * wiener_win2 + i * wiener_win + 3 + 0] =
H[(i * wiener_win + 2) * wiener_win2 + i * wiener_win + 2 + 0] +
horizontal_add_s64x2(delta7_s64);
H[(i * wiener_win + 3) * wiener_win2 + i * wiener_win + 3 + 1] =
H[(i * wiener_win + 2) * wiener_win2 + i * wiener_win + 2 + 1] +
horizontal_add_s64x2(delta8_s64);
#endif // AOM_ARCH_AARCH64
// Row 4: 1 point
H[(i * wiener_win + 4) * wiener_win2 + i * wiener_win + 4] =
H[(i * wiener_win + 3) * wiener_win2 + i * wiener_win + 3] +
horizontal_long_add_s32x4(deltas[9]);
} while (++i < wiener_win);
}
static inline void hadd_update_6_stats_neon(const int64_t *const src,
const int32x4_t *deltas,
int64_t *const dst) {
int64x2_t delta0_s64 = vpaddlq_s32(deltas[0]);
int64x2_t delta1_s64 = vpaddlq_s32(deltas[1]);
int64x2_t delta2_s64 = vpaddlq_s32(deltas[2]);
int64x2_t delta3_s64 = vpaddlq_s32(deltas[3]);
int64x2_t delta4_s64 = vpaddlq_s32(deltas[4]);
int64x2_t delta5_s64 = vpaddlq_s32(deltas[5]);
#if AOM_ARCH_AARCH64
int64x2_t delta01 = vpaddq_s64(delta0_s64, delta1_s64);
int64x2_t delta23 = vpaddq_s64(delta2_s64, delta3_s64);
int64x2_t delta45 = vpaddq_s64(delta4_s64, delta5_s64);
int64x2_t src0 = vld1q_s64(src);
int64x2_t src1 = vld1q_s64(src + 2);
int64x2_t src2 = vld1q_s64(src + 4);
vst1q_s64(dst, vaddq_s64(src0, delta01));
vst1q_s64(dst + 2, vaddq_s64(src1, delta23));
vst1q_s64(dst + 4, vaddq_s64(src2, delta45));
#else
dst[0] = src[0] + horizontal_add_s64x2(delta0_s64);
dst[1] = src[1] + horizontal_add_s64x2(delta1_s64);
dst[2] = src[2] + horizontal_add_s64x2(delta2_s64);
dst[3] = src[3] + horizontal_add_s64x2(delta3_s64);
dst[4] = src[4] + horizontal_add_s64x2(delta4_s64);
dst[5] = src[5] + horizontal_add_s64x2(delta5_s64);
#endif
}
static inline void compute_stats_win7_highbd_neon(
const int16_t *const d, const int32_t d_stride, const int16_t *const s,
const int32_t s_stride, const int32_t width, const int32_t height,
int64_t *const M, int64_t *const H, aom_bit_depth_t bit_depth) {
const int32_t wiener_win = WIENER_WIN;
const int32_t wiener_win2 = wiener_win * wiener_win;
const int32_t w16 = width & ~15;
const int32_t h8 = height & ~7;
int16x8_t mask[2];
mask[0] = vld1q_s16(&(mask_16bit[16]) - width % 16);
mask[1] = vld1q_s16(&(mask_16bit[16]) - width % 16 + 8);
int32_t i, j, x, y;
const int32_t num_bit_left =
32 - 1 /* sign */ - 2 * bit_depth /* energy */ + 2 /* SIMD */;
const int32_t h_allowed =
(1 << num_bit_left) / (w16 + ((w16 != width) ? 16 : 0));
// Step 1: Calculate the top edge of the whole matrix, i.e., the top
// edge of each triangle and square on the top row.
j = 0;
do {
const int16_t *s_t = s;
const int16_t *d_t = d;
int32_t height_t = 0;
int64x2_t sum_m[WIENER_WIN] = { vdupq_n_s64(0) };
int64x2_t sum_h[WIENER_WIN] = { vdupq_n_s64(0) };
int16x8_t src[2], dgd[2];
do {
const int32_t h_t =
((height - height_t) < h_allowed) ? (height - height_t) : h_allowed;
int32x4_t row_m[WIENER_WIN * 2] = { vdupq_n_s32(0) };
int32x4_t row_h[WIENER_WIN * 2] = { vdupq_n_s32(0) };
y = h_t;
do {
x = 0;
while (x < w16) {
src[0] = vld1q_s16(s_t + x);
src[1] = vld1q_s16(s_t + x + 8);
dgd[0] = vld1q_s16(d_t + x);
dgd[1] = vld1q_s16(d_t + x + 8);
stats_top_win7_neon(src, dgd, d_t + j + x, d_stride, row_m, row_h);
x += 16;
}
if (w16 != width) {
src[0] = vld1q_s16(s_t + w16);
src[1] = vld1q_s16(s_t + w16 + 8);
dgd[0] = vld1q_s16(d_t + w16);
dgd[1] = vld1q_s16(d_t + w16 + 8);
src[0] = vandq_s16(src[0], mask[0]);
src[1] = vandq_s16(src[1], mask[1]);
dgd[0] = vandq_s16(dgd[0], mask[0]);
dgd[1] = vandq_s16(dgd[1], mask[1]);
stats_top_win7_neon(src, dgd, d_t + j + w16, d_stride, row_m, row_h);
}
s_t += s_stride;
d_t += d_stride;
} while (--y);
sum_m[0] = vpadalq_s32(sum_m[0], row_m[0]);
sum_m[1] = vpadalq_s32(sum_m[1], row_m[1]);
sum_m[2] = vpadalq_s32(sum_m[2], row_m[2]);
sum_m[3] = vpadalq_s32(sum_m[3], row_m[3]);
sum_m[4] = vpadalq_s32(sum_m[4], row_m[4]);
sum_m[5] = vpadalq_s32(sum_m[5], row_m[5]);
sum_m[6] = vpadalq_s32(sum_m[6], row_m[6]);
sum_h[0] = vpadalq_s32(sum_h[0], row_h[0]);
sum_h[1] = vpadalq_s32(sum_h[1], row_h[1]);
sum_h[2] = vpadalq_s32(sum_h[2], row_h[2]);
sum_h[3] = vpadalq_s32(sum_h[3], row_h[3]);
sum_h[4] = vpadalq_s32(sum_h[4], row_h[4]);
sum_h[5] = vpadalq_s32(sum_h[5], row_h[5]);
sum_h[6] = vpadalq_s32(sum_h[6], row_h[6]);
height_t += h_t;
} while (height_t < height);
#if AOM_ARCH_AARCH64
vst1q_s64(M + wiener_win * j + 0, vpaddq_s64(sum_m[0], sum_m[1]));
vst1q_s64(M + wiener_win * j + 2, vpaddq_s64(sum_m[2], sum_m[3]));
vst1q_s64(M + wiener_win * j + 4, vpaddq_s64(sum_m[4], sum_m[5]));
M[wiener_win * j + 6] = vaddvq_s64(sum_m[6]);
vst1q_s64(H + wiener_win * j + 0, vpaddq_s64(sum_h[0], sum_h[1]));
vst1q_s64(H + wiener_win * j + 2, vpaddq_s64(sum_h[2], sum_h[3]));
vst1q_s64(H + wiener_win * j + 4, vpaddq_s64(sum_h[4], sum_h[5]));
H[wiener_win * j + 6] = vaddvq_s64(sum_h[6]);
#else
M[wiener_win * j + 0] = horizontal_add_s64x2(sum_m[0]);
M[wiener_win * j + 1] = horizontal_add_s64x2(sum_m[1]);
M[wiener_win * j + 2] = horizontal_add_s64x2(sum_m[2]);
M[wiener_win * j + 3] = horizontal_add_s64x2(sum_m[3]);
M[wiener_win * j + 4] = horizontal_add_s64x2(sum_m[4]);
M[wiener_win * j + 5] = horizontal_add_s64x2(sum_m[5]);
M[wiener_win * j + 6] = horizontal_add_s64x2(sum_m[6]);
H[wiener_win * j + 0] = horizontal_add_s64x2(sum_h[0]);
H[wiener_win * j + 1] = horizontal_add_s64x2(sum_h[1]);
H[wiener_win * j + 2] = horizontal_add_s64x2(sum_h[2]);
H[wiener_win * j + 3] = horizontal_add_s64x2(sum_h[3]);
H[wiener_win * j + 4] = horizontal_add_s64x2(sum_h[4]);
H[wiener_win * j + 5] = horizontal_add_s64x2(sum_h[5]);
H[wiener_win * j + 6] = horizontal_add_s64x2(sum_h[6]);
#endif // AOM_ARCH_AARCH64
} while (++j < wiener_win);
// Step 2: Calculate the left edge of each square on the top row.
j = 1;
do {
const int16_t *d_t = d;
int32_t height_t = 0;
int64x2_t sum_h[WIENER_WIN - 1] = { vdupq_n_s64(0) };
int16x8_t dgd[2];
do {
const int32_t h_t =
((height - height_t) < h_allowed) ? (height - height_t) : h_allowed;
int32x4_t row_h[WIENER_WIN - 1] = { vdupq_n_s32(0) };
y = h_t;
do {
x = 0;
while (x < w16) {
dgd[0] = vld1q_s16(d_t + j + x + 0);
dgd[1] = vld1q_s16(d_t + j + x + 8);
stats_left_win7_neon(dgd, d_t + x, d_stride, row_h);
x += 16;
}
if (w16 != width) {
dgd[0] = vld1q_s16(d_t + j + x + 0);
dgd[1] = vld1q_s16(d_t + j + x + 8);
dgd[0] = vandq_s16(dgd[0], mask[0]);
dgd[1] = vandq_s16(dgd[1], mask[1]);
stats_left_win7_neon(dgd, d_t + x, d_stride, row_h);
}
d_t += d_stride;
} while (--y);
sum_h[0] = vpadalq_s32(sum_h[0], row_h[0]);
sum_h[1] = vpadalq_s32(sum_h[1], row_h[1]);
sum_h[2] = vpadalq_s32(sum_h[2], row_h[2]);
sum_h[3] = vpadalq_s32(sum_h[3], row_h[3]);
sum_h[4] = vpadalq_s32(sum_h[4], row_h[4]);
sum_h[5] = vpadalq_s32(sum_h[5], row_h[5]);
height_t += h_t;
} while (height_t < height);
#if AOM_ARCH_AARCH64
int64x2_t sum_h0 = vpaddq_s64(sum_h[0], sum_h[1]);
int64x2_t sum_h2 = vpaddq_s64(sum_h[2], sum_h[3]);
int64x2_t sum_h4 = vpaddq_s64(sum_h[4], sum_h[5]);
vst1_s64(&H[1 * wiener_win2 + j * wiener_win], vget_low_s64(sum_h0));
vst1_s64(&H[2 * wiener_win2 + j * wiener_win], vget_high_s64(sum_h0));
vst1_s64(&H[3 * wiener_win2 + j * wiener_win], vget_low_s64(sum_h2));
vst1_s64(&H[4 * wiener_win2 + j * wiener_win], vget_high_s64(sum_h2));
vst1_s64(&H[5 * wiener_win2 + j * wiener_win], vget_low_s64(sum_h4));
vst1_s64(&H[6 * wiener_win2 + j * wiener_win], vget_high_s64(sum_h4));
#else
H[1 * wiener_win2 + j * wiener_win] = horizontal_add_s64x2(sum_h[0]);
H[2 * wiener_win2 + j * wiener_win] = horizontal_add_s64x2(sum_h[1]);
H[3 * wiener_win2 + j * wiener_win] = horizontal_add_s64x2(sum_h[2]);
H[4 * wiener_win2 + j * wiener_win] = horizontal_add_s64x2(sum_h[3]);
H[5 * wiener_win2 + j * wiener_win] = horizontal_add_s64x2(sum_h[4]);
H[6 * wiener_win2 + j * wiener_win] = horizontal_add_s64x2(sum_h[5]);
#endif // AOM_ARCH_AARCH64
} while (++j < wiener_win);
// Step 3: Derive the top edge of each triangle along the diagonal. No
// triangle in top row.
{
const int16_t *d_t = d;
// Pad to call transpose function.
int32x4_t deltas[(WIENER_WIN + 1) * 2] = { vdupq_n_s32(0) };
int32x4_t deltas_tr[(WIENER_WIN + 1) * 2] = { vdupq_n_s32(0) };
int16x8_t ds[WIENER_WIN * 2];
load_s16_8x6(d_t, d_stride, &ds[0], &ds[2], &ds[4], &ds[6], &ds[8],
&ds[10]);
load_s16_8x6(d_t + width, d_stride, &ds[1], &ds[3], &ds[5], &ds[7], &ds[9],
&ds[11]);
d_t += 6 * d_stride;
step3_win7_neon(d_t, d_stride, width, height, ds, deltas);
transpose_arrays_s32_8x8(deltas, deltas_tr);
update_8_stats_neon(H + 0 * wiener_win * wiener_win2 + 0 * wiener_win,
deltas_tr[0], deltas_tr[4],
H + 1 * wiener_win * wiener_win2 + 1 * wiener_win);
update_8_stats_neon(H + 1 * wiener_win * wiener_win2 + 1 * wiener_win,
deltas_tr[1], deltas_tr[5],
H + 2 * wiener_win * wiener_win2 + 2 * wiener_win);
update_8_stats_neon(H + 2 * wiener_win * wiener_win2 + 2 * wiener_win,
deltas_tr[2], deltas_tr[6],
H + 3 * wiener_win * wiener_win2 + 3 * wiener_win);
update_8_stats_neon(H + 3 * wiener_win * wiener_win2 + 3 * wiener_win,
deltas_tr[3], deltas_tr[7],
H + 4 * wiener_win * wiener_win2 + 4 * wiener_win);
update_8_stats_neon(H + 4 * wiener_win * wiener_win2 + 4 * wiener_win,
deltas_tr[8], deltas_tr[12],
H + 5 * wiener_win * wiener_win2 + 5 * wiener_win);
update_8_stats_neon(H + 5 * wiener_win * wiener_win2 + 5 * wiener_win,
deltas_tr[9], deltas_tr[13],
H + 6 * wiener_win * wiener_win2 + 6 * wiener_win);
}
// Step 4: Derive the top and left edge of each square. No square in top and
// bottom row.
i = 1;
do {
j = i + 1;
do {
const int16_t *di = d + i - 1;
const int16_t *dj = d + j - 1;
int32x4_t deltas[(2 * WIENER_WIN - 1) * 2] = { vdupq_n_s32(0) };
int16x8_t dd[WIENER_WIN * 2], ds[WIENER_WIN * 2];
dd[5] = vdupq_n_s16(0); // Initialize to avoid warning.
const int16_t dd0_values[] = { di[0 * d_stride],
di[1 * d_stride],
di[2 * d_stride],
di[3 * d_stride],
di[4 * d_stride],
di[5 * d_stride],
0,
0 };
dd[0] = vld1q_s16(dd0_values);
const int16_t dd1_values[] = { di[0 * d_stride + width],
di[1 * d_stride + width],
di[2 * d_stride + width],
di[3 * d_stride + width],
di[4 * d_stride + width],
di[5 * d_stride + width],
0,
0 };
dd[1] = vld1q_s16(dd1_values);
const int16_t ds0_values[] = { dj[0 * d_stride],
dj[1 * d_stride],
dj[2 * d_stride],
dj[3 * d_stride],
dj[4 * d_stride],
dj[5 * d_stride],
0,
0 };
ds[0] = vld1q_s16(ds0_values);
int16_t ds1_values[] = { dj[0 * d_stride + width],
dj[1 * d_stride + width],
dj[2 * d_stride + width],
dj[3 * d_stride + width],
dj[4 * d_stride + width],
dj[5 * d_stride + width],
0,
0 };
ds[1] = vld1q_s16(ds1_values);
y = 0;
while (y < h8) {
// 00s 10s 20s 30s 40s 50s 60s 70s 00e 10e 20e 30e 40e 50e 60e 70e
dd[0] = vsetq_lane_s16(di[6 * d_stride], dd[0], 6);
dd[0] = vsetq_lane_s16(di[7 * d_stride], dd[0], 7);
dd[1] = vsetq_lane_s16(di[6 * d_stride + width], dd[1], 6);
dd[1] = vsetq_lane_s16(di[7 * d_stride + width], dd[1], 7);
// 00s 10s 20s 30s 40s 50s 60s 70s 00e 10e 20e 30e 40e 50e 60e 70e
// 01s 11s 21s 31s 41s 51s 61s 71s 01e 11e 21e 31e 41e 51e 61e 71e
ds[0] = vsetq_lane_s16(dj[6 * d_stride], ds[0], 6);
ds[0] = vsetq_lane_s16(dj[7 * d_stride], ds[0], 7);
ds[1] = vsetq_lane_s16(dj[6 * d_stride + width], ds[1], 6);
ds[1] = vsetq_lane_s16(dj[7 * d_stride + width], ds[1], 7);
load_more_16_neon(di + 8 * d_stride, width, &dd[0], &dd[2]);
load_more_16_neon(dj + 8 * d_stride, width, &ds[0], &ds[2]);
load_more_16_neon(di + 9 * d_stride, width, &dd[2], &dd[4]);
load_more_16_neon(dj + 9 * d_stride, width, &ds[2], &ds[4]);
load_more_16_neon(di + 10 * d_stride, width, &dd[4], &dd[6]);
load_more_16_neon(dj + 10 * d_stride, width, &ds[4], &ds[6]);
load_more_16_neon(di + 11 * d_stride, width, &dd[6], &dd[8]);
load_more_16_neon(dj + 11 * d_stride, width, &ds[6], &ds[8]);
load_more_16_neon(di + 12 * d_stride, width, &dd[8], &dd[10]);
load_more_16_neon(dj + 12 * d_stride, width, &ds[8], &ds[10]);
load_more_16_neon(di + 13 * d_stride, width, &dd[10], &dd[12]);
load_more_16_neon(dj + 13 * d_stride, width, &ds[10], &ds[12]);
madd_neon(&deltas[0], dd[0], ds[0]);
madd_neon(&deltas[1], dd[1], ds[1]);
madd_neon(&deltas[2], dd[0], ds[2]);
madd_neon(&deltas[3], dd[1], ds[3]);
madd_neon(&deltas[4], dd[0], ds[4]);
madd_neon(&deltas[5], dd[1], ds[5]);
madd_neon(&deltas[6], dd[0], ds[6]);
madd_neon(&deltas[7], dd[1], ds[7]);
madd_neon(&deltas[8], dd[0], ds[8]);
madd_neon(&deltas[9], dd[1], ds[9]);
madd_neon(&deltas[10], dd[0], ds[10]);
madd_neon(&deltas[11], dd[1], ds[11]);
madd_neon(&deltas[12], dd[0], ds[12]);
madd_neon(&deltas[13], dd[1], ds[13]);
madd_neon(&deltas[14], dd[2], ds[0]);
madd_neon(&deltas[15], dd[3], ds[1]);
madd_neon(&deltas[16], dd[4], ds[0]);
madd_neon(&deltas[17], dd[5], ds[1]);
madd_neon(&deltas[18], dd[6], ds[0]);
madd_neon(&deltas[19], dd[7], ds[1]);
madd_neon(&deltas[20], dd[8], ds[0]);
madd_neon(&deltas[21], dd[9], ds[1]);
madd_neon(&deltas[22], dd[10], ds[0]);
madd_neon(&deltas[23], dd[11], ds[1]);
madd_neon(&deltas[24], dd[12], ds[0]);
madd_neon(&deltas[25], dd[13], ds[1]);
dd[0] = vextq_s16(dd[12], vdupq_n_s16(0), 2);
dd[1] = vextq_s16(dd[13], vdupq_n_s16(0), 2);
ds[0] = vextq_s16(ds[12], vdupq_n_s16(0), 2);
ds[1] = vextq_s16(ds[13], vdupq_n_s16(0), 2);
di += 8 * d_stride;
dj += 8 * d_stride;
y += 8;
}
deltas[0] = hadd_four_32_neon(deltas[0], deltas[2], deltas[4], deltas[6]);
deltas[1] = hadd_four_32_neon(deltas[1], deltas[3], deltas[5], deltas[7]);
deltas[2] =
hadd_four_32_neon(deltas[8], deltas[10], deltas[12], deltas[12]);
deltas[3] =
hadd_four_32_neon(deltas[9], deltas[11], deltas[13], deltas[13]);
deltas[4] =
hadd_four_32_neon(deltas[14], deltas[16], deltas[18], deltas[20]);
deltas[5] =
hadd_four_32_neon(deltas[15], deltas[17], deltas[19], deltas[21]);
deltas[6] =
hadd_four_32_neon(deltas[22], deltas[24], deltas[22], deltas[24]);
deltas[7] =
hadd_four_32_neon(deltas[23], deltas[25], deltas[23], deltas[25]);
deltas[0] = vsubq_s32(deltas[1], deltas[0]);
deltas[1] = vsubq_s32(deltas[3], deltas[2]);
deltas[2] = vsubq_s32(deltas[5], deltas[4]);
deltas[3] = vsubq_s32(deltas[7], deltas[6]);
if (h8 != height) {
const int16_t ds0_vals[] = {
dj[0 * d_stride], dj[0 * d_stride + width],
dj[1 * d_stride], dj[1 * d_stride + width],
dj[2 * d_stride], dj[2 * d_stride + width],
dj[3 * d_stride], dj[3 * d_stride + width]
};
ds[0] = vld1q_s16(ds0_vals);
ds[1] = vsetq_lane_s16(dj[4 * d_stride], ds[1], 0);
ds[1] = vsetq_lane_s16(dj[4 * d_stride + width], ds[1], 1);
ds[1] = vsetq_lane_s16(dj[5 * d_stride], ds[1], 2);
ds[1] = vsetq_lane_s16(dj[5 * d_stride + width], ds[1], 3);
const int16_t dd4_vals[] = {
-di[1 * d_stride], di[1 * d_stride + width],
-di[2 * d_stride], di[2 * d_stride + width],
-di[3 * d_stride], di[3 * d_stride + width],
-di[4 * d_stride], di[4 * d_stride + width]
};
dd[4] = vld1q_s16(dd4_vals);
dd[5] = vsetq_lane_s16(-di[5 * d_stride], dd[5], 0);
dd[5] = vsetq_lane_s16(di[5 * d_stride + width], dd[5], 1);
do {
dd[0] = vdupq_n_s16(-di[0 * d_stride]);
dd[2] = dd[3] = vdupq_n_s16(di[0 * d_stride + width]);
dd[0] = dd[1] = vzipq_s16(dd[0], dd[2]).val[0];
ds[4] = vdupq_n_s16(dj[0 * d_stride]);
ds[6] = ds[7] = vdupq_n_s16(dj[0 * d_stride + width]);
ds[4] = ds[5] = vzipq_s16(ds[4], ds[6]).val[0];
dd[5] = vsetq_lane_s16(-di[6 * d_stride], dd[5], 2);
dd[5] = vsetq_lane_s16(di[6 * d_stride + width], dd[5], 3);
ds[1] = vsetq_lane_s16(dj[6 * d_stride], ds[1], 4);
ds[1] = vsetq_lane_s16(dj[6 * d_stride + width], ds[1], 5);
madd_neon_pairwise(&deltas[0], dd[0], ds[0]);
madd_neon_pairwise(&deltas[1], dd[1], ds[1]);
madd_neon_pairwise(&deltas[2], dd[4], ds[4]);
madd_neon_pairwise(&deltas[3], dd[5], ds[5]);
int32_t tmp0 = vgetq_lane_s32(vreinterpretq_s32_s16(ds[0]), 0);
ds[0] = vextq_s16(ds[0], ds[1], 2);
ds[1] = vextq_s16(ds[1], ds[0], 2);
ds[1] = vreinterpretq_s16_s32(
vsetq_lane_s32(tmp0, vreinterpretq_s32_s16(ds[1]), 3));
int32_t tmp1 = vgetq_lane_s32(vreinterpretq_s32_s16(dd[4]), 0);
dd[4] = vextq_s16(dd[4], dd[5], 2);
dd[5] = vextq_s16(dd[5], dd[4], 2);
dd[5] = vreinterpretq_s16_s32(
vsetq_lane_s32(tmp1, vreinterpretq_s32_s16(dd[5]), 3));
di += d_stride;
dj += d_stride;
} while (++y < height);
}
// Writing one more element on the top edge of a square falls to
// the next square in the same row or the first element in the next
// row, which will just be overwritten later.
update_8_stats_neon(
H + (i - 1) * wiener_win * wiener_win2 + (j - 1) * wiener_win,
deltas[0], deltas[1],
H + i * wiener_win * wiener_win2 + j * wiener_win);
H[(i * wiener_win + 1) * wiener_win2 + j * wiener_win] =
H[((i - 1) * wiener_win + 1) * wiener_win2 + (j - 1) * wiener_win] +
vgetq_lane_s32(deltas[2], 0);
H[(i * wiener_win + 2) * wiener_win2 + j * wiener_win] =
H[((i - 1) * wiener_win + 2) * wiener_win2 + (j - 1) * wiener_win] +
vgetq_lane_s32(deltas[2], 1);
H[(i * wiener_win + 3) * wiener_win2 + j * wiener_win] =
H[((i - 1) * wiener_win + 3) * wiener_win2 + (j - 1) * wiener_win] +
vgetq_lane_s32(deltas[2], 2);
H[(i * wiener_win + 4) * wiener_win2 + j * wiener_win] =
H[((i - 1) * wiener_win + 4) * wiener_win2 + (j - 1) * wiener_win] +
vgetq_lane_s32(deltas[2], 3);
H[(i * wiener_win + 5) * wiener_win2 + j * wiener_win] =
H[((i - 1) * wiener_win + 5) * wiener_win2 + (j - 1) * wiener_win] +
vgetq_lane_s32(deltas[3], 0);
H[(i * wiener_win + 6) * wiener_win2 + j * wiener_win] =
H[((i - 1) * wiener_win + 6) * wiener_win2 + (j - 1) * wiener_win] +
vgetq_lane_s32(deltas[3], 1);
} while (++j < wiener_win);
} while (++i < wiener_win - 1);
// Step 5: Derive other points of each square. No square in bottom row.
i = 0;
do {
const int16_t *const di = d + i;
j = i + 1;
do {
const int16_t *const dj = d + j;
int32x4_t deltas[WIENER_WIN - 1][WIN_7] = { { vdupq_n_s32(0) },
{ vdupq_n_s32(0) } };
int16x8_t d_is[WIN_7];
int16x8_t d_ie[WIN_7];
int16x8_t d_js[WIN_7];
int16x8_t d_je[WIN_7];
x = 0;
while (x < w16) {
load_square_win7_neon(di + x, dj + x, d_stride, height, d_is, d_ie,
d_js, d_je);
derive_square_win7_neon(d_is, d_ie, d_js, d_je, deltas);
x += 16;
}
if (w16 != width) {
load_square_win7_neon(di + x, dj + x, d_stride, height, d_is, d_ie,
d_js, d_je);
d_is[0] = vandq_s16(d_is[0], mask[0]);
d_is[1] = vandq_s16(d_is[1], mask[1]);
d_is[2] = vandq_s16(d_is[2], mask[0]);
d_is[3] = vandq_s16(d_is[3], mask[1]);
d_is[4] = vandq_s16(d_is[4], mask[0]);
d_is[5] = vandq_s16(d_is[5], mask[1]);
d_is[6] = vandq_s16(d_is[6], mask[0]);
d_is[7] = vandq_s16(d_is[7], mask[1]);
d_is[8] = vandq_s16(d_is[8], mask[0]);
d_is[9] = vandq_s16(d_is[9], mask[1]);
d_is[10] = vandq_s16(d_is[10], mask[0]);
d_is[11] = vandq_s16(d_is[11], mask[1]);
d_ie[0] = vandq_s16(d_ie[0], mask[0]);
d_ie[1] = vandq_s16(d_ie[1], mask[1]);
d_ie[2] = vandq_s16(d_ie[2], mask[0]);
d_ie[3] = vandq_s16(d_ie[3], mask[1]);
d_ie[4] = vandq_s16(d_ie[4], mask[0]);
d_ie[5] = vandq_s16(d_ie[5], mask[1]);
d_ie[6] = vandq_s16(d_ie[6], mask[0]);
d_ie[7] = vandq_s16(d_ie[7], mask[1]);
d_ie[8] = vandq_s16(d_ie[8], mask[0]);
d_ie[9] = vandq_s16(d_ie[9], mask[1]);
d_ie[10] = vandq_s16(d_ie[10], mask[0]);
d_ie[11] = vandq_s16(d_ie[11], mask[1]);
derive_square_win7_neon(d_is, d_ie, d_js, d_je, deltas);
}
hadd_update_6_stats_neon(
H + (i * wiener_win + 0) * wiener_win2 + j * wiener_win, deltas[0],
H + (i * wiener_win + 1) * wiener_win2 + j * wiener_win + 1);
hadd_update_6_stats_neon(
H + (i * wiener_win + 1) * wiener_win2 + j * wiener_win, deltas[1],
H + (i * wiener_win + 2) * wiener_win2 + j * wiener_win + 1);
hadd_update_6_stats_neon(
H + (i * wiener_win + 2) * wiener_win2 + j * wiener_win, deltas[2],
H + (i * wiener_win + 3) * wiener_win2 + j * wiener_win + 1);
hadd_update_6_stats_neon(
H + (i * wiener_win + 3) * wiener_win2 + j * wiener_win, deltas[3],
H + (i * wiener_win + 4) * wiener_win2 + j * wiener_win + 1);
hadd_update_6_stats_neon(
H + (i * wiener_win + 4) * wiener_win2 + j * wiener_win, deltas[4],
H + (i * wiener_win + 5) * wiener_win2 + j * wiener_win + 1);
hadd_update_6_stats_neon(
H + (i * wiener_win + 5) * wiener_win2 + j * wiener_win, deltas[5],
H + (i * wiener_win + 6) * wiener_win2 + j * wiener_win + 1);
} while (++j < wiener_win);
} while (++i < wiener_win - 1);
// Step 6: Derive other points of each upper triangle along the diagonal.
i = 0;
do {
const int16_t *const di = d + i;
int32x4_t deltas[WIENER_WIN * (WIENER_WIN - 1)] = { vdupq_n_s32(0) };
int16x8_t d_is[WIN_7], d_ie[WIN_7];
x = 0;
while (x < w16) {
load_triangle_win7_neon(di + x, d_stride, height, d_is, d_ie);
derive_triangle_win7_neon(d_is, d_ie, deltas);
x += 16;
}
if (w16 != width) {
load_triangle_win7_neon(di + x, d_stride, height, d_is, d_ie);
d_is[0] = vandq_s16(d_is[0], mask[0]);
d_is[1] = vandq_s16(d_is[1], mask[1]);
d_is[2] = vandq_s16(d_is[2], mask[0]);
d_is[3] = vandq_s16(d_is[3], mask[1]);
d_is[4] = vandq_s16(d_is[4], mask[0]);
d_is[5] = vandq_s16(d_is[5], mask[1]);
d_is[6] = vandq_s16(d_is[6], mask[0]);
d_is[7] = vandq_s16(d_is[7], mask[1]);
d_is[8] = vandq_s16(d_is[8], mask[0]);
d_is[9] = vandq_s16(d_is[9], mask[1]);
d_is[10] = vandq_s16(d_is[10], mask[0]);
d_is[11] = vandq_s16(d_is[11], mask[1]);
d_ie[0] = vandq_s16(d_ie[0], mask[0]);
d_ie[1] = vandq_s16(d_ie[1], mask[1]);
d_ie[2] = vandq_s16(d_ie[2], mask[0]);
d_ie[3] = vandq_s16(d_ie[3], mask[1]);
d_ie[4] = vandq_s16(d_ie[4], mask[0]);
d_ie[5] = vandq_s16(d_ie[5], mask[1]);
d_ie[6] = vandq_s16(d_ie[6], mask[0]);
d_ie[7] = vandq_s16(d_ie[7], mask[1]);
d_ie[8] = vandq_s16(d_ie[8], mask[0]);
d_ie[9] = vandq_s16(d_ie[9], mask[1]);
d_ie[10] = vandq_s16(d_ie[10], mask[0]);
d_ie[11] = vandq_s16(d_ie[11], mask[1]);
derive_triangle_win7_neon(d_is, d_ie, deltas);
}
// Row 1: 6 points
hadd_update_6_stats_neon(
H + (i * wiener_win + 0) * wiener_win2 + i * wiener_win, deltas,
H + (i * wiener_win + 1) * wiener_win2 + i * wiener_win + 1);
// Row 2: 5 points
hadd_update_4_stats_neon(
H + (i * wiener_win + 1) * wiener_win2 + i * wiener_win + 1, deltas + 6,
H + (i * wiener_win + 2) * wiener_win2 + i * wiener_win + 2);
H[(i * wiener_win + 2) * wiener_win2 + i * wiener_win + 6] =
H[(i * wiener_win + 1) * wiener_win2 + i * wiener_win + 5] +
horizontal_long_add_s32x4(deltas[10]);
// Row 3: 4 points
hadd_update_4_stats_neon(
H + (i * wiener_win + 2) * wiener_win2 + i * wiener_win + 2,
deltas + 11,
H + (i * wiener_win + 3) * wiener_win2 + i * wiener_win + 3);
// Row 4: 3 points
#if AOM_ARCH_AARCH64
int64x2_t delta15_s64 = vpaddlq_s32(deltas[15]);
int64x2_t delta16_s64 = vpaddlq_s32(deltas[16]);
int64x2_t delta1516 = vpaddq_s64(delta15_s64, delta16_s64);
int64x2_t h0 =
vld1q_s64(H + (i * wiener_win + 3) * wiener_win2 + i * wiener_win + 3);
vst1q_s64(H + (i * wiener_win + 4) * wiener_win2 + i * wiener_win + 4,
vaddq_s64(h0, delta1516));
#else
H[(i * wiener_win + 4) * wiener_win2 + i * wiener_win + 4 + 0] =
H[(i * wiener_win + 3) * wiener_win2 + i * wiener_win + 3 + 0] +
horizontal_long_add_s32x4(deltas[15]);
H[(i * wiener_win + 4) * wiener_win2 + i * wiener_win + 4 + 1] =
H[(i * wiener_win + 3) * wiener_win2 + i * wiener_win + 3 + 1] +
horizontal_long_add_s32x4(deltas[16]);
#endif // AOM_ARCH_AARCH64
H[(i * wiener_win + 4) * wiener_win2 + i * wiener_win + 6] =
H[(i * wiener_win + 3) * wiener_win2 + i * wiener_win + 5] +
horizontal_long_add_s32x4(deltas[17]);
// Row 5: 2 points
int64x2_t delta18_s64 = vpaddlq_s32(deltas[18]);
int64x2_t delta19_s64 = vpaddlq_s32(deltas[19]);
#if AOM_ARCH_AARCH64
int64x2_t delta1819 = vpaddq_s64(delta18_s64, delta19_s64);
int64x2_t h1 =
vld1q_s64(H + (i * wiener_win + 4) * wiener_win2 + i * wiener_win + 4);
vst1q_s64(H + (i * wiener_win + 5) * wiener_win2 + i * wiener_win + 5,
vaddq_s64(h1, delta1819));
#else
H[(i * wiener_win + 5) * wiener_win2 + i * wiener_win + 5] =
H[(i * wiener_win + 4) * wiener_win2 + i * wiener_win + 4] +
horizontal_add_s64x2(delta18_s64);
H[(i * wiener_win + 5) * wiener_win2 + i * wiener_win + 5 + 1] =
H[(i * wiener_win + 4) * wiener_win2 + i * wiener_win + 4 + 1] +
horizontal_add_s64x2(delta19_s64);
#endif // AOM_ARCH_AARCH64
// Row 6: 1 points
H[(i * wiener_win + 6) * wiener_win2 + i * wiener_win + 6] =
H[(i * wiener_win + 5) * wiener_win2 + i * wiener_win + 5] +
horizontal_long_add_s32x4(deltas[20]);
} while (++i < wiener_win);
}
static inline void sub_avg_block_highbd_neon(const uint16_t *src,
const int32_t src_stride,
const uint16_t avg,
const int32_t width,
const int32_t height, int16_t *dst,
const int32_t dst_stride) {
const uint16x8_t a = vdupq_n_u16(avg);
int32_t i = height + 1;
do {
int32_t j = 0;
while (j < width) {
const uint16x8_t s = vld1q_u16(src + j);
const uint16x8_t d = vsubq_u16(s, a);
vst1q_s16(dst + j, vreinterpretq_s16_u16(d));
j += 8;
}
src += src_stride;
dst += dst_stride;
} while (--i);
}
static inline uint16_t highbd_find_average_neon(const uint16_t *src,
int src_stride, int width,
int height) {
assert(width > 0);
assert(height > 0);
uint64x2_t sum_u64 = vdupq_n_u64(0);
uint64_t sum = 0;
const uint16x8_t mask =
vreinterpretq_u16_s16(vld1q_s16(&mask_16bit[16] - (width % 8)));
int h = height;
do {
uint32x4_t sum_u32[2] = { vdupq_n_u32(0), vdupq_n_u32(0) };
int w = width;
const uint16_t *row = src;
while (w >= 32) {
uint16x8_t s0 = vld1q_u16(row + 0);
uint16x8_t s1 = vld1q_u16(row + 8);
uint16x8_t s2 = vld1q_u16(row + 16);
uint16x8_t s3 = vld1q_u16(row + 24);
s0 = vaddq_u16(s0, s1);
s2 = vaddq_u16(s2, s3);
sum_u32[0] = vpadalq_u16(sum_u32[0], s0);
sum_u32[1] = vpadalq_u16(sum_u32[1], s2);
row += 32;
w -= 32;
}
if (w >= 16) {
uint16x8_t s0 = vld1q_u16(row + 0);
uint16x8_t s1 = vld1q_u16(row + 8);
s0 = vaddq_u16(s0, s1);
sum_u32[0] = vpadalq_u16(sum_u32[0], s0);
row += 16;
w -= 16;
}
if (w >= 8) {
uint16x8_t s0 = vld1q_u16(row);
sum_u32[1] = vpadalq_u16(sum_u32[1], s0);
row += 8;
w -= 8;
}
if (w) {
uint16x8_t s0 = vandq_u16(vld1q_u16(row), mask);
sum_u32[1] = vpadalq_u16(sum_u32[1], s0);
row += 8;
w -= 8;
}
sum_u64 = vpadalq_u32(sum_u64, vaddq_u32(sum_u32[0], sum_u32[1]));
src += src_stride;
} while (--h != 0);
return (uint16_t)((horizontal_add_u64x2(sum_u64) + sum) / (height * width));
}
void av1_compute_stats_highbd_neon(int32_t wiener_win, const uint8_t *dgd8,
const uint8_t *src8, int16_t *dgd_avg,
int16_t *src_avg, int32_t h_start,
int32_t h_end, int32_t v_start,
int32_t v_end, int32_t dgd_stride,
int32_t src_stride, int64_t *M, int64_t *H,
aom_bit_depth_t bit_depth) {
const int32_t wiener_win2 = wiener_win * wiener_win;
const int32_t wiener_halfwin = (wiener_win >> 1);
const uint16_t *src = CONVERT_TO_SHORTPTR(src8);
const uint16_t *dgd = CONVERT_TO_SHORTPTR(dgd8);
const int32_t width = h_end - h_start;
const int32_t height = v_end - v_start;
const uint16_t *dgd_start = dgd + h_start + v_start * dgd_stride;
const uint16_t avg =
highbd_find_average_neon(dgd_start, dgd_stride, width, height);
const int32_t d_stride = (width + 2 * wiener_halfwin + 15) & ~15;
const int32_t s_stride = (width + 15) & ~15;
sub_avg_block_highbd_neon(src + v_start * src_stride + h_start, src_stride,
avg, width, height, src_avg, s_stride);
sub_avg_block_highbd_neon(
dgd + (v_start - wiener_halfwin) * dgd_stride + h_start - wiener_halfwin,
dgd_stride, avg, width + 2 * wiener_halfwin, height + 2 * wiener_halfwin,
dgd_avg, d_stride);
if (wiener_win == WIENER_WIN) {
compute_stats_win7_highbd_neon(dgd_avg, d_stride, src_avg, s_stride, width,
height, M, H, bit_depth);
} else if (wiener_win == WIENER_WIN_CHROMA) {
compute_stats_win5_highbd_neon(dgd_avg, d_stride, src_avg, s_stride, width,
height, M, H, bit_depth);
}
// H is a symmetric matrix, so we only need to fill out the upper triangle.
// We can copy it down to the lower triangle outside the (i, j) loops.
if (bit_depth == AOM_BITS_8) {
diagonal_copy_stats_neon(wiener_win2, H);
} else if (bit_depth == AOM_BITS_10) { // bit_depth == AOM_BITS_10
const int32_t k4 = wiener_win2 & ~3;
int32_t k = 0;
do {
int64x2_t dst = div4_neon(vld1q_s64(M + k));
vst1q_s64(M + k, dst);
dst = div4_neon(vld1q_s64(M + k + 2));
vst1q_s64(M + k + 2, dst);
H[k * wiener_win2 + k] /= 4;
k += 4;
} while (k < k4);
H[k * wiener_win2 + k] /= 4;
for (; k < wiener_win2; ++k) {
M[k] /= 4;
}
div4_diagonal_copy_stats_neon(wiener_win2, H);
} else { // bit_depth == AOM_BITS_12
const int32_t k4 = wiener_win2 & ~3;
int32_t k = 0;
do {
int64x2_t dst = div16_neon(vld1q_s64(M + k));
vst1q_s64(M + k, dst);
dst = div16_neon(vld1q_s64(M + k + 2));
vst1q_s64(M + k + 2, dst);
H[k * wiener_win2 + k] /= 16;
k += 4;
} while (k < k4);
H[k * wiener_win2 + k] /= 16;
for (; k < wiener_win2; ++k) {
M[k] /= 16;
}
div16_diagonal_copy_stats_neon(wiener_win2, H);
}
}
int64_t av1_highbd_pixel_proj_error_neon(
const uint8_t *src8, int width, int height, int src_stride,
const uint8_t *dat8, int dat_stride, int32_t *flt0, int flt0_stride,
int32_t *flt1, int flt1_stride, int xq[2], const sgr_params_type *params) {
const uint16_t *src = CONVERT_TO_SHORTPTR(src8);
const uint16_t *dat = CONVERT_TO_SHORTPTR(dat8);
int64_t sse = 0;
int64x2_t sse_s64 = vdupq_n_s64(0);
if (params->r[0] > 0 && params->r[1] > 0) {
int32x2_t xq_v = vld1_s32(xq);
int32x2_t xq_sum_v = vshl_n_s32(vpadd_s32(xq_v, xq_v), 4);
do {
int j = 0;
int32x4_t sse_s32 = vdupq_n_s32(0);
do {
const uint16x8_t d = vld1q_u16(&dat[j]);
const uint16x8_t s = vld1q_u16(&src[j]);
int32x4_t flt0_0 = vld1q_s32(&flt0[j]);
int32x4_t flt0_1 = vld1q_s32(&flt0[j + 4]);
int32x4_t flt1_0 = vld1q_s32(&flt1[j]);
int32x4_t flt1_1 = vld1q_s32(&flt1[j + 4]);
int32x4_t d_s32_lo = vreinterpretq_s32_u32(
vmull_lane_u16(vget_low_u16(d), vreinterpret_u16_s32(xq_sum_v), 0));
int32x4_t d_s32_hi = vreinterpretq_s32_u32(vmull_lane_u16(
vget_high_u16(d), vreinterpret_u16_s32(xq_sum_v), 0));
int32x4_t v0 = vsubq_s32(
vdupq_n_s32(1 << (SGRPROJ_RST_BITS + SGRPROJ_PRJ_BITS - 1)),
d_s32_lo);
int32x4_t v1 = vsubq_s32(
vdupq_n_s32(1 << (SGRPROJ_RST_BITS + SGRPROJ_PRJ_BITS - 1)),
d_s32_hi);
v0 = vmlaq_lane_s32(v0, flt0_0, xq_v, 0);
v1 = vmlaq_lane_s32(v1, flt0_1, xq_v, 0);
v0 = vmlaq_lane_s32(v0, flt1_0, xq_v, 1);
v1 = vmlaq_lane_s32(v1, flt1_1, xq_v, 1);
int16x4_t vr0 = vshrn_n_s32(v0, SGRPROJ_RST_BITS + SGRPROJ_PRJ_BITS);
int16x4_t vr1 = vshrn_n_s32(v1, SGRPROJ_RST_BITS + SGRPROJ_PRJ_BITS);
int16x8_t e = vaddq_s16(vcombine_s16(vr0, vr1),
vreinterpretq_s16_u16(vsubq_u16(d, s)));
int16x4_t e_lo = vget_low_s16(e);
int16x4_t e_hi = vget_high_s16(e);
sse_s32 = vmlal_s16(sse_s32, e_lo, e_lo);
sse_s32 = vmlal_s16(sse_s32, e_hi, e_hi);
j += 8;
} while (j <= width - 8);
for (int k = j; k < width; ++k) {
int32_t v = 1 << (SGRPROJ_RST_BITS + SGRPROJ_PRJ_BITS - 1);
v += xq[0] * (flt0[k]) + xq[1] * (flt1[k]);
v -= (xq[1] + xq[0]) * (int32_t)(dat[k] << 4);
int32_t e =
(v >> (SGRPROJ_RST_BITS + SGRPROJ_PRJ_BITS)) + dat[k] - src[k];
sse += ((int64_t)e * e);
}
sse_s64 = vpadalq_s32(sse_s64, sse_s32);
dat += dat_stride;
src += src_stride;
flt0 += flt0_stride;
flt1 += flt1_stride;
} while (--height != 0);
} else if (params->r[0] > 0 || params->r[1] > 0) {
int xq_active = (params->r[0] > 0) ? xq[0] : xq[1];
int32_t *flt = (params->r[0] > 0) ? flt0 : flt1;
int flt_stride = (params->r[0] > 0) ? flt0_stride : flt1_stride;
int32x4_t xq_v = vdupq_n_s32(xq_active);
do {
int j = 0;
int32x4_t sse_s32 = vdupq_n_s32(0);
do {
const uint16x8_t d0 = vld1q_u16(&dat[j]);
const uint16x8_t s0 = vld1q_u16(&src[j]);
int32x4_t flt0_0 = vld1q_s32(&flt[j]);
int32x4_t flt0_1 = vld1q_s32(&flt[j + 4]);
uint16x8_t d_u16 = vshlq_n_u16(d0, 4);
int32x4_t sub0 = vreinterpretq_s32_u32(
vsubw_u16(vreinterpretq_u32_s32(flt0_0), vget_low_u16(d_u16)));
int32x4_t sub1 = vreinterpretq_s32_u32(
vsubw_u16(vreinterpretq_u32_s32(flt0_1), vget_high_u16(d_u16)));
int32x4_t v0 = vmlaq_s32(
vdupq_n_s32(1 << (SGRPROJ_RST_BITS + SGRPROJ_PRJ_BITS - 1)), sub0,
xq_v);
int32x4_t v1 = vmlaq_s32(
vdupq_n_s32(1 << (SGRPROJ_RST_BITS + SGRPROJ_PRJ_BITS - 1)), sub1,
xq_v);
int16x4_t vr0 = vshrn_n_s32(v0, SGRPROJ_RST_BITS + SGRPROJ_PRJ_BITS);
int16x4_t vr1 = vshrn_n_s32(v1, SGRPROJ_RST_BITS + SGRPROJ_PRJ_BITS);
int16x8_t e = vaddq_s16(vcombine_s16(vr0, vr1),
vreinterpretq_s16_u16(vsubq_u16(d0, s0)));
int16x4_t e_lo = vget_low_s16(e);
int16x4_t e_hi = vget_high_s16(e);
sse_s32 = vmlal_s16(sse_s32, e_lo, e_lo);
sse_s32 = vmlal_s16(sse_s32, e_hi, e_hi);
j += 8;
} while (j <= width - 8);
for (int k = j; k < width; ++k) {
int32_t v = 1 << (SGRPROJ_RST_BITS + SGRPROJ_PRJ_BITS - 1);
v += xq_active * (int32_t)((uint32_t)flt[j] - (uint16_t)(dat[k] << 4));
const int32_t e =
(v >> (SGRPROJ_RST_BITS + SGRPROJ_PRJ_BITS)) + dat[k] - src[k];
sse += ((int64_t)e * e);
}
sse_s64 = vpadalq_s32(sse_s64, sse_s32);
dat += dat_stride;
flt += flt_stride;
src += src_stride;
} while (--height != 0);
} else {
do {
int j = 0;
do {
const uint16x8_t d = vld1q_u16(&dat[j]);
const uint16x8_t s = vld1q_u16(&src[j]);
uint16x8_t diff = vabdq_u16(d, s);
uint16x4_t diff_lo = vget_low_u16(diff);
uint16x4_t diff_hi = vget_high_u16(diff);
uint32x4_t sqr_lo = vmull_u16(diff_lo, diff_lo);
uint32x4_t sqr_hi = vmull_u16(diff_hi, diff_hi);
sse_s64 = vpadalq_s32(sse_s64, vreinterpretq_s32_u32(sqr_lo));
sse_s64 = vpadalq_s32(sse_s64, vreinterpretq_s32_u32(sqr_hi));
j += 8;
} while (j <= width - 8);
for (int k = j; k < width; ++k) {
int32_t e = dat[k] - src[k];
sse += e * e;
}
dat += dat_stride;
src += src_stride;
} while (--height != 0);
}
sse += horizontal_add_s64x2(sse_s64);
return sse;
}