xref: /external/qemu/distrib/jpeg-6b/jidctintelsse.c

/*
 * Copyright (C) 2010-2011 Intel Corporation
 *
 * Licensed under the Apache License, Version 2.0 (the "License");
 * you may not use this file except in compliance with the License.
 * You may obtain a copy of the License at
 *
 *      http://www.apache.org/licenses/LICENSE-2.0
 *
 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 */

#define JPEG_INTERNALS
#include "jinclude.h"
#include "jpeglib.h"
#include "jdct.h"		/* Private declarations for DCT subsystem */

#ifdef ANDROID_INTELSSE2_IDCT
#include <emmintrin.h>

#if DCTSIZE != 8
  Sorry, this code only copes with 8x8 DCTs. /* deliberate syntax err */
#endif

#define BITS_INV_ACC 4
#define SHIFT_INV_ROW 12
#define SHIFT_INV_COL 5
const short RND_INV_ROW = 2048;
const short RND_INV_COL = 16;
const short RND_INV_CORR = 15;

static const short __attribute__ ((aligned(16))) M128_one_corr[8] = {1,1,1,1,1,1,1,1};
static const short __attribute__ ((aligned(16))) M128_round_inv_row[8] = {2048,0,2048,0,2048,0,2048,0};
static const short __attribute__ ((aligned(16))) M128_round_inv_col[8] = {16,16,16,16,16,16,16,16};
static const short __attribute__ ((aligned(16))) M128_round_inv_corr[8] = {15,15,15,15,15,15,15,15};

static const short __attribute__ ((aligned(16))) M128_tg_1_16[8] = {13036, 13036, 13036, 13036, 13036, 13036, 13036, 13036};
static const short __attribute__ ((aligned(16))) M128_tg_2_16[8] = {27146, 27146, 27146, 27146, 27146, 27146, 27146, 27146};
static const short __attribute__ ((aligned(16))) M128_tg_3_16[8] = {-21746, -21746, -21746, -21746, -21746, -21746, -21746, -21746};
static const short __attribute__ ((aligned(16))) M128_cos_4_16[8] = {-19195, -19195, -19195, -19195, -19195, -19195, -19195, -19195};

static const short __attribute__ ((aligned(16))) jpeg_adjust[8] = {128, 128, 128, 128, 128, 128, 128, 128};

// Table for rows 0,4
static const short __attribute__ ((aligned(16))) M128_tab_i_04[32] = {
16384, 21407, 16384, 8867,
16384, -8867, 16384, -21407,
16384, 8867, -16384, -21407,
-16384, 21407, 16384, -8867,
22725, 19266, 19266, -4520,
12873, -22725, 4520, -12873,
12873, 4520, -22725, -12873,
4520, 19266, 19266, -22725
};

// Table for rows 1,7
static const short __attribute__ ((aligned(16))) M128_tab_i_17[32] = {
22725, 29692, 22725, 12299,
22725, -12299, 22725, -29692,
22725, 12299, -22725, -29692,
-22725, 29692, 22725, -12299,
31521, 26722, 26722, -6270,
17855, -31521, 6270, -17855,
17855, 6270, -31521, -17855,
6270, 26722, 26722, -31521
};

// Table for rows 2,6
static const short __attribute__ ((aligned(16))) M128_tab_i_26[32] = {
21407, 27969, 21407, 11585,
21407, -11585, 21407, -27969,
21407, 11585, -21407, -27969,
-21407, 27969, 21407, -11585,
29692, 25172, 25172, -5906,
16819, -29692, 5906, -16819,
16819, 5906, -29692, -16819,
5906, 25172, 25172, -29692
};

// Table for rows 3,5
static const short __attribute__ ((aligned(16))) M128_tab_i_35[32] = {
19266, 25172, 19266, 10426,
19266, -10426, 19266, -25172,
19266, 10426, -19266, -25172,
-19266, 25172, 19266, -10426,
26722, 22654, 22654, -5315,
15137, -26722, 5315, -15137,
15137, 5315, -26722, -15137,
5315, 22654, 22654, -26722
};


