1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
|
/*
* Copyright (c) 2018 The WebM project authors. All Rights Reserved.
*
* Use of this source code is governed by a BSD-style license
* that can be found in the LICENSE file in the root of the source
* tree. An additional intellectual property rights grant can be found
* in the file PATENTS. All contributing project authors may
* be found in the AUTHORS file in the root of the source tree.
*/
#include <arm_neon.h>
#include <assert.h>
#include "./vpx_dsp_rtcd.h"
#include "vpx_dsp/arm/sum_neon.h"
uint64_t vpx_sum_squares_2d_i16_neon(const int16_t *src, int stride, int size) {
if (size == 4) {
int16x4_t s[4];
int32x4_t sum_s32;
s[0] = vld1_s16(src + 0 * stride);
s[1] = vld1_s16(src + 1 * stride);
s[2] = vld1_s16(src + 2 * stride);
s[3] = vld1_s16(src + 3 * stride);
sum_s32 = vmull_s16(s[0], s[0]);
sum_s32 = vmlal_s16(sum_s32, s[1], s[1]);
sum_s32 = vmlal_s16(sum_s32, s[2], s[2]);
sum_s32 = vmlal_s16(sum_s32, s[3], s[3]);
return horizontal_long_add_uint32x4(vreinterpretq_u32_s32(sum_s32));
} else {
uint64x2_t sum_u64 = vdupq_n_u64(0);
int rows = size;
do {
const int16_t *src_ptr = src;
int32x4_t sum_s32[2] = { vdupq_n_s32(0), vdupq_n_s32(0) };
int cols = size;
do {
int16x8_t s[8];
s[0] = vld1q_s16(src_ptr + 0 * stride);
s[1] = vld1q_s16(src_ptr + 1 * stride);
s[2] = vld1q_s16(src_ptr + 2 * stride);
s[3] = vld1q_s16(src_ptr + 3 * stride);
s[4] = vld1q_s16(src_ptr + 4 * stride);
s[5] = vld1q_s16(src_ptr + 5 * stride);
s[6] = vld1q_s16(src_ptr + 6 * stride);
s[7] = vld1q_s16(src_ptr + 7 * stride);
sum_s32[0] =
vmlal_s16(sum_s32[0], vget_low_s16(s[0]), vget_low_s16(s[0]));
sum_s32[0] =
vmlal_s16(sum_s32[0], vget_low_s16(s[1]), vget_low_s16(s[1]));
sum_s32[0] =
vmlal_s16(sum_s32[0], vget_low_s16(s[2]), vget_low_s16(s[2]));
sum_s32[0] =
vmlal_s16(sum_s32[0], vget_low_s16(s[3]), vget_low_s16(s[3]));
sum_s32[0] =
vmlal_s16(sum_s32[0], vget_low_s16(s[4]), vget_low_s16(s[4]));
sum_s32[0] =
vmlal_s16(sum_s32[0], vget_low_s16(s[5]), vget_low_s16(s[5]));
sum_s32[0] =
vmlal_s16(sum_s32[0], vget_low_s16(s[6]), vget_low_s16(s[6]));
sum_s32[0] =
vmlal_s16(sum_s32[0], vget_low_s16(s[7]), vget_low_s16(s[7]));
sum_s32[1] =
vmlal_s16(sum_s32[1], vget_high_s16(s[0]), vget_high_s16(s[0]));
sum_s32[1] =
vmlal_s16(sum_s32[1], vget_high_s16(s[1]), vget_high_s16(s[1]));
sum_s32[1] =
vmlal_s16(sum_s32[1], vget_high_s16(s[2]), vget_high_s16(s[2]));
sum_s32[1] =
vmlal_s16(sum_s32[1], vget_high_s16(s[3]), vget_high_s16(s[3]));
sum_s32[1] =
vmlal_s16(sum_s32[1], vget_high_s16(s[4]), vget_high_s16(s[4]));
sum_s32[1] =
vmlal_s16(sum_s32[1], vget_high_s16(s[5]), vget_high_s16(s[5]));
sum_s32[1] =
vmlal_s16(sum_s32[1], vget_high_s16(s[6]), vget_high_s16(s[6]));
sum_s32[1] =
vmlal_s16(sum_s32[1], vget_high_s16(s[7]), vget_high_s16(s[7]));
src_ptr += 8;
cols -= 8;
} while (cols);
sum_u64 = vpadalq_u32(sum_u64, vreinterpretq_u32_s32(sum_s32[0]));
sum_u64 = vpadalq_u32(sum_u64, vreinterpretq_u32_s32(sum_s32[1]));
src += 8 * stride;
rows -= 8;
} while (rows);
return horizontal_add_uint64x2(sum_u64);
}
}
|
