133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora// Copyright 2014 Google Inc. All Rights Reserved. 233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora// 333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora// Use of this source code is governed by a BSD-style license 433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora// that can be found in the COPYING file in the root of the source 533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora// tree. An additional intellectual property rights grant can be found 633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora// in the file PATENTS. All contributing project authors may 733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora// be found in the AUTHORS file in the root of the source tree. 833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora// ----------------------------------------------------------------------------- 933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora// 1033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora// SSE2 variant of methods for lossless decoder 1133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora// 1233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora// Author: Skal (pascal.massimino@gmail.com) 1333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 1433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora#include "./dsp.h" 1533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 1633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora#include <assert.h> 1733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 1833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora#if defined(WEBP_USE_SSE2) 1933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora#include <emmintrin.h> 2033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora#include "./lossless.h" 2133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 2233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora//------------------------------------------------------------------------------ 2333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora// Predictor Transform 2433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 2533f74dabbc7920a65ed435d7417987589febdc16Vikas Arorastatic WEBP_INLINE uint32_t ClampedAddSubtractFull(uint32_t c0, uint32_t c1, 2633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora uint32_t c2) { 2733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i zero = _mm_setzero_si128(); 2833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i C0 = _mm_unpacklo_epi8(_mm_cvtsi32_si128(c0), zero); 2933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i C1 = _mm_unpacklo_epi8(_mm_cvtsi32_si128(c1), zero); 3033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i C2 = _mm_unpacklo_epi8(_mm_cvtsi32_si128(c2), zero); 3133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i V1 = _mm_add_epi16(C0, C1); 3233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i V2 = _mm_sub_epi16(V1, C2); 3333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i b = _mm_packus_epi16(V2, V2); 3433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const uint32_t output = _mm_cvtsi128_si32(b); 3533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora return output; 3633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora} 3733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 3833f74dabbc7920a65ed435d7417987589febdc16Vikas Arorastatic WEBP_INLINE uint32_t ClampedAddSubtractHalf(uint32_t c0, uint32_t c1, 3933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora uint32_t c2) { 4033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i zero = _mm_setzero_si128(); 4133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i C0 = _mm_unpacklo_epi8(_mm_cvtsi32_si128(c0), zero); 4233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i C1 = _mm_unpacklo_epi8(_mm_cvtsi32_si128(c1), zero); 4333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i B0 = _mm_unpacklo_epi8(_mm_cvtsi32_si128(c2), zero); 4433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i avg = _mm_add_epi16(C1, C0); 4533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i A0 = _mm_srli_epi16(avg, 1); 4633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i A1 = _mm_sub_epi16(A0, B0); 4733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i BgtA = _mm_cmpgt_epi16(B0, A0); 4833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i A2 = _mm_sub_epi16(A1, BgtA); 4933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i A3 = _mm_srai_epi16(A2, 1); 5033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i A4 = _mm_add_epi16(A0, A3); 5133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i A5 = _mm_packus_epi16(A4, A4); 5233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const uint32_t output = _mm_cvtsi128_si32(A5); 5333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora return output; 5433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora} 5533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 5633f74dabbc7920a65ed435d7417987589febdc16Vikas Arorastatic WEBP_INLINE uint32_t Select(uint32_t a, uint32_t b, uint32_t c) { 5733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora int pa_minus_pb; 5833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i zero = _mm_setzero_si128(); 5933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i A0 = _mm_cvtsi32_si128(a); 6033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i B0 = _mm_cvtsi32_si128(b); 6133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i C0 = _mm_cvtsi32_si128(c); 6233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i AC0 = _mm_subs_epu8(A0, C0); 6333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i CA0 = _mm_subs_epu8(C0, A0); 6433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i BC0 = _mm_subs_epu8(B0, C0); 6533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i CB0 = _mm_subs_epu8(C0, B0); 6633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i AC = _mm_or_si128(AC0, CA0); 6733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i BC = _mm_or_si128(BC0, CB0); 6833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i pa = _mm_unpacklo_epi8(AC, zero); // |a - c| 6933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i pb = _mm_unpacklo_epi8(BC, zero); // |b - c| 7033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i diff = _mm_sub_epi16(pb, pa); 7133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora { 7233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora int16_t out[8]; 7333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora _mm_storeu_si128((__m128i*)out, diff); 7433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora pa_minus_pb = out[0] + out[1] + out[2] + out[3]; 7533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora } 7633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora return (pa_minus_pb <= 0) ? a : b; 7733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora} 7833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 7933f74dabbc7920a65ed435d7417987589febdc16Vikas Arorastatic WEBP_INLINE __m128i Average2_128i(uint32_t a0, uint32_t a1) { 8033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i zero = _mm_setzero_si128(); 8133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i A0 = _mm_unpacklo_epi8(_mm_cvtsi32_si128(a0), zero); 8233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i A1 = _mm_unpacklo_epi8(_mm_cvtsi32_si128(a1), zero); 8333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i sum = _mm_add_epi16(A1, A0); 8433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i avg = _mm_srli_epi16(sum, 1); 8533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora return avg; 8633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora} 8733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 8833f74dabbc7920a65ed435d7417987589febdc16Vikas Arorastatic WEBP_INLINE uint32_t Average2(uint32_t a0, uint32_t a1) { 8933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i avg = Average2_128i(a0, a1); 9033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i A2 = _mm_packus_epi16(avg, avg); 9133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const uint32_t output = _mm_cvtsi128_si32(A2); 9233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora return output; 9333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora} 9433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 9533f74dabbc7920a65ed435d7417987589febdc16Vikas Arorastatic WEBP_INLINE uint32_t Average3(uint32_t a0, uint32_t a1, uint32_t a2) { 9633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i zero = _mm_setzero_si128(); 9733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i avg1 = Average2_128i(a0, a2); 9833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i A1 = _mm_unpacklo_epi8(_mm_cvtsi32_si128(a1), zero); 9933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i sum = _mm_add_epi16(avg1, A1); 10033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i avg2 = _mm_srli_epi16(sum, 1); 10133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i A2 = _mm_packus_epi16(avg2, avg2); 10233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const uint32_t output = _mm_cvtsi128_si32(A2); 10333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora return output; 10433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora} 10533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 10633f74dabbc7920a65ed435d7417987589febdc16Vikas Arorastatic WEBP_INLINE uint32_t Average4(uint32_t a0, uint32_t a1, 10733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora uint32_t a2, uint32_t a3) { 10833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i avg1 = Average2_128i(a0, a1); 10933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i avg2 = Average2_128i(a2, a3); 11033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i sum = _mm_add_epi16(avg2, avg1); 11133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i avg3 = _mm_srli_epi16(sum, 1); 11233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i A0 = _mm_packus_epi16(avg3, avg3); 11333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const uint32_t output = _mm_cvtsi128_si32(A0); 11433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora return output; 11533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora} 11633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 11733f74dabbc7920a65ed435d7417987589febdc16Vikas Arorastatic uint32_t Predictor5(uint32_t left, const uint32_t* const top) { 11833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const uint32_t pred = Average3(left, top[0], top[1]); 11933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora return pred; 12033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora} 12133f74dabbc7920a65ed435d7417987589febdc16Vikas Arorastatic uint32_t Predictor6(uint32_t left, const uint32_t* const top) { 12233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const uint32_t pred = Average2(left, top[-1]); 12333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora return pred; 12433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora} 12533f74dabbc7920a65ed435d7417987589febdc16Vikas Arorastatic uint32_t Predictor7(uint32_t left, const uint32_t* const top) { 12633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const uint32_t pred = Average2(left, top[0]); 12733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora return pred; 12833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora} 12933f74dabbc7920a65ed435d7417987589febdc16Vikas Arorastatic uint32_t Predictor8(uint32_t left, const uint32_t* const top) { 13033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const uint32_t pred = Average2(top[-1], top[0]); 13133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora (void)left; 13233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora return pred; 13333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora} 13433f74dabbc7920a65ed435d7417987589febdc16Vikas Arorastatic uint32_t Predictor9(uint32_t left, const uint32_t* const top) { 13533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const uint32_t pred = Average2(top[0], top[1]); 13633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora (void)left; 13733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora return pred; 13833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora} 13933f74dabbc7920a65ed435d7417987589febdc16Vikas Arorastatic uint32_t Predictor10(uint32_t left, const uint32_t* const top) { 14033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const uint32_t pred = Average4(left, top[-1], top[0], top[1]); 14133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora return pred; 14233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora} 14333f74dabbc7920a65ed435d7417987589febdc16Vikas Arorastatic uint32_t Predictor11(uint32_t left, const uint32_t* const top) { 14433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const uint32_t pred = Select(top[0], left, top[-1]); 14533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora return pred; 14633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora} 14733f74dabbc7920a65ed435d7417987589febdc16Vikas Arorastatic uint32_t Predictor12(uint32_t left, const uint32_t* const top) { 14833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const uint32_t pred = ClampedAddSubtractFull(left, top[0], top[-1]); 14933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora return pred; 15033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora} 15133f74dabbc7920a65ed435d7417987589febdc16Vikas Arorastatic uint32_t Predictor13(uint32_t left, const uint32_t* const top) { 15233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const uint32_t pred = ClampedAddSubtractHalf(left, top[0], top[-1]); 15333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora return pred; 15433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora} 15533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 15633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora//------------------------------------------------------------------------------ 15733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora// Subtract-Green Transform 15833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 15933f74dabbc7920a65ed435d7417987589febdc16Vikas Arorastatic void SubtractGreenFromBlueAndRed(uint32_t* argb_data, int num_pixels) { 16033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i mask = _mm_set1_epi32(0x0000ff00); 16133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora int i; 16233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora for (i = 0; i + 4 <= num_pixels; i += 4) { 16333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i in = _mm_loadu_si128((__m128i*)&argb_data[i]); 16433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i in_00g0 = _mm_and_si128(in, mask); // 00g0|00g0|... 16533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i in_0g00 = _mm_slli_epi32(in_00g0, 8); // 0g00|0g00|... 16633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i in_000g = _mm_srli_epi32(in_00g0, 8); // 000g|000g|... 16733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i in_0g0g = _mm_or_si128(in_0g00, in_000g); 16833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i out = _mm_sub_epi8(in, in_0g0g); 16933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora _mm_storeu_si128((__m128i*)&argb_data[i], out); 17033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora } 17133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora // fallthrough and finish off with plain-C 17233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora VP8LSubtractGreenFromBlueAndRed_C(argb_data + i, num_pixels - i); 17333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora} 17433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 17533f74dabbc7920a65ed435d7417987589febdc16Vikas Arorastatic void AddGreenToBlueAndRed(uint32_t* argb_data, int num_pixels) { 17633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i mask = _mm_set1_epi32(0x0000ff00); 17733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora int i; 17833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora for (i = 0; i + 4 <= num_pixels; i += 4) { 17933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i in = _mm_loadu_si128((__m128i*)&argb_data[i]); 18033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i in_00g0 = _mm_and_si128(in, mask); // 00g0|00g0|... 18133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i in_0g00 = _mm_slli_epi32(in_00g0, 8); // 0g00|0g00|... 18233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i in_000g = _mm_srli_epi32(in_00g0, 8); // 000g|000g|... 18333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i in_0g0g = _mm_or_si128(in_0g00, in_000g); 18433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i out = _mm_add_epi8(in, in_0g0g); 18533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora _mm_storeu_si128((__m128i*)&argb_data[i], out); 18633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora } 18733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora // fallthrough and finish off with plain-C 18833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora VP8LAddGreenToBlueAndRed_C(argb_data + i, num_pixels - i); 18933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora} 19033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 19133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora//------------------------------------------------------------------------------ 19233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora// Color Transform 19333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 19433f74dabbc7920a65ed435d7417987589febdc16Vikas Arorastatic WEBP_INLINE __m128i ColorTransformDelta(__m128i color_pred, 19533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora __m128i color) { 19633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora // We simulate signed 8-bit multiplication as: 19733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora // * Left shift the two (8-bit) numbers by 8 bits, 19833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora // * Perform a 16-bit signed multiplication and retain the higher 16-bits. 19933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i color_pred_shifted = _mm_slli_epi32(color_pred, 8); 20033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i color_shifted = _mm_slli_epi32(color, 8); 20133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora // Note: This performs multiplication on 8 packed 16-bit numbers, 4 of which 20233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora // happen to be zeroes. 20333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i signed_mult = 20433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora _mm_mulhi_epi16(color_pred_shifted, color_shifted); 20533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora return _mm_srli_epi32(signed_mult, 5); 20633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora} 20733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 20833f74dabbc7920a65ed435d7417987589febdc16Vikas Arorastatic WEBP_INLINE void TransformColor(const VP8LMultipliers* const m, 20933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora uint32_t* argb_data, 21033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora int num_pixels) { 21133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i g_to_r = _mm_set1_epi32(m->green_to_red_); // multipliers 21233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i g_to_b = _mm_set1_epi32(m->green_to_blue_); 21333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i r_to_b = _mm_set1_epi32(m->red_to_blue_); 21433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 21533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora int i; 21633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 21733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora for (i = 0; i + 4 <= num_pixels; i += 4) { 21833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i in = _mm_loadu_si128((__m128i*)&argb_data[i]); 21933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i alpha_green_mask = _mm_set1_epi32(0xff00ff00); // masks 22033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i red_mask = _mm_set1_epi32(0x00ff0000); 22133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i green_mask = _mm_set1_epi32(0x0000ff00); 22233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i lower_8bit_mask = _mm_set1_epi32(0x000000ff); 22333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i ag = _mm_and_si128(in, alpha_green_mask); // alpha, green 22433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i r = _mm_srli_epi32(_mm_and_si128(in, red_mask), 16); 22533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i g = _mm_srli_epi32(_mm_and_si128(in, green_mask), 8); 22633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i b = in; 22733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 22833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i r_delta = ColorTransformDelta(g_to_r, g); // red 22933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i r_new = 23033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora _mm_and_si128(_mm_sub_epi32(r, r_delta), lower_8bit_mask); 23133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i r_new_shifted = _mm_slli_epi32(r_new, 16); 23233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 23333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i b_delta_1 = ColorTransformDelta(g_to_b, g); // blue 23433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i b_delta_2 = ColorTransformDelta(r_to_b, r); 23533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i b_delta = _mm_add_epi32(b_delta_1, b_delta_2); 23633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i b_new = 23733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora _mm_and_si128(_mm_sub_epi32(b, b_delta), lower_8bit_mask); 23833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 23933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i out = _mm_or_si128(_mm_or_si128(ag, r_new_shifted), b_new); 24033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora _mm_storeu_si128((__m128i*)&argb_data[i], out); 24133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora } 24233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 24333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora // Fall-back to C-version for left-overs. 24433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora VP8LTransformColor_C(m, argb_data + i, num_pixels - i); 24533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora} 24633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 24733f74dabbc7920a65ed435d7417987589febdc16Vikas Arorastatic WEBP_INLINE void TransformColorInverse(const VP8LMultipliers* const m, 24833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora uint32_t* argb_data, 24933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora int num_pixels) { 25033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i g_to_r = _mm_set1_epi32(m->green_to_red_); // multipliers 25133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i g_to_b = _mm_set1_epi32(m->green_to_blue_); 25233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i r_to_b = _mm_set1_epi32(m->red_to_blue_); 25333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 25433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora int i; 25533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 25633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora for (i = 0; i + 4 <= num_pixels; i += 4) { 25733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i in = _mm_loadu_si128((__m128i*)&argb_data[i]); 25833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i alpha_green_mask = _mm_set1_epi32(0xff00ff00); // masks 25933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i red_mask = _mm_set1_epi32(0x00ff0000); 26033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i green_mask = _mm_set1_epi32(0x0000ff00); 26133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i lower_8bit_mask = _mm_set1_epi32(0x000000ff); 26233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i ag = _mm_and_si128(in, alpha_green_mask); // alpha, green 26333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i r = _mm_srli_epi32(_mm_and_si128(in, red_mask), 16); 26433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i g = _mm_srli_epi32(_mm_and_si128(in, green_mask), 8); 26533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i b = in; 26633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 26733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i r_delta = ColorTransformDelta(g_to_r, g); // red 26833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i r_new = 26933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora _mm_and_si128(_mm_add_epi32(r, r_delta), lower_8bit_mask); 27033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i r_new_shifted = _mm_slli_epi32(r_new, 16); 27133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 27233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i b_delta_1 = ColorTransformDelta(g_to_b, g); // blue 27333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i b_delta_2 = ColorTransformDelta(r_to_b, r_new); 27433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i b_delta = _mm_add_epi32(b_delta_1, b_delta_2); 27533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i b_new = 27633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora _mm_and_si128(_mm_add_epi32(b, b_delta), lower_8bit_mask); 27733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 27833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i out = _mm_or_si128(_mm_or_si128(ag, r_new_shifted), b_new); 27933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora _mm_storeu_si128((__m128i*)&argb_data[i], out); 28033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora } 28133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 28233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora // Fall-back to C-version for left-overs. 28333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora VP8LTransformColorInverse_C(m, argb_data + i, num_pixels - i); 28433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora} 28533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 28633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora//------------------------------------------------------------------------------ 28733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora// Color-space conversion functions 28833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 28933f74dabbc7920a65ed435d7417987589febdc16Vikas Arorastatic void ConvertBGRAToRGBA(const uint32_t* src, 29033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora int num_pixels, uint8_t* dst) { 29133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i* in = (const __m128i*)src; 29233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora __m128i* out = (__m128i*)dst; 29333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora while (num_pixels >= 8) { 29433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i bgra0 = _mm_loadu_si128(in++); // bgra0|bgra1|bgra2|bgra3 29533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i bgra4 = _mm_loadu_si128(in++); // bgra4|bgra5|bgra6|bgra7 29633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i v0l = _mm_unpacklo_epi8(bgra0, bgra4); // b0b4g0g4r0r4a0a4... 29733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i v0h = _mm_unpackhi_epi8(bgra0, bgra4); // b2b6g2g6r2r6a2a6... 29833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i v1l = _mm_unpacklo_epi8(v0l, v0h); // b0b2b4b6g0g2g4g6... 29933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i v1h = _mm_unpackhi_epi8(v0l, v0h); // b1b3b5b7g1g3g5g7... 30033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i v2l = _mm_unpacklo_epi8(v1l, v1h); // b0...b7 | g0...g7 30133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i v2h = _mm_unpackhi_epi8(v1l, v1h); // r0...r7 | a0...a7 30233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i ga0 = _mm_unpackhi_epi64(v2l, v2h); // g0...g7 | a0...a7 30333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i rb0 = _mm_unpacklo_epi64(v2h, v2l); // r0...r7 | b0...b7 30433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i rg0 = _mm_unpacklo_epi8(rb0, ga0); // r0g0r1g1 ... r6g6r7g7 30533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i ba0 = _mm_unpackhi_epi8(rb0, ga0); // b0a0b1a1 ... b6a6b7a7 30633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i rgba0 = _mm_unpacklo_epi16(rg0, ba0); // rgba0|rgba1... 30733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i rgba4 = _mm_unpackhi_epi16(rg0, ba0); // rgba4|rgba5... 30833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora _mm_storeu_si128(out++, rgba0); 30933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora _mm_storeu_si128(out++, rgba4); 31033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora num_pixels -= 8; 31133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora } 31233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora // left-overs 31333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora VP8LConvertBGRAToRGBA_C((const uint32_t*)in, num_pixels, (uint8_t*)out); 31433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora} 31533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 31633f74dabbc7920a65ed435d7417987589febdc16Vikas Arorastatic void ConvertBGRAToRGBA4444(const uint32_t* src, 31733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora int num_pixels, uint8_t* dst) { 31833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i mask_0x0f = _mm_set1_epi8(0x0f); 31933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i mask_0xf0 = _mm_set1_epi8(0xf0); 32033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i* in = (const __m128i*)src; 32133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora __m128i* out = (__m128i*)dst; 32233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora while (num_pixels >= 8) { 32333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i bgra0 = _mm_loadu_si128(in++); // bgra0|bgra1|bgra2|bgra3 32433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i bgra4 = _mm_loadu_si128(in++); // bgra4|bgra5|bgra6|bgra7 32533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i v0l = _mm_unpacklo_epi8(bgra0, bgra4); // b0b4g0g4r0r4a0a4... 32633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i v0h = _mm_unpackhi_epi8(bgra0, bgra4); // b2b6g2g6r2r6a2a6... 32733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i v1l = _mm_unpacklo_epi8(v0l, v0h); // b0b2b4b6g0g2g4g6... 32833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i v1h = _mm_unpackhi_epi8(v0l, v0h); // b1b3b5b7g1g3g5g7... 32933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i v2l = _mm_unpacklo_epi8(v1l, v1h); // b0...b7 | g0...g7 33033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i v2h = _mm_unpackhi_epi8(v1l, v1h); // r0...r7 | a0...a7 33133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i ga0 = _mm_unpackhi_epi64(v2l, v2h); // g0...g7 | a0...a7 33233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i rb0 = _mm_unpacklo_epi64(v2h, v2l); // r0...r7 | b0...b7 33333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i ga1 = _mm_srli_epi16(ga0, 4); // g0-|g1-|...|a6-|a7- 33433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i rb1 = _mm_and_si128(rb0, mask_0xf0); // -r0|-r1|...|-b6|-a7 33533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i ga2 = _mm_and_si128(ga1, mask_0x0f); // g0-|g1-|...|a6-|a7- 33633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i rgba0 = _mm_or_si128(ga2, rb1); // rg0..rg7 | ba0..ba7 33733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i rgba1 = _mm_srli_si128(rgba0, 8); // ba0..ba7 | 0 33833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora#ifdef WEBP_SWAP_16BIT_CSP 33933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i rgba = _mm_unpacklo_epi8(rgba1, rgba0); // barg0...barg7 34033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora#else 34133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i rgba = _mm_unpacklo_epi8(rgba0, rgba1); // rgba0...rgba7 34233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora#endif 34333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora _mm_storeu_si128(out++, rgba); 34433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora num_pixels -= 8; 34533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora } 34633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora // left-overs 34733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora VP8LConvertBGRAToRGBA4444_C((const uint32_t*)in, num_pixels, (uint8_t*)out); 34833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora} 34933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 35033f74dabbc7920a65ed435d7417987589febdc16Vikas Arorastatic void ConvertBGRAToRGB565(const uint32_t* src, 35133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora int num_pixels, uint8_t* dst) { 35233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i mask_0xe0 = _mm_set1_epi8(0xe0); 35333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i mask_0xf8 = _mm_set1_epi8(0xf8); 35433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i mask_0x07 = _mm_set1_epi8(0x07); 35533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i* in = (const __m128i*)src; 35633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora __m128i* out = (__m128i*)dst; 35733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora while (num_pixels >= 8) { 35833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i bgra0 = _mm_loadu_si128(in++); // bgra0|bgra1|bgra2|bgra3 35933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i bgra4 = _mm_loadu_si128(in++); // bgra4|bgra5|bgra6|bgra7 36033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i v0l = _mm_unpacklo_epi8(bgra0, bgra4); // b0b4g0g4r0r4a0a4... 36133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i v0h = _mm_unpackhi_epi8(bgra0, bgra4); // b2b6g2g6r2r6a2a6... 36233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i v1l = _mm_unpacklo_epi8(v0l, v0h); // b0b2b4b6g0g2g4g6... 36333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i v1h = _mm_unpackhi_epi8(v0l, v0h); // b1b3b5b7g1g3g5g7... 36433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i v2l = _mm_unpacklo_epi8(v1l, v1h); // b0...b7 | g0...g7 36533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i v2h = _mm_unpackhi_epi8(v1l, v1h); // r0...r7 | a0...a7 36633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i ga0 = _mm_unpackhi_epi64(v2l, v2h); // g0...g7 | a0...a7 36733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i rb0 = _mm_unpacklo_epi64(v2h, v2l); // r0...r7 | b0...b7 36833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i rb1 = _mm_and_si128(rb0, mask_0xf8); // -r0..-r7|-b0..-b7 36933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i g_lo1 = _mm_srli_epi16(ga0, 5); 37033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i g_lo2 = _mm_and_si128(g_lo1, mask_0x07); // g0-...g7-|xx (3b) 37133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i g_hi1 = _mm_slli_epi16(ga0, 3); 37233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i g_hi2 = _mm_and_si128(g_hi1, mask_0xe0); // -g0...-g7|xx (3b) 37333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i b0 = _mm_srli_si128(rb1, 8); // -b0...-b7|0 37433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i rg1 = _mm_or_si128(rb1, g_lo2); // gr0...gr7|xx 37533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i b1 = _mm_srli_epi16(b0, 3); 37633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i gb1 = _mm_or_si128(b1, g_hi2); // bg0...bg7|xx 37733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora#ifdef WEBP_SWAP_16BIT_CSP 37833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i rgba = _mm_unpacklo_epi8(gb1, rg1); // rggb0...rggb7 37933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora#else 38033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i rgba = _mm_unpacklo_epi8(rg1, gb1); // bgrb0...bgrb7 38133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora#endif 38233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora _mm_storeu_si128(out++, rgba); 38333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora num_pixels -= 8; 38433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora } 38533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora // left-overs 38633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora VP8LConvertBGRAToRGB565_C((const uint32_t*)in, num_pixels, (uint8_t*)out); 38733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora} 38833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 38933f74dabbc7920a65ed435d7417987589febdc16Vikas Arorastatic void ConvertBGRAToBGR(const uint32_t* src, 39033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora int num_pixels, uint8_t* dst) { 39133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i mask_l = _mm_set_epi32(0, 0x00ffffff, 0, 0x00ffffff); 39233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i mask_h = _mm_set_epi32(0x00ffffff, 0, 0x00ffffff, 0); 39333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i* in = (const __m128i*)src; 39433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const uint8_t* const end = dst + num_pixels * 3; 39533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora // the last storel_epi64 below writes 8 bytes starting at offset 18 39633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora while (dst + 26 <= end) { 39733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i bgra0 = _mm_loadu_si128(in++); // bgra0|bgra1|bgra2|bgra3 39833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i bgra4 = _mm_loadu_si128(in++); // bgra4|bgra5|bgra6|bgra7 39933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i a0l = _mm_and_si128(bgra0, mask_l); // bgr0|0|bgr0|0 40033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i a4l = _mm_and_si128(bgra4, mask_l); // bgr0|0|bgr0|0 40133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i a0h = _mm_and_si128(bgra0, mask_h); // 0|bgr0|0|bgr0 40233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i a4h = _mm_and_si128(bgra4, mask_h); // 0|bgr0|0|bgr0 40333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i b0h = _mm_srli_epi64(a0h, 8); // 000b|gr00|000b|gr00 40433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i b4h = _mm_srli_epi64(a4h, 8); // 000b|gr00|000b|gr00 40533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i c0 = _mm_or_si128(a0l, b0h); // rgbrgb00|rgbrgb00 40633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i c4 = _mm_or_si128(a4l, b4h); // rgbrgb00|rgbrgb00 40733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i c2 = _mm_srli_si128(c0, 8); 40833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i c6 = _mm_srli_si128(c4, 8); 40933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora _mm_storel_epi64((__m128i*)(dst + 0), c0); 41033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora _mm_storel_epi64((__m128i*)(dst + 6), c2); 41133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora _mm_storel_epi64((__m128i*)(dst + 12), c4); 41233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora _mm_storel_epi64((__m128i*)(dst + 18), c6); 41333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora dst += 24; 41433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora num_pixels -= 8; 41533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora } 41633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora // left-overs 41733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora VP8LConvertBGRAToBGR_C((const uint32_t*)in, num_pixels, dst); 41833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora} 41933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 42033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora//------------------------------------------------------------------------------ 42133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 42233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora#define LINE_SIZE 16 // 8 or 16 42333f74dabbc7920a65ed435d7417987589febdc16Vikas Arorastatic void AddVector(const uint32_t* a, const uint32_t* b, uint32_t* out, 42433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora int size) { 42533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora int i; 42633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora assert(size % LINE_SIZE == 0); 42733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora for (i = 0; i < size; i += LINE_SIZE) { 42833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i a0 = _mm_loadu_si128((__m128i*)&a[i + 0]); 42933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i a1 = _mm_loadu_si128((__m128i*)&a[i + 4]); 43033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora#if (LINE_SIZE == 16) 43133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i a2 = _mm_loadu_si128((__m128i*)&a[i + 8]); 43233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i a3 = _mm_loadu_si128((__m128i*)&a[i + 12]); 43333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora#endif 43433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i b0 = _mm_loadu_si128((__m128i*)&b[i + 0]); 43533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i b1 = _mm_loadu_si128((__m128i*)&b[i + 4]); 43633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora#if (LINE_SIZE == 16) 43733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i b2 = _mm_loadu_si128((__m128i*)&b[i + 8]); 43833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i b3 = _mm_loadu_si128((__m128i*)&b[i + 12]); 43933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora#endif 44033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora _mm_storeu_si128((__m128i*)&out[i + 0], _mm_add_epi32(a0, b0)); 44133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora _mm_storeu_si128((__m128i*)&out[i + 4], _mm_add_epi32(a1, b1)); 44233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora#if (LINE_SIZE == 16) 44333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora _mm_storeu_si128((__m128i*)&out[i + 8], _mm_add_epi32(a2, b2)); 44433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora _mm_storeu_si128((__m128i*)&out[i + 12], _mm_add_epi32(a3, b3)); 44533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora#endif 44633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora } 44733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora} 44833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 44933f74dabbc7920a65ed435d7417987589febdc16Vikas Arorastatic void AddVectorEq(const uint32_t* a, uint32_t* out, int size) { 45033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora int i; 45133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora assert(size % LINE_SIZE == 0); 45233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora for (i = 0; i < size; i += LINE_SIZE) { 45333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i a0 = _mm_loadu_si128((__m128i*)&a[i + 0]); 45433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i a1 = _mm_loadu_si128((__m128i*)&a[i + 4]); 45533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora#if (LINE_SIZE == 16) 45633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i a2 = _mm_loadu_si128((__m128i*)&a[i + 8]); 45733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i a3 = _mm_loadu_si128((__m128i*)&a[i + 12]); 45833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora#endif 45933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i b0 = _mm_loadu_si128((__m128i*)&out[i + 0]); 46033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i b1 = _mm_loadu_si128((__m128i*)&out[i + 4]); 46133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora#if (LINE_SIZE == 16) 46233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i b2 = _mm_loadu_si128((__m128i*)&out[i + 8]); 46333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const __m128i b3 = _mm_loadu_si128((__m128i*)&out[i + 12]); 46433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora#endif 46533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora _mm_storeu_si128((__m128i*)&out[i + 0], _mm_add_epi32(a0, b0)); 46633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora _mm_storeu_si128((__m128i*)&out[i + 4], _mm_add_epi32(a1, b1)); 46733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora#if (LINE_SIZE == 16) 46833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora _mm_storeu_si128((__m128i*)&out[i + 8], _mm_add_epi32(a2, b2)); 46933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora _mm_storeu_si128((__m128i*)&out[i + 12], _mm_add_epi32(a3, b3)); 47033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora#endif 47133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora } 47233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora} 47333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora#undef LINE_SIZE 47433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 47533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora// Note we are adding uint32_t's as *signed* int32's (using _mm_add_epi32). But 47633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora// that's ok since the histogram values are less than 1<<28 (max picture size). 47733f74dabbc7920a65ed435d7417987589febdc16Vikas Arorastatic void HistogramAdd(const VP8LHistogram* const a, 47833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const VP8LHistogram* const b, 47933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora VP8LHistogram* const out) { 48033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora int i; 48133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora const int literal_size = VP8LHistogramNumCodes(a->palette_code_bits_); 48233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora assert(a->palette_code_bits_ == b->palette_code_bits_); 48333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora if (b != out) { 48433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora AddVector(a->literal_, b->literal_, out->literal_, NUM_LITERAL_CODES); 48533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora AddVector(a->red_, b->red_, out->red_, NUM_LITERAL_CODES); 48633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora AddVector(a->blue_, b->blue_, out->blue_, NUM_LITERAL_CODES); 48733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora AddVector(a->alpha_, b->alpha_, out->alpha_, NUM_LITERAL_CODES); 48833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora } else { 48933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora AddVectorEq(a->literal_, out->literal_, NUM_LITERAL_CODES); 49033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora AddVectorEq(a->red_, out->red_, NUM_LITERAL_CODES); 49133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora AddVectorEq(a->blue_, out->blue_, NUM_LITERAL_CODES); 49233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora AddVectorEq(a->alpha_, out->alpha_, NUM_LITERAL_CODES); 49333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora } 49433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora for (i = NUM_LITERAL_CODES; i < literal_size; ++i) { 49533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora out->literal_[i] = a->literal_[i] + b->literal_[i]; 49633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora } 49733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora for (i = 0; i < NUM_DISTANCE_CODES; ++i) { 49833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora out->distance_[i] = a->distance_[i] + b->distance_[i]; 49933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora } 50033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora} 50133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 50233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora#endif // WEBP_USE_SSE2 50333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 50433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora//------------------------------------------------------------------------------ 50533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 50633f74dabbc7920a65ed435d7417987589febdc16Vikas Aroraextern void VP8LDspInitSSE2(void); 50733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 50833f74dabbc7920a65ed435d7417987589febdc16Vikas Aroravoid VP8LDspInitSSE2(void) { 50933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora#if defined(WEBP_USE_SSE2) 51033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora VP8LPredictors[5] = Predictor5; 51133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora VP8LPredictors[6] = Predictor6; 51233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora VP8LPredictors[7] = Predictor7; 51333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora VP8LPredictors[8] = Predictor8; 51433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora VP8LPredictors[9] = Predictor9; 51533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora VP8LPredictors[10] = Predictor10; 51633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora VP8LPredictors[11] = Predictor11; 51733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora VP8LPredictors[12] = Predictor12; 51833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora VP8LPredictors[13] = Predictor13; 51933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 52033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora VP8LSubtractGreenFromBlueAndRed = SubtractGreenFromBlueAndRed; 52133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora VP8LAddGreenToBlueAndRed = AddGreenToBlueAndRed; 52233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 52333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora VP8LTransformColor = TransformColor; 52433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora VP8LTransformColorInverse = TransformColorInverse; 52533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 52633f74dabbc7920a65ed435d7417987589febdc16Vikas Arora VP8LConvertBGRAToRGBA = ConvertBGRAToRGBA; 52733f74dabbc7920a65ed435d7417987589febdc16Vikas Arora VP8LConvertBGRAToRGBA4444 = ConvertBGRAToRGBA4444; 52833f74dabbc7920a65ed435d7417987589febdc16Vikas Arora VP8LConvertBGRAToRGB565 = ConvertBGRAToRGB565; 52933f74dabbc7920a65ed435d7417987589febdc16Vikas Arora VP8LConvertBGRAToBGR = ConvertBGRAToBGR; 53033f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 53133f74dabbc7920a65ed435d7417987589febdc16Vikas Arora VP8LHistogramAdd = HistogramAdd; 53233f74dabbc7920a65ed435d7417987589febdc16Vikas Arora#endif // WEBP_USE_SSE2 53333f74dabbc7920a65ed435d7417987589febdc16Vikas Arora} 53433f74dabbc7920a65ed435d7417987589febdc16Vikas Arora 53533f74dabbc7920a65ed435d7417987589febdc16Vikas Arora//------------------------------------------------------------------------------ 536