/*
 * Perform dequantization and inverse DCT on one block of coefficients by SSE.
 */

GLOBAL(void)
jpeg_idct_intelsse (j_decompress_ptr cinfo, jpeg_component_info * compptr,
		 JCOEFPTR coef_block,
		 JSAMPARRAY output_buf, JDIMENSION output_col)
{
  __m128i row0, tmp1, tmp2, tmp3, row2, tmp5, tmp6, tmp7;
  int ctr;
  JSAMPROW  outptrTemp;
  JSAMPLE *range_limit = IDCT_range_limit(cinfo);
  short __attribute__((aligned(16))) quantptrSSE[DCTSIZE2];
  short __attribute__((aligned(16))) workspaceSSE[DCTSIZE2];
  short __attribute__((aligned(16))) coef_blockSSE[DCTSIZE2];
  __m128i x0, x1, x2, x3, x4, x5, x6, x7;
  __m128i* tg3, *tg1, *tg2, *cos4;
  __m128i tm765, tp765, tm465, tp465, tp03, tm03, tp12, tm12, tp65, tm65;
  __m128i t0, t1, t2, t3, t4, t5, t6, t7;
  __m128i temp, temp2;
  short * wsptr;
  unsigned char * outptr;

#define iDCT_8_2ROWs(table1, table2)   \
    row0 = _mm_shufflelo_epi16(row0, 0xD8); /*x7, x6, x5, x4, x3, x1, x2, x0*/    \
    row2 = _mm_shufflelo_epi16(row2, 0xD8);   \
    tmp1 = _mm_shuffle_epi32(row0, 0);      /*x2, x0, x2, x0, x2, x0, x2, x0*/    \
    tmp5 = _mm_shuffle_epi32(row2, 0);        \
                                                                                  \
    tmp3 = _mm_shuffle_epi32(row0, 0x55);   /*x3, x1, x3, x1, x3, x1, x3, x1*/    \
    tmp7 = _mm_shuffle_epi32(row2, 0x55);     \
    row0 = _mm_shufflehi_epi16(row0, 0xD8); /*x7, x5, x6, x4, x3, x1, x2, x0*/    \
    row2 = _mm_shufflehi_epi16(row2, 0xD8);   \
						\
    tmp1 = _mm_madd_epi16(tmp1, * ( __m128i*)table1);      /*x2*w13+x0*w12, x2*w9+x0*w8, x2*w5+x0*w4, x2*w1+x0*w0*/   \
    tmp5 = _mm_madd_epi16(tmp5, * ( __m128i*)table2);       \
						\
    tmp2 =  _mm_shuffle_epi32(row0, 0xAA);  /*x6, x4, x6, x4, x6, x4, x6, x4*/    \
    tmp6 = _mm_shuffle_epi32(row2, 0xAA);     \
    row0 = _mm_shuffle_epi32(row0, 0xFF);   /*x7, x5, x7, x5, x7, x5, x7, x5*/    \
    row2 = _mm_shuffle_epi32(row2, 0xFF);     \
\
    tmp3 = _mm_madd_epi16(tmp3, * ( __m128i*)(table1+16)); /*x3*w29+x1*w28, x3*w25+x1*w24, x3*w21+x1*w20, x3*w17+x1*w16*/  \
    tmp7 = _mm_madd_epi16(tmp7, * ( __m128i*)(table2+16) ); \
    row0 = _mm_madd_epi16(row0, * ( __m128i*)(table1+24)); /*x7*w31+x5*w30, x7*w27+x5*w26, x7*w23+x5*w22, x7*w19+x5*w18*/  \
    row2 = _mm_madd_epi16(row2, * ( __m128i*)(table2+24) ); \
    tmp2 = _mm_madd_epi16(tmp2, * ( __m128i*)(table1+8) ); /*x6*w15+x4*w14, x6*w11+x4*w10, x6*w7+x4*w6, x6*w3+x4*w2*/  \
    tmp6 = _mm_madd_epi16(tmp6, * ( __m128i*)(table2+8) );  \
                                                             \
    tmp1 = _mm_add_epi32(tmp1, * ( __m128i*)M128_round_inv_row);       \
    tmp5 = _mm_add_epi32(tmp5, * ( __m128i*)M128_round_inv_row);      \
    row0 = _mm_add_epi32(row0, tmp3);    /*b3, b2, b1, b0*/  \
    row2 = _mm_add_epi32(row2, tmp7);                       \
    tmp1 = _mm_add_epi32(tmp1, tmp2);    /*a3, a2, a1, a0*/  \
    tmp5 = _mm_add_epi32(tmp5, tmp6);                       \
                                                             \
    tmp2 = tmp1;  \
    tmp6 = tmp5;  \
    tmp2 = _mm_sub_epi32(tmp2, row0); /*for row0. y4= a3-b3, y5=a2-b2, y6=a1-b1, y7=a0-b0 */   \
    tmp6 = _mm_sub_epi32(tmp6, row2);  \
    row0 = _mm_add_epi32(row0, tmp1); /*y3=a3+b3,y2=a2+b2,y1=a1+b1,y0=a0+b0*/   \
    row2 = _mm_add_epi32(row2, tmp5);  \
    tmp2 = _mm_srai_epi32(tmp2, SHIFT_INV_ROW);             \
    tmp6 = _mm_srai_epi32(tmp6, SHIFT_INV_ROW);  \
    row0 = _mm_srai_epi32(row0, SHIFT_INV_ROW);             \
    row2 = _mm_srai_epi32(row2, SHIFT_INV_ROW);  \
    tmp2 = _mm_shuffle_epi32(tmp2, 0x1B); /*y7, y6, y5, y4*/   \
    tmp6 = _mm_shuffle_epi32(tmp6, 0x1B);  \
    row0 = _mm_packs_epi32(row0, tmp2); /*row0 = y7,y6,y5,y4,y3,y2,y1,y0*/  \
    row2 = _mm_packs_epi32(row2, tmp6);  /*row2 = y7,...y0*/


#define iDCT_8_COL()  \
    x3 = _mm_load_si128(( __m128i*)(wsptr+24));\
    x1 = _mm_load_si128(( __m128i*)(wsptr+8));\
    x5 = row0;\
    x7 = row2;\
\
    tg3 = ( __m128i*)(M128_tg_3_16);\
    tg1 = ( __m128i*)(M128_tg_1_16);\
    tg2 = ( __m128i*)(M128_tg_2_16);\
    cos4 =(__m128i*)(M128_cos_4_16);\
\
    temp = _mm_mulhi_epi16(x5, *tg3);  /*row5*tg3*/ \
    temp2 = _mm_mulhi_epi16(x3, *tg3);\
    temp = _mm_adds_epi16(temp, x5); /*coef adjustment*/ \
    temp2 = _mm_adds_epi16(temp2, x3);\
    tm765 = _mm_adds_epi16(temp, x3);\
    tm465 = _mm_subs_epi16(x5, temp2);\
\
    temp = _mm_mulhi_epi16(x7, *tg1);  /*row7*tg1*/ \
    temp2 = _mm_mulhi_epi16(x1, *tg1);\
    tp765 = _mm_adds_epi16(temp, x1);\
    tp465 = _mm_subs_epi16(temp2, x7);  /*row1*tg1 - row7*/ \
\
    t7 = _mm_adds_epi16(tp765, tm765);\
    t7 = _mm_adds_epi16(t7, *( __m128i*)M128_one_corr);\
    tp65 = _mm_subs_epi16(tp765, tm765);\
    t4 =  _mm_adds_epi16(tp465, tm465);\
    tm65 = _mm_subs_epi16(tp465, tm465);\
    tm65 = _mm_adds_epi16(tm65, *( __m128i*)M128_one_corr);\
\
    x0 = _mm_load_si128(( __m128i*)(wsptr));\
    x4 = _mm_load_si128(( __m128i*)(wsptr+32));\
    x2 = _mm_load_si128(( __m128i*)(wsptr+16));\
    x6 = _mm_load_si128(( __m128i*)(wsptr+48));\
\
    /*t6 = ( tp65 + tm65 ) * cos_4_16;*/ \
    temp = _mm_adds_epi16(tp65, tm65);\
    temp2 = _mm_subs_epi16(tp65, tm65);\
    t6 = _mm_mulhi_epi16(temp, *cos4);\
    t5 = _mm_mulhi_epi16(temp2, *cos4);\
    t6 = _mm_adds_epi16(t6, temp);\
    t6 = _mm_or_si128(t6, *( __m128i*)M128_one_corr);\
    t5 = _mm_adds_epi16(t5, temp2);\
    t5 = _mm_or_si128(t5, *( __m128i*)M128_one_corr);\
\
    tp03 = _mm_adds_epi16(x0, x4);\
    tp12 = _mm_subs_epi16(x0, x4);\
\
    temp = _mm_mulhi_epi16(x6, *tg2);\
    temp2 = _mm_mulhi_epi16(x2, *tg2);\
    tm03 = _mm_adds_epi16(temp, x2);\
    tm12 = _mm_subs_epi16(temp2, x6);\
\
    t0 = _mm_adds_epi16(tp03, tm03);\
    t0 = _mm_adds_epi16(t0, *( __m128i*)M128_round_inv_col);\
    t3 = _mm_subs_epi16(tp03, tm03);\
    t3 = _mm_adds_epi16(t3, *( __m128i*)M128_round_inv_corr);\
    t1 = _mm_adds_epi16(tp12, tm12);\
    t1 = _mm_adds_epi16(t1, *( __m128i*)M128_round_inv_col);\
    t2 = _mm_subs_epi16(tp12, tm12);\
    t2 = _mm_adds_epi16(t2, *( __m128i*)M128_round_inv_corr);\
\
    temp = _mm_adds_epi16(t0, t7);   /*y0*/ \
    temp2 = _mm_adds_epi16(t1, t6);  /*y1*/ \
    temp = _mm_srai_epi16(temp, SHIFT_INV_COL);\
    temp2 = _mm_srai_epi16(temp2, SHIFT_INV_COL);\
    temp = _mm_adds_epi16(temp, *( __m128i*)jpeg_adjust); /*Add 128 for jpeg decoding*/ \
    temp2 = _mm_adds_epi16(temp2, *( __m128i*)jpeg_adjust);\
\
    temp = _mm_packus_epi16(temp, temp2);\
    _mm_store_si128(( __m128i*)(outptr), temp);  /*store y0, y1*/ \
\
    temp = _mm_adds_epi16(t2, t5);\
    temp2 = _mm_adds_epi16(t3, t4);\
    temp = _mm_srai_epi16(temp, SHIFT_INV_COL);\
    temp2 = _mm_srai_epi16(temp2, SHIFT_INV_COL);\
    temp = _mm_adds_epi16(temp, *( __m128i*)jpeg_adjust);\
    temp2 = _mm_adds_epi16(temp2, *( __m128i*)jpeg_adjust);\
\
    temp = _mm_packus_epi16(temp, temp2);\
    _mm_store_si128(( __m128i*)(outptr+16), temp);  /*store y2, y3*/ \
\
    temp = _mm_subs_epi16(t3, t4);\
    temp2 = _mm_subs_epi16(t2, t5);\
    temp = _mm_srai_epi16(temp, SHIFT_INV_COL);\
    temp2 = _mm_srai_epi16(temp2, SHIFT_INV_COL);\
    temp = _mm_adds_epi16(temp, *( __m128i*)jpeg_adjust);\
    temp2 = _mm_adds_epi16(temp2, *( __m128i*)jpeg_adjust);\
\
    temp = _mm_packus_epi16(temp, temp2);\
    _mm_store_si128(( __m128i*)(outptr+32), temp);  /*store y4, y5*/ \
\
    temp = _mm_subs_epi16(t1, t6);\
    temp2 = _mm_subs_epi16(t0, t7);\
    temp = _mm_srai_epi16(temp, SHIFT_INV_COL);\
    temp2 = _mm_srai_epi16(temp2, SHIFT_INV_COL);\
    temp = _mm_adds_epi16(temp, *( __m128i*)jpeg_adjust);\
    temp2 = _mm_adds_epi16(temp2, *( __m128i*)jpeg_adjust);\
\
    temp = _mm_packus_epi16(temp, temp2);\
    _mm_store_si128(( __m128i*)(outptr+48), temp);  /*store y6, y7*/


  /*Memcpy to do 16byte alignment. */
  memcpy((char*)quantptrSSE, (char*)compptr->dct_table, sizeof(quantptrSSE));
  memcpy((char*)coef_blockSSE, (char*)coef_block, sizeof(coef_blockSSE));

  wsptr = (short *)workspaceSSE;
  outptr = (unsigned char*)workspaceSSE;

  // row 0 and row 2
  row0 = _mm_load_si128((__m128i const*)(coef_blockSSE));
  row2 = _mm_load_si128((__m128i const*)(coef_blockSSE+8*2));
  row0 = _mm_mullo_epi16( row0, *(__m128i const*)quantptrSSE );
  row2 = _mm_mullo_epi16( row2, *(__m128i const*)(quantptrSSE+8*2) );

  iDCT_8_2ROWs(M128_tab_i_04, M128_tab_i_26);

  _mm_store_si128((__m128i*)(wsptr), row0);
  _mm_store_si128((__m128i*)(wsptr+8*2), row2);

  // row 4 and row 6
  row0 = _mm_load_si128((__m128i const*)(coef_blockSSE+8*4));
  row2 = _mm_load_si128((__m128i const*)(coef_blockSSE+8*6));
  row0 = _mm_mullo_epi16(row0, *(__m128i const*)(quantptrSSE+8*4) );
  row2 = _mm_mullo_epi16(row2, *(__m128i const*)(quantptrSSE+8*6) );

  iDCT_8_2ROWs(M128_tab_i_04, M128_tab_i_26);

  _mm_store_si128((__m128i*)(wsptr+32), row0);
  _mm_store_si128((__m128i*)(wsptr+48), row2);

  // row 3 and row 1
  row0 = _mm_load_si128((__m128i const*)(coef_blockSSE+8*3));
  row2 = _mm_load_si128((__m128i const*)(coef_blockSSE+8*1));
  row0 = _mm_mullo_epi16(row0, *(__m128i const*)(quantptrSSE+24) );
  row2 = _mm_mullo_epi16(row2, *(__m128i const*)(quantptrSSE+8) );

  iDCT_8_2ROWs(M128_tab_i_35, M128_tab_i_17);

  _mm_store_si128((__m128i*)(wsptr+24), row0);
  _mm_store_si128((__m128i*)(wsptr+8), row2);

  // row 5 and row 7
  row0 = _mm_load_si128((__m128i const*)(coef_blockSSE+8*5));
  row2 = _mm_load_si128((__m128i const*)(coef_blockSSE+8*7));
  row0 = _mm_mullo_epi16(row0, *(__m128i const*)(quantptrSSE+40) );
  row2 = _mm_mullo_epi16(row2, *(__m128i const*)(quantptrSSE+56));

  iDCT_8_2ROWs( M128_tab_i_35, M128_tab_i_17);

  iDCT_8_COL();

  for(ctr = 0; ctr < DCTSIZE; ctr++)
  {
    outptrTemp = output_buf[ctr] + output_col;
    memcpy(outptrTemp, outptr, DCTSIZE);
    outptr += DCTSIZE;   /* advance pointer to next row */
  }

  return;
}
#endif /* ANDROID_INTELSSE2_IDCT */