quicktime/ffmpeg/libavcodec/sh4/idct_sh4.c

   1 /*
   2  * idct for sh4
   3  *
   4  * Copyright (c) 2001-2003 BERO <bero@geocities.co.jp>
   5  *
   6  * This library is free software; you can redistribute it and/or
   7  * modify it under the terms of the GNU Lesser General Public
   8  * License as published by the Free Software Foundation; either
   9  * version 2 of the License, or (at your option) any later version.
  10  *
  11  * This library is distributed in the hope that it will be useful,
  12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  14  * Lesser General Public License for more details.
  15  *
  16  * You should have received a copy of the GNU Lesser General Public
  17  * License along with this library; if not, write to the Free Software
  18  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  19  */
  20
  21 #include "../dsputil.h"
  22 #define c1      1.38703984532214752434  /* sqrt(2)*cos(1*pi/16) */
  23 #define c2      1.30656296487637657577  /* sqrt(2)*cos(2*pi/16) */
  24 #define c3      1.17587560241935884520  /* sqrt(2)*cos(3*pi/16) */
  25 #define c4      1.00000000000000000000  /* sqrt(2)*cos(4*pi/16) */
  26 #define c5      0.78569495838710234903  /* sqrt(2)*cos(5*pi/16) */
  27 #define c6      0.54119610014619712324  /* sqrt(2)*cos(6*pi/16) */
  28 #define c7      0.27589937928294311353  /* sqrt(2)*cos(7*pi/16) */
  29
  30 const   static float even_table[] __attribute__ ((aligned(8))) = {
  31          c4, c4, c4, c4,
  32          c2, c6,-c6,-c2,
  33          c4,-c4,-c4, c4,
  34          c6,-c2, c2,-c6
  35 };
  36
  37 const   static float odd_table[] __attribute__ ((aligned(8))) = {
  38          c1, c3, c5, c7,
  39          c3,-c7,-c1,-c5,
  40          c5,-c1, c7, c3,
  41          c7,-c5, c3,-c1
  42 };
  43
  44 #undef  c1
  45 #undef  c2
  46 #undef  c3
  47 #undef  c4
  48 #undef  c5
  49 #undef  c6
  50 #undef  c7
  51
  52 #if defined(__SH4_SINGLE__) || defined(__SH4_SINGLE_ONLY__)
  53
  54 #define load_matrix(table) \
  55         __asm__ volatile( \
  56         "       fschg\n" \
  57         "       fmov    @%0+,xd0\n" \
  58         "       fmov    @%0+,xd2\n" \
  59         "       fmov    @%0+,xd4\n" \
  60         "       fmov    @%0+,xd6\n" \
  61         "       fmov    @%0+,xd8\n" \
  62         "       fmov    @%0+,xd10\n" \
  63         "       fmov    @%0+,xd12\n" \
  64         "       fmov    @%0+,xd14\n" \
  65         "       fschg\n" \
  66         :\
  67         : "r"(table)\
  68         : "0" \
  69         )
  70
  71 #define ftrv() \
  72                 __asm__ volatile("ftrv xmtrx,fv0" \
  73                 : "=f"(fr0),"=f"(fr1),"=f"(fr2),"=f"(fr3) \
  74                 :  "0"(fr0), "1"(fr1), "2"(fr2), "3"(fr3) );
  75
  76 #define DEFREG  \
  77         register float fr0 __asm__("fr0"); \
  78         register float fr1 __asm__("fr1"); \
  79         register float fr2 __asm__("fr2"); \
  80         register float fr3 __asm__("fr3")
  81
  82 #else
  83
  84 /* generic C code for check */
  85
  86 static void ftrv_(const float xf[],float fv[])
  87 {
  88         float f0,f1,f2,f3;
  89         f0 = fv[0];
  90         f1 = fv[1];
  91         f2 = fv[2];
  92         f3 = fv[3];
  93         fv[0] = xf[0]*f0 + xf[4]*f1 + xf[ 8]*f2 + xf[12]*f3;
  94         fv[1] = xf[1]*f0 + xf[5]*f1 + xf[ 9]*f2 + xf[13]*f3;
  95         fv[2] = xf[2]*f0 + xf[6]*f1 + xf[10]*f2 + xf[14]*f3;
  96         fv[3] = xf[3]*f0 + xf[7]*f1 + xf[11]*f2 + xf[15]*f3;
  97 }
  98
  99 static void load_matrix_(float xf[],const float table[])
 100 {
 101         int i;
 102         for(i=0;i<16;i++) xf[i]=table[i];
 103 }
 104
 105 #define ftrv()  ftrv_(xf,fv)
 106 #define load_matrix(table)      load_matrix_(xf,table)
 107
 108 #define DEFREG \
 109         float fv[4],xf[16]
 110
 111 #define fr0     fv[0]
 112 #define fr1     fv[1]
 113 #define fr2     fv[2]
 114 #define fr3     fv[3]
 115
 116 #endif
 117
 118 #if 1
 119 #define DESCALE(x,n)    (x)*(1.0f/(1<<(n)))
 120 #else
 121 #define DESCALE(x,n)    (((int)(x)+(1<<(n-1)))>>(n))
 122 #endif
 123
 124 /* this code work worse on gcc cvs. 3.2.3 work fine */
 125
 126
 127 #if 1
 128 //optimized
 129
 130 void idct_sh4(DCTELEM *block)
 131 {
 132         DEFREG;
 133
 134         int i;
 135         float   tblock[8*8],*fblock;
 136         int ofs1,ofs2,ofs3;
 137
 138 #if defined(__SH4__)
 139 #error  "FIXME!! change to single float"
 140 #endif
 141
 142         /* row */
 143
 144         /* even part */
 145         load_matrix(even_table);
 146
 147         fblock = tblock+4;
 148         i = 8;
 149         do {
 150                 fr0 = block[0];
 151                 fr1 = block[2];
 152                 fr2 = block[4];
 153                 fr3 = block[6];
 154                 block+=8;
 155                 ftrv();
 156                 *--fblock = fr3;
 157                 *--fblock = fr2;
 158                 *--fblock = fr1;
 159                 *--fblock = fr0;
 160                 fblock+=8+4;
 161         } while(--i);
 162         block-=8*8;
 163         fblock-=8*8+4;
 164
 165         load_matrix(odd_table);
 166
 167         i = 8;
 168
 169 //      ofs1 = sizeof(float)*1;
 170 //      ofs2 = sizeof(float)*2;
 171 //      ofs3 = sizeof(float)*3;
 172
 173         do {
 174                 float t0,t1,t2,t3;
 175                 fr0 = block[1];
 176                 fr1 = block[3];
 177                 fr2 = block[5];
 178                 fr3 = block[7];
 179                 block+=8;
 180                 ftrv();
 181                 t0 = *fblock++;
 182                 t1 = *fblock++;
 183                 t2 = *fblock++;
 184                 t3 = *fblock++;
 185                 fblock+=4;
 186                 *--fblock = t0 - fr0;
 187                 *--fblock = t1 - fr1;
 188                 *--fblock = t2 - fr2;
 189                 *--fblock = t3 - fr3;
 190                 *--fblock = t3 + fr3;
 191                 *--fblock = t2 + fr2;
 192                 *--fblock = t1 + fr1;
 193                 *--fblock = t0 + fr0;
 194                 fblock+=8;
 195         } while(--i);
 196         block-=8*8;
 197         fblock-=8*8;
 198
 199         /* col */
 200
 201         /* even part */
 202         load_matrix(even_table);
 203
 204         ofs1 = sizeof(float)*2*8;
 205         ofs2 = sizeof(float)*4*8;
 206         ofs3 = sizeof(float)*6*8;
 207
 208         i = 8;
 209
 210 #define OA(fblock,ofs)  *(float*)((char*)fblock + ofs)
 211
 212         do {
 213                 fr0 = OA(fblock,   0);
 214                 fr1 = OA(fblock,ofs1);
 215                 fr2 = OA(fblock,ofs2);
 216                 fr3 = OA(fblock,ofs3);
 217                 ftrv();
 218                 OA(fblock,0   ) = fr0;
 219                 OA(fblock,ofs1) = fr1;
 220                 OA(fblock,ofs2) = fr2;
 221                 OA(fblock,ofs3) = fr3;
 222                 fblock++;
 223         } while(--i);
 224         fblock-=8;
 225
 226         load_matrix(odd_table);
 227
 228         i=8;
 229         do {
 230                 float t0,t1,t2,t3;
 231                 t0 = OA(fblock,   0); /* [8*0] */
 232                 t1 = OA(fblock,ofs1); /* [8*2] */
 233                 t2 = OA(fblock,ofs2); /* [8*4] */
 234                 t3 = OA(fblock,ofs3); /* [8*6] */
 235                 fblock+=8;
 236                 fr0 = OA(fblock,   0); /* [8*1] */
 237                 fr1 = OA(fblock,ofs1); /* [8*3] */
 238                 fr2 = OA(fblock,ofs2); /* [8*5] */
 239                 fr3 = OA(fblock,ofs3); /* [8*7] */
 240                 fblock+=-8+1;
 241                 ftrv();
 242                 block[8*0] = DESCALE(t0 + fr0,3);
 243                 block[8*7] = DESCALE(t0 - fr0,3);
 244                 block[8*1] = DESCALE(t1 + fr1,3);
 245                 block[8*6] = DESCALE(t1 - fr1,3);
 246                 block[8*2] = DESCALE(t2 + fr2,3);
 247                 block[8*5] = DESCALE(t2 - fr2,3);
 248                 block[8*3] = DESCALE(t3 + fr3,3);
 249                 block[8*4] = DESCALE(t3 - fr3,3);
 250                 block++;
 251         } while(--i);
 252
 253 #if defined(__SH4__)
 254 #error  "FIXME!! change to double"
 255 #endif
 256 }
 257 #else
 258 void idct_sh4(DCTELEM *block)
 259 {
 260         DEFREG;
 261
 262         int i;
 263         float   tblock[8*8],*fblock;
 264
 265         /* row */
 266
 267         /* even part */
 268         load_matrix(even_table);
 269
 270         fblock = tblock;
 271         i = 8;
 272         do {
 273                 fr0 = block[0];
 274                 fr1 = block[2];
 275                 fr2 = block[4];
 276                 fr3 = block[6];
 277                 block+=8;
 278                 ftrv();
 279                 fblock[0] = fr0;
 280                 fblock[2] = fr1;
 281                 fblock[4] = fr2;
 282                 fblock[6] = fr3;
 283                 fblock+=8;
 284         } while(--i);
 285         block-=8*8;
 286         fblock-=8*8;
 287
 288         load_matrix(odd_table);
 289
 290         i = 8;
 291
 292         do {
 293                 float t0,t1,t2,t3;
 294                 fr0 = block[1];
 295                 fr1 = block[3];
 296                 fr2 = block[5];
 297                 fr3 = block[7];
 298                 block+=8;
 299                 ftrv();
 300                 t0 = fblock[0];
 301                 t1 = fblock[2];
 302                 t2 = fblock[4];
 303                 t3 = fblock[6];
 304                 fblock[0] = t0 + fr0;
 305                 fblock[7] = t0 - fr0;
 306                 fblock[1] = t1 + fr1;
 307                 fblock[6] = t1 - fr1;
 308                 fblock[2] = t2 + fr2;
 309                 fblock[5] = t2 - fr2;
 310                 fblock[3] = t3 + fr3;
 311                 fblock[4] = t3 - fr3;
 312                 fblock+=8;
 313         } while(--i);
 314         block-=8*8;
 315         fblock-=8*8;
 316
 317         /* col */
 318
 319         /* even part */
 320         load_matrix(even_table);
 321
 322         i = 8;
 323
 324         do {
 325                 fr0 = fblock[8*0];
 326                 fr1 = fblock[8*2];
 327                 fr2 = fblock[8*4];
 328                 fr3 = fblock[8*6];
 329                 ftrv();
 330                 fblock[8*0] = fr0;
 331                 fblock[8*2] = fr1;
 332                 fblock[8*4] = fr2;
 333                 fblock[8*6] = fr3;
 334                 fblock++;
 335         } while(--i);
 336         fblock-=8;
 337
 338         load_matrix(odd_table);
 339
 340         i=8;
 341         do {
 342                 float t0,t1,t2,t3;
 343                 fr0 = fblock[8*1];
 344                 fr1 = fblock[8*3];
 345                 fr2 = fblock[8*5];
 346                 fr3 = fblock[8*7];
 347                 ftrv();
 348                 t0 = fblock[8*0];
 349                 t1 = fblock[8*2];
 350                 t2 = fblock[8*4];
 351                 t3 = fblock[8*6];
 352                 fblock++;
 353                 block[8*0] = DESCALE(t0 + fr0,3);
 354                 block[8*7] = DESCALE(t0 - fr0,3);
 355                 block[8*1] = DESCALE(t1 + fr1,3);
 356                 block[8*6] = DESCALE(t1 - fr1,3);
 357                 block[8*2] = DESCALE(t2 + fr2,3);
 358                 block[8*5] = DESCALE(t2 - fr2,3);
 359                 block[8*3] = DESCALE(t3 + fr3,3);
 360                 block[8*4] = DESCALE(t3 - fr3,3);
 361                 block++;
 362         } while(--i);
 363 }
 364 #endif