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.

470 lines
17KB

  1. /*
  2. * FFT/MDCT transform with SSE optimizations
  3. * Copyright (c) 2008 Loren Merritt
  4. *
  5. * This file is part of FFmpeg.
  6. *
  7. * FFmpeg is free software; you can redistribute it and/or
  8. * modify it under the terms of the GNU Lesser General Public
  9. * License as published by the Free Software Foundation; either
  10. * version 2.1 of the License, or (at your option) any later version.
  11. *
  12. * FFmpeg is distributed in the hope that it will be useful,
  13. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  14. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  15. * Lesser General Public License for more details.
  16. *
  17. * You should have received a copy of the GNU Lesser General Public
  18. * License along with FFmpeg; if not, write to the Free Software
  19. * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
  20. */
  21. #include "libavutil/x86_cpu.h"
  22. #include "libavutil/common.h"
  23. #include "libavcodec/dsputil.h"
  24. #include "fft.h"
  25. DECLARE_ALIGNED(16, static const int, m1m1m1m1)[4] =
  26. { 1 << 31, 1 << 31, 1 << 31, 1 << 31 };
  27. void ff_fft_dispatch_sse(FFTComplex *z, int nbits);
  28. void ff_fft_dispatch_interleave_sse(FFTComplex *z, int nbits);
  29. void ff_fft_calc_sse(FFTContext *s, FFTComplex *z)
  30. {
  31. int n = 1 << s->nbits;
  32. ff_fft_dispatch_interleave_sse(z, s->nbits);
  33. if(n <= 16) {
  34. x86_reg i = -8*n;
  35. __asm__ volatile(
  36. "1: \n"
  37. "movaps (%0,%1), %%xmm0 \n"
  38. "movaps %%xmm0, %%xmm1 \n"
  39. "unpcklps 16(%0,%1), %%xmm0 \n"
  40. "unpckhps 16(%0,%1), %%xmm1 \n"
  41. "movaps %%xmm0, (%0,%1) \n"
  42. "movaps %%xmm1, 16(%0,%1) \n"
  43. "add $32, %0 \n"
  44. "jl 1b \n"
  45. :"+r"(i)
  46. :"r"(z+n)
  47. :"memory"
  48. );
  49. }
  50. }
  51. void ff_fft_permute_sse(FFTContext *s, FFTComplex *z)
  52. {
  53. int n = 1 << s->nbits;
  54. int i;
  55. for(i=0; i<n; i+=2) {
  56. __asm__ volatile(
  57. "movaps %2, %%xmm0 \n"
  58. "movlps %%xmm0, %0 \n"
  59. "movhps %%xmm0, %1 \n"
  60. :"=m"(s->tmp_buf[s->revtab[i]]),
  61. "=m"(s->tmp_buf[s->revtab[i+1]])
  62. :"m"(z[i])
  63. );
  64. }
  65. memcpy(z, s->tmp_buf, n*sizeof(FFTComplex));
  66. }
  67. void ff_imdct_half_sse(FFTContext *s, FFTSample *output, const FFTSample *input)
  68. {
  69. av_unused x86_reg i, j, k, l;
  70. long n = 1 << s->mdct_bits;
  71. long n2 = n >> 1;
  72. long n4 = n >> 2;
  73. long n8 = n >> 3;
  74. const uint16_t *revtab = s->revtab + n8;
  75. const FFTSample *tcos = s->tcos;
  76. const FFTSample *tsin = s->tsin;
  77. FFTComplex *z = (FFTComplex *)output;
  78. /* pre rotation */
  79. for(k=n8-2; k>=0; k-=2) {
  80. __asm__ volatile(
  81. "movaps (%2,%1,2), %%xmm0 \n" // { z[k].re, z[k].im, z[k+1].re, z[k+1].im }
  82. "movaps -16(%2,%0,2), %%xmm1 \n" // { z[-k-2].re, z[-k-2].im, z[-k-1].re, z[-k-1].im }
  83. "movaps %%xmm0, %%xmm2 \n"
  84. "shufps $0x88, %%xmm1, %%xmm0 \n" // { z[k].re, z[k+1].re, z[-k-2].re, z[-k-1].re }
  85. "shufps $0x77, %%xmm2, %%xmm1 \n" // { z[-k-1].im, z[-k-2].im, z[k+1].im, z[k].im }
  86. "movlps (%3,%1), %%xmm4 \n"
  87. "movlps (%4,%1), %%xmm5 \n"
  88. "movhps -8(%3,%0), %%xmm4 \n" // { cos[k], cos[k+1], cos[-k-2], cos[-k-1] }
  89. "movhps -8(%4,%0), %%xmm5 \n" // { sin[k], sin[k+1], sin[-k-2], sin[-k-1] }
  90. "movaps %%xmm0, %%xmm2 \n"
  91. "movaps %%xmm1, %%xmm3 \n"
  92. "mulps %%xmm5, %%xmm0 \n" // re*sin
  93. "mulps %%xmm4, %%xmm1 \n" // im*cos
  94. "mulps %%xmm4, %%xmm2 \n" // re*cos
  95. "mulps %%xmm5, %%xmm3 \n" // im*sin
  96. "subps %%xmm0, %%xmm1 \n" // -> re
  97. "addps %%xmm3, %%xmm2 \n" // -> im
  98. "movaps %%xmm1, %%xmm0 \n"
  99. "unpcklps %%xmm2, %%xmm1 \n" // { z[k], z[k+1] }
  100. "unpckhps %%xmm2, %%xmm0 \n" // { z[-k-2], z[-k-1] }
  101. ::"r"(-4*k), "r"(4*k),
  102. "r"(input+n4), "r"(tcos+n8), "r"(tsin+n8)
  103. );
  104. #if ARCH_X86_64
  105. // if we have enough regs, don't let gcc make the luts latency-bound
  106. // but if not, latency is faster than spilling
  107. __asm__("movlps %%xmm0, %0 \n"
  108. "movhps %%xmm0, %1 \n"
  109. "movlps %%xmm1, %2 \n"
  110. "movhps %%xmm1, %3 \n"
  111. :"=m"(z[revtab[-k-2]]),
  112. "=m"(z[revtab[-k-1]]),
  113. "=m"(z[revtab[ k ]]),
  114. "=m"(z[revtab[ k+1]])
  115. );
  116. #else
  117. __asm__("movlps %%xmm0, %0" :"=m"(z[revtab[-k-2]]));
  118. __asm__("movhps %%xmm0, %0" :"=m"(z[revtab[-k-1]]));
  119. __asm__("movlps %%xmm1, %0" :"=m"(z[revtab[ k ]]));
  120. __asm__("movhps %%xmm1, %0" :"=m"(z[revtab[ k+1]]));
  121. #endif
  122. }
  123. ff_fft_dispatch_sse(z, s->nbits);
  124. /* post rotation + reinterleave + reorder */
  125. #define CMUL(j,xmm0,xmm1)\
  126. "movaps (%2,"#j",2), %%xmm6 \n"\
  127. "movaps 16(%2,"#j",2), "#xmm0"\n"\
  128. "movaps %%xmm6, "#xmm1"\n"\
  129. "movaps "#xmm0",%%xmm7 \n"\
  130. "mulps (%3,"#j"), %%xmm6 \n"\
  131. "mulps (%4,"#j"), "#xmm0"\n"\
  132. "mulps (%4,"#j"), "#xmm1"\n"\
  133. "mulps (%3,"#j"), %%xmm7 \n"\
  134. "subps %%xmm6, "#xmm0"\n"\
  135. "addps %%xmm7, "#xmm1"\n"
  136. j = -n2;
  137. k = n2-16;
  138. __asm__ volatile(
  139. "1: \n"
  140. CMUL(%0, %%xmm0, %%xmm1)
  141. CMUL(%1, %%xmm4, %%xmm5)
  142. "shufps $0x1b, %%xmm1, %%xmm1 \n"
  143. "shufps $0x1b, %%xmm5, %%xmm5 \n"
  144. "movaps %%xmm4, %%xmm6 \n"
  145. "unpckhps %%xmm1, %%xmm4 \n"
  146. "unpcklps %%xmm1, %%xmm6 \n"
  147. "movaps %%xmm0, %%xmm2 \n"
  148. "unpcklps %%xmm5, %%xmm0 \n"
  149. "unpckhps %%xmm5, %%xmm2 \n"
  150. "movaps %%xmm6, (%2,%1,2) \n"
  151. "movaps %%xmm4, 16(%2,%1,2) \n"
  152. "movaps %%xmm0, (%2,%0,2) \n"
  153. "movaps %%xmm2, 16(%2,%0,2) \n"
  154. "sub $16, %1 \n"
  155. "add $16, %0 \n"
  156. "jl 1b \n"
  157. :"+&r"(j), "+&r"(k)
  158. :"r"(z+n8), "r"(tcos+n8), "r"(tsin+n8)
  159. :"memory"
  160. );
  161. }
  162. void ff_imdct_calc_sse(FFTContext *s, FFTSample *output, const FFTSample *input)
  163. {
  164. x86_reg j, k;
  165. long n = 1 << s->mdct_bits;
  166. long n4 = n >> 2;
  167. ff_imdct_half_sse(s, output+n4, input);
  168. j = -n;
  169. k = n-16;
  170. __asm__ volatile(
  171. "movaps %4, %%xmm7 \n"
  172. "1: \n"
  173. "movaps (%2,%1), %%xmm0 \n"
  174. "movaps (%3,%0), %%xmm1 \n"
  175. "shufps $0x1b, %%xmm0, %%xmm0 \n"
  176. "shufps $0x1b, %%xmm1, %%xmm1 \n"
  177. "xorps %%xmm7, %%xmm0 \n"
  178. "movaps %%xmm1, (%3,%1) \n"
  179. "movaps %%xmm0, (%2,%0) \n"
  180. "sub $16, %1 \n"
  181. "add $16, %0 \n"
  182. "jl 1b \n"
  183. :"+r"(j), "+r"(k)
  184. :"r"(output+n4), "r"(output+n4*3),
  185. "m"(*m1m1m1m1)
  186. );
  187. }
  188. DECLARE_ALIGNED(16, static const float, b1)[] = {
  189. 0.500603, 0.505471, 0.515447, 0.531043,
  190. 0.553104, 0.582935, 0.622504, 0.674808,
  191. -1.169440, -0.972568, -0.839350, -0.744536,
  192. -10.190008, -3.407609, -2.057781, -1.484165,
  193. 0.502419, 0.522499, 0.566944, 0.646822,
  194. 0.788155, 1.060678, 1.722447, 5.101149,
  195. 0.509796, 0.601345, 0.899976, 2.562916,
  196. 1.000000, 1.000000, 1.306563, 0.541196,
  197. 1.000000, 0.707107, 1.000000, -0.707107
  198. };
  199. DECLARE_ALIGNED(16, static const int32_t, smask)[4] = {
  200. 0, 0, 0x80000000, 0x80000000
  201. };
  202. /* butterfly operator */
  203. #define BUTTERFLY(a,b,c,tmp) \
  204. "movaps %%" #a ", %%" #tmp " \n\t" \
  205. "subps %%" #b ", %%" #a " \n\t" \
  206. "addps %%" #tmp ", %%" #b " \n\t" \
  207. "mulps " #c ", %%" #a " \n\t"
  208. ///* Same as BUTTERFLY when vectors a and b overlap */
  209. #define BUTTERFLY0(val, mask, cos, tmp, shuf) \
  210. "movaps %%" #val ", %%" #tmp " \n\t" \
  211. "shufps " #shuf ", %%" #val ",%%" #val " \n\t" \
  212. "xorps %%" #mask ", %%" #tmp " \n\t" /* flip signs */ \
  213. "addps %%" #tmp ", %%" #val " \n\t" \
  214. "mulps %%" #cos ", %%" #val " \n\t"
  215. #define BUTTERFLY2(val, mask, cos, tmp) BUTTERFLY0(val, mask, cos, tmp, $0x1b)
  216. #define BUTTERFLY3(val, mask, cos, tmp) BUTTERFLY0(val, mask, cos, tmp, $0xb1)
  217. void ff_dct32_float_sse(FFTSample *out, const FFTSample *in)
  218. {
  219. int32_t tmp1 = 0;
  220. __asm__ volatile(
  221. /* pass 1 */
  222. "movaps (%4), %%xmm0 \n\t"
  223. "movaps 112(%4), %%xmm1 \n\t"
  224. "shufps $0x1b, %%xmm1, %%xmm1 \n\t"
  225. BUTTERFLY(xmm0, xmm1, (%2), xmm3)
  226. "movaps 64(%4), %%xmm7 \n\t"
  227. "movaps 48(%4), %%xmm4 \n\t"
  228. "shufps $0x1b, %%xmm4, %%xmm4 \n\t"
  229. BUTTERFLY(xmm7, xmm4, 48(%2), xmm3)
  230. /* pass 2 */
  231. "movaps 64(%2), %%xmm2 \n\t"
  232. BUTTERFLY(xmm1, xmm4, %%xmm2, xmm3)
  233. "movaps %%xmm1, 48(%1) \n\t"
  234. "movaps %%xmm4, (%1) \n\t"
  235. /* pass 1 */
  236. "movaps 16(%4), %%xmm1 \n\t"
  237. "movaps 96(%4), %%xmm6 \n\t"
  238. "shufps $0x1b, %%xmm6, %%xmm6 \n\t"
  239. BUTTERFLY(xmm1, xmm6, 16(%2), xmm3)
  240. "movaps 80(%4), %%xmm4 \n\t"
  241. "movaps 32(%4), %%xmm5 \n\t"
  242. "shufps $0x1b, %%xmm5, %%xmm5 \n\t"
  243. BUTTERFLY(xmm4, xmm5, 32(%2), xmm3)
  244. /* pass 2 */
  245. BUTTERFLY(xmm0, xmm7, %%xmm2, xmm3)
  246. "movaps 80(%2), %%xmm2 \n\t"
  247. BUTTERFLY(xmm6, xmm5, %%xmm2, xmm3)
  248. BUTTERFLY(xmm1, xmm4, %%xmm2, xmm3)
  249. /* pass 3 */
  250. "movaps 96(%2), %%xmm2 \n\t"
  251. "shufps $0x1b, %%xmm1, %%xmm1 \n\t"
  252. BUTTERFLY(xmm0, xmm1, %%xmm2, xmm3)
  253. "movaps %%xmm0, 112(%1) \n\t"
  254. "movaps %%xmm1, 96(%1) \n\t"
  255. "movaps 0(%1), %%xmm0 \n\t"
  256. "shufps $0x1b, %%xmm5, %%xmm5 \n\t"
  257. BUTTERFLY(xmm0, xmm5, %%xmm2, xmm3)
  258. "movaps 48(%1), %%xmm1 \n\t"
  259. "shufps $0x1b, %%xmm6, %%xmm6 \n\t"
  260. BUTTERFLY(xmm1, xmm6, %%xmm2, xmm3)
  261. "movaps %%xmm1, 48(%1) \n\t"
  262. "shufps $0x1b, %%xmm4, %%xmm4 \n\t"
  263. BUTTERFLY(xmm7, xmm4, %%xmm2, xmm3)
  264. /* pass 4 */
  265. "movaps (%3), %%xmm3 \n\t"
  266. "movaps 112(%2), %%xmm2 \n\t"
  267. BUTTERFLY2(xmm5, xmm3, xmm2, xmm1)
  268. BUTTERFLY2(xmm0, xmm3, xmm2, xmm1)
  269. "movaps %%xmm0, 16(%1) \n\t"
  270. BUTTERFLY2(xmm6, xmm3, xmm2, xmm1)
  271. "movaps %%xmm6, 32(%1) \n\t"
  272. "movaps 48(%1), %%xmm0 \n\t"
  273. BUTTERFLY2(xmm0, xmm3, xmm2, xmm1)
  274. "movaps %%xmm0, 48(%1) \n\t"
  275. BUTTERFLY2(xmm4, xmm3, xmm2, xmm1)
  276. BUTTERFLY2(xmm7, xmm3, xmm2, xmm1)
  277. "movaps 96(%1), %%xmm6 \n\t"
  278. BUTTERFLY2(xmm6, xmm3, xmm2, xmm1)
  279. "movaps 112(%1), %%xmm0 \n\t"
  280. BUTTERFLY2(xmm0, xmm3, xmm2, xmm1)
  281. /* pass 5 */
  282. "movaps 128(%2), %%xmm2 \n\t"
  283. "shufps $0xCC, %%xmm3,%%xmm3 \n\t"
  284. BUTTERFLY3(xmm5, xmm3, xmm2, xmm1)
  285. "movaps %%xmm5, (%1) \n\t"
  286. "movaps 16(%1), %%xmm1 \n\t"
  287. BUTTERFLY3(xmm1, xmm3, xmm2, xmm5)
  288. "movaps %%xmm1, 16(%1) \n\t"
  289. BUTTERFLY3(xmm4, xmm3, xmm2, xmm5)
  290. "movaps %%xmm4, 64(%1) \n\t"
  291. BUTTERFLY3(xmm7, xmm3, xmm2, xmm5)
  292. "movaps %%xmm7, 80(%1) \n\t"
  293. "movaps 32(%1), %%xmm5 \n\t"
  294. BUTTERFLY3(xmm5, xmm3, xmm2, xmm7)
  295. "movaps %%xmm5, 32(%1) \n\t"
  296. "movaps 48(%1), %%xmm4 \n\t"
  297. BUTTERFLY3(xmm4, xmm3, xmm2, xmm7)
  298. "movaps %%xmm4, 48(%1) \n\t"
  299. BUTTERFLY3(xmm6, xmm3, xmm2, xmm7)
  300. "movaps %%xmm6, 96(%1) \n\t"
  301. BUTTERFLY3(xmm0, xmm3, xmm2, xmm7)
  302. "movaps %%xmm0, 112(%1) \n\t"
  303. /* pass 6, no SIMD... */
  304. "movss 56(%1), %%xmm3 \n\t"
  305. "movl 4(%1), %0 \n\t"
  306. "addss 60(%1), %%xmm3 \n\t"
  307. "movss 72(%1), %%xmm7 \n\t"
  308. "addss %%xmm3, %%xmm4 \n\t"
  309. "movss 52(%1), %%xmm2 \n\t"
  310. "addss %%xmm3, %%xmm2 \n\t"
  311. "movss 24(%1), %%xmm3 \n\t"
  312. "addss 28(%1), %%xmm3 \n\t"
  313. "addss 76(%1), %%xmm7 \n\t"
  314. "addss %%xmm3, %%xmm1 \n\t"
  315. "addss %%xmm4, %%xmm5 \n\t"
  316. "movss %%xmm1, 16(%1) \n\t"
  317. "movss 20(%1), %%xmm1 \n\t"
  318. "addss %%xmm3, %%xmm1 \n\t"
  319. "movss 40(%1), %%xmm3 \n\t"
  320. "movss %%xmm1, 48(%1) \n\t"
  321. "addss 44(%1), %%xmm3 \n\t"
  322. "movss 20(%1), %%xmm1 \n\t"
  323. "addss %%xmm3, %%xmm4 \n\t"
  324. "addss %%xmm2, %%xmm3 \n\t"
  325. "addss 28(%1), %%xmm1 \n\t"
  326. "movss %%xmm3, 40(%1) \n\t"
  327. "addss 36(%1), %%xmm2 \n\t"
  328. "movss 8(%1), %%xmm3 \n\t"
  329. "movss %%xmm2, 56(%1) \n\t"
  330. "addss 12(%1), %%xmm3 \n\t"
  331. "movss %%xmm5, 8(%1) \n\t"
  332. "movss %%xmm3, 32(%1) \n\t"
  333. "movss 52(%1), %%xmm2 \n\t"
  334. "movss 80(%1), %%xmm3 \n\t"
  335. "movss 120(%1), %%xmm5 \n\t"
  336. "movss %%xmm1, 80(%1) \n\t"
  337. "movss %%xmm4, 24(%1) \n\t"
  338. "addss 124(%1), %%xmm5 \n\t"
  339. "movss 64(%1), %%xmm1 \n\t"
  340. "addss 60(%1), %%xmm2 \n\t"
  341. "addss %%xmm5, %%xmm0 \n\t"
  342. "addss 116(%1), %%xmm5 \n\t"
  343. "movl %0, 64(%1) \n\t"
  344. "addss %%xmm0, %%xmm6 \n\t"
  345. "addss %%xmm6, %%xmm1 \n\t"
  346. "movl 12(%1), %0 \n\t"
  347. "movss %%xmm1, 4(%1) \n\t"
  348. "movss 88(%1), %%xmm1 \n\t"
  349. "movl %0, 96(%1) \n\t"
  350. "addss 92(%1), %%xmm1 \n\t"
  351. "movss 104(%1), %%xmm4 \n\t"
  352. "movl 28(%1), %0 \n\t"
  353. "addss 108(%1), %%xmm4 \n\t"
  354. "addss %%xmm4, %%xmm0 \n\t"
  355. "addss %%xmm1, %%xmm3 \n\t"
  356. "addss 84(%1), %%xmm1 \n\t"
  357. "addss %%xmm5, %%xmm4 \n\t"
  358. "addss %%xmm3, %%xmm6 \n\t"
  359. "addss %%xmm0, %%xmm3 \n\t"
  360. "addss %%xmm7, %%xmm0 \n\t"
  361. "addss 100(%1), %%xmm5 \n\t"
  362. "addss %%xmm4, %%xmm7 \n\t"
  363. "movl %0, 112(%1) \n\t"
  364. "movss %%xmm0, 28(%1) \n\t"
  365. "movss 36(%1), %%xmm0 \n\t"
  366. "movss %%xmm7, 36(%1) \n\t"
  367. "addss %%xmm1, %%xmm4 \n\t"
  368. "movss 116(%1), %%xmm7 \n\t"
  369. "addss %%xmm2, %%xmm0 \n\t"
  370. "addss 124(%1), %%xmm7 \n\t"
  371. "movss %%xmm0, 72(%1) \n\t"
  372. "movss 44(%1), %%xmm0 \n\t"
  373. "movss %%xmm6, 12(%1) \n\t"
  374. "movss %%xmm3, 20(%1) \n\t"
  375. "addss %%xmm0, %%xmm2 \n\t"
  376. "movss %%xmm4, 44(%1) \n\t"
  377. "movss %%xmm2, 88(%1) \n\t"
  378. "addss 60(%1), %%xmm0 \n\t"
  379. "movl 60(%1), %0 \n\t"
  380. "movl %0, 120(%1) \n\t"
  381. "movss %%xmm0, 104(%1) \n\t"
  382. "addss %%xmm5, %%xmm1 \n\t"
  383. "addss 68(%1), %%xmm5 \n\t"
  384. "movss %%xmm1, 52(%1) \n\t"
  385. "movss %%xmm5, 60(%1) \n\t"
  386. "movss 68(%1), %%xmm1 \n\t"
  387. "movss 100(%1), %%xmm5 \n\t"
  388. "addss %%xmm7, %%xmm5 \n\t"
  389. "addss 108(%1), %%xmm7 \n\t"
  390. "addss %%xmm5, %%xmm1 \n\t"
  391. "movss 84(%1), %%xmm2 \n\t"
  392. "addss 92(%1), %%xmm2 \n\t"
  393. "addss %%xmm2, %%xmm5 \n\t"
  394. "movss %%xmm1, 68(%1) \n\t"
  395. "addss %%xmm7, %%xmm2 \n\t"
  396. "movss 76(%1), %%xmm1 \n\t"
  397. "movss %%xmm2, 84(%1) \n\t"
  398. "movss %%xmm5, 76(%1) \n\t"
  399. "movss 108(%1), %%xmm2 \n\t"
  400. "addss %%xmm1, %%xmm7 \n\t"
  401. "addss 124(%1), %%xmm2 \n\t"
  402. "addss %%xmm2, %%xmm1 \n\t"
  403. "addss 92(%1), %%xmm2 \n\t"
  404. "movss %%xmm1, 100(%1) \n\t"
  405. "movss %%xmm2, 108(%1) \n\t"
  406. "movss 92(%1), %%xmm2 \n\t"
  407. "movss %%xmm7, 92(%1) \n\t"
  408. "addss 124(%1), %%xmm2 \n\t"
  409. "movss %%xmm2, 116(%1) \n\t"
  410. :"+&r"(tmp1)
  411. :"r"(out), "r"(b1), "r"(smask), "r"(in)
  412. :"memory"
  413. );
  414. }