mirror of https://github.com/opencv/opencv.git
Open Source Computer Vision Library
https://opencv.org/
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
407 lines
17 KiB
407 lines
17 KiB
// Copyright 2012 Google Inc. All Rights Reserved. |
|
// |
|
// Use of this source code is governed by a BSD-style license |
|
// that can be found in the COPYING 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. |
|
// ----------------------------------------------------------------------------- |
|
// |
|
// ARM NEON version of dsp functions and loop filtering. |
|
// |
|
// Authors: Somnath Banerjee (somnath@google.com) |
|
// Johann Koenig (johannkoenig@google.com) |
|
|
|
#include "./dsp.h" |
|
|
|
#if defined(__cplusplus) || defined(c_plusplus) |
|
extern "C" { |
|
#endif |
|
|
|
#if defined(WEBP_USE_NEON) |
|
|
|
#include "../dec/vp8i.h" |
|
|
|
#define QRegs "q0", "q1", "q2", "q3", "q4", "q5", "q6", "q7", \ |
|
"q8", "q9", "q10", "q11", "q12", "q13", "q14", "q15" |
|
|
|
#define FLIP_SIGN_BIT2(a, b, s) \ |
|
"veor " #a "," #a "," #s " \n" \ |
|
"veor " #b "," #b "," #s " \n" \ |
|
|
|
#define FLIP_SIGN_BIT4(a, b, c, d, s) \ |
|
FLIP_SIGN_BIT2(a, b, s) \ |
|
FLIP_SIGN_BIT2(c, d, s) \ |
|
|
|
#define NEEDS_FILTER(p1, p0, q0, q1, thresh, mask) \ |
|
"vabd.u8 q15," #p0 "," #q0 " \n" /* abs(p0 - q0) */ \ |
|
"vabd.u8 q14," #p1 "," #q1 " \n" /* abs(p1 - q1) */ \ |
|
"vqadd.u8 q15, q15, q15 \n" /* abs(p0 - q0) * 2 */ \ |
|
"vshr.u8 q14, q14, #1 \n" /* abs(p1 - q1) / 2 */ \ |
|
"vqadd.u8 q15, q15, q14 \n" /* abs(p0 - q0) * 2 + abs(p1 - q1) / 2 */ \ |
|
"vdup.8 q14, " #thresh " \n" \ |
|
"vcge.u8 " #mask ", q14, q15 \n" /* mask <= thresh */ |
|
|
|
#define GET_BASE_DELTA(p1, p0, q0, q1, o) \ |
|
"vqsub.s8 q15," #q0 "," #p0 " \n" /* (q0 - p0) */ \ |
|
"vqsub.s8 " #o "," #p1 "," #q1 " \n" /* (p1 - q1) */ \ |
|
"vqadd.s8 " #o "," #o ", q15 \n" /* (p1 - q1) + 1 * (p0 - q0) */ \ |
|
"vqadd.s8 " #o "," #o ", q15 \n" /* (p1 - q1) + 2 * (p0 - q0) */ \ |
|
"vqadd.s8 " #o "," #o ", q15 \n" /* (p1 - q1) + 3 * (p0 - q0) */ |
|
|
|
#define DO_SIMPLE_FILTER(p0, q0, fl) \ |
|
"vmov.i8 q15, #0x03 \n" \ |
|
"vqadd.s8 q15, q15, " #fl " \n" /* filter1 = filter + 3 */ \ |
|
"vshr.s8 q15, q15, #3 \n" /* filter1 >> 3 */ \ |
|
"vqadd.s8 " #p0 "," #p0 ", q15 \n" /* p0 += filter1 */ \ |
|
\ |
|
"vmov.i8 q15, #0x04 \n" \ |
|
"vqadd.s8 q15, q15, " #fl " \n" /* filter1 = filter + 4 */ \ |
|
"vshr.s8 q15, q15, #3 \n" /* filter2 >> 3 */ \ |
|
"vqsub.s8 " #q0 "," #q0 ", q15 \n" /* q0 -= filter2 */ |
|
|
|
// Applies filter on 2 pixels (p0 and q0) |
|
#define DO_FILTER2(p1, p0, q0, q1, thresh) \ |
|
NEEDS_FILTER(p1, p0, q0, q1, thresh, q9) /* filter mask in q9 */ \ |
|
"vmov.i8 q10, #0x80 \n" /* sign bit */ \ |
|
FLIP_SIGN_BIT4(p1, p0, q0, q1, q10) /* convert to signed value */ \ |
|
GET_BASE_DELTA(p1, p0, q0, q1, q11) /* get filter level */ \ |
|
"vand q9, q9, q11 \n" /* apply filter mask */ \ |
|
DO_SIMPLE_FILTER(p0, q0, q9) /* apply filter */ \ |
|
FLIP_SIGN_BIT2(p0, q0, q10) |
|
|
|
// Load/Store vertical edge |
|
#define LOAD8x4(c1, c2, c3, c4, b1, b2, stride) \ |
|
"vld4.8 {" #c1"[0], " #c2"[0], " #c3"[0], " #c4"[0]}," #b1 "," #stride"\n" \ |
|
"vld4.8 {" #c1"[1], " #c2"[1], " #c3"[1], " #c4"[1]}," #b2 "," #stride"\n" \ |
|
"vld4.8 {" #c1"[2], " #c2"[2], " #c3"[2], " #c4"[2]}," #b1 "," #stride"\n" \ |
|
"vld4.8 {" #c1"[3], " #c2"[3], " #c3"[3], " #c4"[3]}," #b2 "," #stride"\n" \ |
|
"vld4.8 {" #c1"[4], " #c2"[4], " #c3"[4], " #c4"[4]}," #b1 "," #stride"\n" \ |
|
"vld4.8 {" #c1"[5], " #c2"[5], " #c3"[5], " #c4"[5]}," #b2 "," #stride"\n" \ |
|
"vld4.8 {" #c1"[6], " #c2"[6], " #c3"[6], " #c4"[6]}," #b1 "," #stride"\n" \ |
|
"vld4.8 {" #c1"[7], " #c2"[7], " #c3"[7], " #c4"[7]}," #b2 "," #stride"\n" |
|
|
|
#define STORE8x2(c1, c2, p, stride) \ |
|
"vst2.8 {" #c1"[0], " #c2"[0]}," #p "," #stride " \n" \ |
|
"vst2.8 {" #c1"[1], " #c2"[1]}," #p "," #stride " \n" \ |
|
"vst2.8 {" #c1"[2], " #c2"[2]}," #p "," #stride " \n" \ |
|
"vst2.8 {" #c1"[3], " #c2"[3]}," #p "," #stride " \n" \ |
|
"vst2.8 {" #c1"[4], " #c2"[4]}," #p "," #stride " \n" \ |
|
"vst2.8 {" #c1"[5], " #c2"[5]}," #p "," #stride " \n" \ |
|
"vst2.8 {" #c1"[6], " #c2"[6]}," #p "," #stride " \n" \ |
|
"vst2.8 {" #c1"[7], " #c2"[7]}," #p "," #stride " \n" |
|
|
|
//----------------------------------------------------------------------------- |
|
// Simple In-loop filtering (Paragraph 15.2) |
|
|
|
static void SimpleVFilter16NEON(uint8_t* p, int stride, int thresh) { |
|
__asm__ volatile ( |
|
"sub %[p], %[p], %[stride], lsl #1 \n" // p -= 2 * stride |
|
|
|
"vld1.u8 {q1}, [%[p]], %[stride] \n" // p1 |
|
"vld1.u8 {q2}, [%[p]], %[stride] \n" // p0 |
|
"vld1.u8 {q3}, [%[p]], %[stride] \n" // q0 |
|
"vld1.u8 {q4}, [%[p]] \n" // q1 |
|
|
|
DO_FILTER2(q1, q2, q3, q4, %[thresh]) |
|
|
|
"sub %[p], %[p], %[stride], lsl #1 \n" // p -= 2 * stride |
|
|
|
"vst1.u8 {q2}, [%[p]], %[stride] \n" // store op0 |
|
"vst1.u8 {q3}, [%[p]] \n" // store oq0 |
|
: [p] "+r"(p) |
|
: [stride] "r"(stride), [thresh] "r"(thresh) |
|
: "memory", QRegs |
|
); |
|
} |
|
|
|
static void SimpleHFilter16NEON(uint8_t* p, int stride, int thresh) { |
|
__asm__ volatile ( |
|
"sub r4, %[p], #2 \n" // base1 = p - 2 |
|
"lsl r6, %[stride], #1 \n" // r6 = 2 * stride |
|
"add r5, r4, %[stride] \n" // base2 = base1 + stride |
|
|
|
LOAD8x4(d2, d3, d4, d5, [r4], [r5], r6) |
|
LOAD8x4(d6, d7, d8, d9, [r4], [r5], r6) |
|
"vswp d3, d6 \n" // p1:q1 p0:q3 |
|
"vswp d5, d8 \n" // q0:q2 q1:q4 |
|
"vswp q2, q3 \n" // p1:q1 p0:q2 q0:q3 q1:q4 |
|
|
|
DO_FILTER2(q1, q2, q3, q4, %[thresh]) |
|
|
|
"sub %[p], %[p], #1 \n" // p - 1 |
|
|
|
"vswp d5, d6 \n" |
|
STORE8x2(d4, d5, [%[p]], %[stride]) |
|
STORE8x2(d6, d7, [%[p]], %[stride]) |
|
|
|
: [p] "+r"(p) |
|
: [stride] "r"(stride), [thresh] "r"(thresh) |
|
: "memory", "r4", "r5", "r6", QRegs |
|
); |
|
} |
|
|
|
static void SimpleVFilter16iNEON(uint8_t* p, int stride, int thresh) { |
|
int k; |
|
for (k = 3; k > 0; --k) { |
|
p += 4 * stride; |
|
SimpleVFilter16NEON(p, stride, thresh); |
|
} |
|
} |
|
|
|
static void SimpleHFilter16iNEON(uint8_t* p, int stride, int thresh) { |
|
int k; |
|
for (k = 3; k > 0; --k) { |
|
p += 4; |
|
SimpleHFilter16NEON(p, stride, thresh); |
|
} |
|
} |
|
|
|
//----------------------------------------------------------------------------- |
|
// Inverse transforms (Paragraph 14.4) |
|
|
|
static void TransformOneNEON(const int16_t *in, uint8_t *dst) { |
|
const int kBPS = BPS; |
|
const int16_t constants[] = {20091, 17734, 0, 0}; |
|
/* kC1, kC2. Padded because vld1.16 loads 8 bytes |
|
* Technically these are unsigned but vqdmulh is only available in signed. |
|
* vqdmulh returns high half (effectively >> 16) but also doubles the value, |
|
* changing the >> 16 to >> 15 and requiring an additional >> 1. |
|
* We use this to our advantage with kC2. The canonical value is 35468. |
|
* However, the high bit is set so treating it as signed will give incorrect |
|
* results. We avoid this by down shifting by 1 here to clear the highest bit. |
|
* Combined with the doubling effect of vqdmulh we get >> 16. |
|
* This can not be applied to kC1 because the lowest bit is set. Down shifting |
|
* the constant would reduce precision. |
|
*/ |
|
|
|
/* libwebp uses a trick to avoid some extra addition that libvpx does. |
|
* Instead of: |
|
* temp2 = ip[12] + ((ip[12] * cospi8sqrt2minus1) >> 16); |
|
* libwebp adds 1 << 16 to cospi8sqrt2minus1 (kC1). However, this causes the |
|
* same issue with kC1 and vqdmulh that we work around by down shifting kC2 |
|
*/ |
|
|
|
/* Adapted from libvpx: vp8/common/arm/neon/shortidct4x4llm_neon.asm */ |
|
__asm__ volatile ( |
|
"vld1.16 {q1, q2}, [%[in]] \n" |
|
"vld1.16 {d0}, [%[constants]] \n" |
|
|
|
/* d2: in[0] |
|
* d3: in[8] |
|
* d4: in[4] |
|
* d5: in[12] |
|
*/ |
|
"vswp d3, d4 \n" |
|
|
|
/* q8 = {in[4], in[12]} * kC1 * 2 >> 16 |
|
* q9 = {in[4], in[12]} * kC2 >> 16 |
|
*/ |
|
"vqdmulh.s16 q8, q2, d0[0] \n" |
|
"vqdmulh.s16 q9, q2, d0[1] \n" |
|
|
|
/* d22 = a = in[0] + in[8] |
|
* d23 = b = in[0] - in[8] |
|
*/ |
|
"vqadd.s16 d22, d2, d3 \n" |
|
"vqsub.s16 d23, d2, d3 \n" |
|
|
|
/* The multiplication should be x * kC1 >> 16 |
|
* However, with vqdmulh we get x * kC1 * 2 >> 16 |
|
* (multiply, double, return high half) |
|
* We avoided this in kC2 by pre-shifting the constant. |
|
* q8 = in[4]/[12] * kC1 >> 16 |
|
*/ |
|
"vshr.s16 q8, q8, #1 \n" |
|
|
|
/* Add {in[4], in[12]} back after the multiplication. This is handled by |
|
* adding 1 << 16 to kC1 in the libwebp C code. |
|
*/ |
|
"vqadd.s16 q8, q2, q8 \n" |
|
|
|
/* d20 = c = in[4]*kC2 - in[12]*kC1 |
|
* d21 = d = in[4]*kC1 + in[12]*kC2 |
|
*/ |
|
"vqsub.s16 d20, d18, d17 \n" |
|
"vqadd.s16 d21, d19, d16 \n" |
|
|
|
/* d2 = tmp[0] = a + d |
|
* d3 = tmp[1] = b + c |
|
* d4 = tmp[2] = b - c |
|
* d5 = tmp[3] = a - d |
|
*/ |
|
"vqadd.s16 d2, d22, d21 \n" |
|
"vqadd.s16 d3, d23, d20 \n" |
|
"vqsub.s16 d4, d23, d20 \n" |
|
"vqsub.s16 d5, d22, d21 \n" |
|
|
|
"vzip.16 q1, q2 \n" |
|
"vzip.16 q1, q2 \n" |
|
|
|
"vswp d3, d4 \n" |
|
|
|
/* q8 = {tmp[4], tmp[12]} * kC1 * 2 >> 16 |
|
* q9 = {tmp[4], tmp[12]} * kC2 >> 16 |
|
*/ |
|
"vqdmulh.s16 q8, q2, d0[0] \n" |
|
"vqdmulh.s16 q9, q2, d0[1] \n" |
|
|
|
/* d22 = a = tmp[0] + tmp[8] |
|
* d23 = b = tmp[0] - tmp[8] |
|
*/ |
|
"vqadd.s16 d22, d2, d3 \n" |
|
"vqsub.s16 d23, d2, d3 \n" |
|
|
|
/* See long winded explanations prior */ |
|
"vshr.s16 q8, q8, #1 \n" |
|
"vqadd.s16 q8, q2, q8 \n" |
|
|
|
/* d20 = c = in[4]*kC2 - in[12]*kC1 |
|
* d21 = d = in[4]*kC1 + in[12]*kC2 |
|
*/ |
|
"vqsub.s16 d20, d18, d17 \n" |
|
"vqadd.s16 d21, d19, d16 \n" |
|
|
|
/* d2 = tmp[0] = a + d |
|
* d3 = tmp[1] = b + c |
|
* d4 = tmp[2] = b - c |
|
* d5 = tmp[3] = a - d |
|
*/ |
|
"vqadd.s16 d2, d22, d21 \n" |
|
"vqadd.s16 d3, d23, d20 \n" |
|
"vqsub.s16 d4, d23, d20 \n" |
|
"vqsub.s16 d5, d22, d21 \n" |
|
|
|
"vld1.32 d6[0], [%[dst]], %[kBPS] \n" |
|
"vld1.32 d6[1], [%[dst]], %[kBPS] \n" |
|
"vld1.32 d7[0], [%[dst]], %[kBPS] \n" |
|
"vld1.32 d7[1], [%[dst]], %[kBPS] \n" |
|
|
|
"sub %[dst], %[dst], %[kBPS], lsl #2 \n" |
|
|
|
/* (val) + 4 >> 3 */ |
|
"vrshr.s16 d2, d2, #3 \n" |
|
"vrshr.s16 d3, d3, #3 \n" |
|
"vrshr.s16 d4, d4, #3 \n" |
|
"vrshr.s16 d5, d5, #3 \n" |
|
|
|
"vzip.16 q1, q2 \n" |
|
"vzip.16 q1, q2 \n" |
|
|
|
/* Must accumulate before saturating */ |
|
"vmovl.u8 q8, d6 \n" |
|
"vmovl.u8 q9, d7 \n" |
|
|
|
"vqadd.s16 q1, q1, q8 \n" |
|
"vqadd.s16 q2, q2, q9 \n" |
|
|
|
"vqmovun.s16 d0, q1 \n" |
|
"vqmovun.s16 d1, q2 \n" |
|
|
|
"vst1.32 d0[0], [%[dst]], %[kBPS] \n" |
|
"vst1.32 d0[1], [%[dst]], %[kBPS] \n" |
|
"vst1.32 d1[0], [%[dst]], %[kBPS] \n" |
|
"vst1.32 d1[1], [%[dst]] \n" |
|
|
|
: [in] "+r"(in), [dst] "+r"(dst) /* modified registers */ |
|
: [kBPS] "r"(kBPS), [constants] "r"(constants) /* constants */ |
|
: "memory", "q0", "q1", "q2", "q8", "q9", "q10", "q11" /* clobbered */ |
|
); |
|
} |
|
|
|
static void TransformTwoNEON(const int16_t* in, uint8_t* dst, int do_two) { |
|
TransformOneNEON(in, dst); |
|
if (do_two) { |
|
TransformOneNEON(in + 16, dst + 4); |
|
} |
|
} |
|
|
|
static void TransformWHT(const int16_t* in, int16_t* out) { |
|
const int kStep = 32; // The store is only incrementing the pointer as if we |
|
// had stored a single byte. |
|
__asm__ volatile ( |
|
// part 1 |
|
// load data into q0, q1 |
|
"vld1.16 {q0, q1}, [%[in]] \n" |
|
|
|
"vaddl.s16 q2, d0, d3 \n" // a0 = in[0] + in[12] |
|
"vaddl.s16 q3, d1, d2 \n" // a1 = in[4] + in[8] |
|
"vsubl.s16 q4, d1, d2 \n" // a2 = in[4] - in[8] |
|
"vsubl.s16 q5, d0, d3 \n" // a3 = in[0] - in[12] |
|
|
|
"vadd.s32 q0, q2, q3 \n" // tmp[0] = a0 + a1 |
|
"vsub.s32 q2, q2, q3 \n" // tmp[8] = a0 - a1 |
|
"vadd.s32 q1, q5, q4 \n" // tmp[4] = a3 + a2 |
|
"vsub.s32 q3, q5, q4 \n" // tmp[12] = a3 - a2 |
|
|
|
// Transpose |
|
// q0 = tmp[0, 4, 8, 12], q1 = tmp[2, 6, 10, 14] |
|
// q2 = tmp[1, 5, 9, 13], q3 = tmp[3, 7, 11, 15] |
|
"vswp d1, d4 \n" // vtrn.64 q0, q2 |
|
"vswp d3, d6 \n" // vtrn.64 q1, q3 |
|
"vtrn.32 q0, q1 \n" |
|
"vtrn.32 q2, q3 \n" |
|
|
|
"vmov.s32 q4, #3 \n" // dc = 3 |
|
"vadd.s32 q0, q0, q4 \n" // dc = tmp[0] + 3 |
|
"vadd.s32 q6, q0, q3 \n" // a0 = dc + tmp[3] |
|
"vadd.s32 q7, q1, q2 \n" // a1 = tmp[1] + tmp[2] |
|
"vsub.s32 q8, q1, q2 \n" // a2 = tmp[1] - tmp[2] |
|
"vsub.s32 q9, q0, q3 \n" // a3 = dc - tmp[3] |
|
|
|
"vadd.s32 q0, q6, q7 \n" |
|
"vshrn.s32 d0, q0, #3 \n" // (a0 + a1) >> 3 |
|
"vadd.s32 q1, q9, q8 \n" |
|
"vshrn.s32 d1, q1, #3 \n" // (a3 + a2) >> 3 |
|
"vsub.s32 q2, q6, q7 \n" |
|
"vshrn.s32 d2, q2, #3 \n" // (a0 - a1) >> 3 |
|
"vsub.s32 q3, q9, q8 \n" |
|
"vshrn.s32 d3, q3, #3 \n" // (a3 - a2) >> 3 |
|
|
|
// set the results to output |
|
"vst1.16 d0[0], [%[out]], %[kStep] \n" |
|
"vst1.16 d1[0], [%[out]], %[kStep] \n" |
|
"vst1.16 d2[0], [%[out]], %[kStep] \n" |
|
"vst1.16 d3[0], [%[out]], %[kStep] \n" |
|
"vst1.16 d0[1], [%[out]], %[kStep] \n" |
|
"vst1.16 d1[1], [%[out]], %[kStep] \n" |
|
"vst1.16 d2[1], [%[out]], %[kStep] \n" |
|
"vst1.16 d3[1], [%[out]], %[kStep] \n" |
|
"vst1.16 d0[2], [%[out]], %[kStep] \n" |
|
"vst1.16 d1[2], [%[out]], %[kStep] \n" |
|
"vst1.16 d2[2], [%[out]], %[kStep] \n" |
|
"vst1.16 d3[2], [%[out]], %[kStep] \n" |
|
"vst1.16 d0[3], [%[out]], %[kStep] \n" |
|
"vst1.16 d1[3], [%[out]], %[kStep] \n" |
|
"vst1.16 d2[3], [%[out]], %[kStep] \n" |
|
"vst1.16 d3[3], [%[out]], %[kStep] \n" |
|
|
|
: [out] "+r"(out) // modified registers |
|
: [in] "r"(in), [kStep] "r"(kStep) // constants |
|
: "memory", "q0", "q1", "q2", "q3", "q4", |
|
"q5", "q6", "q7", "q8", "q9" // clobbered |
|
); |
|
} |
|
|
|
#endif // WEBP_USE_NEON |
|
|
|
//------------------------------------------------------------------------------ |
|
// Entry point |
|
|
|
extern void VP8DspInitNEON(void); |
|
|
|
void VP8DspInitNEON(void) { |
|
#if defined(WEBP_USE_NEON) |
|
VP8Transform = TransformTwoNEON; |
|
VP8TransformWHT = TransformWHT; |
|
|
|
VP8SimpleVFilter16 = SimpleVFilter16NEON; |
|
VP8SimpleHFilter16 = SimpleHFilter16NEON; |
|
VP8SimpleVFilter16i = SimpleVFilter16iNEON; |
|
VP8SimpleHFilter16i = SimpleHFilter16iNEON; |
|
#endif // WEBP_USE_NEON |
|
} |
|
|
|
#if defined(__cplusplus) || defined(c_plusplus) |
|
} // extern "C" |
|
#endif
|
|
|