| Index: source/libvpx/vpx_dsp/x86/variance_sse2.c
|
| diff --git a/source/libvpx/vpx_dsp/x86/variance_sse2.c b/source/libvpx/vpx_dsp/x86/variance_sse2.c
|
| new file mode 100644
|
| index 0000000000000000000000000000000000000000..6256bc53621457b3863e34781284fa659e35ec7a
|
| --- /dev/null
|
| +++ b/source/libvpx/vpx_dsp/x86/variance_sse2.c
|
| @@ -0,0 +1,309 @@
|
| +/*
|
| + * Copyright (c) 2010 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 <emmintrin.h> // SSE2
|
| +
|
| +#include "./vpx_config.h"
|
| +#include "./vpx_dsp_rtcd.h"
|
| +
|
| +#include "vpx_ports/mem.h"
|
| +
|
| +typedef void (*getNxMvar_fn_t) (const unsigned char *src, int src_stride,
|
| + const unsigned char *ref, int ref_stride,
|
| + unsigned int *sse, int *sum);
|
| +
|
| +unsigned int vpx_get_mb_ss_sse2(const int16_t *src) {
|
| + __m128i vsum = _mm_setzero_si128();
|
| + int i;
|
| +
|
| + for (i = 0; i < 32; ++i) {
|
| + const __m128i v = _mm_loadu_si128((const __m128i *)src);
|
| + vsum = _mm_add_epi32(vsum, _mm_madd_epi16(v, v));
|
| + src += 8;
|
| + }
|
| +
|
| + vsum = _mm_add_epi32(vsum, _mm_srli_si128(vsum, 8));
|
| + vsum = _mm_add_epi32(vsum, _mm_srli_si128(vsum, 4));
|
| + return _mm_cvtsi128_si32(vsum);
|
| +}
|
| +
|
| +#define READ64(p, stride, i) \
|
| + _mm_unpacklo_epi8(_mm_cvtsi32_si128(*(const uint32_t *)(p + i * stride)), \
|
| + _mm_cvtsi32_si128(*(const uint32_t *)(p + (i + 1) * stride)))
|
| +
|
| +static void get4x4var_sse2(const uint8_t *src, int src_stride,
|
| + const uint8_t *ref, int ref_stride,
|
| + unsigned int *sse, int *sum) {
|
| + const __m128i zero = _mm_setzero_si128();
|
| + const __m128i src0 = _mm_unpacklo_epi8(READ64(src, src_stride, 0), zero);
|
| + const __m128i src1 = _mm_unpacklo_epi8(READ64(src, src_stride, 2), zero);
|
| + const __m128i ref0 = _mm_unpacklo_epi8(READ64(ref, ref_stride, 0), zero);
|
| + const __m128i ref1 = _mm_unpacklo_epi8(READ64(ref, ref_stride, 2), zero);
|
| + const __m128i diff0 = _mm_sub_epi16(src0, ref0);
|
| + const __m128i diff1 = _mm_sub_epi16(src1, ref1);
|
| +
|
| + // sum
|
| + __m128i vsum = _mm_add_epi16(diff0, diff1);
|
| + vsum = _mm_add_epi16(vsum, _mm_srli_si128(vsum, 8));
|
| + vsum = _mm_add_epi16(vsum, _mm_srli_si128(vsum, 4));
|
| + vsum = _mm_add_epi16(vsum, _mm_srli_si128(vsum, 2));
|
| + *sum = (int16_t)_mm_extract_epi16(vsum, 0);
|
| +
|
| + // sse
|
| + vsum = _mm_add_epi32(_mm_madd_epi16(diff0, diff0),
|
| + _mm_madd_epi16(diff1, diff1));
|
| + vsum = _mm_add_epi32(vsum, _mm_srli_si128(vsum, 8));
|
| + vsum = _mm_add_epi32(vsum, _mm_srli_si128(vsum, 4));
|
| + *sse = _mm_cvtsi128_si32(vsum);
|
| +}
|
| +
|
| +void vpx_get8x8var_sse2(const uint8_t *src, int src_stride,
|
| + const uint8_t *ref, int ref_stride,
|
| + unsigned int *sse, int *sum) {
|
| + const __m128i zero = _mm_setzero_si128();
|
| + __m128i vsum = _mm_setzero_si128();
|
| + __m128i vsse = _mm_setzero_si128();
|
| + int i;
|
| +
|
| + for (i = 0; i < 8; i += 2) {
|
| + const __m128i src0 = _mm_unpacklo_epi8(_mm_loadl_epi64(
|
| + (const __m128i *)(src + i * src_stride)), zero);
|
| + const __m128i ref0 = _mm_unpacklo_epi8(_mm_loadl_epi64(
|
| + (const __m128i *)(ref + i * ref_stride)), zero);
|
| + const __m128i diff0 = _mm_sub_epi16(src0, ref0);
|
| +
|
| + const __m128i src1 = _mm_unpacklo_epi8(_mm_loadl_epi64(
|
| + (const __m128i *)(src + (i + 1) * src_stride)), zero);
|
| + const __m128i ref1 = _mm_unpacklo_epi8(_mm_loadl_epi64(
|
| + (const __m128i *)(ref + (i + 1) * ref_stride)), zero);
|
| + const __m128i diff1 = _mm_sub_epi16(src1, ref1);
|
| +
|
| + vsum = _mm_add_epi16(vsum, diff0);
|
| + vsum = _mm_add_epi16(vsum, diff1);
|
| + vsse = _mm_add_epi32(vsse, _mm_madd_epi16(diff0, diff0));
|
| + vsse = _mm_add_epi32(vsse, _mm_madd_epi16(diff1, diff1));
|
| + }
|
| +
|
| + // sum
|
| + vsum = _mm_add_epi16(vsum, _mm_srli_si128(vsum, 8));
|
| + vsum = _mm_add_epi16(vsum, _mm_srli_si128(vsum, 4));
|
| + vsum = _mm_add_epi16(vsum, _mm_srli_si128(vsum, 2));
|
| + *sum = (int16_t)_mm_extract_epi16(vsum, 0);
|
| +
|
| + // sse
|
| + vsse = _mm_add_epi32(vsse, _mm_srli_si128(vsse, 8));
|
| + vsse = _mm_add_epi32(vsse, _mm_srli_si128(vsse, 4));
|
| + *sse = _mm_cvtsi128_si32(vsse);
|
| +}
|
| +
|
| +void vpx_get16x16var_sse2(const uint8_t *src, int src_stride,
|
| + const uint8_t *ref, int ref_stride,
|
| + unsigned int *sse, int *sum) {
|
| + const __m128i zero = _mm_setzero_si128();
|
| + __m128i vsum = _mm_setzero_si128();
|
| + __m128i vsse = _mm_setzero_si128();
|
| + int i;
|
| +
|
| + for (i = 0; i < 16; ++i) {
|
| + const __m128i s = _mm_loadu_si128((const __m128i *)src);
|
| + const __m128i r = _mm_loadu_si128((const __m128i *)ref);
|
| +
|
| + const __m128i src0 = _mm_unpacklo_epi8(s, zero);
|
| + const __m128i ref0 = _mm_unpacklo_epi8(r, zero);
|
| + const __m128i diff0 = _mm_sub_epi16(src0, ref0);
|
| +
|
| + const __m128i src1 = _mm_unpackhi_epi8(s, zero);
|
| + const __m128i ref1 = _mm_unpackhi_epi8(r, zero);
|
| + const __m128i diff1 = _mm_sub_epi16(src1, ref1);
|
| +
|
| + vsum = _mm_add_epi16(vsum, diff0);
|
| + vsum = _mm_add_epi16(vsum, diff1);
|
| + vsse = _mm_add_epi32(vsse, _mm_madd_epi16(diff0, diff0));
|
| + vsse = _mm_add_epi32(vsse, _mm_madd_epi16(diff1, diff1));
|
| +
|
| + src += src_stride;
|
| + ref += ref_stride;
|
| + }
|
| +
|
| + // sum
|
| + vsum = _mm_add_epi16(vsum, _mm_srli_si128(vsum, 8));
|
| + vsum = _mm_add_epi16(vsum, _mm_srli_si128(vsum, 4));
|
| + *sum = (int16_t)_mm_extract_epi16(vsum, 0) +
|
| + (int16_t)_mm_extract_epi16(vsum, 1);
|
| +
|
| + // sse
|
| + vsse = _mm_add_epi32(vsse, _mm_srli_si128(vsse, 8));
|
| + vsse = _mm_add_epi32(vsse, _mm_srli_si128(vsse, 4));
|
| + *sse = _mm_cvtsi128_si32(vsse);
|
| +}
|
| +
|
| +
|
| +static void variance_sse2(const unsigned char *src, int src_stride,
|
| + const unsigned char *ref, int ref_stride,
|
| + int w, int h, unsigned int *sse, int *sum,
|
| + getNxMvar_fn_t var_fn, int block_size) {
|
| + int i, j;
|
| +
|
| + *sse = 0;
|
| + *sum = 0;
|
| +
|
| + for (i = 0; i < h; i += block_size) {
|
| + for (j = 0; j < w; j += block_size) {
|
| + unsigned int sse0;
|
| + int sum0;
|
| + var_fn(src + src_stride * i + j, src_stride,
|
| + ref + ref_stride * i + j, ref_stride, &sse0, &sum0);
|
| + *sse += sse0;
|
| + *sum += sum0;
|
| + }
|
| + }
|
| +}
|
| +
|
| +unsigned int vpx_variance4x4_sse2(const unsigned char *src, int src_stride,
|
| + const unsigned char *ref, int ref_stride,
|
| + unsigned int *sse) {
|
| + int sum;
|
| + get4x4var_sse2(src, src_stride, ref, ref_stride, sse, &sum);
|
| + return *sse - (((unsigned int)sum * sum) >> 4);
|
| +}
|
| +
|
| +unsigned int vpx_variance8x4_sse2(const uint8_t *src, int src_stride,
|
| + const uint8_t *ref, int ref_stride,
|
| + unsigned int *sse) {
|
| + int sum;
|
| + variance_sse2(src, src_stride, ref, ref_stride, 8, 4,
|
| + sse, &sum, get4x4var_sse2, 4);
|
| + return *sse - (((unsigned int)sum * sum) >> 5);
|
| +}
|
| +
|
| +unsigned int vpx_variance4x8_sse2(const uint8_t *src, int src_stride,
|
| + const uint8_t *ref, int ref_stride,
|
| + unsigned int *sse) {
|
| + int sum;
|
| + variance_sse2(src, src_stride, ref, ref_stride, 4, 8,
|
| + sse, &sum, get4x4var_sse2, 4);
|
| + return *sse - (((unsigned int)sum * sum) >> 5);
|
| +}
|
| +
|
| +unsigned int vpx_variance8x8_sse2(const unsigned char *src, int src_stride,
|
| + const unsigned char *ref, int ref_stride,
|
| + unsigned int *sse) {
|
| + int sum;
|
| + vpx_get8x8var_sse2(src, src_stride, ref, ref_stride, sse, &sum);
|
| + return *sse - (((unsigned int)sum * sum) >> 6);
|
| +}
|
| +
|
| +unsigned int vpx_variance16x8_sse2(const unsigned char *src, int src_stride,
|
| + const unsigned char *ref, int ref_stride,
|
| + unsigned int *sse) {
|
| + int sum;
|
| + variance_sse2(src, src_stride, ref, ref_stride, 16, 8,
|
| + sse, &sum, vpx_get8x8var_sse2, 8);
|
| + return *sse - (((unsigned int)sum * sum) >> 7);
|
| +}
|
| +
|
| +unsigned int vpx_variance8x16_sse2(const unsigned char *src, int src_stride,
|
| + const unsigned char *ref, int ref_stride,
|
| + unsigned int *sse) {
|
| + int sum;
|
| + variance_sse2(src, src_stride, ref, ref_stride, 8, 16,
|
| + sse, &sum, vpx_get8x8var_sse2, 8);
|
| + return *sse - (((unsigned int)sum * sum) >> 7);
|
| +}
|
| +
|
| +unsigned int vpx_variance16x16_sse2(const unsigned char *src, int src_stride,
|
| + const unsigned char *ref, int ref_stride,
|
| + unsigned int *sse) {
|
| + int sum;
|
| + vpx_get16x16var_sse2(src, src_stride, ref, ref_stride, sse, &sum);
|
| + return *sse - (((unsigned int)sum * sum) >> 8);
|
| +}
|
| +
|
| +unsigned int vpx_variance32x32_sse2(const uint8_t *src, int src_stride,
|
| + const uint8_t *ref, int ref_stride,
|
| + unsigned int *sse) {
|
| + int sum;
|
| + variance_sse2(src, src_stride, ref, ref_stride, 32, 32,
|
| + sse, &sum, vpx_get16x16var_sse2, 16);
|
| + return *sse - (((int64_t)sum * sum) >> 10);
|
| +}
|
| +
|
| +unsigned int vpx_variance32x16_sse2(const uint8_t *src, int src_stride,
|
| + const uint8_t *ref, int ref_stride,
|
| + unsigned int *sse) {
|
| + int sum;
|
| + variance_sse2(src, src_stride, ref, ref_stride, 32, 16,
|
| + sse, &sum, vpx_get16x16var_sse2, 16);
|
| + return *sse - (((int64_t)sum * sum) >> 9);
|
| +}
|
| +
|
| +unsigned int vpx_variance16x32_sse2(const uint8_t *src, int src_stride,
|
| + const uint8_t *ref, int ref_stride,
|
| + unsigned int *sse) {
|
| + int sum;
|
| + variance_sse2(src, src_stride, ref, ref_stride, 16, 32,
|
| + sse, &sum, vpx_get16x16var_sse2, 16);
|
| + return *sse - (((int64_t)sum * sum) >> 9);
|
| +}
|
| +
|
| +unsigned int vpx_variance64x64_sse2(const uint8_t *src, int src_stride,
|
| + const uint8_t *ref, int ref_stride,
|
| + unsigned int *sse) {
|
| + int sum;
|
| + variance_sse2(src, src_stride, ref, ref_stride, 64, 64,
|
| + sse, &sum, vpx_get16x16var_sse2, 16);
|
| + return *sse - (((int64_t)sum * sum) >> 12);
|
| +}
|
| +
|
| +unsigned int vpx_variance64x32_sse2(const uint8_t *src, int src_stride,
|
| + const uint8_t *ref, int ref_stride,
|
| + unsigned int *sse) {
|
| + int sum;
|
| + variance_sse2(src, src_stride, ref, ref_stride, 64, 32,
|
| + sse, &sum, vpx_get16x16var_sse2, 16);
|
| + return *sse - (((int64_t)sum * sum) >> 11);
|
| +}
|
| +
|
| +unsigned int vpx_variance32x64_sse2(const uint8_t *src, int src_stride,
|
| + const uint8_t *ref, int ref_stride,
|
| + unsigned int *sse) {
|
| + int sum;
|
| + variance_sse2(src, src_stride, ref, ref_stride, 32, 64,
|
| + sse, &sum, vpx_get16x16var_sse2, 16);
|
| + return *sse - (((int64_t)sum * sum) >> 11);
|
| +}
|
| +
|
| +unsigned int vpx_mse8x8_sse2(const uint8_t *src, int src_stride,
|
| + const uint8_t *ref, int ref_stride,
|
| + unsigned int *sse) {
|
| + vpx_variance8x8_sse2(src, src_stride, ref, ref_stride, sse);
|
| + return *sse;
|
| +}
|
| +
|
| +unsigned int vpx_mse8x16_sse2(const uint8_t *src, int src_stride,
|
| + const uint8_t *ref, int ref_stride,
|
| + unsigned int *sse) {
|
| + vpx_variance8x16_sse2(src, src_stride, ref, ref_stride, sse);
|
| + return *sse;
|
| +}
|
| +
|
| +unsigned int vpx_mse16x8_sse2(const uint8_t *src, int src_stride,
|
| + const uint8_t *ref, int ref_stride,
|
| + unsigned int *sse) {
|
| + vpx_variance16x8_sse2(src, src_stride, ref, ref_stride, sse);
|
| + return *sse;
|
| +}
|
| +
|
| +unsigned int vpx_mse16x16_sse2(const uint8_t *src, int src_stride,
|
| + const uint8_t *ref, int ref_stride,
|
| + unsigned int *sse) {
|
| + vpx_variance16x16_sse2(src, src_stride, ref, ref_stride, sse);
|
| + return *sse;
|
| +}
|
|
|