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.

363 lines
9.6KB

  1. /*
  2. * idct for sh4
  3. *
  4. * Copyright (c) 2001-2003 BERO <bero@geocities.co.jp>
  5. *
  6. * This file is part of FFmpeg.
  7. *
  8. * FFmpeg is free software; you can redistribute it and/or
  9. * modify it under the terms of the GNU Lesser General Public
  10. * License as published by the Free Software Foundation; either
  11. * version 2.1 of the License, or (at your option) any later version.
  12. *
  13. * FFmpeg is distributed in the hope that it will be useful,
  14. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  16. * Lesser General Public License for more details.
  17. *
  18. * You should have received a copy of the GNU Lesser General Public
  19. * License along with FFmpeg; if not, write to the Free Software
  20. * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
  21. */
  22. #include "libavcodec/dsputil.h"
  23. #include "dsputil_sh4.h"
  24. #include "sh4.h"
  25. #define c1 1.38703984532214752434 /* sqrt(2)*cos(1*pi/16) */
  26. #define c2 1.30656296487637657577 /* sqrt(2)*cos(2*pi/16) */
  27. #define c3 1.17587560241935884520 /* sqrt(2)*cos(3*pi/16) */
  28. #define c4 1.00000000000000000000 /* sqrt(2)*cos(4*pi/16) */
  29. #define c5 0.78569495838710234903 /* sqrt(2)*cos(5*pi/16) */
  30. #define c6 0.54119610014619712324 /* sqrt(2)*cos(6*pi/16) */
  31. #define c7 0.27589937928294311353 /* sqrt(2)*cos(7*pi/16) */
  32. static const float even_table[] __attribute__ ((aligned(8))) = {
  33. c4, c4, c4, c4,
  34. c2, c6,-c6,-c2,
  35. c4,-c4,-c4, c4,
  36. c6,-c2, c2,-c6
  37. };
  38. static const float odd_table[] __attribute__ ((aligned(8))) = {
  39. c1, c3, c5, c7,
  40. c3,-c7,-c1,-c5,
  41. c5,-c1, c7, c3,
  42. c7,-c5, c3,-c1
  43. };
  44. #undef c1
  45. #undef c2
  46. #undef c3
  47. #undef c4
  48. #undef c5
  49. #undef c6
  50. #undef c7
  51. #if 1
  52. #define load_matrix(table) \
  53. do { \
  54. const float *t = table; \
  55. __asm__ volatile( \
  56. " fschg\n" \
  57. " fmov @%0+,xd0\n" \
  58. " fmov @%0+,xd2\n" \
  59. " fmov @%0+,xd4\n" \
  60. " fmov @%0+,xd6\n" \
  61. " fmov @%0+,xd8\n" \
  62. " fmov @%0+,xd10\n" \
  63. " fmov @%0+,xd12\n" \
  64. " fmov @%0+,xd14\n" \
  65. " fschg\n" \
  66. : "+r"(t) \
  67. ); \
  68. } while (0)
  69. #define ftrv() \
  70. __asm__ volatile("ftrv xmtrx,fv0" \
  71. : "+f"(fr0),"+f"(fr1),"+f"(fr2),"+f"(fr3));
  72. #define DEFREG \
  73. register float fr0 __asm__("fr0"); \
  74. register float fr1 __asm__("fr1"); \
  75. register float fr2 __asm__("fr2"); \
  76. register float fr3 __asm__("fr3")
  77. #else
  78. /* generic C code for check */
  79. static void ftrv_(const float xf[],float fv[])
  80. {
  81. float f0,f1,f2,f3;
  82. f0 = fv[0];
  83. f1 = fv[1];
  84. f2 = fv[2];
  85. f3 = fv[3];
  86. fv[0] = xf[0]*f0 + xf[4]*f1 + xf[ 8]*f2 + xf[12]*f3;
  87. fv[1] = xf[1]*f0 + xf[5]*f1 + xf[ 9]*f2 + xf[13]*f3;
  88. fv[2] = xf[2]*f0 + xf[6]*f1 + xf[10]*f2 + xf[14]*f3;
  89. fv[3] = xf[3]*f0 + xf[7]*f1 + xf[11]*f2 + xf[15]*f3;
  90. }
  91. static void load_matrix_(float xf[],const float table[])
  92. {
  93. int i;
  94. for(i=0;i<16;i++) xf[i]=table[i];
  95. }
  96. #define ftrv() ftrv_(xf,fv)
  97. #define load_matrix(table) load_matrix_(xf,table)
  98. #define DEFREG \
  99. float fv[4],xf[16]
  100. #define fr0 fv[0]
  101. #define fr1 fv[1]
  102. #define fr2 fv[2]
  103. #define fr3 fv[3]
  104. #endif
  105. #if 1
  106. #define DESCALE(x,n) (x)*(1.0f/(1<<(n)))
  107. #else
  108. #define DESCALE(x,n) (((int)(x)+(1<<(n-1)))>>(n))
  109. #endif
  110. /* this code work worse on gcc cvs. 3.2.3 work fine */
  111. #if 1
  112. //optimized
  113. void idct_sh4(DCTELEM *block)
  114. {
  115. DEFREG;
  116. int i;
  117. float tblock[8*8],*fblock;
  118. int ofs1,ofs2,ofs3;
  119. int fpscr;
  120. fp_single_enter(fpscr);
  121. /* row */
  122. /* even part */
  123. load_matrix(even_table);
  124. fblock = tblock+4;
  125. i = 8;
  126. do {
  127. fr0 = block[0];
  128. fr1 = block[2];
  129. fr2 = block[4];
  130. fr3 = block[6];
  131. block+=8;
  132. ftrv();
  133. *--fblock = fr3;
  134. *--fblock = fr2;
  135. *--fblock = fr1;
  136. *--fblock = fr0;
  137. fblock+=8+4;
  138. } while(--i);
  139. block-=8*8;
  140. fblock-=8*8+4;
  141. load_matrix(odd_table);
  142. i = 8;
  143. do {
  144. float t0,t1,t2,t3;
  145. fr0 = block[1];
  146. fr1 = block[3];
  147. fr2 = block[5];
  148. fr3 = block[7];
  149. block+=8;
  150. ftrv();
  151. t0 = *fblock++;
  152. t1 = *fblock++;
  153. t2 = *fblock++;
  154. t3 = *fblock++;
  155. fblock+=4;
  156. *--fblock = t0 - fr0;
  157. *--fblock = t1 - fr1;
  158. *--fblock = t2 - fr2;
  159. *--fblock = t3 - fr3;
  160. *--fblock = t3 + fr3;
  161. *--fblock = t2 + fr2;
  162. *--fblock = t1 + fr1;
  163. *--fblock = t0 + fr0;
  164. fblock+=8;
  165. } while(--i);
  166. block-=8*8;
  167. fblock-=8*8;
  168. /* col */
  169. /* even part */
  170. load_matrix(even_table);
  171. ofs1 = sizeof(float)*2*8;
  172. ofs2 = sizeof(float)*4*8;
  173. ofs3 = sizeof(float)*6*8;
  174. i = 8;
  175. #define OA(fblock,ofs) *(float*)((char*)fblock + ofs)
  176. do {
  177. fr0 = OA(fblock, 0);
  178. fr1 = OA(fblock,ofs1);
  179. fr2 = OA(fblock,ofs2);
  180. fr3 = OA(fblock,ofs3);
  181. ftrv();
  182. OA(fblock,0 ) = fr0;
  183. OA(fblock,ofs1) = fr1;
  184. OA(fblock,ofs2) = fr2;
  185. OA(fblock,ofs3) = fr3;
  186. fblock++;
  187. } while(--i);
  188. fblock-=8;
  189. load_matrix(odd_table);
  190. i=8;
  191. do {
  192. float t0,t1,t2,t3;
  193. t0 = OA(fblock, 0); /* [8*0] */
  194. t1 = OA(fblock,ofs1); /* [8*2] */
  195. t2 = OA(fblock,ofs2); /* [8*4] */
  196. t3 = OA(fblock,ofs3); /* [8*6] */
  197. fblock+=8;
  198. fr0 = OA(fblock, 0); /* [8*1] */
  199. fr1 = OA(fblock,ofs1); /* [8*3] */
  200. fr2 = OA(fblock,ofs2); /* [8*5] */
  201. fr3 = OA(fblock,ofs3); /* [8*7] */
  202. fblock+=-8+1;
  203. ftrv();
  204. block[8*0] = DESCALE(t0 + fr0,3);
  205. block[8*7] = DESCALE(t0 - fr0,3);
  206. block[8*1] = DESCALE(t1 + fr1,3);
  207. block[8*6] = DESCALE(t1 - fr1,3);
  208. block[8*2] = DESCALE(t2 + fr2,3);
  209. block[8*5] = DESCALE(t2 - fr2,3);
  210. block[8*3] = DESCALE(t3 + fr3,3);
  211. block[8*4] = DESCALE(t3 - fr3,3);
  212. block++;
  213. } while(--i);
  214. fp_single_leave(fpscr);
  215. }
  216. #else
  217. void idct_sh4(DCTELEM *block)
  218. {
  219. DEFREG;
  220. int i;
  221. float tblock[8*8],*fblock;
  222. /* row */
  223. /* even part */
  224. load_matrix(even_table);
  225. fblock = tblock;
  226. i = 8;
  227. do {
  228. fr0 = block[0];
  229. fr1 = block[2];
  230. fr2 = block[4];
  231. fr3 = block[6];
  232. block+=8;
  233. ftrv();
  234. fblock[0] = fr0;
  235. fblock[2] = fr1;
  236. fblock[4] = fr2;
  237. fblock[6] = fr3;
  238. fblock+=8;
  239. } while(--i);
  240. block-=8*8;
  241. fblock-=8*8;
  242. load_matrix(odd_table);
  243. i = 8;
  244. do {
  245. float t0,t1,t2,t3;
  246. fr0 = block[1];
  247. fr1 = block[3];
  248. fr2 = block[5];
  249. fr3 = block[7];
  250. block+=8;
  251. ftrv();
  252. t0 = fblock[0];
  253. t1 = fblock[2];
  254. t2 = fblock[4];
  255. t3 = fblock[6];
  256. fblock[0] = t0 + fr0;
  257. fblock[7] = t0 - fr0;
  258. fblock[1] = t1 + fr1;
  259. fblock[6] = t1 - fr1;
  260. fblock[2] = t2 + fr2;
  261. fblock[5] = t2 - fr2;
  262. fblock[3] = t3 + fr3;
  263. fblock[4] = t3 - fr3;
  264. fblock+=8;
  265. } while(--i);
  266. block-=8*8;
  267. fblock-=8*8;
  268. /* col */
  269. /* even part */
  270. load_matrix(even_table);
  271. i = 8;
  272. do {
  273. fr0 = fblock[8*0];
  274. fr1 = fblock[8*2];
  275. fr2 = fblock[8*4];
  276. fr3 = fblock[8*6];
  277. ftrv();
  278. fblock[8*0] = fr0;
  279. fblock[8*2] = fr1;
  280. fblock[8*4] = fr2;
  281. fblock[8*6] = fr3;
  282. fblock++;
  283. } while(--i);
  284. fblock-=8;
  285. load_matrix(odd_table);
  286. i=8;
  287. do {
  288. float t0,t1,t2,t3;
  289. fr0 = fblock[8*1];
  290. fr1 = fblock[8*3];
  291. fr2 = fblock[8*5];
  292. fr3 = fblock[8*7];
  293. ftrv();
  294. t0 = fblock[8*0];
  295. t1 = fblock[8*2];
  296. t2 = fblock[8*4];
  297. t3 = fblock[8*6];
  298. fblock++;
  299. block[8*0] = DESCALE(t0 + fr0,3);
  300. block[8*7] = DESCALE(t0 - fr0,3);
  301. block[8*1] = DESCALE(t1 + fr1,3);
  302. block[8*6] = DESCALE(t1 - fr1,3);
  303. block[8*2] = DESCALE(t2 + fr2,3);
  304. block[8*5] = DESCALE(t2 - fr2,3);
  305. block[8*3] = DESCALE(t3 + fr3,3);
  306. block[8*4] = DESCALE(t3 - fr3,3);
  307. block++;
  308. } while(--i);
  309. }
  310. #endif