git.sesse.net Git - vlc/blob - plugins/idct/idctaltivec.c

   1 /*****************************************************************************
   2  * idctaltivec.c : AltiVec IDCT module
   3  *****************************************************************************
   4  * Copyright (C) 2001 VideoLAN
   5  * $Id: idctaltivec.c,v 1.26 2002/06/01 16:45:34 sam Exp $
   6  *
   7  * Authors: Christophe Massiot <massiot@via.ecp.fr>
   8  *
   9  * This program is free software; you can redistribute it and/or modify
  10  * it under the terms of the GNU General Public License as published by
  11  * the Free Software Foundation; either version 2 of the License, or
  12  * (at your option) any later version.
  13  *
  14  * This program is distributed in the hope that it will be useful,
  15  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  16  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  17  * GNU General Public License for more details.
  18  *
  19  * You should have received a copy of the GNU General Public License
  20  * along with this program; if not, write to the Free Software
  21  * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA  02111, USA.
  22  *****************************************************************************/
  23
  24 #ifndef __BUILD_ALTIVEC_ASM__
  25
  26 /*****************************************************************************
  27  * Preamble
  28  *****************************************************************************/
  29 #include <vlc/vlc.h>
  30
  31 #include <stdlib.h>                                      /* malloc(), free() */
  32 #include <string.h>
  33 #ifdef HAVE_INTTYPES_H
  34 #   include <inttypes.h>                                       /* int16_t .. */
  35 #endif
  36
  37 #include "idct.h"
  38
  39 /*****************************************************************************
  40  * Local prototypes.
  41  *****************************************************************************/
  42 static void idct_getfunctions( function_list_t * p_function_list );
  43
  44 /*****************************************************************************
  45  * Build configuration tree.
  46  *****************************************************************************/
  47 MODULE_CONFIG_START
  48 MODULE_CONFIG_STOP
  49
  50 MODULE_INIT_START
  51     SET_DESCRIPTION( _("AltiVec IDCT module") )
  52     ADD_CAPABILITY( IDCT, 200 )
  53     ADD_REQUIREMENT( ALTIVEC )
  54     ADD_SHORTCUT( "altivec" )
  55 MODULE_INIT_STOP
  56
  57 MODULE_ACTIVATE_START
  58     idct_getfunctions( &p_module->p_functions->idct );
  59 MODULE_ACTIVATE_STOP
  60
  61 MODULE_DEACTIVATE_START
  62 MODULE_DEACTIVATE_STOP
  63
  64 /* Following functions are local */
  65
  66 /*****************************************************************************
  67  * NormScan : This IDCT uses reordered coeffs, so we patch the scan table
  68  *****************************************************************************/
  69 static void NormScan( u8 ppi_scan[2][64] )
  70 {
  71     int     i, j;
  72
  73     for( i = 0; i < 64; i++ )
  74     {
  75         j = ppi_scan[0][i];
  76         ppi_scan[0][i] = (j >> 3) | ((j & 7) << 3);
  77
  78         j = ppi_scan[1][i];
  79         ppi_scan[1][i] = (j >> 3) | ((j & 7) << 3);
  80     }
  81 }
  82
  83 /*****************************************************************************
  84  * Placeholders for unused functions
  85  *****************************************************************************/
  86 static void InitIDCT( void ** pp_idct_data )
  87 {
  88 }
  89
  90 /*****************************************************************************
  91  * IDCT in AltiVec
  92  *****************************************************************************/
  93
  94 #ifndef CAN_COMPILE_C_ALTIVEC
  95
  96 static int16_t constants[5][8] ATTR_ALIGN(16) = {
  97     {23170, 13573, 6518, 21895, -23170, -21895, 32, 31},
  98     {16384, 22725, 21407, 19266, 16384, 19266, 21407, 22725},
  99     {22725, 31521, 29692, 26722, 22725, 26722, 29692, 31521},
 100     {21407, 29692, 27969, 25172, 21407, 25172, 27969, 29692},
 101     {19266, 26722, 25172, 22654, 19266, 22654, 25172, 26722}
 102 };
 103
 104 /*
 105  * The asm code is generated with:
 106  *
 107  * gcc-2.95 -fvec -D__BUILD_ALTIVEC_ASM__ -O9 -fomit-frame-pointer -mregnames -S
 108  *      idct_altivec.c
 109  *
 110  * awk '{args=""; len=split ($2, arg, ",");
 111  *      for (i=1; i<=len; i++) { a=arg[i]; if (i<len) a=a",";
 112  *                               args = args sprintf ("%-6s", a) }
 113  *      printf ("\t\"\t%-16s%-24s\\n\"\n", $1, args) }' idct_altivec.s |
 114  * unexpand -a
 115  *
 116  * I then do some simple trimming on the function prolog/trailers
 117  */
 118
 119 void idct_block_copy_altivec (int16_t * block, uint8_t * dest, int stride)
 120 {
 121     asm ("                                              \n"
 122         "#      stwu            %r1,  -128(%r1)         \n"
 123         "#      mflr            %r0                     \n"
 124         "#      stw             %r0,  132(%r1)          \n"
 125         "#      addi            %r0,  %r1,  128         \n"
 126         "#      bl              _savev25                \n"
 127
 128         "       addi            %r9,  %r3,  112         \n"
 129         "       vspltish        %v25, 4                 \n"
 130         "       vxor            %v13, %v13, %v13        \n"
 131         "       lis             %r10, constants@ha      \n"
 132         "       lvx             %v1,  0,    %r9         \n"
 133         "       la              %r10, constants@l(%r10) \n"
 134         "       lvx             %v5,  0,    %r3         \n"
 135         "       addi            %r9,  %r3,  16          \n"
 136         "       lvx             %v8,  0,    %r10        \n"
 137         "       addi            %r11, %r10, 32          \n"
 138         "       lvx             %v12, 0,    %r9         \n"
 139         "       lvx             %v6,  0,    %r11        \n"
 140         "       addi            %r8,  %r3,  48          \n"
 141         "       vslh            %v1,  %v1,  %v25        \n"
 142         "       addi            %r9,  %r3,  80          \n"
 143         "       lvx             %v11, 0,    %r8         \n"
 144         "       vslh            %v5,  %v5,  %v25        \n"
 145         "       lvx             %v0,  0,    %r9         \n"
 146         "       addi            %r11, %r10, 64          \n"
 147         "       vsplth          %v3,  %v8,  2           \n"
 148         "       lvx             %v7,  0,    %r11        \n"
 149         "       addi            %r9,  %r3,  96          \n"
 150         "       vslh            %v12, %v12, %v25        \n"
 151         "       vmhraddshs      %v27, %v1,  %v6,  %v13  \n"
 152         "       addi            %r8,  %r3,  32          \n"
 153         "       vsplth          %v2,  %v8,  5           \n"
 154         "       lvx             %v1,  0,    %r9         \n"
 155         "       vslh            %v11, %v11, %v25        \n"
 156         "       addi            %r3,  %r3,  64          \n"
 157         "       lvx             %v9,  0,    %r8         \n"
 158         "       addi            %r9,  %r10, 48          \n"
 159         "       vslh            %v0,  %v0,  %v25        \n"
 160         "       lvx             %v4,  0,    %r9         \n"
 161         "       vmhraddshs      %v31, %v12, %v6,  %v13  \n"
 162         "       addi            %r10, %r10, 16          \n"
 163         "       vmhraddshs      %v30, %v0,  %v7,  %v13  \n"
 164         "       lvx             %v10, 0,    %r3         \n"
 165         "       vsplth          %v19, %v8,  3           \n"
 166         "       vmhraddshs      %v15, %v11, %v7,  %v13  \n"
 167         "       lvx             %v12, 0,    %r10        \n"
 168         "       vsplth          %v6,  %v8,  4           \n"
 169         "       vslh            %v1,  %v1,  %v25        \n"
 170         "       vsplth          %v11, %v8,  1           \n"
 171         "       li              %r9,  4                 \n"
 172         "       vslh            %v9,  %v9,  %v25        \n"
 173         "       vsplth          %v7,  %v8,  0           \n"
 174         "       vmhraddshs      %v18, %v1,  %v4,  %v13  \n"
 175         "       vspltw          %v8,  %v8,  3           \n"
 176         "       vsubshs         %v0,  %v13, %v27        \n"
 177         "       vmhraddshs      %v1,  %v9,  %v4,  %v13  \n"
 178         "       vmhraddshs      %v17, %v3,  %v31, %v0   \n"
 179         "       vmhraddshs      %v4,  %v2,  %v15, %v30  \n"
 180         "       vslh            %v10, %v10, %v25        \n"
 181         "       vmhraddshs      %v9,  %v5,  %v12, %v13  \n"
 182         "       vspltish        %v25, 6                 \n"
 183         "       vmhraddshs      %v5,  %v10, %v12, %v13  \n"
 184         "       vmhraddshs      %v28, %v19, %v30, %v15  \n"
 185         "       vmhraddshs      %v27, %v3,  %v27, %v31  \n"
 186         "       vsubshs         %v0,  %v13, %v18        \n"
 187         "       vmhraddshs      %v18, %v11, %v18, %v1   \n"
 188         "       vaddshs         %v30, %v17, %v4         \n"
 189         "       vmhraddshs      %v12, %v11, %v1,  %v0   \n"
 190         "       vsubshs         %v4,  %v17, %v4         \n"
 191         "       vaddshs         %v10, %v9,  %v5         \n"
 192         "       vsubshs         %v17, %v27, %v28        \n"
 193         "       vaddshs         %v27, %v27, %v28        \n"
 194         "       vsubshs         %v1,  %v9,  %v5         \n"
 195         "       vaddshs         %v28, %v10, %v18        \n"
 196         "       vsubshs         %v18, %v10, %v18        \n"
 197         "       vaddshs         %v10, %v1,  %v12        \n"
 198         "       vsubshs         %v1,  %v1,  %v12        \n"
 199         "       vsubshs         %v12, %v17, %v4         \n"
 200         "       vaddshs         %v4,  %v17, %v4         \n"
 201         "       vmhraddshs      %v5,  %v7,  %v12, %v1   \n"
 202         "       vmhraddshs      %v26, %v6,  %v4,  %v10  \n"
 203         "       vmhraddshs      %v29, %v6,  %v12, %v1   \n"
 204         "       vmhraddshs      %v14, %v7,  %v4,  %v10  \n"
 205         "       vsubshs         %v12, %v18, %v30        \n"
 206         "       vaddshs         %v9,  %v28, %v27        \n"
 207         "       vaddshs         %v16, %v18, %v30        \n"
 208         "       vsubshs         %v10, %v28, %v27        \n"
 209         "       vmrglh          %v31, %v9,  %v12        \n"
 210         "       vmrglh          %v30, %v5,  %v26        \n"
 211         "       vmrglh          %v15, %v14, %v29        \n"
 212         "       vmrghh          %v5,  %v5,  %v26        \n"
 213         "       vmrglh          %v27, %v16, %v10        \n"
 214         "       vmrghh          %v9,  %v9,  %v12        \n"
 215         "       vmrghh          %v18, %v16, %v10        \n"
 216         "       vmrghh          %v1,  %v14, %v29        \n"
 217         "       vmrglh          %v14, %v9,  %v5         \n"
 218         "       vmrglh          %v16, %v31, %v30        \n"
 219         "       vmrglh          %v10, %v15, %v27        \n"
 220         "       vmrghh          %v9,  %v9,  %v5         \n"
 221         "       vmrghh          %v26, %v15, %v27        \n"
 222         "       vmrglh          %v27, %v16, %v10        \n"
 223         "       vmrghh          %v12, %v1,  %v18        \n"
 224         "       vmrglh          %v29, %v1,  %v18        \n"
 225         "       vsubshs         %v0,  %v13, %v27        \n"
 226         "       vmrghh          %v5,  %v31, %v30        \n"
 227         "       vmrglh          %v31, %v9,  %v12        \n"
 228         "       vmrglh          %v30, %v5,  %v26        \n"
 229         "       vmrglh          %v15, %v14, %v29        \n"
 230         "       vmhraddshs      %v17, %v3,  %v31, %v0   \n"
 231         "       vmrghh          %v18, %v16, %v10        \n"
 232         "       vmhraddshs      %v27, %v3,  %v27, %v31  \n"
 233         "       vmhraddshs      %v4,  %v2,  %v15, %v30  \n"
 234         "       vmrghh          %v1,  %v14, %v29        \n"
 235         "       vmhraddshs      %v28, %v19, %v30, %v15  \n"
 236         "       vmrghh          %v0,  %v9,  %v12        \n"
 237         "       vsubshs         %v13, %v13, %v18        \n"
 238         "       vmrghh          %v5,  %v5,  %v26        \n"
 239         "       vmhraddshs      %v18, %v11, %v18, %v1   \n"
 240         "       vaddshs         %v9,  %v0,  %v8         \n"
 241         "       vaddshs         %v30, %v17, %v4         \n"
 242         "       vmhraddshs      %v12, %v11, %v1,  %v13  \n"
 243         "       vsubshs         %v4,  %v17, %v4         \n"
 244         "       vaddshs         %v10, %v9,  %v5         \n"
 245         "       vsubshs         %v17, %v27, %v28        \n"
 246         "       vaddshs         %v27, %v27, %v28        \n"
 247         "       vsubshs         %v1,  %v9,  %v5         \n"
 248         "       vaddshs         %v28, %v10, %v18        \n"
 249         "       vsubshs         %v18, %v10, %v18        \n"
 250         "       vaddshs         %v10, %v1,  %v12        \n"
 251         "       vsubshs         %v1,  %v1,  %v12        \n"
 252         "       vsubshs         %v12, %v17, %v4         \n"
 253         "       vaddshs         %v4,  %v17, %v4         \n"
 254         "       vaddshs         %v9,  %v28, %v27        \n"
 255         "       vmhraddshs      %v14, %v7,  %v4,  %v10  \n"
 256         "       vsrah           %v9,  %v9,  %v25        \n"
 257         "       vmhraddshs      %v5,  %v7,  %v12, %v1   \n"
 258         "       vpkshus         %v0,  %v9,  %v9         \n"
 259         "       vmhraddshs      %v29, %v6,  %v12, %v1   \n"
 260         "       stvewx          %v0,  0,    %r4         \n"
 261         "       vaddshs         %v16, %v18, %v30        \n"
 262         "       vsrah           %v31, %v14, %v25        \n"
 263         "       stvewx          %v0,  %r9,  %r4         \n"
 264         "       add             %r4,  %r4,  %r5         \n"
 265         "       vsrah           %v15, %v16, %v25        \n"
 266         "       vpkshus         %v0,  %v31, %v31        \n"
 267         "       vsrah           %v1,  %v5,  %v25        \n"
 268         "       stvewx          %v0,  0,    %r4         \n"
 269         "       vsubshs         %v12, %v18, %v30        \n"
 270         "       stvewx          %v0,  %r9,  %r4         \n"
 271         "       vmhraddshs      %v26, %v6,  %v4,  %v10  \n"
 272         "       vpkshus         %v0,  %v1,  %v1         \n"
 273         "       add             %r4,  %r4,  %r5         \n"
 274         "       vsrah           %v5,  %v12, %v25        \n"
 275         "       stvewx          %v0,  0,    %r4         \n"
 276         "       vsrah           %v30, %v29, %v25        \n"
 277         "       stvewx          %v0,  %r9,  %r4         \n"
 278         "       vsubshs         %v10, %v28, %v27        \n"
 279         "       vpkshus         %v0,  %v15, %v15        \n"
 280         "       add             %r4,  %r4,  %r5         \n"
 281         "       stvewx          %v0,  0,    %r4         \n"
 282         "       vsrah           %v18, %v26, %v25        \n"
 283         "       stvewx          %v0,  %r9,  %r4         \n"
 284         "       vsrah           %v27, %v10, %v25        \n"
 285         "       vpkshus         %v0,  %v5,  %v5         \n"
 286         "       add             %r4,  %r4,  %r5         \n"
 287         "       stvewx          %v0,  0,    %r4         \n"
 288         "       stvewx          %v0,  %r9,  %r4         \n"
 289         "       vpkshus         %v0,  %v30, %v30        \n"
 290         "       add             %r4,  %r4,  %r5         \n"
 291         "       stvewx          %v0,  0,    %r4         \n"
 292         "       stvewx          %v0,  %r9,  %r4         \n"
 293         "       vpkshus         %v0,  %v18, %v18        \n"
 294         "       add             %r4,  %r4,  %r5         \n"
 295         "       stvewx          %v0,  0,    %r4         \n"
 296         "       stvewx          %v0,  %r9,  %r4         \n"
 297         "       add             %r4,  %r4,  %r5         \n"
 298         "       vpkshus         %v0,  %v27, %v27        \n"
 299         "       stvewx          %v0,  0,    %r4         \n"
 300         "       stvewx          %v0,  %r9,  %r4         \n"
 301
 302         "#      addi            %r0,  %r1,  128         \n"
 303         "#      bl              _restv25                \n"
 304         "#      lwz             %r0,  132(%r1)          \n"
 305         "#      mtlr            %r0                     \n"
 306         "#      la              %r1,  128(%r1)          \n"
 307          );
 308 }
 309
 310 void idct_block_add_altivec (int16_t * block, uint8_t * dest, int stride)
 311 {
 312     asm ("                                              \n"
 313         "#      stwu            %r1,  -192(%r1)         \n"
 314         "#      mflr            %r0                     \n"
 315         "#      stw             %r0,  196(%r1)          \n"
 316         "#      addi            %r0,  %r1,  192         \n"
 317         "#      bl              _savev21                \n"
 318
 319         "       addi            %r9,  %r3,  112         \n"
 320         "       vspltish        %v21, 4                 \n"
 321         "       vxor            %v1,  %v1,  %v1         \n"
 322         "       lvx             %v13, 0,    %r9         \n"
 323         "       lis             %r10, constants@ha      \n"
 324         "       vspltisw        %v3,  -1                \n"
 325         "       la              %r10, constants@l(%r10) \n"
 326         "       lvx             %v5,  0,    %r3         \n"
 327         "       addi            %r9,  %r3,  16          \n"
 328         "       lvx             %v8,  0,    %r10        \n"
 329         "       lvx             %v12, 0,    %r9         \n"
 330         "       addi            %r11, %r10, 32          \n"
 331         "       lvx             %v6,  0,    %r11        \n"
 332         "       addi            %r8,  %r3,  48          \n"
 333         "       vslh            %v13, %v13, %v21        \n"
 334         "       addi            %r9,  %r3,  80          \n"
 335         "       lvx             %v11, 0,    %r8         \n"
 336         "       vslh            %v5,  %v5,  %v21        \n"
 337         "       lvx             %v0,  0,    %r9         \n"
 338         "       addi            %r11, %r10, 64          \n"
 339         "       vsplth          %v2,  %v8,  2           \n"
 340         "       lvx             %v7,  0,    %r11        \n"
 341         "       vslh            %v12, %v12, %v21        \n"
 342         "       addi            %r9,  %r3,  96          \n"
 343         "       vmhraddshs      %v24, %v13, %v6,  %v1   \n"
 344         "       addi            %r8,  %r3,  32          \n"
 345         "       vsplth          %v17, %v8,  5           \n"
 346         "       lvx             %v13, 0,    %r9         \n"
 347         "       vslh            %v11, %v11, %v21        \n"
 348         "       addi            %r3,  %r3,  64          \n"
 349         "       lvx             %v10, 0,    %r8         \n"
 350         "       vslh            %v0,  %v0,  %v21        \n"
 351         "       addi            %r9,  %r10, 48          \n"
 352         "       vmhraddshs      %v31, %v12, %v6,  %v1   \n"
 353         "       lvx             %v4,  0,    %r9         \n"
 354         "       addi            %r10, %r10, 16          \n"
 355         "       vmhraddshs      %v26, %v0,  %v7,  %v1   \n"
 356         "       lvx             %v9,  0,    %r3         \n"
 357         "       vsplth          %v16, %v8,  3           \n"
 358         "       vmhraddshs      %v22, %v11, %v7,  %v1   \n"
 359         "       lvx             %v6,  0,    %r10        \n"
 360         "       lvsl            %v19, 0,    %r4         \n"
 361         "       vsubshs         %v12, %v1,  %v24        \n"
 362         "       lvsl            %v0,  %r5,  %r4         \n"
 363         "       vsplth          %v11, %v8,  1           \n"
 364         "       vslh            %v10, %v10, %v21        \n"
 365         "       vmrghb          %v19, %v3,  %v19        \n"
 366         "       lvx             %v15, 0,    %r4         \n"
 367         "       vslh            %v13, %v13, %v21        \n"
 368         "       vmrghb          %v3,  %v3,  %v0         \n"
 369         "       li              %r9,  4                 \n"
 370         "       vmhraddshs      %v14, %v2,  %v31, %v12  \n"
 371         "       vsplth          %v7,  %v8,  0           \n"
 372         "       vmhraddshs      %v23, %v13, %v4,  %v1   \n"
 373         "       vsplth          %v18, %v8,  4           \n"
 374         "       vmhraddshs      %v27, %v10, %v4,  %v1   \n"
 375         "       vspltw          %v8,  %v8,  3           \n"
 376         "       vmhraddshs      %v12, %v17, %v22, %v26  \n"
 377         "       vperm           %v15, %v15, %v1,  %v19  \n"
 378         "       vslh            %v9,  %v9,  %v21        \n"
 379         "       vmhraddshs      %v10, %v5,  %v6,  %v1   \n"
 380         "       vspltish        %v21, 6                 \n"
 381         "       vmhraddshs      %v30, %v9,  %v6,  %v1   \n"
 382         "       vmhraddshs      %v26, %v16, %v26, %v22  \n"
 383         "       vmhraddshs      %v24, %v2,  %v24, %v31  \n"
 384         "       vmhraddshs      %v31, %v11, %v23, %v27  \n"
 385         "       vsubshs         %v0,  %v1,  %v23        \n"
 386         "       vaddshs         %v23, %v14, %v12        \n"
 387         "       vmhraddshs      %v9,  %v11, %v27, %v0   \n"
 388         "       vsubshs         %v12, %v14, %v12        \n"
 389         "       vaddshs         %v6,  %v10, %v30        \n"
 390         "       vsubshs         %v14, %v24, %v26        \n"
 391         "       vaddshs         %v24, %v24, %v26        \n"
 392         "       vsubshs         %v13, %v10, %v30        \n"
 393         "       vaddshs         %v26, %v6,  %v31        \n"
 394         "       vsubshs         %v31, %v6,  %v31        \n"
 395         "       vaddshs         %v6,  %v13, %v9         \n"
 396         "       vsubshs         %v13, %v13, %v9         \n"
 397         "       vsubshs         %v9,  %v14, %v12        \n"
 398         "       vaddshs         %v12, %v14, %v12        \n"
 399         "       vmhraddshs      %v30, %v7,  %v9,  %v13  \n"
 400         "       vmhraddshs      %v25, %v18, %v12, %v6   \n"
 401         "       vmhraddshs      %v28, %v18, %v9,  %v13  \n"
 402         "       vmhraddshs      %v29, %v7,  %v12, %v6   \n"
 403         "       vaddshs         %v10, %v26, %v24        \n"
 404         "       vsubshs         %v5,  %v31, %v23        \n"
 405         "       vsubshs         %v13, %v26, %v24        \n"
 406         "       vaddshs         %v4,  %v31, %v23        \n"
 407         "       vmrglh          %v26, %v30, %v25        \n"
 408         "       vmrglh          %v31, %v10, %v5         \n"
 409         "       vmrglh          %v22, %v29, %v28        \n"
 410         "       vmrghh          %v30, %v30, %v25        \n"
 411         "       vmrglh          %v24, %v4,  %v13        \n"
 412         "       vmrghh          %v10, %v10, %v5         \n"
 413         "       vmrghh          %v23, %v4,  %v13        \n"
 414         "       vmrghh          %v27, %v29, %v28        \n"
 415         "       vmrglh          %v29, %v10, %v30        \n"
 416         "       vmrglh          %v4,  %v31, %v26        \n"
 417         "       vmrglh          %v13, %v22, %v24        \n"
 418         "       vmrghh          %v10, %v10, %v30        \n"
 419         "       vmrghh          %v25, %v22, %v24        \n"
 420         "       vmrglh          %v24, %v4,  %v13        \n"
 421         "       vmrghh          %v5,  %v27, %v23        \n"
 422         "       vmrglh          %v28, %v27, %v23        \n"
 423         "       vsubshs         %v0,  %v1,  %v24        \n"
 424         "       vmrghh          %v30, %v31, %v26        \n"
 425         "       vmrglh          %v31, %v10, %v5         \n"
 426         "       vmrglh          %v26, %v30, %v25        \n"
 427         "       vmrglh          %v22, %v29, %v28        \n"
 428         "       vmhraddshs      %v14, %v2,  %v31, %v0   \n"
 429         "       vmrghh          %v23, %v4,  %v13        \n"
 430         "       vmhraddshs      %v24, %v2,  %v24, %v31  \n"
 431         "       vmhraddshs      %v12, %v17, %v22, %v26  \n"
 432         "       vmrghh          %v27, %v29, %v28        \n"
 433         "       vmhraddshs      %v26, %v16, %v26, %v22  \n"
 434         "       vmrghh          %v0,  %v10, %v5         \n"
 435         "       vmhraddshs      %v31, %v11, %v23, %v27  \n"
 436         "       vmrghh          %v30, %v30, %v25        \n"
 437         "       vsubshs         %v13, %v1,  %v23        \n"
 438         "       vaddshs         %v10, %v0,  %v8         \n"
 439         "       vaddshs         %v23, %v14, %v12        \n"
 440         "       vsubshs         %v12, %v14, %v12        \n"
 441         "       vaddshs         %v6,  %v10, %v30        \n"
 442         "       vsubshs         %v14, %v24, %v26        \n"
 443         "       vmhraddshs      %v9,  %v11, %v27, %v13  \n"
 444         "       vaddshs         %v24, %v24, %v26        \n"
 445         "       vaddshs         %v26, %v6,  %v31        \n"
 446         "       vsubshs         %v13, %v10, %v30        \n"
 447         "       vaddshs         %v10, %v26, %v24        \n"
 448         "       vsubshs         %v31, %v6,  %v31        \n"
 449         "       vaddshs         %v6,  %v13, %v9         \n"
 450         "       vsrah           %v10, %v10, %v21        \n"
 451         "       vsubshs         %v13, %v13, %v9         \n"
 452         "       vaddshs         %v0,  %v15, %v10        \n"
 453         "       vsubshs         %v9,  %v14, %v12        \n"
 454         "       vaddshs         %v12, %v14, %v12        \n"
 455         "       vpkshus         %v15, %v0,  %v0         \n"
 456         "       stvewx          %v15, 0,    %r4         \n"
 457         "       vaddshs         %v4,  %v31, %v23        \n"
 458         "       vmhraddshs      %v29, %v7,  %v12, %v6   \n"
 459         "       stvewx          %v15, %r9,  %r4         \n"
 460         "       add             %r4,  %r4,  %r5         \n"
 461         "       vsubshs         %v5,  %v31, %v23        \n"
 462         "       lvx             %v15, 0,    %r4         \n"
 463         "       vmhraddshs      %v30, %v7,  %v9,  %v13  \n"
 464         "       vsrah           %v22, %v4,  %v21        \n"
 465         "       vperm           %v15, %v15, %v1,  %v3   \n"
 466         "       vmhraddshs      %v28, %v18, %v9,  %v13  \n"
 467         "       vsrah           %v31, %v29, %v21        \n"
 468         "       vsubshs         %v13, %v26, %v24        \n"
 469         "       vaddshs         %v0,  %v15, %v31        \n"
 470         "       vsrah           %v27, %v30, %v21        \n"
 471         "       vpkshus         %v15, %v0,  %v0         \n"
 472         "       vsrah           %v30, %v5,  %v21        \n"
 473         "       stvewx          %v15, 0,    %r4         \n"
 474         "       vsrah           %v26, %v28, %v21        \n"
 475         "       stvewx          %v15, %r9,  %r4         \n"
 476         "       vmhraddshs      %v25, %v18, %v12, %v6   \n"
 477         "       add             %r4,  %r4,  %r5         \n"
 478         "       vsrah           %v24, %v13, %v21        \n"
 479         "       lvx             %v15, 0,    %r4         \n"
 480         "       vperm           %v15, %v15, %v1,  %v19  \n"
 481         "       vsrah           %v23, %v25, %v21        \n"
 482         "       vaddshs         %v0,  %v15, %v27        \n"
 483         "       vpkshus         %v15, %v0,  %v0         \n"
 484         "       stvewx          %v15, 0,    %r4         \n"
 485         "       stvewx          %v15, %r9,  %r4         \n"
 486         "       add             %r4,  %r4,  %r5         \n"
 487         "       lvx             %v15, 0,    %r4         \n"
 488         "       vperm           %v15, %v15, %v1,  %v3   \n"
 489         "       vaddshs         %v0,  %v15, %v22        \n"
 490         "       vpkshus         %v15, %v0,  %v0         \n"
 491         "       stvewx          %v15, 0,    %r4         \n"
 492         "       stvewx          %v15, %r9,  %r4         \n"
 493         "       add             %r4,  %r4,  %r5         \n"
 494         "       lvx             %v15, 0,    %r4         \n"
 495         "       vperm           %v15, %v15, %v1,  %v19  \n"
 496         "       vaddshs         %v0,  %v15, %v30        \n"
 497         "       vpkshus         %v15, %v0,  %v0         \n"
 498         "       stvewx          %v15, 0,    %r4         \n"
 499         "       stvewx          %v15, %r9,  %r4         \n"
 500         "       add             %r4,  %r4,  %r5         \n"
 501         "       lvx             %v15, 0,    %r4         \n"
 502         "       vperm           %v15, %v15, %v1,  %v3   \n"
 503         "       vaddshs         %v0,  %v15, %v26        \n"
 504         "       vpkshus         %v15, %v0,  %v0         \n"
 505         "       stvewx          %v15, 0,    %r4         \n"
 506         "       stvewx          %v15, %r9,  %r4         \n"
 507         "       add             %r4,  %r4,  %r5         \n"
 508         "       lvx             %v15, 0,    %r4         \n"
 509         "       vperm           %v15, %v15, %v1,  %v19  \n"
 510         "       vaddshs         %v0,  %v15, %v23        \n"
 511         "       vpkshus         %v15, %v0,  %v0         \n"
 512         "       stvewx          %v15, 0,    %r4         \n"
 513         "       stvewx          %v15, %r9,  %r4         \n"
 514         "       add             %r4,  %r4,  %r5         \n"
 515         "       lvx             %v15, 0,    %r4         \n"
 516         "       vperm           %v15, %v15, %v1,  %v3   \n"
 517         "       vaddshs         %v0,  %v15, %v24        \n"
 518         "       vpkshus         %v15, %v0,  %v0         \n"
 519         "       stvewx          %v15, 0,    %r4         \n"
 520         "       stvewx          %v15, %r9,  %r4         \n"
 521
 522         "#      addi            %r0,  %r1,  192         \n"
 523         "#      bl              _restv21                \n"
 524         "#      lwz             %r0,  196(%r1)          \n"
 525         "#      mtlr            %r0                     \n"
 526         "#      la              %r1,  192(%r1)          \n"
 527          );
 528 }
 529
 530 #endif  /* !CAN_COMPILE_C_ALTIVEC */
 531 #endif  /* __BUILD_ALTIVEC_ASM__ */
 532
 533
 534 #if defined(CAN_COMPILE_C_ALTIVEC) || defined(__BUILD_ALTIVEC_ASM__)
 535
 536 #define vector_s16_t vector signed short
 537 #define vector_u16_t vector unsigned short
 538 #define vector_s8_t vector signed char
 539 #define vector_u8_t vector unsigned char
 540 #define vector_s32_t vector signed int
 541 #define vector_u32_t vector unsigned int
 542
 543 #define IDCT_HALF                                       \
 544     /* 1st stage */                                     \
 545     t1 = vec_mradds (a1, vx7, vx1 );                    \
 546     t8 = vec_mradds (a1, vx1, vec_subs (zero, vx7));    \
 547     t7 = vec_mradds (a2, vx5, vx3);                     \
 548     t3 = vec_mradds (ma2, vx3, vx5);                    \
 549                                                         \
 550     /* 2nd stage */                                     \
 551     t5 = vec_adds (vx0, vx4);                           \
 552     t0 = vec_subs (vx0, vx4);                           \
 553     t2 = vec_mradds (a0, vx6, vx2);                     \
 554     t4 = vec_mradds (a0, vx2, vec_subs (zero,vx6));     \
 555     t6 = vec_adds (t8, t3);                             \
 556     t3 = vec_subs (t8, t3);                             \
 557     t8 = vec_subs (t1, t7);                             \
 558     t1 = vec_adds (t1, t7);                             \
 559                                                         \
 560     /* 3rd stage */                                     \
 561     t7 = vec_adds (t5, t2);                             \
 562     t2 = vec_subs (t5, t2);                             \
 563     t5 = vec_adds (t0, t4);                             \
 564     t0 = vec_subs (t0, t4);                             \
 565     t4 = vec_subs (t8, t3);                             \
 566     t3 = vec_adds (t8, t3);                             \
 567                                                         \
 568     /* 4th stage */                                     \
 569     vy0 = vec_adds (t7, t1);                            \
 570     vy7 = vec_subs (t7, t1);                            \
 571     vy1 = vec_mradds (c4, t3, t5);                      \
 572     vy6 = vec_mradds (mc4, t3, t5);                     \
 573     vy2 = vec_mradds (c4, t4, t0);                      \
 574     vy5 = vec_mradds (mc4, t4, t0);                     \
 575     vy3 = vec_adds (t2, t6);                            \
 576     vy4 = vec_subs (t2, t6);
 577
 578 #define IDCT                                                            \
 579     vector_s16_t vx0, vx1, vx2, vx3, vx4, vx5, vx6, vx7;                \
 580     vector_s16_t vy0, vy1, vy2, vy3, vy4, vy5, vy6, vy7;                \
 581     vector_s16_t a0, a1, a2, ma2, c4, mc4, zero, bias;                  \
 582     vector_s16_t t0, t1, t2, t3, t4, t5, t6, t7, t8;                    \
 583     vector_u16_t shift;                                                 \
 584                                                                         \
 585     c4 = vec_splat (constants[0], 0);                                   \
 586     a0 = vec_splat (constants[0], 1);                                   \
 587     a1 = vec_splat (constants[0], 2);                                   \
 588     a2 = vec_splat (constants[0], 3);                                   \
 589     mc4 = vec_splat (constants[0], 4);                                  \
 590     ma2 = vec_splat (constants[0], 5);                                  \
 591     bias = (vector_s16_t)vec_splat ((vector_s32_t)constants[0], 3);     \
 592                                                                         \
 593     zero = vec_splat_s16 (0);                                           \
 594     shift = vec_splat_u16 (4);                                          \
 595                                                                         \
 596     vx0 = vec_mradds (vec_sl (block[0], shift), constants[1], zero);    \
 597     vx1 = vec_mradds (vec_sl (block[1], shift), constants[2], zero);    \
 598     vx2 = vec_mradds (vec_sl (block[2], shift), constants[3], zero);    \
 599     vx3 = vec_mradds (vec_sl (block[3], shift), constants[4], zero);    \
 600     vx4 = vec_mradds (vec_sl (block[4], shift), constants[1], zero);    \
 601     vx5 = vec_mradds (vec_sl (block[5], shift), constants[4], zero);    \
 602     vx6 = vec_mradds (vec_sl (block[6], shift), constants[3], zero);    \
 603     vx7 = vec_mradds (vec_sl (block[7], shift), constants[2], zero);    \
 604                                                                         \
 605     IDCT_HALF                                                           \
 606                                                                         \
 607     vx0 = vec_mergeh (vy0, vy4);                                        \
 608     vx1 = vec_mergel (vy0, vy4);                                        \
 609     vx2 = vec_mergeh (vy1, vy5);                                        \
 610     vx3 = vec_mergel (vy1, vy5);                                        \
 611     vx4 = vec_mergeh (vy2, vy6);                                        \
 612     vx5 = vec_mergel (vy2, vy6);                                        \
 613     vx6 = vec_mergeh (vy3, vy7);                                        \
 614     vx7 = vec_mergel (vy3, vy7);                                        \
 615                                                                         \
 616     vy0 = vec_mergeh (vx0, vx4);                                        \
 617     vy1 = vec_mergel (vx0, vx4);                                        \
 618     vy2 = vec_mergeh (vx1, vx5);                                        \
 619     vy3 = vec_mergel (vx1, vx5);                                        \
 620     vy4 = vec_mergeh (vx2, vx6);                                        \
 621     vy5 = vec_mergel (vx2, vx6);                                        \
 622     vy6 = vec_mergeh (vx3, vx7);                                        \
 623     vy7 = vec_mergel (vx3, vx7);                                        \
 624                                                                         \
 625     vx0 = vec_adds (vec_mergeh (vy0, vy4), bias);                       \
 626     vx1 = vec_mergel (vy0, vy4);                                        \
 627     vx2 = vec_mergeh (vy1, vy5);                                        \
 628     vx3 = vec_mergel (vy1, vy5);                                        \
 629     vx4 = vec_mergeh (vy2, vy6);                                        \
 630     vx5 = vec_mergel (vy2, vy6);                                        \
 631     vx6 = vec_mergeh (vy3, vy7);                                        \
 632     vx7 = vec_mergel (vy3, vy7);                                        \
 633                                                                         \
 634     IDCT_HALF                                                           \
 635                                                                         \
 636     shift = vec_splat_u16 (6);                                          \
 637     vx0 = vec_sra (vy0, shift);                                         \
 638     vx1 = vec_sra (vy1, shift);                                         \
 639     vx2 = vec_sra (vy2, shift);                                         \
 640     vx3 = vec_sra (vy3, shift);                                         \
 641     vx4 = vec_sra (vy4, shift);                                         \
 642     vx5 = vec_sra (vy5, shift);                                         \
 643     vx6 = vec_sra (vy6, shift);                                         \
 644     vx7 = vec_sra (vy7, shift);
 645
 646 static vector_s16_t constants[5] ATTR_ALIGN(16) = {
 647     (vector_s16_t)(23170, 13573, 6518, 21895, -23170, -21895, 32, 31),
 648     (vector_s16_t)(16384, 22725, 21407, 19266, 16384, 19266, 21407, 22725),
 649     (vector_s16_t)(22725, 31521, 29692, 26722, 22725, 26722, 29692, 31521),
 650     (vector_s16_t)(21407, 29692, 27969, 25172, 21407, 25172, 27969, 29692),
 651     (vector_s16_t)(19266, 26722, 25172, 22654, 19266, 22654, 25172, 26722)
 652 };
 653
 654 void idct_block_copy_altivec (vector_s16_t * block, unsigned char * dest,
 655                               int stride)
 656 {
 657     vector_u8_t tmp;
 658
 659     IDCT
 660
 661 #define COPY(dest,src)                                          \
 662     tmp = vec_packsu (src, src);                                \
 663     vec_ste ((vector_u32_t)tmp, 0, (unsigned int *)dest);       \
 664     vec_ste ((vector_u32_t)tmp, 4, (unsigned int *)dest);
 665
 666     COPY (dest, vx0)    dest += stride;
 667     COPY (dest, vx1)    dest += stride;
 668     COPY (dest, vx2)    dest += stride;
 669     COPY (dest, vx3)    dest += stride;
 670     COPY (dest, vx4)    dest += stride;
 671     COPY (dest, vx5)    dest += stride;
 672     COPY (dest, vx6)    dest += stride;
 673     COPY (dest, vx7)
 674 }
 675
 676 void idct_block_add_altivec (vector_s16_t * block, unsigned char * dest,
 677                              int stride)
 678 {
 679     vector_u8_t tmp;
 680     vector_s16_t tmp2, tmp3;
 681     vector_u8_t perm0;
 682     vector_u8_t perm1;
 683     vector_u8_t p0, p1, p;
 684
 685     IDCT
 686
 687     p0 = vec_lvsl (0, dest);
 688     p1 = vec_lvsl (stride, dest);
 689     p = vec_splat_u8 (-1);
 690     perm0 = vec_mergeh (p, p0);
 691     perm1 = vec_mergeh (p, p1);
 692
 693 #define ADD(dest,src,perm)                                              \
 694     /* *(uint64_t *)&tmp = *(uint64_t *)dest; */                        \
 695     tmp = vec_ld (0, dest);                                             \
 696     tmp2 = (vector_s16_t)vec_perm (tmp, (vector_u8_t)zero, perm);       \
 697     tmp3 = vec_adds (tmp2, src);                                        \
 698     tmp = vec_packsu (tmp3, tmp3);                                      \
 699     vec_ste ((vector_u32_t)tmp, 0, (unsigned int *)dest);               \
 700     vec_ste ((vector_u32_t)tmp, 4, (unsigned int *)dest);
 701
 702     ADD (dest, vx0, perm0)      dest += stride;
 703     ADD (dest, vx1, perm1)      dest += stride;
 704     ADD (dest, vx2, perm0)      dest += stride;
 705     ADD (dest, vx3, perm1)      dest += stride;
 706     ADD (dest, vx4, perm0)      dest += stride;
 707     ADD (dest, vx5, perm1)      dest += stride;
 708     ADD (dest, vx6, perm0)      dest += stride;
 709     ADD (dest, vx7, perm1)
 710 }
 711
 712 #endif  /* __BUILD_ALTIVEC_ASM__ || CAN_COMPILE_C_ALTIVEC */
 713
 714 #ifndef __BUILD_ALTIVEC_ASM__
 715
 716 /*****************************************************************************
 717  * Functions exported as capabilities. They are declared as static so that
 718  * we don't pollute the namespace too much.
 719  *****************************************************************************/
 720 static void idct_getfunctions( function_list_t * p_function_list )
 721 {
 722 #define F p_function_list->functions.idct
 723     F.pf_idct_init = InitIDCT;
 724     F.pf_norm_scan = NormScan;
 725     /* FIXME : it would be a nice idea to use sparse IDCT functions */
 726     F.pf_sparse_idct_add = idct_block_add_altivec;
 727     F.pf_sparse_idct_copy = idct_block_copy_altivec;
 728     F.pf_idct_add = idct_block_add_altivec;
 729     F.pf_idct_copy = idct_block_copy_altivec;
 730 #undef F
 731 }
 732
 733 #endif  /* __BUILD_ALTIVEC_ASM__ */