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.

349 lines
11KB

  1. /*
  2. Originally provided by Intel at AP-922
  3. http://developer.intel.com/vtune/cbts/strmsimd/922down.htm
  4. (See more app notes at http://developer.intel.com/vtune/cbts/strmsimd/appnotes.htm)
  5. but in a limited edition.
  6. column code adapted from peter gubanov
  7. Copyright (c) 2000-2001 Peter Gubanov <peter@elecard.net.ru>
  8. http://www.elecard.com/peter/idct.shtml
  9. Rounding trick Copyright (c) 2000 Michel Lespinasse <walken@zoy.org>
  10. MMI port by Leon van Stuivenberg
  11. */
  12. #include "../common.h"
  13. #include "../dsputil.h"
  14. #include "mmi.h"
  15. #define BITS_INV_ACC 5 // 4 or 5 for IEEE
  16. #define SHIFT_INV_ROW (16 - BITS_INV_ACC)
  17. #define SHIFT_INV_COL (1 + BITS_INV_ACC)
  18. #define TG1 6518
  19. #define TG2 13573
  20. #define TG3 21895
  21. #define CS4 23170
  22. #define ROUNDER_0 0
  23. #define ROUNDER_1 16
  24. #define TAB_i_04 (32+0)
  25. #define TAB_i_17 (32+64)
  26. #define TAB_i_26 (32+128)
  27. #define TAB_i_35 (32+192)
  28. #define TG_1_16 (32+256+0)
  29. #define TG_2_16 (32+256+16)
  30. #define TG_3_16 (32+256+32)
  31. #define COS_4_16 (32+256+48)
  32. #define CLIPMAX (32+256+64+0)
  33. static short consttable[] align16 = {
  34. /* rounder 0*/ // assume SHIFT_INV_ROW == 11
  35. 0x3ff, 1, 0x3ff, 1, 0x3ff, 1, 0x3ff, 1,
  36. /* rounder 1*/
  37. 0x3ff, 0, 0x3ff, 0, 0x3ff, 0, 0x3ff, 0,
  38. /* row 0/4*/
  39. 16384, 21407, -16384, -21407, 22725, 19266, -22725, -12873,
  40. 8867, 16384, 8867, 16384, 4520, 12873, -4520, 19266,
  41. 16384, -8867, 16384, -8867, 12873, -22725, 19266, -22725,
  42. 21407, -16384, -21407, 16384, 19266, 4520, -12873, 4520,
  43. /* row 1/7*/
  44. 22725, 29692, -22725, -29692, 31521, 26722, -31521, -17855,
  45. 12299, 22725, 12299, 22725, 6270, 17855, -6270, 26722,
  46. 22725, -12299, 22725, -12299, 17855, -31521, 26722, -31521,
  47. 29692, -22725, -29692, 22725, 26722, 6270, -17855, 6270,
  48. /* row 2/6*/
  49. 21407, 27969, -21407, -27969, 29692, 25172, -29692, -16819,
  50. 11585, 21407, 11585, 21407, 5906, 16819, -5906, 25172,
  51. 21407, -11585, 21407, -11585, 16819, -29692, 25172, -29692,
  52. 27969, -21407, -27969, 21407, 25172, 5906, -16819, 5906,
  53. /*row 3/5*/
  54. 19266, 25172, -19266, -25172, 26722, 22654, -26722, -15137,
  55. 10426, 19266, 10426, 19266, 5315, 15137, -5315, 22654,
  56. 19266, -10426, 19266, -10426, 15137, -26722, 22654, -26722,
  57. 25172, -19266, -25172, 19266, 22654, 5315, -15137, 5315,
  58. /*column constants*/
  59. TG1, TG1, TG1, TG1, TG1, TG1, TG1, TG1,
  60. TG2, TG2, TG2, TG2, TG2, TG2, TG2, TG2,
  61. TG3, TG3, TG3, TG3, TG3, TG3, TG3, TG3,
  62. CS4, CS4, CS4, CS4, CS4, CS4, CS4, CS4,
  63. /* clamp */
  64. 255, 255, 255, 255, 255, 255, 255, 255
  65. };
  66. #define DCT_8_INV_ROW1(blk, rowoff, taboff, rnd, outreg) { \
  67. lq(blk, rowoff, $16); /* r16 = x7 x5 x3 x1 x6 x4 x2 x0 */ \
  68. /*slot*/ \
  69. lq($24, 0+taboff, $17); /* r17 = w */ \
  70. /*delay slot $16*/ \
  71. lq($24, 16+taboff, $18);/* r18 = w */ \
  72. prevh($16, $2); /* r2 = x1 x3 x5 x7 x0 x2 x4 x6 */ \
  73. lq($24, 32+taboff, $19);/* r19 = w */ \
  74. phmadh($17, $16, $17); /* r17 = b1"b0'a1"a0' */ \
  75. lq($24, 48+taboff, $20);/* r20 = w */ \
  76. phmadh($18, $2, $18); /* r18 = b1'b0"a1'a0" */ \
  77. phmadh($19, $16, $19); /* r19 = b3"b2'a3"a2' */ \
  78. phmadh($20, $2, $20); /* r20 = b3'b2"a3'a2" */ \
  79. paddw($17, $18, $17); /* r17 = (b1)(b0)(a1)(a0) */ \
  80. paddw($19, $20, $19); /* r19 = (b3)(b2)(a3)(a2) */ \
  81. pcpyld($19, $17, $18); /* r18 = (a3)(a2)(a1)(a0) */ \
  82. pcpyud($17, $19, $20); /* r20 = (b3)(b2)(b1)(b0) */ \
  83. paddw($18, rnd, $18); /* r18 = (a3)(a2)(a1)(a0) */\
  84. paddw($18, $20, $17); /* r17 = ()()()(a0+b0) */ \
  85. psubw($18, $20, $20); /* r20 = ()()()(a0-b0) */ \
  86. psraw($17, SHIFT_INV_ROW, $17); /* r17 = (y3 y2 y1 y0) */ \
  87. psraw($20, SHIFT_INV_ROW, $20); /* r20 = (y4 y5 y6 y7) */ \
  88. ppach($20, $17, outreg);/* out = y4 y5 y6 y7 y3 y2 y1 y0 Note order */ \
  89. \
  90. prevh(outreg, $2); \
  91. pcpyud($2, $2, $2); \
  92. pcpyld($2, outreg, outreg); \
  93. }
  94. #define DCT_8_INV_COL8() \
  95. \
  96. lq($24, TG_3_16, $2); /* r2 = tn3 */ \
  97. \
  98. pmulth($11, $2, $17); /* r17 = x3 * tn3 (6420) */ \
  99. psraw($17, 15, $17); \
  100. pmfhl_uw($3); /* r3 = 7531 */ \
  101. psraw($3, 15, $3); \
  102. pinteh($3, $17, $17); /* r17 = x3 * tn3 */ \
  103. psubh($17, $13, $17); /* r17 = tm35 */ \
  104. \
  105. pmulth($13, $2, $18); /* r18 = x5 * tn3 (6420) */ \
  106. psraw($18, 15, $18); \
  107. pmfhl_uw($3); /* r3 = 7531 */ \
  108. psraw($3, 15, $3); \
  109. pinteh($3, $18, $18); /* r18 = x5 * tn3 */ \
  110. paddh($18, $11, $18); /* r18 = tp35 */ \
  111. \
  112. lq($24, TG_1_16, $2); /* r2 = tn1 */ \
  113. \
  114. pmulth($15, $2, $19); /* r19 = x7 * tn1 (6420) */ \
  115. psraw($19, 15, $19); \
  116. pmfhl_uw($3); /* r3 = 7531 */ \
  117. psraw($3, 15, $3); \
  118. pinteh($3, $19, $19); /* r19 = x7 * tn1 */ \
  119. paddh($19, $9, $19); /* r19 = tp17 */ \
  120. \
  121. pmulth($9, $2, $20); /* r20 = x1 * tn1 (6420) */ \
  122. psraw($20, 15, $20); \
  123. pmfhl_uw($3); /* r3 = 7531 */ \
  124. psraw($3, 15, $3); \
  125. pinteh($3, $20, $20); /* r20 = x1 * tn1 */ \
  126. psubh($20, $15, $20); /* r20 = tm17 */ \
  127. \
  128. psubh($19, $18, $3); /* r3 = t1 */ \
  129. paddh($20, $17, $16); /* r16 = t2 */ \
  130. psubh($20, $17, $23); /* r23 = b3 */ \
  131. paddh($19, $18, $20); /* r20 = b0 */ \
  132. \
  133. lq($24, COS_4_16, $2); /* r2 = cs4 */ \
  134. \
  135. paddh($3, $16, $21); /* r21 = t1+t2 */ \
  136. psubh($3, $16, $22); /* r22 = t1-t2 */ \
  137. \
  138. pmulth($21, $2, $21); /* r21 = cs4 * (t1+t2) 6420 */ \
  139. psraw($21, 15, $21); \
  140. pmfhl_uw($3); /* r3 = 7531 */ \
  141. psraw($3, 15, $3); \
  142. pinteh($3, $21, $21); /* r21 = b1 */ \
  143. \
  144. pmulth($22, $2, $22); /* r22 = cs4 * (t1-t2) 6420 */ \
  145. psraw($22, 15, $22); \
  146. pmfhl_uw($3); /* r3 = 7531 */ \
  147. psraw($3, 15, $3); \
  148. pinteh($3, $22, $22); /* r22 = b2 */ \
  149. \
  150. lq($24, TG_2_16, $2); /* r2 = tn2 */ \
  151. \
  152. pmulth($10, $2, $17); /* r17 = x2 * tn2 (6420) */ \
  153. psraw($17, 15, $17); \
  154. pmfhl_uw($3); /* r3 = 7531 */ \
  155. psraw($3, 15, $3); \
  156. pinteh($3, $17, $17); /* r17 = x3 * tn3 */ \
  157. psubh($17, $14, $17); /* r17 = tm26 */ \
  158. \
  159. pmulth($14, $2, $18); /* r18 = x6 * tn2 (6420) */ \
  160. psraw($18, 15, $18); \
  161. pmfhl_uw($3); /* r3 = 7531 */ \
  162. psraw($3, 15, $3); \
  163. pinteh($3, $18, $18); /* r18 = x6 * tn2 */ \
  164. paddh($18, $10, $18); /* r18 = tp26 */ \
  165. \
  166. paddh($8, $12, $2); /* r2 = tp04 */ \
  167. psubh($8, $12, $3); /* r3 = tm04 */ \
  168. \
  169. paddh($2, $18, $16); /* r16 = a0 */ \
  170. psubh($2, $18, $19); /* r19 = a3 */ \
  171. psubh($3, $17, $18); /* r18 = a2 */ \
  172. paddh($3, $17, $17); /* r17 = a1 */
  173. #define DCT_8_INV_COL8_STORE(blk) \
  174. \
  175. paddh($16, $20, $2); /* y0 a0+b0 */ \
  176. psubh($16, $20, $16); /* y7 a0-b0 */ \
  177. psrah($2, SHIFT_INV_COL, $2); \
  178. psrah($16, SHIFT_INV_COL, $16); \
  179. sq($2, 0, blk); \
  180. sq($16, 112, blk); \
  181. \
  182. paddh($17, $21, $3); /* y1 a1+b1 */ \
  183. psubh($17, $21, $17); /* y6 a1-b1 */ \
  184. psrah($3, SHIFT_INV_COL, $3); \
  185. psrah($17, SHIFT_INV_COL, $17); \
  186. sq($3, 16, blk); \
  187. sq($17, 96, blk); \
  188. \
  189. paddh($18, $22, $2); /* y2 a2+b2 */ \
  190. psubh($18, $22, $18); /* y5 a2-b2 */ \
  191. psrah($2, SHIFT_INV_COL, $2); \
  192. psrah($18, SHIFT_INV_COL, $18); \
  193. sq($2, 32, blk); \
  194. sq($18, 80, blk); \
  195. \
  196. paddh($19, $23, $3); /* y3 a3+b3 */ \
  197. psubh($19, $23, $19); /* y4 a3-b3 */ \
  198. psrah($3, SHIFT_INV_COL, $3); \
  199. psrah($19, SHIFT_INV_COL, $19); \
  200. sq($3, 48, blk); \
  201. sq($19, 64, blk);
  202. #define DCT_8_INV_COL8_PMS() \
  203. paddh($16, $20, $2); /* y0 a0+b0 */ \
  204. psubh($16, $20, $20); /* y7 a0-b0 */ \
  205. psrah($2, SHIFT_INV_COL, $16); \
  206. psrah($20, SHIFT_INV_COL, $20); \
  207. \
  208. paddh($17, $21, $3); /* y1 a1+b1 */ \
  209. psubh($17, $21, $21); /* y6 a1-b1 */ \
  210. psrah($3, SHIFT_INV_COL, $17); \
  211. psrah($21, SHIFT_INV_COL, $21); \
  212. \
  213. paddh($18, $22, $2); /* y2 a2+b2 */ \
  214. psubh($18, $22, $22); /* y5 a2-b2 */ \
  215. psrah($2, SHIFT_INV_COL, $18); \
  216. psrah($22, SHIFT_INV_COL, $22); \
  217. \
  218. paddh($19, $23, $3); /* y3 a3+b3 */ \
  219. psubh($19, $23, $23); /* y4 a3-b3 */ \
  220. psrah($3, SHIFT_INV_COL, $19); \
  221. psrah($23, SHIFT_INV_COL, $23);
  222. #define PUT(rs) \
  223. pminh(rs, $11, $2); \
  224. pmaxh($2, $0, $2); \
  225. ppacb($0, $2, $2); \
  226. sd3(2, 0, 4); \
  227. __asm__ __volatile__ ("add $4, $5, $4");
  228. #define DCT_8_INV_COL8_PUT() \
  229. PUT($16); \
  230. PUT($17); \
  231. PUT($18); \
  232. PUT($19); \
  233. PUT($23); \
  234. PUT($22); \
  235. PUT($21); \
  236. PUT($20);
  237. #define ADD(rs) \
  238. ld3(4, 0, 2); \
  239. pextlb($0, $2, $2); \
  240. paddh($2, rs, $2); \
  241. pminh($2, $11, $2); \
  242. pmaxh($2, $0, $2); \
  243. ppacb($0, $2, $2); \
  244. sd3(2, 0, 4); \
  245. __asm__ __volatile__ ("add $4, $5, $4");
  246. /*fixme: schedule*/
  247. #define DCT_8_INV_COL8_ADD() \
  248. ADD($16); \
  249. ADD($17); \
  250. ADD($18); \
  251. ADD($19); \
  252. ADD($23); \
  253. ADD($22); \
  254. ADD($21); \
  255. ADD($20);
  256. void ff_mmi_idct(int16_t * block)
  257. {
  258. /* $4 = block */
  259. __asm__ __volatile__("la $24, %0"::"m"(consttable[0]));
  260. lq($24, ROUNDER_0, $8);
  261. lq($24, ROUNDER_1, $7);
  262. DCT_8_INV_ROW1($4, 0, TAB_i_04, $8, $8);
  263. DCT_8_INV_ROW1($4, 16, TAB_i_17, $7, $9);
  264. DCT_8_INV_ROW1($4, 32, TAB_i_26, $7, $10);
  265. DCT_8_INV_ROW1($4, 48, TAB_i_35, $7, $11);
  266. DCT_8_INV_ROW1($4, 64, TAB_i_04, $7, $12);
  267. DCT_8_INV_ROW1($4, 80, TAB_i_35, $7, $13);
  268. DCT_8_INV_ROW1($4, 96, TAB_i_26, $7, $14);
  269. DCT_8_INV_ROW1($4, 112, TAB_i_17, $7, $15);
  270. DCT_8_INV_COL8();
  271. DCT_8_INV_COL8_STORE($4);
  272. //let savedtemp regs be saved
  273. __asm__ __volatile__(" ":::"$16", "$17", "$18", "$19", "$20", "$21", "$22", "$23");
  274. }
  275. void ff_mmi_idct_put(uint8_t *dest, int line_size, DCTELEM *block)
  276. {
  277. /* $4 = dest, $5 = line_size, $6 = block */
  278. __asm__ __volatile__("la $24, %0"::"m"(consttable[0]));
  279. lq($24, ROUNDER_0, $8);
  280. lq($24, ROUNDER_1, $7);
  281. DCT_8_INV_ROW1($6, 0, TAB_i_04, $8, $8);
  282. DCT_8_INV_ROW1($6, 16, TAB_i_17, $7, $9);
  283. DCT_8_INV_ROW1($6, 32, TAB_i_26, $7, $10);
  284. DCT_8_INV_ROW1($6, 48, TAB_i_35, $7, $11);
  285. DCT_8_INV_ROW1($6, 64, TAB_i_04, $7, $12);
  286. DCT_8_INV_ROW1($6, 80, TAB_i_35, $7, $13);
  287. DCT_8_INV_ROW1($6, 96, TAB_i_26, $7, $14);
  288. DCT_8_INV_ROW1($6, 112, TAB_i_17, $7, $15);
  289. DCT_8_INV_COL8();
  290. lq($24, CLIPMAX, $11);
  291. DCT_8_INV_COL8_PMS();
  292. DCT_8_INV_COL8_PUT();
  293. //let savedtemp regs be saved
  294. __asm__ __volatile__(" ":::"$16", "$17", "$18", "$19", "$20", "$21", "$22", "$23");
  295. }
  296. void ff_mmi_idct_add(uint8_t *dest, int line_size, DCTELEM *block)
  297. {
  298. /* $4 = dest, $5 = line_size, $6 = block */
  299. __asm__ __volatile__("la $24, %0"::"m"(consttable[0]));
  300. lq($24, ROUNDER_0, $8);
  301. lq($24, ROUNDER_1, $7);
  302. DCT_8_INV_ROW1($6, 0, TAB_i_04, $8, $8);
  303. DCT_8_INV_ROW1($6, 16, TAB_i_17, $7, $9);
  304. DCT_8_INV_ROW1($6, 32, TAB_i_26, $7, $10);
  305. DCT_8_INV_ROW1($6, 48, TAB_i_35, $7, $11);
  306. DCT_8_INV_ROW1($6, 64, TAB_i_04, $7, $12);
  307. DCT_8_INV_ROW1($6, 80, TAB_i_35, $7, $13);
  308. DCT_8_INV_ROW1($6, 96, TAB_i_26, $7, $14);
  309. DCT_8_INV_ROW1($6, 112, TAB_i_17, $7, $15);
  310. DCT_8_INV_COL8();
  311. lq($24, CLIPMAX, $11);
  312. DCT_8_INV_COL8_PMS();
  313. DCT_8_INV_COL8_ADD();
  314. //let savedtemp regs be saved
  315. __asm__ __volatile__(" ":::"$16", "$17", "$18", "$19", "$20", "$21", "$22", "$23");
  316. }