mirror of https://github.com/FFmpeg/FFmpeg.git
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
421 lines
11 KiB
421 lines
11 KiB
/* |
|
Copyright (C) 2001 Michael Niedermayer (michaelni@gmx.at) |
|
|
|
This program is free software; you can redistribute it and/or modify |
|
it under the terms of the GNU General Public License as published by |
|
the Free Software Foundation; either version 2 of the License, or |
|
(at your option) any later version. |
|
|
|
This program is distributed in the hope that it will be useful, |
|
but WITHOUT ANY WARRANTY; without even the implied warranty of |
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
|
GNU General Public License for more details. |
|
|
|
You should have received a copy of the GNU General Public License |
|
along with this program; if not, write to the Free Software |
|
Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA |
|
*/ |
|
|
|
/* |
|
based upon some outcommented c code from mpeg2dec (idct_mmx.c written by Aaron Holtzman <aholtzma@ess.engr.uvic.ca>) |
|
*/ |
|
|
|
#include <inttypes.h> |
|
|
|
#include "simple_idct.h" |
|
|
|
#if 0 |
|
#define W1 2841 /* 2048*sqrt (2)*cos (1*pi/16) */ |
|
#define W2 2676 /* 2048*sqrt (2)*cos (2*pi/16) */ |
|
#define W3 2408 /* 2048*sqrt (2)*cos (3*pi/16) */ |
|
#define W4 2048 /* 2048*sqrt (2)*cos (4*pi/16) */ |
|
#define W5 1609 /* 2048*sqrt (2)*cos (5*pi/16) */ |
|
#define W6 1108 /* 2048*sqrt (2)*cos (6*pi/16) */ |
|
#define W7 565 /* 2048*sqrt (2)*cos (7*pi/16) */ |
|
#define ROW_SHIFT 8 |
|
#define COL_SHIFT 17 |
|
#else |
|
#define W1 22725 //cos(i*M_PI/16)*sqrt(2)*(1<<14) + 0.5 |
|
#define W2 21407 //cos(i*M_PI/16)*sqrt(2)*(1<<14) + 0.5 |
|
#define W3 19266 //cos(i*M_PI/16)*sqrt(2)*(1<<14) + 0.5 |
|
#define W4 16384 //cos(i*M_PI/16)*sqrt(2)*(1<<14) + 0.5 |
|
#define W5 12873 //cos(i*M_PI/16)*sqrt(2)*(1<<14) + 0.5 |
|
#define W6 8867 //cos(i*M_PI/16)*sqrt(2)*(1<<14) + 0.5 |
|
#define W7 4520 //cos(i*M_PI/16)*sqrt(2)*(1<<14) + 0.5 |
|
#define ROW_SHIFT 11 |
|
#define COL_SHIFT 20 // 6 |
|
#endif |
|
|
|
/* 8x8 Matrix used to do a trivial (slow) 8 point IDCT */ |
|
static int coeff[64]={ |
|
W4, W4, W4, W4, W4, W4, W4, W4, |
|
W1, W3, W5, W7,-W7,-W5,-W3,-W1, |
|
W2, W6,-W6,-W2,-W2,-W6, W6, W2, |
|
W3,-W7,-W1,-W5, W5, W1, W7,-W3, |
|
W4,-W4,-W4, W4, W4,-W4,-W4, W4, |
|
W5,-W1, W7, W3,-W3,-W7, W1,-W5, |
|
W6,-W2, W2,-W6,-W6, W2,-W2, W6, |
|
W7,-W5, W3,-W1, W1,-W3, W5,-W7 |
|
}; |
|
|
|
static int inline idctRowCondZ (int16_t * row) |
|
{ |
|
int a0, a1, a2, a3, b0, b1, b2, b3; |
|
|
|
if( !( ((uint32_t*)row)[0]|((uint32_t*)row)[1] |((uint32_t*)row)[2] |((uint32_t*)row)[3])) { |
|
/* row[0] = row[1] = row[2] = row[3] = row[4] = |
|
row[5] = row[6] = row[7] = 0;*/ |
|
return 0; |
|
} |
|
|
|
if(!( ((uint32_t*)row)[2] |((uint32_t*)row)[3] )){ |
|
a0 = W4*row[0] + W2*row[2] + (1<<(ROW_SHIFT-1)); |
|
a1 = W4*row[0] + W6*row[2] + (1<<(ROW_SHIFT-1)); |
|
a2 = W4*row[0] - W6*row[2] + (1<<(ROW_SHIFT-1)); |
|
a3 = W4*row[0] - W2*row[2] + (1<<(ROW_SHIFT-1)); |
|
|
|
b0 = W1*row[1] + W3*row[3]; |
|
b1 = W3*row[1] - W7*row[3]; |
|
b2 = W5*row[1] - W1*row[3]; |
|
b3 = W7*row[1] - W5*row[3]; |
|
}else{ |
|
a0 = W4*row[0] + W2*row[2] + W4*row[4] + W6*row[6] + (1<<(ROW_SHIFT-1)); |
|
a1 = W4*row[0] + W6*row[2] - W4*row[4] - W2*row[6] + (1<<(ROW_SHIFT-1)); |
|
a2 = W4*row[0] - W6*row[2] - W4*row[4] + W2*row[6] + (1<<(ROW_SHIFT-1)); |
|
a3 = W4*row[0] - W2*row[2] + W4*row[4] - W6*row[6] + (1<<(ROW_SHIFT-1)); |
|
|
|
b0 = W1*row[1] + W3*row[3] + W5*row[5] + W7*row[7]; |
|
b1 = W3*row[1] - W7*row[3] - W1*row[5] - W5*row[7]; |
|
b2 = W5*row[1] - W1*row[3] + W7*row[5] + W3*row[7]; |
|
b3 = W7*row[1] - W5*row[3] + W3*row[5] - W1*row[7]; |
|
} |
|
|
|
row[0] = (a0 + b0) >> ROW_SHIFT; |
|
row[1] = (a1 + b1) >> ROW_SHIFT; |
|
row[2] = (a2 + b2) >> ROW_SHIFT; |
|
row[3] = (a3 + b3) >> ROW_SHIFT; |
|
row[4] = (a3 - b3) >> ROW_SHIFT; |
|
row[5] = (a2 - b2) >> ROW_SHIFT; |
|
row[6] = (a1 - b1) >> ROW_SHIFT; |
|
row[7] = (a0 - b0) >> ROW_SHIFT; |
|
|
|
return 1; |
|
} |
|
|
|
static int inline idctRowCondDC (int16_t * row) |
|
{ |
|
int a0, a1, a2, a3, b0, b1, b2, b3; |
|
|
|
if( !( ((uint32_t*)row)[1] |((uint32_t*)row)[2] |((uint32_t*)row)[3]| row[1])) { |
|
// row[0] = row[1] = row[2] = row[3] = row[4] = row[5] = row[6] = row[7] = row[0]<<3; |
|
uint16_t temp= row[0]<<3; |
|
((uint32_t*)row)[0]=((uint32_t*)row)[1]= |
|
((uint32_t*)row)[2]=((uint32_t*)row)[3]= temp + (temp<<16); |
|
return 0; |
|
} |
|
|
|
if(!( ((uint32_t*)row)[2] |((uint32_t*)row)[3] )){ |
|
a0 = W4*row[0] + W2*row[2] + (1<<(ROW_SHIFT-1)); |
|
a1 = W4*row[0] + W6*row[2] + (1<<(ROW_SHIFT-1)); |
|
a2 = W4*row[0] - W6*row[2] + (1<<(ROW_SHIFT-1)); |
|
a3 = W4*row[0] - W2*row[2] + (1<<(ROW_SHIFT-1)); |
|
|
|
b0 = W1*row[1] + W3*row[3]; |
|
b1 = W3*row[1] - W7*row[3]; |
|
b2 = W5*row[1] - W1*row[3]; |
|
b3 = W7*row[1] - W5*row[3]; |
|
}else{ |
|
a0 = W4*row[0] + W2*row[2] + W4*row[4] + W6*row[6] + (1<<(ROW_SHIFT-1)); |
|
a1 = W4*row[0] + W6*row[2] - W4*row[4] - W2*row[6] + (1<<(ROW_SHIFT-1)); |
|
a2 = W4*row[0] - W6*row[2] - W4*row[4] + W2*row[6] + (1<<(ROW_SHIFT-1)); |
|
a3 = W4*row[0] - W2*row[2] + W4*row[4] - W6*row[6] + (1<<(ROW_SHIFT-1)); |
|
|
|
b0 = W1*row[1] + W3*row[3] + W5*row[5] + W7*row[7]; |
|
b1 = W3*row[1] - W7*row[3] - W1*row[5] - W5*row[7]; |
|
b2 = W5*row[1] - W1*row[3] + W7*row[5] + W3*row[7]; |
|
b3 = W7*row[1] - W5*row[3] + W3*row[5] - W1*row[7]; |
|
} |
|
|
|
row[0] = (a0 + b0) >> ROW_SHIFT; |
|
row[7] = (a0 - b0) >> ROW_SHIFT; |
|
row[1] = (a1 + b1) >> ROW_SHIFT; |
|
row[6] = (a1 - b1) >> ROW_SHIFT; |
|
row[2] = (a2 + b2) >> ROW_SHIFT; |
|
row[5] = (a2 - b2) >> ROW_SHIFT; |
|
row[3] = (a3 + b3) >> ROW_SHIFT; |
|
row[4] = (a3 - b3) >> ROW_SHIFT; |
|
|
|
return 1; |
|
} |
|
|
|
static void inline idctCol (int16_t * col) |
|
{ |
|
|
|
/* |
|
if( !(col[8*1] | col[8*2] |col[8*3] |col[8*4] |col[8*5] |col[8*6] | col[8*7])) { |
|
col[8*0] = col[8*1] = col[8*2] = col[8*3] = col[8*4] = |
|
col[8*5] = col[8*6] = col[8*7] = col[8*0]<<3; |
|
return; |
|
}*/ |
|
|
|
int a0, a1, a2, a3, b0, b1, b2, b3; |
|
col[0] += (1<<(COL_SHIFT-1))/W4; |
|
a0 = W4*col[8*0] + W2*col[8*2] + W4*col[8*4] + W6*col[8*6]; |
|
a1 = W4*col[8*0] + W6*col[8*2] - W4*col[8*4] - W2*col[8*6]; |
|
a2 = W4*col[8*0] - W6*col[8*2] - W4*col[8*4] + W2*col[8*6]; |
|
a3 = W4*col[8*0] - W2*col[8*2] + W4*col[8*4] - W6*col[8*6]; |
|
|
|
b0 = W1*col[8*1] + W3*col[8*3] + W5*col[8*5] + W7*col[8*7]; |
|
b1 = W3*col[8*1] - W7*col[8*3] - W1*col[8*5] - W5*col[8*7]; |
|
b2 = W5*col[8*1] - W1*col[8*3] + W7*col[8*5] + W3*col[8*7]; |
|
b3 = W7*col[8*1] - W5*col[8*3] + W3*col[8*5] - W1*col[8*7]; |
|
|
|
col[8*0] = (a0 + b0) >> COL_SHIFT; |
|
col[8*7] = (a0 - b0) >> COL_SHIFT; |
|
col[8*1] = (a1 + b1) >> COL_SHIFT; |
|
col[8*6] = (a1 - b1) >> COL_SHIFT; |
|
col[8*2] = (a2 + b2) >> COL_SHIFT; |
|
col[8*5] = (a2 - b2) >> COL_SHIFT; |
|
col[8*3] = (a3 + b3) >> COL_SHIFT; |
|
col[8*4] = (a3 - b3) >> COL_SHIFT; |
|
} |
|
|
|
static void inline idctSparseCol (int16_t * col) |
|
{ |
|
int a0, a1, a2, a3, b0, b1, b2, b3; |
|
col[0] += (1<<(COL_SHIFT-1))/W4; |
|
a0 = W4*col[8*0]; |
|
a1 = W4*col[8*0]; |
|
a2 = W4*col[8*0]; |
|
a3 = W4*col[8*0]; |
|
|
|
if(col[8*2]){ |
|
a0 += + W2*col[8*2]; |
|
a1 += + W6*col[8*2]; |
|
a2 += - W6*col[8*2]; |
|
a3 += - W2*col[8*2]; |
|
} |
|
|
|
if(col[8*4]){ |
|
a0 += + W4*col[8*4]; |
|
a1 += - W4*col[8*4]; |
|
a2 += - W4*col[8*4]; |
|
a3 += + W4*col[8*4]; |
|
} |
|
|
|
if(col[8*6]){ |
|
a0 += + W6*col[8*6]; |
|
a1 += - W2*col[8*6]; |
|
a2 += + W2*col[8*6]; |
|
a3 += - W6*col[8*6]; |
|
} |
|
|
|
if(col[8*1]){ |
|
b0 = W1*col[8*1]; |
|
b1 = W3*col[8*1]; |
|
b2 = W5*col[8*1]; |
|
b3 = W7*col[8*1]; |
|
}else{ |
|
b0 = |
|
b1 = |
|
b2 = |
|
b3 = 0; |
|
} |
|
|
|
if(col[8*3]){ |
|
b0 += + W3*col[8*3]; |
|
b1 += - W7*col[8*3]; |
|
b2 += - W1*col[8*3]; |
|
b3 += - W5*col[8*3]; |
|
} |
|
|
|
if(col[8*5]){ |
|
b0 += + W5*col[8*5]; |
|
b1 += - W1*col[8*5]; |
|
b2 += + W7*col[8*5]; |
|
b3 += + W3*col[8*5]; |
|
} |
|
|
|
if(col[8*7]){ |
|
b0 += + W7*col[8*7]; |
|
b1 += - W5*col[8*7]; |
|
b2 += + W3*col[8*7]; |
|
b3 += - W1*col[8*7]; |
|
} |
|
|
|
if(!(b0|b1|b2|b3)){ |
|
col[8*0] = (a0) >> COL_SHIFT; |
|
col[8*7] = (a0) >> COL_SHIFT; |
|
col[8*1] = (a1) >> COL_SHIFT; |
|
col[8*6] = (a1) >> COL_SHIFT; |
|
col[8*2] = (a2) >> COL_SHIFT; |
|
col[8*5] = (a2) >> COL_SHIFT; |
|
col[8*3] = (a3) >> COL_SHIFT; |
|
col[8*4] = (a3) >> COL_SHIFT; |
|
}else{ |
|
col[8*0] = (a0 + b0) >> COL_SHIFT; |
|
col[8*7] = (a0 - b0) >> COL_SHIFT; |
|
col[8*1] = (a1 + b1) >> COL_SHIFT; |
|
col[8*6] = (a1 - b1) >> COL_SHIFT; |
|
col[8*2] = (a2 + b2) >> COL_SHIFT; |
|
col[8*5] = (a2 - b2) >> COL_SHIFT; |
|
col[8*3] = (a3 + b3) >> COL_SHIFT; |
|
col[8*4] = (a3 - b3) >> COL_SHIFT; |
|
} |
|
} |
|
|
|
static void inline idctSparse2Col (int16_t * col) |
|
{ |
|
int a0, a1, a2, a3, b0, b1, b2, b3; |
|
col[0] += (1<<(COL_SHIFT-1))/W4; |
|
a0 = W4*col[8*0]; |
|
a1 = W4*col[8*0]; |
|
a2 = W4*col[8*0]; |
|
a3 = W4*col[8*0]; |
|
|
|
if(col[8*2]){ |
|
a0 += + W2*col[8*2]; |
|
a1 += + W6*col[8*2]; |
|
a2 += - W6*col[8*2]; |
|
a3 += - W2*col[8*2]; |
|
} |
|
|
|
if(col[8*4]){ |
|
a0 += + W4*col[8*4]; |
|
a1 += - W4*col[8*4]; |
|
a2 += - W4*col[8*4]; |
|
a3 += + W4*col[8*4]; |
|
} |
|
|
|
if(col[8*6]){ |
|
a0 += + W6*col[8*6]; |
|
a1 += - W2*col[8*6]; |
|
a2 += + W2*col[8*6]; |
|
a3 += - W6*col[8*6]; |
|
} |
|
|
|
if(col[8*1] || 1){ |
|
b0 = W1*col[8*1]; |
|
b1 = W3*col[8*1]; |
|
b2 = W5*col[8*1]; |
|
b3 = W7*col[8*1]; |
|
}else{ |
|
b0 = |
|
b1 = |
|
b2 = |
|
b3 = 0; |
|
} |
|
|
|
if(col[8*3]){ |
|
b0 += + W3*col[8*3]; |
|
b1 += - W7*col[8*3]; |
|
b2 += - W1*col[8*3]; |
|
b3 += - W5*col[8*3]; |
|
} |
|
|
|
if(col[8*5]){ |
|
b0 += + W5*col[8*5]; |
|
b1 += - W1*col[8*5]; |
|
b2 += + W7*col[8*5]; |
|
b3 += + W3*col[8*5]; |
|
} |
|
|
|
if(col[8*7]){ |
|
b0 += + W7*col[8*7]; |
|
b1 += - W5*col[8*7]; |
|
b2 += + W3*col[8*7]; |
|
b3 += - W1*col[8*7]; |
|
} |
|
|
|
col[8*0] = (a0 + b0) >> COL_SHIFT; |
|
col[8*7] = (a0 - b0) >> COL_SHIFT; |
|
col[8*1] = (a1 + b1) >> COL_SHIFT; |
|
col[8*6] = (a1 - b1) >> COL_SHIFT; |
|
col[8*2] = (a2 + b2) >> COL_SHIFT; |
|
col[8*5] = (a2 - b2) >> COL_SHIFT; |
|
col[8*3] = (a3 + b3) >> COL_SHIFT; |
|
col[8*4] = (a3 - b3) >> COL_SHIFT; |
|
} |
|
|
|
|
|
void simple_idct (short *block) |
|
{ |
|
|
|
int i; |
|
|
|
#if 0 |
|
int nonZero[8]; |
|
int buffer[64]; |
|
int nNonZero=0; |
|
|
|
idctRowCondDC(block); |
|
|
|
for(i=1; i<8; i++) |
|
{ |
|
nonZero[nNonZero]=i; |
|
nNonZero+= idctRowCondZ(block + i*8); |
|
} |
|
|
|
if(nNonZero==0) |
|
{ |
|
for(i=0; i<8; i++) |
|
{ |
|
block[i ]= |
|
block[i+8 ]= |
|
block[i+16]= |
|
block[i+24]= |
|
block[i+32]= |
|
block[i+40]= |
|
block[i+48]= |
|
block[i+56]= (W4*block[i] + (1<<(COL_SHIFT-1))) >> COL_SHIFT; |
|
} |
|
} |
|
else if(nNonZero==1) |
|
{ |
|
int index= nonZero[0]*8; |
|
for(i=0; i<8; i++) |
|
{ |
|
int bias= W4*block[i] + (1<<(COL_SHIFT-1)); |
|
int c= block[i + index]; |
|
block[i ]= (c*coeff[index ] + bias) >> COL_SHIFT; |
|
block[i+8 ]= (c*coeff[index+1] + bias) >> COL_SHIFT; |
|
block[i+16]= (c*coeff[index+2] + bias) >> COL_SHIFT; |
|
block[i+24]= (c*coeff[index+3] + bias) >> COL_SHIFT; |
|
block[i+32]= (c*coeff[index+4] + bias) >> COL_SHIFT; |
|
block[i+40]= (c*coeff[index+5] + bias) >> COL_SHIFT; |
|
block[i+48]= (c*coeff[index+6] + bias) >> COL_SHIFT; |
|
block[i+56]= (c*coeff[index+7] + bias) >> COL_SHIFT; |
|
} |
|
} |
|
/* else if(nNonZero==2) |
|
{ |
|
int index1= nonZero[0]*8; |
|
int index2= nonZero[1]*8; |
|
for(i=0; i<8; i++) |
|
{ |
|
int bias= W4*block[i] + (1<<(COL_SHIFT-1)); |
|
int c1= block[i + index1]; |
|
int c2= block[i + index2]; |
|
block[i ]= (c1*coeff[index1 ] + c2*coeff[index2 ] + bias) >> COL_SHIFT; |
|
block[i+8 ]= (c1*coeff[index1+1] + c2*coeff[index2+1] + bias) >> COL_SHIFT; |
|
block[i+16]= (c1*coeff[index1+2] + c2*coeff[index2+2] + bias) >> COL_SHIFT; |
|
block[i+24]= (c1*coeff[index1+3] + c2*coeff[index2+3] + bias) >> COL_SHIFT; |
|
block[i+32]= (c1*coeff[index1+4] + c2*coeff[index2+4] + bias) >> COL_SHIFT; |
|
block[i+40]= (c1*coeff[index1+5] + c2*coeff[index2+5] + bias) >> COL_SHIFT; |
|
block[i+48]= (c1*coeff[index1+6] + c2*coeff[index2+6] + bias) >> COL_SHIFT; |
|
block[i+56]= (c1*coeff[index1+7] + c2*coeff[index2+7] + bias) >> COL_SHIFT; |
|
} |
|
}*/ |
|
else |
|
{ |
|
for(i=0; i<8; i++) |
|
idctSparse2Col(block + i); |
|
} |
|
#else |
|
for(i=0; i<8; i++) |
|
idctRowCondDC(block + i*8); |
|
|
|
for(i=0; i<8; i++) |
|
idctSparseCol(block + i); |
|
#endif |
|
}
|
|
|