simple_idct_alpha.c
上传用户:wstnjxml
上传日期:2014-04-03
资源大小:7248k
文件大小:8k
源码类别:

Windows CE

开发平台:

C/C++

  1. /*
  2.  * Simple IDCT (Alpha optimized)
  3.  *
  4.  * Copyright (c) 2001 Michael Niedermayer <michaelni@gmx.at>
  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.  * based upon some outcommented c code from mpeg2dec (idct_mmx.c
  21.  * written by Aaron Holtzman <aholtzma@ess.engr.uvic.ca>)
  22.  *
  23.  * Alpha optimiziations by M錸s Rullg錼d <mru@users.sourceforge.net>
  24.  *                     and Falk Hueffner <falk@debian.org>
  25.  */
  26. #include "asm.h"
  27. #include "../dsputil.h"
  28. extern void (*put_pixels_clamped_axp_p)(const DCTELEM *block, uint8_t *pixels,
  29.                                         int line_size);
  30. extern void (*add_pixels_clamped_axp_p)(const DCTELEM *block, uint8_t *pixels, 
  31.                                         int line_size);
  32. // cos(i * M_PI / 16) * sqrt(2) * (1 << 14)
  33. // W4 is actually exactly 16384, but using 16383 works around
  34. // accumulating rounding errors for some encoders
  35. #define W1 ((int_fast32_t) 22725)
  36. #define W2 ((int_fast32_t) 21407)
  37. #define W3 ((int_fast32_t) 19266)
  38. #define W4 ((int_fast32_t) 16383)
  39. #define W5 ((int_fast32_t) 12873)
  40. #define W6 ((int_fast32_t)  8867)
  41. #define W7 ((int_fast32_t)  4520)
  42. #define ROW_SHIFT 11
  43. #define COL_SHIFT 20
  44. /* 0: all entries 0, 1: only first entry nonzero, 2: otherwise  */
  45. static inline int idct_row(DCTELEM *row)
  46. {
  47.     int_fast32_t a0, a1, a2, a3, b0, b1, b2, b3, t;
  48.     uint64_t l, r, t2;
  49.     l = ldq(row);
  50.     r = ldq(row + 4);
  51.     if (l == 0 && r == 0)
  52.         return 0;
  53.     
  54.     a0 = W4 * sextw(l) + (1 << (ROW_SHIFT - 1));
  55.     if (((l & ~0xffffUL) | r) == 0) {
  56.         a0 >>= ROW_SHIFT;
  57.         t2 = (uint16_t) a0;
  58.         t2 |= t2 << 16;
  59.         t2 |= t2 << 32;
  60.         
  61.         stq(t2, row);
  62.         stq(t2, row + 4);
  63.         return 1;
  64.     }
  65.     a1 = a0;
  66.     a2 = a0;
  67.     a3 = a0;
  68.     t = extwl(l, 4);            /* row[2] */
  69.     if (t != 0) {
  70.         t = sextw(t);
  71.         a0 += W2 * t;
  72.         a1 += W6 * t;
  73.         a2 -= W6 * t;
  74.         a3 -= W2 * t;
  75.     }
  76.     t = extwl(r, 0);            /* row[4] */
  77.     if (t != 0) {
  78.         t = sextw(t);
  79.         a0 += W4 * t;
  80.         a1 -= W4 * t;
  81.         a2 -= W4 * t;
  82.         a3 += W4 * t;
  83.     }
  84.     t = extwl(r, 4);            /* row[6] */
  85.     if (t != 0) {
  86.         t = sextw(t);
  87.         a0 += W6 * t;
  88.         a1 -= W2 * t;
  89.         a2 += W2 * t;
  90.         a3 -= W6 * t;
  91.     }
  92.     t = extwl(l, 2);            /* row[1] */
  93.     if (t != 0) {
  94.         t = sextw(t);
  95.         b0 = W1 * t;
  96.         b1 = W3 * t;
  97.         b2 = W5 * t;
  98.         b3 = W7 * t;
  99.     } else {
  100.         b0 = 0;
  101.         b1 = 0;
  102.         b2 = 0;
  103.         b3 = 0;
  104.     }
  105.     t = extwl(l, 6);            /* row[3] */
  106.     if (t) {
  107.         t = sextw(t);
  108.         b0 += W3 * t;
  109.         b1 -= W7 * t;
  110.         b2 -= W1 * t;
  111.         b3 -= W5 * t;
  112.     }
  113.     
  114.     t = extwl(r, 2);            /* row[5] */
  115.     if (t) {
  116.         t = sextw(t);
  117.         b0 += W5 * t;
  118.         b1 -= W1 * t;
  119.         b2 += W7 * t;
  120.         b3 += W3 * t;
  121.     }
  122.     t = extwl(r, 6);            /* row[7] */
  123.     if (t) {
  124.         t = sextw(t);
  125.         b0 += W7 * t;
  126.         b1 -= W5 * t;
  127.         b2 += W3 * t;
  128.         b3 -= W1 * t;
  129.     }
  130.     row[0] = (a0 + b0) >> ROW_SHIFT;
  131.     row[1] = (a1 + b1) >> ROW_SHIFT;
  132.     row[2] = (a2 + b2) >> ROW_SHIFT;
  133.     row[3] = (a3 + b3) >> ROW_SHIFT;
  134.     row[4] = (a3 - b3) >> ROW_SHIFT;
  135.     row[5] = (a2 - b2) >> ROW_SHIFT;
  136.     row[6] = (a1 - b1) >> ROW_SHIFT;
  137.     row[7] = (a0 - b0) >> ROW_SHIFT;
  138.     return 2;
  139. }
  140. static inline void idct_col(DCTELEM *col)
  141. {
  142.     int_fast32_t a0, a1, a2, a3, b0, b1, b2, b3;
  143.     col[0] += (1 << (COL_SHIFT - 1)) / W4;
  144.     a0 = W4 * col[8 * 0];
  145.     a1 = W4 * col[8 * 0];
  146.     a2 = W4 * col[8 * 0];
  147.     a3 = W4 * col[8 * 0];
  148.     if (col[8 * 2]) {
  149.         a0 += W2 * col[8 * 2];
  150.         a1 += W6 * col[8 * 2];
  151.         a2 -= W6 * col[8 * 2];
  152.         a3 -= W2 * col[8 * 2];
  153.     }
  154.     if (col[8 * 4]) {
  155.         a0 += W4 * col[8 * 4];
  156.         a1 -= W4 * col[8 * 4];
  157.         a2 -= W4 * col[8 * 4];
  158.         a3 += W4 * col[8 * 4];
  159.     }
  160.     if (col[8 * 6]) {
  161.         a0 += W6 * col[8 * 6];
  162.         a1 -= W2 * col[8 * 6];
  163.         a2 += W2 * col[8 * 6];
  164.         a3 -= W6 * col[8 * 6];
  165.     }
  166.     if (col[8 * 1]) {
  167.         b0 = W1 * col[8 * 1];
  168.         b1 = W3 * col[8 * 1];
  169.         b2 = W5 * col[8 * 1];
  170.         b3 = W7 * col[8 * 1];
  171.     } else {
  172.         b0 = 0;
  173.         b1 = 0;
  174.         b2 = 0;
  175.         b3 = 0;
  176.     }
  177.     if (col[8 * 3]) {
  178.         b0 += W3 * col[8 * 3];
  179.         b1 -= W7 * col[8 * 3];
  180.         b2 -= W1 * col[8 * 3];
  181.         b3 -= W5 * col[8 * 3];
  182.     }
  183.     if (col[8 * 5]) {
  184.         b0 += W5 * col[8 * 5];
  185.         b1 -= W1 * col[8 * 5];
  186.         b2 += W7 * col[8 * 5];
  187.         b3 += W3 * col[8 * 5];
  188.     }
  189.     if (col[8 * 7]) {
  190.         b0 += W7 * col[8 * 7];
  191.         b1 -= W5 * col[8 * 7];
  192.         b2 += W3 * col[8 * 7];
  193.         b3 -= W1 * col[8 * 7];
  194.     }
  195.     col[8 * 0] = (a0 + b0) >> COL_SHIFT;
  196.     col[8 * 7] = (a0 - b0) >> COL_SHIFT;
  197.     col[8 * 1] = (a1 + b1) >> COL_SHIFT;
  198.     col[8 * 6] = (a1 - b1) >> COL_SHIFT;
  199.     col[8 * 2] = (a2 + b2) >> COL_SHIFT;
  200.     col[8 * 5] = (a2 - b2) >> COL_SHIFT;
  201.     col[8 * 3] = (a3 + b3) >> COL_SHIFT;
  202.     col[8 * 4] = (a3 - b3) >> COL_SHIFT;
  203. }
  204. /* If all rows but the first one are zero after row transformation,
  205.    all rows will be identical after column transformation.  */
  206. static inline void idct_col2(DCTELEM *col)
  207. {
  208.     int i;
  209.     uint64_t l, r;
  210.     for (i = 0; i < 8; ++i) {
  211.         int_fast32_t a0 = col[i] + (1 << (COL_SHIFT - 1)) / W4;
  212.         a0 *= W4;
  213.         col[i] = a0 >> COL_SHIFT;
  214.     }
  215.     l = ldq(col + 0 * 4); r = ldq(col + 1 * 4);
  216.     stq(l, col +  2 * 4); stq(r, col +  3 * 4);
  217.     stq(l, col +  4 * 4); stq(r, col +  5 * 4);
  218.     stq(l, col +  6 * 4); stq(r, col +  7 * 4);
  219.     stq(l, col +  8 * 4); stq(r, col +  9 * 4);
  220.     stq(l, col + 10 * 4); stq(r, col + 11 * 4);
  221.     stq(l, col + 12 * 4); stq(r, col + 13 * 4);
  222.     stq(l, col + 14 * 4); stq(r, col + 15 * 4);
  223. }
  224. void simple_idct_axp(DCTELEM *block)
  225. {
  226.     int i;
  227.     int rowsZero = 1;           /* all rows except row 0 zero */
  228.     int rowsConstant = 1;       /* all rows consist of a constant value */
  229.     for (i = 0; i < 8; i++) {
  230.         int sparseness = idct_row(block + 8 * i);
  231.         if (i > 0 && sparseness > 0)
  232.             rowsZero = 0;
  233.         if (sparseness == 2)
  234.             rowsConstant = 0;
  235.     }
  236.     if (rowsZero) {
  237.         idct_col2(block);
  238.     } else if (rowsConstant) {
  239.         idct_col(block);
  240.         for (i = 0; i < 8; i += 2) {
  241.             uint64_t v = (uint16_t) block[0];
  242.             uint64_t w = (uint16_t) block[8];
  243.             v |= v << 16;
  244.             w |= w << 16;
  245.             v |= v << 32;
  246.             w |= w << 32;
  247.             stq(v, block + 0 * 4);
  248.             stq(v, block + 1 * 4);
  249.             stq(w, block + 2 * 4);
  250.             stq(w, block + 3 * 4);
  251.     block += 4 * 4;
  252.         }
  253.     } else {
  254.         for (i = 0; i < 8; i++)
  255.             idct_col(block + i);
  256.     }
  257. }
  258. void simple_idct_put_axp(uint8_t *dest, int line_size, DCTELEM *block)
  259. {
  260.     simple_idct_axp(block);
  261.     put_pixels_clamped_axp_p(block, dest, line_size);
  262. }
  263. void simple_idct_add_axp(uint8_t *dest, int line_size, DCTELEM *block)
  264. {
  265.     simple_idct_axp(block);
  266.     add_pixels_clamped_axp_p(block, dest, line_size);
  267. }