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.

422 lines
11KB

  1. /*
  2. Copyright (C) 2001 Michael Niedermayer (michaelni@gmx.at)
  3. This program is free software; you can redistribute it and/or modify
  4. it under the terms of the GNU General Public License as published by
  5. the Free Software Foundation; either version 2 of the License, or
  6. (at your option) any later version.
  7. This program is distributed in the hope that it will be useful,
  8. but WITHOUT ANY WARRANTY; without even the implied warranty of
  9. MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  10. GNU General Public License for more details.
  11. You should have received a copy of the GNU General Public License
  12. along with this program; if not, write to the Free Software
  13. Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
  14. */
  15. /*
  16. based upon some outcommented c code from mpeg2dec (idct_mmx.c written by Aaron Holtzman <aholtzma@ess.engr.uvic.ca>)
  17. */
  18. #include <inttypes.h>
  19. #include "simple_idct.h"
  20. #if 0
  21. #define W1 2841 /* 2048*sqrt (2)*cos (1*pi/16) */
  22. #define W2 2676 /* 2048*sqrt (2)*cos (2*pi/16) */
  23. #define W3 2408 /* 2048*sqrt (2)*cos (3*pi/16) */
  24. #define W4 2048 /* 2048*sqrt (2)*cos (4*pi/16) */
  25. #define W5 1609 /* 2048*sqrt (2)*cos (5*pi/16) */
  26. #define W6 1108 /* 2048*sqrt (2)*cos (6*pi/16) */
  27. #define W7 565 /* 2048*sqrt (2)*cos (7*pi/16) */
  28. #define ROW_SHIFT 8
  29. #define COL_SHIFT 17
  30. #else
  31. #define W1 22725 //cos(i*M_PI/16)*sqrt(2)*(1<<14) + 0.5
  32. #define W2 21407 //cos(i*M_PI/16)*sqrt(2)*(1<<14) + 0.5
  33. #define W3 19266 //cos(i*M_PI/16)*sqrt(2)*(1<<14) + 0.5
  34. #define W4 16384 //cos(i*M_PI/16)*sqrt(2)*(1<<14) + 0.5
  35. #define W5 12873 //cos(i*M_PI/16)*sqrt(2)*(1<<14) + 0.5
  36. #define W6 8867 //cos(i*M_PI/16)*sqrt(2)*(1<<14) + 0.5
  37. #define W7 4520 //cos(i*M_PI/16)*sqrt(2)*(1<<14) + 0.5
  38. #define ROW_SHIFT 11
  39. #define COL_SHIFT 20 // 6
  40. #endif
  41. /* 8x8 Matrix used to do a trivial (slow) 8 point IDCT */
  42. static int coeff[64]={
  43. W4, W4, W4, W4, W4, W4, W4, W4,
  44. W1, W3, W5, W7,-W7,-W5,-W3,-W1,
  45. W2, W6,-W6,-W2,-W2,-W6, W6, W2,
  46. W3,-W7,-W1,-W5, W5, W1, W7,-W3,
  47. W4,-W4,-W4, W4, W4,-W4,-W4, W4,
  48. W5,-W1, W7, W3,-W3,-W7, W1,-W5,
  49. W6,-W2, W2,-W6,-W6, W2,-W2, W6,
  50. W7,-W5, W3,-W1, W1,-W3, W5,-W7
  51. };
  52. static int inline idctRowCondZ (int16_t * row)
  53. {
  54. int a0, a1, a2, a3, b0, b1, b2, b3;
  55. if( !( ((uint32_t*)row)[0]|((uint32_t*)row)[1] |((uint32_t*)row)[2] |((uint32_t*)row)[3])) {
  56. /* row[0] = row[1] = row[2] = row[3] = row[4] =
  57. row[5] = row[6] = row[7] = 0;*/
  58. return 0;
  59. }
  60. if(!( ((uint32_t*)row)[2] |((uint32_t*)row)[3] )){
  61. a0 = W4*row[0] + W2*row[2] + (1<<(ROW_SHIFT-1));
  62. a1 = W4*row[0] + W6*row[2] + (1<<(ROW_SHIFT-1));
  63. a2 = W4*row[0] - W6*row[2] + (1<<(ROW_SHIFT-1));
  64. a3 = W4*row[0] - W2*row[2] + (1<<(ROW_SHIFT-1));
  65. b0 = W1*row[1] + W3*row[3];
  66. b1 = W3*row[1] - W7*row[3];
  67. b2 = W5*row[1] - W1*row[3];
  68. b3 = W7*row[1] - W5*row[3];
  69. }else{
  70. a0 = W4*row[0] + W2*row[2] + W4*row[4] + W6*row[6] + (1<<(ROW_SHIFT-1));
  71. a1 = W4*row[0] + W6*row[2] - W4*row[4] - W2*row[6] + (1<<(ROW_SHIFT-1));
  72. a2 = W4*row[0] - W6*row[2] - W4*row[4] + W2*row[6] + (1<<(ROW_SHIFT-1));
  73. a3 = W4*row[0] - W2*row[2] + W4*row[4] - W6*row[6] + (1<<(ROW_SHIFT-1));
  74. b0 = W1*row[1] + W3*row[3] + W5*row[5] + W7*row[7];
  75. b1 = W3*row[1] - W7*row[3] - W1*row[5] - W5*row[7];
  76. b2 = W5*row[1] - W1*row[3] + W7*row[5] + W3*row[7];
  77. b3 = W7*row[1] - W5*row[3] + W3*row[5] - W1*row[7];
  78. }
  79. row[0] = (a0 + b0) >> ROW_SHIFT;
  80. row[1] = (a1 + b1) >> ROW_SHIFT;
  81. row[2] = (a2 + b2) >> ROW_SHIFT;
  82. row[3] = (a3 + b3) >> ROW_SHIFT;
  83. row[4] = (a3 - b3) >> ROW_SHIFT;
  84. row[5] = (a2 - b2) >> ROW_SHIFT;
  85. row[6] = (a1 - b1) >> ROW_SHIFT;
  86. row[7] = (a0 - b0) >> ROW_SHIFT;
  87. return 1;
  88. }
  89. static int inline idctRowCondDC (int16_t * row)
  90. {
  91. int a0, a1, a2, a3, b0, b1, b2, b3;
  92. if( !( ((uint32_t*)row)[1] |((uint32_t*)row)[2] |((uint32_t*)row)[3]| row[1])) {
  93. // row[0] = row[1] = row[2] = row[3] = row[4] = row[5] = row[6] = row[7] = row[0]<<3;
  94. uint16_t temp= row[0]<<3;
  95. ((uint32_t*)row)[0]=((uint32_t*)row)[1]=
  96. ((uint32_t*)row)[2]=((uint32_t*)row)[3]= temp + (temp<<16);
  97. return 0;
  98. }
  99. if(!( ((uint32_t*)row)[2] |((uint32_t*)row)[3] )){
  100. a0 = W4*row[0] + W2*row[2] + (1<<(ROW_SHIFT-1));
  101. a1 = W4*row[0] + W6*row[2] + (1<<(ROW_SHIFT-1));
  102. a2 = W4*row[0] - W6*row[2] + (1<<(ROW_SHIFT-1));
  103. a3 = W4*row[0] - W2*row[2] + (1<<(ROW_SHIFT-1));
  104. b0 = W1*row[1] + W3*row[3];
  105. b1 = W3*row[1] - W7*row[3];
  106. b2 = W5*row[1] - W1*row[3];
  107. b3 = W7*row[1] - W5*row[3];
  108. }else{
  109. a0 = W4*row[0] + W2*row[2] + W4*row[4] + W6*row[6] + (1<<(ROW_SHIFT-1));
  110. a1 = W4*row[0] + W6*row[2] - W4*row[4] - W2*row[6] + (1<<(ROW_SHIFT-1));
  111. a2 = W4*row[0] - W6*row[2] - W4*row[4] + W2*row[6] + (1<<(ROW_SHIFT-1));
  112. a3 = W4*row[0] - W2*row[2] + W4*row[4] - W6*row[6] + (1<<(ROW_SHIFT-1));
  113. b0 = W1*row[1] + W3*row[3] + W5*row[5] + W7*row[7];
  114. b1 = W3*row[1] - W7*row[3] - W1*row[5] - W5*row[7];
  115. b2 = W5*row[1] - W1*row[3] + W7*row[5] + W3*row[7];
  116. b3 = W7*row[1] - W5*row[3] + W3*row[5] - W1*row[7];
  117. }
  118. row[0] = (a0 + b0) >> ROW_SHIFT;
  119. row[7] = (a0 - b0) >> ROW_SHIFT;
  120. row[1] = (a1 + b1) >> ROW_SHIFT;
  121. row[6] = (a1 - b1) >> ROW_SHIFT;
  122. row[2] = (a2 + b2) >> ROW_SHIFT;
  123. row[5] = (a2 - b2) >> ROW_SHIFT;
  124. row[3] = (a3 + b3) >> ROW_SHIFT;
  125. row[4] = (a3 - b3) >> ROW_SHIFT;
  126. return 1;
  127. }
  128. static void inline idctCol (int16_t * col)
  129. {
  130. /*
  131. if( !(col[8*1] | col[8*2] |col[8*3] |col[8*4] |col[8*5] |col[8*6] | col[8*7])) {
  132. col[8*0] = col[8*1] = col[8*2] = col[8*3] = col[8*4] =
  133. col[8*5] = col[8*6] = col[8*7] = col[8*0]<<3;
  134. return;
  135. }*/
  136. int a0, a1, a2, a3, b0, b1, b2, b3;
  137. col[0] += (1<<(COL_SHIFT-1))/W4;
  138. a0 = W4*col[8*0] + W2*col[8*2] + W4*col[8*4] + W6*col[8*6];
  139. a1 = W4*col[8*0] + W6*col[8*2] - W4*col[8*4] - W2*col[8*6];
  140. a2 = W4*col[8*0] - W6*col[8*2] - W4*col[8*4] + W2*col[8*6];
  141. a3 = W4*col[8*0] - W2*col[8*2] + W4*col[8*4] - W6*col[8*6];
  142. b0 = W1*col[8*1] + W3*col[8*3] + W5*col[8*5] + W7*col[8*7];
  143. b1 = W3*col[8*1] - W7*col[8*3] - W1*col[8*5] - W5*col[8*7];
  144. b2 = W5*col[8*1] - W1*col[8*3] + W7*col[8*5] + W3*col[8*7];
  145. b3 = W7*col[8*1] - W5*col[8*3] + W3*col[8*5] - W1*col[8*7];
  146. col[8*0] = (a0 + b0) >> COL_SHIFT;
  147. col[8*7] = (a0 - b0) >> COL_SHIFT;
  148. col[8*1] = (a1 + b1) >> COL_SHIFT;
  149. col[8*6] = (a1 - b1) >> COL_SHIFT;
  150. col[8*2] = (a2 + b2) >> COL_SHIFT;
  151. col[8*5] = (a2 - b2) >> COL_SHIFT;
  152. col[8*3] = (a3 + b3) >> COL_SHIFT;
  153. col[8*4] = (a3 - b3) >> COL_SHIFT;
  154. }
  155. static void inline idctSparseCol (int16_t * col)
  156. {
  157. int a0, a1, a2, a3, b0, b1, b2, b3;
  158. col[0] += (1<<(COL_SHIFT-1))/W4;
  159. a0 = W4*col[8*0];
  160. a1 = W4*col[8*0];
  161. a2 = W4*col[8*0];
  162. a3 = W4*col[8*0];
  163. if(col[8*2]){
  164. a0 += + W2*col[8*2];
  165. a1 += + W6*col[8*2];
  166. a2 += - W6*col[8*2];
  167. a3 += - W2*col[8*2];
  168. }
  169. if(col[8*4]){
  170. a0 += + W4*col[8*4];
  171. a1 += - W4*col[8*4];
  172. a2 += - W4*col[8*4];
  173. a3 += + W4*col[8*4];
  174. }
  175. if(col[8*6]){
  176. a0 += + W6*col[8*6];
  177. a1 += - W2*col[8*6];
  178. a2 += + W2*col[8*6];
  179. a3 += - W6*col[8*6];
  180. }
  181. if(col[8*1]){
  182. b0 = W1*col[8*1];
  183. b1 = W3*col[8*1];
  184. b2 = W5*col[8*1];
  185. b3 = W7*col[8*1];
  186. }else{
  187. b0 =
  188. b1 =
  189. b2 =
  190. b3 = 0;
  191. }
  192. if(col[8*3]){
  193. b0 += + W3*col[8*3];
  194. b1 += - W7*col[8*3];
  195. b2 += - W1*col[8*3];
  196. b3 += - W5*col[8*3];
  197. }
  198. if(col[8*5]){
  199. b0 += + W5*col[8*5];
  200. b1 += - W1*col[8*5];
  201. b2 += + W7*col[8*5];
  202. b3 += + W3*col[8*5];
  203. }
  204. if(col[8*7]){
  205. b0 += + W7*col[8*7];
  206. b1 += - W5*col[8*7];
  207. b2 += + W3*col[8*7];
  208. b3 += - W1*col[8*7];
  209. }
  210. if(!(b0|b1|b2|b3)){
  211. col[8*0] = (a0) >> COL_SHIFT;
  212. col[8*7] = (a0) >> COL_SHIFT;
  213. col[8*1] = (a1) >> COL_SHIFT;
  214. col[8*6] = (a1) >> COL_SHIFT;
  215. col[8*2] = (a2) >> COL_SHIFT;
  216. col[8*5] = (a2) >> COL_SHIFT;
  217. col[8*3] = (a3) >> COL_SHIFT;
  218. col[8*4] = (a3) >> COL_SHIFT;
  219. }else{
  220. col[8*0] = (a0 + b0) >> COL_SHIFT;
  221. col[8*7] = (a0 - b0) >> COL_SHIFT;
  222. col[8*1] = (a1 + b1) >> COL_SHIFT;
  223. col[8*6] = (a1 - b1) >> COL_SHIFT;
  224. col[8*2] = (a2 + b2) >> COL_SHIFT;
  225. col[8*5] = (a2 - b2) >> COL_SHIFT;
  226. col[8*3] = (a3 + b3) >> COL_SHIFT;
  227. col[8*4] = (a3 - b3) >> COL_SHIFT;
  228. }
  229. }
  230. static void inline idctSparse2Col (int16_t * col)
  231. {
  232. int a0, a1, a2, a3, b0, b1, b2, b3;
  233. col[0] += (1<<(COL_SHIFT-1))/W4;
  234. a0 = W4*col[8*0];
  235. a1 = W4*col[8*0];
  236. a2 = W4*col[8*0];
  237. a3 = W4*col[8*0];
  238. if(col[8*2]){
  239. a0 += + W2*col[8*2];
  240. a1 += + W6*col[8*2];
  241. a2 += - W6*col[8*2];
  242. a3 += - W2*col[8*2];
  243. }
  244. if(col[8*4]){
  245. a0 += + W4*col[8*4];
  246. a1 += - W4*col[8*4];
  247. a2 += - W4*col[8*4];
  248. a3 += + W4*col[8*4];
  249. }
  250. if(col[8*6]){
  251. a0 += + W6*col[8*6];
  252. a1 += - W2*col[8*6];
  253. a2 += + W2*col[8*6];
  254. a3 += - W6*col[8*6];
  255. }
  256. if(col[8*1] || 1){
  257. b0 = W1*col[8*1];
  258. b1 = W3*col[8*1];
  259. b2 = W5*col[8*1];
  260. b3 = W7*col[8*1];
  261. }else{
  262. b0 =
  263. b1 =
  264. b2 =
  265. b3 = 0;
  266. }
  267. if(col[8*3]){
  268. b0 += + W3*col[8*3];
  269. b1 += - W7*col[8*3];
  270. b2 += - W1*col[8*3];
  271. b3 += - W5*col[8*3];
  272. }
  273. if(col[8*5]){
  274. b0 += + W5*col[8*5];
  275. b1 += - W1*col[8*5];
  276. b2 += + W7*col[8*5];
  277. b3 += + W3*col[8*5];
  278. }
  279. if(col[8*7]){
  280. b0 += + W7*col[8*7];
  281. b1 += - W5*col[8*7];
  282. b2 += + W3*col[8*7];
  283. b3 += - W1*col[8*7];
  284. }
  285. col[8*0] = (a0 + b0) >> COL_SHIFT;
  286. col[8*7] = (a0 - b0) >> COL_SHIFT;
  287. col[8*1] = (a1 + b1) >> COL_SHIFT;
  288. col[8*6] = (a1 - b1) >> COL_SHIFT;
  289. col[8*2] = (a2 + b2) >> COL_SHIFT;
  290. col[8*5] = (a2 - b2) >> COL_SHIFT;
  291. col[8*3] = (a3 + b3) >> COL_SHIFT;
  292. col[8*4] = (a3 - b3) >> COL_SHIFT;
  293. }
  294. void simple_idct (short *block)
  295. {
  296. int i;
  297. #if 0
  298. int nonZero[8];
  299. int buffer[64];
  300. int nNonZero=0;
  301. idctRowCondDC(block);
  302. for(i=1; i<8; i++)
  303. {
  304. nonZero[nNonZero]=i;
  305. nNonZero+= idctRowCondZ(block + i*8);
  306. }
  307. if(nNonZero==0)
  308. {
  309. for(i=0; i<8; i++)
  310. {
  311. block[i ]=
  312. block[i+8 ]=
  313. block[i+16]=
  314. block[i+24]=
  315. block[i+32]=
  316. block[i+40]=
  317. block[i+48]=
  318. block[i+56]= (W4*block[i] + (1<<(COL_SHIFT-1))) >> COL_SHIFT;
  319. }
  320. }
  321. else if(nNonZero==1)
  322. {
  323. int index= nonZero[0]*8;
  324. for(i=0; i<8; i++)
  325. {
  326. int bias= W4*block[i] + (1<<(COL_SHIFT-1));
  327. int c= block[i + index];
  328. block[i ]= (c*coeff[index ] + bias) >> COL_SHIFT;
  329. block[i+8 ]= (c*coeff[index+1] + bias) >> COL_SHIFT;
  330. block[i+16]= (c*coeff[index+2] + bias) >> COL_SHIFT;
  331. block[i+24]= (c*coeff[index+3] + bias) >> COL_SHIFT;
  332. block[i+32]= (c*coeff[index+4] + bias) >> COL_SHIFT;
  333. block[i+40]= (c*coeff[index+5] + bias) >> COL_SHIFT;
  334. block[i+48]= (c*coeff[index+6] + bias) >> COL_SHIFT;
  335. block[i+56]= (c*coeff[index+7] + bias) >> COL_SHIFT;
  336. }
  337. }
  338. /* else if(nNonZero==2)
  339. {
  340. int index1= nonZero[0]*8;
  341. int index2= nonZero[1]*8;
  342. for(i=0; i<8; i++)
  343. {
  344. int bias= W4*block[i] + (1<<(COL_SHIFT-1));
  345. int c1= block[i + index1];
  346. int c2= block[i + index2];
  347. block[i ]= (c1*coeff[index1 ] + c2*coeff[index2 ] + bias) >> COL_SHIFT;
  348. block[i+8 ]= (c1*coeff[index1+1] + c2*coeff[index2+1] + bias) >> COL_SHIFT;
  349. block[i+16]= (c1*coeff[index1+2] + c2*coeff[index2+2] + bias) >> COL_SHIFT;
  350. block[i+24]= (c1*coeff[index1+3] + c2*coeff[index2+3] + bias) >> COL_SHIFT;
  351. block[i+32]= (c1*coeff[index1+4] + c2*coeff[index2+4] + bias) >> COL_SHIFT;
  352. block[i+40]= (c1*coeff[index1+5] + c2*coeff[index2+5] + bias) >> COL_SHIFT;
  353. block[i+48]= (c1*coeff[index1+6] + c2*coeff[index2+6] + bias) >> COL_SHIFT;
  354. block[i+56]= (c1*coeff[index1+7] + c2*coeff[index2+7] + bias) >> COL_SHIFT;
  355. }
  356. }*/
  357. else
  358. {
  359. for(i=0; i<8; i++)
  360. idctSparse2Col(block + i);
  361. }
  362. #else
  363. for(i=0; i<8; i++)
  364. idctRowCondDC(block + i*8);
  365. for(i=0; i<8; i++)
  366. idctSparseCol(block + i);
  367. #endif
  368. }