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.

2890 lines
145KB

  1. /*
  2. * MMX optimized DSP utils
  3. * Copyright (c) 2000, 2001 Fabrice Bellard
  4. * Copyright (c) 2002-2004 Michael Niedermayer <michaelni@gmx.at>
  5. *
  6. * MMX optimization by Nick Kurshev <nickols_k@mail.ru>
  7. *
  8. * This file is part of Libav.
  9. *
  10. * Libav is free software; you can redistribute it and/or
  11. * modify it under the terms of the GNU Lesser General Public
  12. * License as published by the Free Software Foundation; either
  13. * version 2.1 of the License, or (at your option) any later version.
  14. *
  15. * Libav is distributed in the hope that it will be useful,
  16. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  17. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  18. * Lesser General Public License for more details.
  19. *
  20. * You should have received a copy of the GNU Lesser General Public
  21. * License along with Libav; if not, write to the Free Software
  22. * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
  23. */
  24. #include "libavutil/cpu.h"
  25. #include "libavutil/x86/asm.h"
  26. #include "libavcodec/dsputil.h"
  27. #include "libavcodec/h264dsp.h"
  28. #include "libavcodec/mpegvideo.h"
  29. #include "libavcodec/simple_idct.h"
  30. #include "dsputil_mmx.h"
  31. #include "idct_xvid.h"
  32. //#undef NDEBUG
  33. //#include <assert.h>
  34. /* pixel operations */
  35. DECLARE_ALIGNED(8, const uint64_t, ff_bone) = 0x0101010101010101ULL;
  36. DECLARE_ALIGNED(8, const uint64_t, ff_wtwo) = 0x0002000200020002ULL;
  37. DECLARE_ALIGNED(16, const uint64_t, ff_pdw_80000000)[2] =
  38. { 0x8000000080000000ULL, 0x8000000080000000ULL };
  39. DECLARE_ALIGNED(16, const xmm_reg, ff_pw_1) = { 0x0001000100010001ULL, 0x0001000100010001ULL };
  40. DECLARE_ALIGNED(16, const xmm_reg, ff_pw_2) = { 0x0002000200020002ULL, 0x0002000200020002ULL };
  41. DECLARE_ALIGNED(16, const xmm_reg, ff_pw_3) = { 0x0003000300030003ULL, 0x0003000300030003ULL };
  42. DECLARE_ALIGNED(16, const xmm_reg, ff_pw_4) = { 0x0004000400040004ULL, 0x0004000400040004ULL };
  43. DECLARE_ALIGNED(16, const xmm_reg, ff_pw_5) = { 0x0005000500050005ULL, 0x0005000500050005ULL };
  44. DECLARE_ALIGNED(16, const xmm_reg, ff_pw_8) = { 0x0008000800080008ULL, 0x0008000800080008ULL };
  45. DECLARE_ALIGNED(16, const xmm_reg, ff_pw_9) = { 0x0009000900090009ULL, 0x0009000900090009ULL };
  46. DECLARE_ALIGNED(8, const uint64_t, ff_pw_15) = 0x000F000F000F000FULL;
  47. DECLARE_ALIGNED(16, const xmm_reg, ff_pw_16) = { 0x0010001000100010ULL, 0x0010001000100010ULL };
  48. DECLARE_ALIGNED(16, const xmm_reg, ff_pw_17) = { 0x0011001100110011ULL, 0x0011001100110011ULL };
  49. DECLARE_ALIGNED(16, const xmm_reg, ff_pw_18) = { 0x0012001200120012ULL, 0x0012001200120012ULL };
  50. DECLARE_ALIGNED(8, const uint64_t, ff_pw_20) = 0x0014001400140014ULL;
  51. DECLARE_ALIGNED(16, const xmm_reg, ff_pw_27) = { 0x001B001B001B001BULL, 0x001B001B001B001BULL };
  52. DECLARE_ALIGNED(16, const xmm_reg, ff_pw_28) = { 0x001C001C001C001CULL, 0x001C001C001C001CULL };
  53. DECLARE_ALIGNED(16, const xmm_reg, ff_pw_32) = { 0x0020002000200020ULL, 0x0020002000200020ULL };
  54. DECLARE_ALIGNED(8, const uint64_t, ff_pw_42) = 0x002A002A002A002AULL;
  55. DECLARE_ALIGNED(8, const uint64_t, ff_pw_53) = 0x0035003500350035ULL;
  56. DECLARE_ALIGNED(16, const xmm_reg, ff_pw_63) = { 0x003F003F003F003FULL, 0x003F003F003F003FULL };
  57. DECLARE_ALIGNED(16, const xmm_reg, ff_pw_64) = { 0x0040004000400040ULL, 0x0040004000400040ULL };
  58. DECLARE_ALIGNED(8, const uint64_t, ff_pw_96) = 0x0060006000600060ULL;
  59. DECLARE_ALIGNED(8, const uint64_t, ff_pw_128) = 0x0080008000800080ULL;
  60. DECLARE_ALIGNED(8, const uint64_t, ff_pw_255) = 0x00ff00ff00ff00ffULL;
  61. DECLARE_ALIGNED(16, const xmm_reg, ff_pw_512) = { 0x0200020002000200ULL, 0x0200020002000200ULL };
  62. DECLARE_ALIGNED(16, const xmm_reg, ff_pw_1019) = { 0x03FB03FB03FB03FBULL, 0x03FB03FB03FB03FBULL };
  63. DECLARE_ALIGNED(16, const xmm_reg, ff_pb_0) = { 0x0000000000000000ULL, 0x0000000000000000ULL };
  64. DECLARE_ALIGNED(16, const xmm_reg, ff_pb_1) = { 0x0101010101010101ULL, 0x0101010101010101ULL };
  65. DECLARE_ALIGNED(16, const xmm_reg, ff_pb_3) = { 0x0303030303030303ULL, 0x0303030303030303ULL };
  66. DECLARE_ALIGNED(16, const xmm_reg, ff_pb_4) = { 0x0404040404040404ULL, 0x0404040404040404ULL };
  67. DECLARE_ALIGNED(8, const uint64_t, ff_pb_7) = 0x0707070707070707ULL;
  68. DECLARE_ALIGNED(8, const uint64_t, ff_pb_1F) = 0x1F1F1F1F1F1F1F1FULL;
  69. DECLARE_ALIGNED(8, const uint64_t, ff_pb_3F) = 0x3F3F3F3F3F3F3F3FULL;
  70. DECLARE_ALIGNED(16, const xmm_reg, ff_pb_80) = { 0x8080808080808080ULL, 0x8080808080808080ULL };
  71. DECLARE_ALIGNED(8, const uint64_t, ff_pb_81) = 0x8181818181818181ULL;
  72. DECLARE_ALIGNED(16, const xmm_reg, ff_pb_A1) = { 0xA1A1A1A1A1A1A1A1ULL, 0xA1A1A1A1A1A1A1A1ULL };
  73. DECLARE_ALIGNED(16, const xmm_reg, ff_pb_F8) = { 0xF8F8F8F8F8F8F8F8ULL, 0xF8F8F8F8F8F8F8F8ULL };
  74. DECLARE_ALIGNED(8, const uint64_t, ff_pb_FC) = 0xFCFCFCFCFCFCFCFCULL;
  75. DECLARE_ALIGNED(16, const xmm_reg, ff_pb_FE) = { 0xFEFEFEFEFEFEFEFEULL, 0xFEFEFEFEFEFEFEFEULL };
  76. DECLARE_ALIGNED(16, const double, ff_pd_1)[2] = { 1.0, 1.0 };
  77. DECLARE_ALIGNED(16, const double, ff_pd_2)[2] = { 2.0, 2.0 };
  78. #if HAVE_INLINE_ASM
  79. #define JUMPALIGN() __asm__ volatile (".p2align 3"::)
  80. #define MOVQ_ZERO(regd) __asm__ volatile ("pxor %%"#regd", %%"#regd ::)
  81. #define MOVQ_BFE(regd) \
  82. __asm__ volatile ( \
  83. "pcmpeqd %%"#regd", %%"#regd" \n\t" \
  84. "paddb %%"#regd", %%"#regd" \n\t" ::)
  85. #ifndef PIC
  86. #define MOVQ_BONE(regd) __asm__ volatile ("movq %0, %%"#regd" \n\t" :: "m"(ff_bone))
  87. #define MOVQ_WTWO(regd) __asm__ volatile ("movq %0, %%"#regd" \n\t" :: "m"(ff_wtwo))
  88. #else
  89. // for shared library it's better to use this way for accessing constants
  90. // pcmpeqd -> -1
  91. #define MOVQ_BONE(regd) \
  92. __asm__ volatile ( \
  93. "pcmpeqd %%"#regd", %%"#regd" \n\t" \
  94. "psrlw $15, %%"#regd" \n\t" \
  95. "packuswb %%"#regd", %%"#regd" \n\t" ::)
  96. #define MOVQ_WTWO(regd) \
  97. __asm__ volatile ( \
  98. "pcmpeqd %%"#regd", %%"#regd" \n\t" \
  99. "psrlw $15, %%"#regd" \n\t" \
  100. "psllw $1, %%"#regd" \n\t"::)
  101. #endif
  102. // using regr as temporary and for the output result
  103. // first argument is unmodifed and second is trashed
  104. // regfe is supposed to contain 0xfefefefefefefefe
  105. #define PAVGB_MMX_NO_RND(rega, regb, regr, regfe) \
  106. "movq "#rega", "#regr" \n\t" \
  107. "pand "#regb", "#regr" \n\t" \
  108. "pxor "#rega", "#regb" \n\t" \
  109. "pand "#regfe", "#regb" \n\t" \
  110. "psrlq $1, "#regb" \n\t" \
  111. "paddb "#regb", "#regr" \n\t"
  112. #define PAVGB_MMX(rega, regb, regr, regfe) \
  113. "movq "#rega", "#regr" \n\t" \
  114. "por "#regb", "#regr" \n\t" \
  115. "pxor "#rega", "#regb" \n\t" \
  116. "pand "#regfe", "#regb" \n\t" \
  117. "psrlq $1, "#regb" \n\t" \
  118. "psubb "#regb", "#regr" \n\t"
  119. // mm6 is supposed to contain 0xfefefefefefefefe
  120. #define PAVGBP_MMX_NO_RND(rega, regb, regr, regc, regd, regp) \
  121. "movq "#rega", "#regr" \n\t" \
  122. "movq "#regc", "#regp" \n\t" \
  123. "pand "#regb", "#regr" \n\t" \
  124. "pand "#regd", "#regp" \n\t" \
  125. "pxor "#rega", "#regb" \n\t" \
  126. "pxor "#regc", "#regd" \n\t" \
  127. "pand %%mm6, "#regb" \n\t" \
  128. "pand %%mm6, "#regd" \n\t" \
  129. "psrlq $1, "#regb" \n\t" \
  130. "psrlq $1, "#regd" \n\t" \
  131. "paddb "#regb", "#regr" \n\t" \
  132. "paddb "#regd", "#regp" \n\t"
  133. #define PAVGBP_MMX(rega, regb, regr, regc, regd, regp) \
  134. "movq "#rega", "#regr" \n\t" \
  135. "movq "#regc", "#regp" \n\t" \
  136. "por "#regb", "#regr" \n\t" \
  137. "por "#regd", "#regp" \n\t" \
  138. "pxor "#rega", "#regb" \n\t" \
  139. "pxor "#regc", "#regd" \n\t" \
  140. "pand %%mm6, "#regb" \n\t" \
  141. "pand %%mm6, "#regd" \n\t" \
  142. "psrlq $1, "#regd" \n\t" \
  143. "psrlq $1, "#regb" \n\t" \
  144. "psubb "#regb", "#regr" \n\t" \
  145. "psubb "#regd", "#regp" \n\t"
  146. /***********************************/
  147. /* MMX no rounding */
  148. #define DEF(x, y) x ## _no_rnd_ ## y ## _mmx
  149. #define SET_RND MOVQ_WONE
  150. #define PAVGBP(a, b, c, d, e, f) PAVGBP_MMX_NO_RND(a, b, c, d, e, f)
  151. #define PAVGB(a, b, c, e) PAVGB_MMX_NO_RND(a, b, c, e)
  152. #define OP_AVG(a, b, c, e) PAVGB_MMX(a, b, c, e)
  153. #include "dsputil_rnd_template.c"
  154. #undef DEF
  155. #undef SET_RND
  156. #undef PAVGBP
  157. #undef PAVGB
  158. /***********************************/
  159. /* MMX rounding */
  160. #define DEF(x, y) x ## _ ## y ## _mmx
  161. #define SET_RND MOVQ_WTWO
  162. #define PAVGBP(a, b, c, d, e, f) PAVGBP_MMX(a, b, c, d, e, f)
  163. #define PAVGB(a, b, c, e) PAVGB_MMX(a, b, c, e)
  164. #include "dsputil_rnd_template.c"
  165. #undef DEF
  166. #undef SET_RND
  167. #undef PAVGBP
  168. #undef PAVGB
  169. #undef OP_AVG
  170. /***********************************/
  171. /* 3Dnow specific */
  172. #define DEF(x) x ## _3dnow
  173. #define PAVGB "pavgusb"
  174. #define OP_AVG PAVGB
  175. #include "dsputil_avg_template.c"
  176. #undef DEF
  177. #undef PAVGB
  178. #undef OP_AVG
  179. /***********************************/
  180. /* MMX2 specific */
  181. #define DEF(x) x ## _mmx2
  182. /* Introduced only in MMX2 set */
  183. #define PAVGB "pavgb"
  184. #define OP_AVG PAVGB
  185. #include "dsputil_avg_template.c"
  186. #undef DEF
  187. #undef PAVGB
  188. #undef OP_AVG
  189. #define put_no_rnd_pixels16_mmx put_pixels16_mmx
  190. #define put_no_rnd_pixels8_mmx put_pixels8_mmx
  191. #define put_pixels16_mmx2 put_pixels16_mmx
  192. #define put_pixels8_mmx2 put_pixels8_mmx
  193. #define put_pixels4_mmx2 put_pixels4_mmx
  194. #define put_no_rnd_pixels16_mmx2 put_no_rnd_pixels16_mmx
  195. #define put_no_rnd_pixels8_mmx2 put_no_rnd_pixels8_mmx
  196. #define put_pixels16_3dnow put_pixels16_mmx
  197. #define put_pixels8_3dnow put_pixels8_mmx
  198. #define put_pixels4_3dnow put_pixels4_mmx
  199. #define put_no_rnd_pixels16_3dnow put_no_rnd_pixels16_mmx
  200. #define put_no_rnd_pixels8_3dnow put_no_rnd_pixels8_mmx
  201. /***********************************/
  202. /* standard MMX */
  203. void ff_put_pixels_clamped_mmx(const DCTELEM *block, uint8_t *pixels,
  204. int line_size)
  205. {
  206. const DCTELEM *p;
  207. uint8_t *pix;
  208. /* read the pixels */
  209. p = block;
  210. pix = pixels;
  211. /* unrolled loop */
  212. __asm__ volatile (
  213. "movq (%3), %%mm0 \n\t"
  214. "movq 8(%3), %%mm1 \n\t"
  215. "movq 16(%3), %%mm2 \n\t"
  216. "movq 24(%3), %%mm3 \n\t"
  217. "movq 32(%3), %%mm4 \n\t"
  218. "movq 40(%3), %%mm5 \n\t"
  219. "movq 48(%3), %%mm6 \n\t"
  220. "movq 56(%3), %%mm7 \n\t"
  221. "packuswb %%mm1, %%mm0 \n\t"
  222. "packuswb %%mm3, %%mm2 \n\t"
  223. "packuswb %%mm5, %%mm4 \n\t"
  224. "packuswb %%mm7, %%mm6 \n\t"
  225. "movq %%mm0, (%0) \n\t"
  226. "movq %%mm2, (%0, %1) \n\t"
  227. "movq %%mm4, (%0, %1, 2) \n\t"
  228. "movq %%mm6, (%0, %2) \n\t"
  229. :: "r"(pix), "r"((x86_reg)line_size), "r"((x86_reg)line_size * 3),
  230. "r"(p)
  231. : "memory");
  232. pix += line_size * 4;
  233. p += 32;
  234. // if here would be an exact copy of the code above
  235. // compiler would generate some very strange code
  236. // thus using "r"
  237. __asm__ volatile (
  238. "movq (%3), %%mm0 \n\t"
  239. "movq 8(%3), %%mm1 \n\t"
  240. "movq 16(%3), %%mm2 \n\t"
  241. "movq 24(%3), %%mm3 \n\t"
  242. "movq 32(%3), %%mm4 \n\t"
  243. "movq 40(%3), %%mm5 \n\t"
  244. "movq 48(%3), %%mm6 \n\t"
  245. "movq 56(%3), %%mm7 \n\t"
  246. "packuswb %%mm1, %%mm0 \n\t"
  247. "packuswb %%mm3, %%mm2 \n\t"
  248. "packuswb %%mm5, %%mm4 \n\t"
  249. "packuswb %%mm7, %%mm6 \n\t"
  250. "movq %%mm0, (%0) \n\t"
  251. "movq %%mm2, (%0, %1) \n\t"
  252. "movq %%mm4, (%0, %1, 2) \n\t"
  253. "movq %%mm6, (%0, %2) \n\t"
  254. :: "r"(pix), "r"((x86_reg)line_size), "r"((x86_reg)line_size * 3), "r"(p)
  255. : "memory");
  256. }
  257. #define put_signed_pixels_clamped_mmx_half(off) \
  258. "movq "#off"(%2), %%mm1 \n\t" \
  259. "movq 16 + "#off"(%2), %%mm2 \n\t" \
  260. "movq 32 + "#off"(%2), %%mm3 \n\t" \
  261. "movq 48 + "#off"(%2), %%mm4 \n\t" \
  262. "packsswb 8 + "#off"(%2), %%mm1 \n\t" \
  263. "packsswb 24 + "#off"(%2), %%mm2 \n\t" \
  264. "packsswb 40 + "#off"(%2), %%mm3 \n\t" \
  265. "packsswb 56 + "#off"(%2), %%mm4 \n\t" \
  266. "paddb %%mm0, %%mm1 \n\t" \
  267. "paddb %%mm0, %%mm2 \n\t" \
  268. "paddb %%mm0, %%mm3 \n\t" \
  269. "paddb %%mm0, %%mm4 \n\t" \
  270. "movq %%mm1, (%0) \n\t" \
  271. "movq %%mm2, (%0, %3) \n\t" \
  272. "movq %%mm3, (%0, %3, 2) \n\t" \
  273. "movq %%mm4, (%0, %1) \n\t"
  274. void ff_put_signed_pixels_clamped_mmx(const DCTELEM *block, uint8_t *pixels,
  275. int line_size)
  276. {
  277. x86_reg line_skip = line_size;
  278. x86_reg line_skip3;
  279. __asm__ volatile (
  280. "movq "MANGLE(ff_pb_80)", %%mm0 \n\t"
  281. "lea (%3, %3, 2), %1 \n\t"
  282. put_signed_pixels_clamped_mmx_half(0)
  283. "lea (%0, %3, 4), %0 \n\t"
  284. put_signed_pixels_clamped_mmx_half(64)
  285. : "+&r"(pixels), "=&r"(line_skip3)
  286. : "r"(block), "r"(line_skip)
  287. : "memory");
  288. }
  289. void ff_add_pixels_clamped_mmx(const DCTELEM *block, uint8_t *pixels,
  290. int line_size)
  291. {
  292. const DCTELEM *p;
  293. uint8_t *pix;
  294. int i;
  295. /* read the pixels */
  296. p = block;
  297. pix = pixels;
  298. MOVQ_ZERO(mm7);
  299. i = 4;
  300. do {
  301. __asm__ volatile (
  302. "movq (%2), %%mm0 \n\t"
  303. "movq 8(%2), %%mm1 \n\t"
  304. "movq 16(%2), %%mm2 \n\t"
  305. "movq 24(%2), %%mm3 \n\t"
  306. "movq %0, %%mm4 \n\t"
  307. "movq %1, %%mm6 \n\t"
  308. "movq %%mm4, %%mm5 \n\t"
  309. "punpcklbw %%mm7, %%mm4 \n\t"
  310. "punpckhbw %%mm7, %%mm5 \n\t"
  311. "paddsw %%mm4, %%mm0 \n\t"
  312. "paddsw %%mm5, %%mm1 \n\t"
  313. "movq %%mm6, %%mm5 \n\t"
  314. "punpcklbw %%mm7, %%mm6 \n\t"
  315. "punpckhbw %%mm7, %%mm5 \n\t"
  316. "paddsw %%mm6, %%mm2 \n\t"
  317. "paddsw %%mm5, %%mm3 \n\t"
  318. "packuswb %%mm1, %%mm0 \n\t"
  319. "packuswb %%mm3, %%mm2 \n\t"
  320. "movq %%mm0, %0 \n\t"
  321. "movq %%mm2, %1 \n\t"
  322. : "+m"(*pix), "+m"(*(pix + line_size))
  323. : "r"(p)
  324. : "memory");
  325. pix += line_size * 2;
  326. p += 16;
  327. } while (--i);
  328. }
  329. static void put_pixels4_mmx(uint8_t *block, const uint8_t *pixels,
  330. int line_size, int h)
  331. {
  332. __asm__ volatile (
  333. "lea (%3, %3), %%"REG_a" \n\t"
  334. ".p2align 3 \n\t"
  335. "1: \n\t"
  336. "movd (%1 ), %%mm0 \n\t"
  337. "movd (%1, %3), %%mm1 \n\t"
  338. "movd %%mm0, (%2) \n\t"
  339. "movd %%mm1, (%2, %3) \n\t"
  340. "add %%"REG_a", %1 \n\t"
  341. "add %%"REG_a", %2 \n\t"
  342. "movd (%1 ), %%mm0 \n\t"
  343. "movd (%1, %3), %%mm1 \n\t"
  344. "movd %%mm0, (%2) \n\t"
  345. "movd %%mm1, (%2, %3) \n\t"
  346. "add %%"REG_a", %1 \n\t"
  347. "add %%"REG_a", %2 \n\t"
  348. "subl $4, %0 \n\t"
  349. "jnz 1b \n\t"
  350. : "+g"(h), "+r"(pixels), "+r"(block)
  351. : "r"((x86_reg)line_size)
  352. : "%"REG_a, "memory"
  353. );
  354. }
  355. static void put_pixels8_mmx(uint8_t *block, const uint8_t *pixels,
  356. int line_size, int h)
  357. {
  358. __asm__ volatile (
  359. "lea (%3, %3), %%"REG_a" \n\t"
  360. ".p2align 3 \n\t"
  361. "1: \n\t"
  362. "movq (%1 ), %%mm0 \n\t"
  363. "movq (%1, %3), %%mm1 \n\t"
  364. "movq %%mm0, (%2) \n\t"
  365. "movq %%mm1, (%2, %3) \n\t"
  366. "add %%"REG_a", %1 \n\t"
  367. "add %%"REG_a", %2 \n\t"
  368. "movq (%1 ), %%mm0 \n\t"
  369. "movq (%1, %3), %%mm1 \n\t"
  370. "movq %%mm0, (%2) \n\t"
  371. "movq %%mm1, (%2, %3) \n\t"
  372. "add %%"REG_a", %1 \n\t"
  373. "add %%"REG_a", %2 \n\t"
  374. "subl $4, %0 \n\t"
  375. "jnz 1b \n\t"
  376. : "+g"(h), "+r"(pixels), "+r"(block)
  377. : "r"((x86_reg)line_size)
  378. : "%"REG_a, "memory"
  379. );
  380. }
  381. static void put_pixels16_mmx(uint8_t *block, const uint8_t *pixels,
  382. int line_size, int h)
  383. {
  384. __asm__ volatile (
  385. "lea (%3, %3), %%"REG_a" \n\t"
  386. ".p2align 3 \n\t"
  387. "1: \n\t"
  388. "movq (%1 ), %%mm0 \n\t"
  389. "movq 8(%1 ), %%mm4 \n\t"
  390. "movq (%1, %3), %%mm1 \n\t"
  391. "movq 8(%1, %3), %%mm5 \n\t"
  392. "movq %%mm0, (%2) \n\t"
  393. "movq %%mm4, 8(%2) \n\t"
  394. "movq %%mm1, (%2, %3) \n\t"
  395. "movq %%mm5, 8(%2, %3) \n\t"
  396. "add %%"REG_a", %1 \n\t"
  397. "add %%"REG_a", %2 \n\t"
  398. "movq (%1 ), %%mm0 \n\t"
  399. "movq 8(%1 ), %%mm4 \n\t"
  400. "movq (%1, %3), %%mm1 \n\t"
  401. "movq 8(%1, %3), %%mm5 \n\t"
  402. "movq %%mm0, (%2) \n\t"
  403. "movq %%mm4, 8(%2) \n\t"
  404. "movq %%mm1, (%2, %3) \n\t"
  405. "movq %%mm5, 8(%2, %3) \n\t"
  406. "add %%"REG_a", %1 \n\t"
  407. "add %%"REG_a", %2 \n\t"
  408. "subl $4, %0 \n\t"
  409. "jnz 1b \n\t"
  410. : "+g"(h), "+r"(pixels), "+r"(block)
  411. : "r"((x86_reg)line_size)
  412. : "%"REG_a, "memory"
  413. );
  414. }
  415. static void put_pixels16_sse2(uint8_t *block, const uint8_t *pixels,
  416. int line_size, int h)
  417. {
  418. __asm__ volatile (
  419. "1: \n\t"
  420. "movdqu (%1 ), %%xmm0 \n\t"
  421. "movdqu (%1, %3 ), %%xmm1 \n\t"
  422. "movdqu (%1, %3, 2), %%xmm2 \n\t"
  423. "movdqu (%1, %4 ), %%xmm3 \n\t"
  424. "lea (%1, %3, 4), %1 \n\t"
  425. "movdqa %%xmm0, (%2) \n\t"
  426. "movdqa %%xmm1, (%2, %3) \n\t"
  427. "movdqa %%xmm2, (%2, %3, 2) \n\t"
  428. "movdqa %%xmm3, (%2, %4) \n\t"
  429. "subl $4, %0 \n\t"
  430. "lea (%2, %3, 4), %2 \n\t"
  431. "jnz 1b \n\t"
  432. : "+g"(h), "+r"(pixels), "+r"(block)
  433. : "r"((x86_reg)line_size), "r"((x86_reg)3L * line_size)
  434. : "memory"
  435. );
  436. }
  437. static void avg_pixels16_sse2(uint8_t *block, const uint8_t *pixels,
  438. int line_size, int h)
  439. {
  440. __asm__ volatile (
  441. "1: \n\t"
  442. "movdqu (%1 ), %%xmm0 \n\t"
  443. "movdqu (%1, %3 ), %%xmm1 \n\t"
  444. "movdqu (%1, %3, 2), %%xmm2 \n\t"
  445. "movdqu (%1, %4 ), %%xmm3 \n\t"
  446. "lea (%1, %3, 4), %1 \n\t"
  447. "pavgb (%2 ), %%xmm0 \n\t"
  448. "pavgb (%2, %3 ), %%xmm1 \n\t"
  449. "pavgb (%2, %3, 2), %%xmm2 \n\t"
  450. "pavgb (%2, %4), %%xmm3 \n\t"
  451. "movdqa %%xmm0, (%2) \n\t"
  452. "movdqa %%xmm1, (%2, %3) \n\t"
  453. "movdqa %%xmm2, (%2, %3, 2) \n\t"
  454. "movdqa %%xmm3, (%2, %4) \n\t"
  455. "subl $4, %0 \n\t"
  456. "lea (%2, %3, 4), %2 \n\t"
  457. "jnz 1b \n\t"
  458. : "+g"(h), "+r"(pixels), "+r"(block)
  459. : "r"((x86_reg)line_size), "r"((x86_reg)3L * line_size)
  460. : "memory"
  461. );
  462. }
  463. #define CLEAR_BLOCKS(name, n) \
  464. static void name(DCTELEM *blocks) \
  465. { \
  466. __asm__ volatile ( \
  467. "pxor %%mm7, %%mm7 \n\t" \
  468. "mov %1, %%"REG_a" \n\t" \
  469. "1: \n\t" \
  470. "movq %%mm7, (%0, %%"REG_a") \n\t" \
  471. "movq %%mm7, 8(%0, %%"REG_a") \n\t" \
  472. "movq %%mm7, 16(%0, %%"REG_a") \n\t" \
  473. "movq %%mm7, 24(%0, %%"REG_a") \n\t" \
  474. "add $32, %%"REG_a" \n\t" \
  475. "js 1b \n\t" \
  476. :: "r"(((uint8_t *)blocks) + 128 * n), \
  477. "i"(-128 * n) \
  478. : "%"REG_a \
  479. ); \
  480. }
  481. CLEAR_BLOCKS(clear_blocks_mmx, 6)
  482. CLEAR_BLOCKS(clear_block_mmx, 1)
  483. static void clear_block_sse(DCTELEM *block)
  484. {
  485. __asm__ volatile (
  486. "xorps %%xmm0, %%xmm0 \n"
  487. "movaps %%xmm0, (%0) \n"
  488. "movaps %%xmm0, 16(%0) \n"
  489. "movaps %%xmm0, 32(%0) \n"
  490. "movaps %%xmm0, 48(%0) \n"
  491. "movaps %%xmm0, 64(%0) \n"
  492. "movaps %%xmm0, 80(%0) \n"
  493. "movaps %%xmm0, 96(%0) \n"
  494. "movaps %%xmm0, 112(%0) \n"
  495. :: "r"(block)
  496. : "memory"
  497. );
  498. }
  499. static void clear_blocks_sse(DCTELEM *blocks)
  500. {
  501. __asm__ volatile (
  502. "xorps %%xmm0, %%xmm0 \n"
  503. "mov %1, %%"REG_a" \n"
  504. "1: \n"
  505. "movaps %%xmm0, (%0, %%"REG_a") \n"
  506. "movaps %%xmm0, 16(%0, %%"REG_a") \n"
  507. "movaps %%xmm0, 32(%0, %%"REG_a") \n"
  508. "movaps %%xmm0, 48(%0, %%"REG_a") \n"
  509. "movaps %%xmm0, 64(%0, %%"REG_a") \n"
  510. "movaps %%xmm0, 80(%0, %%"REG_a") \n"
  511. "movaps %%xmm0, 96(%0, %%"REG_a") \n"
  512. "movaps %%xmm0, 112(%0, %%"REG_a") \n"
  513. "add $128, %%"REG_a" \n"
  514. "js 1b \n"
  515. :: "r"(((uint8_t *)blocks) + 128 * 6),
  516. "i"(-128 * 6)
  517. : "%"REG_a
  518. );
  519. }
  520. static void add_bytes_mmx(uint8_t *dst, uint8_t *src, int w)
  521. {
  522. x86_reg i = 0;
  523. __asm__ volatile (
  524. "jmp 2f \n\t"
  525. "1: \n\t"
  526. "movq (%1, %0), %%mm0 \n\t"
  527. "movq (%2, %0), %%mm1 \n\t"
  528. "paddb %%mm0, %%mm1 \n\t"
  529. "movq %%mm1, (%2, %0) \n\t"
  530. "movq 8(%1, %0), %%mm0 \n\t"
  531. "movq 8(%2, %0), %%mm1 \n\t"
  532. "paddb %%mm0, %%mm1 \n\t"
  533. "movq %%mm1, 8(%2, %0) \n\t"
  534. "add $16, %0 \n\t"
  535. "2: \n\t"
  536. "cmp %3, %0 \n\t"
  537. "js 1b \n\t"
  538. : "+r"(i)
  539. : "r"(src), "r"(dst), "r"((x86_reg)w - 15)
  540. );
  541. for ( ; i < w; i++)
  542. dst[i + 0] += src[i + 0];
  543. }
  544. #if HAVE_7REGS
  545. static void add_hfyu_median_prediction_cmov(uint8_t *dst, const uint8_t *top,
  546. const uint8_t *diff, int w,
  547. int *left, int *left_top)
  548. {
  549. x86_reg w2 = -w;
  550. x86_reg x;
  551. int l = *left & 0xff;
  552. int tl = *left_top & 0xff;
  553. int t;
  554. __asm__ volatile (
  555. "mov %7, %3 \n"
  556. "1: \n"
  557. "movzbl (%3, %4), %2 \n"
  558. "mov %2, %k3 \n"
  559. "sub %b1, %b3 \n"
  560. "add %b0, %b3 \n"
  561. "mov %2, %1 \n"
  562. "cmp %0, %2 \n"
  563. "cmovg %0, %2 \n"
  564. "cmovg %1, %0 \n"
  565. "cmp %k3, %0 \n"
  566. "cmovg %k3, %0 \n"
  567. "mov %7, %3 \n"
  568. "cmp %2, %0 \n"
  569. "cmovl %2, %0 \n"
  570. "add (%6, %4), %b0 \n"
  571. "mov %b0, (%5, %4) \n"
  572. "inc %4 \n"
  573. "jl 1b \n"
  574. : "+&q"(l), "+&q"(tl), "=&r"(t), "=&q"(x), "+&r"(w2)
  575. : "r"(dst + w), "r"(diff + w), "rm"(top + w)
  576. );
  577. *left = l;
  578. *left_top = tl;
  579. }
  580. #endif
  581. static inline void transpose4x4(uint8_t *dst, uint8_t *src, x86_reg dst_stride, x86_reg src_stride){
  582. __asm__ volatile( //FIXME could save 1 instruction if done as 8x4 ...
  583. "movd (%1), %%mm0 \n\t"
  584. "add %3, %1 \n\t"
  585. "movd (%1), %%mm1 \n\t"
  586. "movd (%1,%3,1), %%mm2 \n\t"
  587. "movd (%1,%3,2), %%mm3 \n\t"
  588. "punpcklbw %%mm1, %%mm0 \n\t"
  589. "punpcklbw %%mm3, %%mm2 \n\t"
  590. "movq %%mm0, %%mm1 \n\t"
  591. "punpcklwd %%mm2, %%mm0 \n\t"
  592. "punpckhwd %%mm2, %%mm1 \n\t"
  593. "movd %%mm0, (%0) \n\t"
  594. "add %2, %0 \n\t"
  595. "punpckhdq %%mm0, %%mm0 \n\t"
  596. "movd %%mm0, (%0) \n\t"
  597. "movd %%mm1, (%0,%2,1) \n\t"
  598. "punpckhdq %%mm1, %%mm1 \n\t"
  599. "movd %%mm1, (%0,%2,2) \n\t"
  600. : "+&r" (dst),
  601. "+&r" (src)
  602. : "r" (dst_stride),
  603. "r" (src_stride)
  604. : "memory"
  605. );
  606. }
  607. #define H263_LOOP_FILTER \
  608. "pxor %%mm7, %%mm7 \n\t" \
  609. "movq %0, %%mm0 \n\t" \
  610. "movq %0, %%mm1 \n\t" \
  611. "movq %3, %%mm2 \n\t" \
  612. "movq %3, %%mm3 \n\t" \
  613. "punpcklbw %%mm7, %%mm0 \n\t" \
  614. "punpckhbw %%mm7, %%mm1 \n\t" \
  615. "punpcklbw %%mm7, %%mm2 \n\t" \
  616. "punpckhbw %%mm7, %%mm3 \n\t" \
  617. "psubw %%mm2, %%mm0 \n\t" \
  618. "psubw %%mm3, %%mm1 \n\t" \
  619. "movq %1, %%mm2 \n\t" \
  620. "movq %1, %%mm3 \n\t" \
  621. "movq %2, %%mm4 \n\t" \
  622. "movq %2, %%mm5 \n\t" \
  623. "punpcklbw %%mm7, %%mm2 \n\t" \
  624. "punpckhbw %%mm7, %%mm3 \n\t" \
  625. "punpcklbw %%mm7, %%mm4 \n\t" \
  626. "punpckhbw %%mm7, %%mm5 \n\t" \
  627. "psubw %%mm2, %%mm4 \n\t" \
  628. "psubw %%mm3, %%mm5 \n\t" \
  629. "psllw $2, %%mm4 \n\t" \
  630. "psllw $2, %%mm5 \n\t" \
  631. "paddw %%mm0, %%mm4 \n\t" \
  632. "paddw %%mm1, %%mm5 \n\t" \
  633. "pxor %%mm6, %%mm6 \n\t" \
  634. "pcmpgtw %%mm4, %%mm6 \n\t" \
  635. "pcmpgtw %%mm5, %%mm7 \n\t" \
  636. "pxor %%mm6, %%mm4 \n\t" \
  637. "pxor %%mm7, %%mm5 \n\t" \
  638. "psubw %%mm6, %%mm4 \n\t" \
  639. "psubw %%mm7, %%mm5 \n\t" \
  640. "psrlw $3, %%mm4 \n\t" \
  641. "psrlw $3, %%mm5 \n\t" \
  642. "packuswb %%mm5, %%mm4 \n\t" \
  643. "packsswb %%mm7, %%mm6 \n\t" \
  644. "pxor %%mm7, %%mm7 \n\t" \
  645. "movd %4, %%mm2 \n\t" \
  646. "punpcklbw %%mm2, %%mm2 \n\t" \
  647. "punpcklbw %%mm2, %%mm2 \n\t" \
  648. "punpcklbw %%mm2, %%mm2 \n\t" \
  649. "psubusb %%mm4, %%mm2 \n\t" \
  650. "movq %%mm2, %%mm3 \n\t" \
  651. "psubusb %%mm4, %%mm3 \n\t" \
  652. "psubb %%mm3, %%mm2 \n\t" \
  653. "movq %1, %%mm3 \n\t" \
  654. "movq %2, %%mm4 \n\t" \
  655. "pxor %%mm6, %%mm3 \n\t" \
  656. "pxor %%mm6, %%mm4 \n\t" \
  657. "paddusb %%mm2, %%mm3 \n\t" \
  658. "psubusb %%mm2, %%mm4 \n\t" \
  659. "pxor %%mm6, %%mm3 \n\t" \
  660. "pxor %%mm6, %%mm4 \n\t" \
  661. "paddusb %%mm2, %%mm2 \n\t" \
  662. "packsswb %%mm1, %%mm0 \n\t" \
  663. "pcmpgtb %%mm0, %%mm7 \n\t" \
  664. "pxor %%mm7, %%mm0 \n\t" \
  665. "psubb %%mm7, %%mm0 \n\t" \
  666. "movq %%mm0, %%mm1 \n\t" \
  667. "psubusb %%mm2, %%mm0 \n\t" \
  668. "psubb %%mm0, %%mm1 \n\t" \
  669. "pand %5, %%mm1 \n\t" \
  670. "psrlw $2, %%mm1 \n\t" \
  671. "pxor %%mm7, %%mm1 \n\t" \
  672. "psubb %%mm7, %%mm1 \n\t" \
  673. "movq %0, %%mm5 \n\t" \
  674. "movq %3, %%mm6 \n\t" \
  675. "psubb %%mm1, %%mm5 \n\t" \
  676. "paddb %%mm1, %%mm6 \n\t"
  677. static void h263_v_loop_filter_mmx(uint8_t *src, int stride, int qscale)
  678. {
  679. if (CONFIG_H263_DECODER || CONFIG_H263_ENCODER) {
  680. const int strength = ff_h263_loop_filter_strength[qscale];
  681. __asm__ volatile (
  682. H263_LOOP_FILTER
  683. "movq %%mm3, %1 \n\t"
  684. "movq %%mm4, %2 \n\t"
  685. "movq %%mm5, %0 \n\t"
  686. "movq %%mm6, %3 \n\t"
  687. : "+m"(*(uint64_t*)(src - 2 * stride)),
  688. "+m"(*(uint64_t*)(src - 1 * stride)),
  689. "+m"(*(uint64_t*)(src + 0 * stride)),
  690. "+m"(*(uint64_t*)(src + 1 * stride))
  691. : "g"(2 * strength), "m"(ff_pb_FC)
  692. );
  693. }
  694. }
  695. static void h263_h_loop_filter_mmx(uint8_t *src, int stride, int qscale)
  696. {
  697. if (CONFIG_H263_DECODER || CONFIG_H263_ENCODER) {
  698. const int strength = ff_h263_loop_filter_strength[qscale];
  699. DECLARE_ALIGNED(8, uint64_t, temp)[4];
  700. uint8_t *btemp = (uint8_t*)temp;
  701. src -= 2;
  702. transpose4x4(btemp, src, 8, stride);
  703. transpose4x4(btemp + 4, src + 4 * stride, 8, stride);
  704. __asm__ volatile (
  705. H263_LOOP_FILTER // 5 3 4 6
  706. : "+m"(temp[0]),
  707. "+m"(temp[1]),
  708. "+m"(temp[2]),
  709. "+m"(temp[3])
  710. : "g"(2 * strength), "m"(ff_pb_FC)
  711. );
  712. __asm__ volatile (
  713. "movq %%mm5, %%mm1 \n\t"
  714. "movq %%mm4, %%mm0 \n\t"
  715. "punpcklbw %%mm3, %%mm5 \n\t"
  716. "punpcklbw %%mm6, %%mm4 \n\t"
  717. "punpckhbw %%mm3, %%mm1 \n\t"
  718. "punpckhbw %%mm6, %%mm0 \n\t"
  719. "movq %%mm5, %%mm3 \n\t"
  720. "movq %%mm1, %%mm6 \n\t"
  721. "punpcklwd %%mm4, %%mm5 \n\t"
  722. "punpcklwd %%mm0, %%mm1 \n\t"
  723. "punpckhwd %%mm4, %%mm3 \n\t"
  724. "punpckhwd %%mm0, %%mm6 \n\t"
  725. "movd %%mm5, (%0) \n\t"
  726. "punpckhdq %%mm5, %%mm5 \n\t"
  727. "movd %%mm5, (%0, %2) \n\t"
  728. "movd %%mm3, (%0, %2, 2) \n\t"
  729. "punpckhdq %%mm3, %%mm3 \n\t"
  730. "movd %%mm3, (%0, %3) \n\t"
  731. "movd %%mm1, (%1) \n\t"
  732. "punpckhdq %%mm1, %%mm1 \n\t"
  733. "movd %%mm1, (%1, %2) \n\t"
  734. "movd %%mm6, (%1, %2, 2) \n\t"
  735. "punpckhdq %%mm6, %%mm6 \n\t"
  736. "movd %%mm6, (%1, %3) \n\t"
  737. :: "r"(src),
  738. "r"(src + 4 * stride),
  739. "r"((x86_reg)stride),
  740. "r"((x86_reg)(3 * stride))
  741. );
  742. }
  743. }
  744. /* Draw the edges of width 'w' of an image of size width, height
  745. * this MMX version can only handle w == 8 || w == 16. */
  746. static void draw_edges_mmx(uint8_t *buf, int wrap, int width, int height,
  747. int w, int h, int sides)
  748. {
  749. uint8_t *ptr, *last_line;
  750. int i;
  751. last_line = buf + (height - 1) * wrap;
  752. /* left and right */
  753. ptr = buf;
  754. if (w == 8) {
  755. __asm__ volatile (
  756. "1: \n\t"
  757. "movd (%0), %%mm0 \n\t"
  758. "punpcklbw %%mm0, %%mm0 \n\t"
  759. "punpcklwd %%mm0, %%mm0 \n\t"
  760. "punpckldq %%mm0, %%mm0 \n\t"
  761. "movq %%mm0, -8(%0) \n\t"
  762. "movq -8(%0, %2), %%mm1 \n\t"
  763. "punpckhbw %%mm1, %%mm1 \n\t"
  764. "punpckhwd %%mm1, %%mm1 \n\t"
  765. "punpckhdq %%mm1, %%mm1 \n\t"
  766. "movq %%mm1, (%0, %2) \n\t"
  767. "add %1, %0 \n\t"
  768. "cmp %3, %0 \n\t"
  769. "jb 1b \n\t"
  770. : "+r"(ptr)
  771. : "r"((x86_reg)wrap), "r"((x86_reg)width), "r"(ptr + wrap * height)
  772. );
  773. } else {
  774. __asm__ volatile (
  775. "1: \n\t"
  776. "movd (%0), %%mm0 \n\t"
  777. "punpcklbw %%mm0, %%mm0 \n\t"
  778. "punpcklwd %%mm0, %%mm0 \n\t"
  779. "punpckldq %%mm0, %%mm0 \n\t"
  780. "movq %%mm0, -8(%0) \n\t"
  781. "movq %%mm0, -16(%0) \n\t"
  782. "movq -8(%0, %2), %%mm1 \n\t"
  783. "punpckhbw %%mm1, %%mm1 \n\t"
  784. "punpckhwd %%mm1, %%mm1 \n\t"
  785. "punpckhdq %%mm1, %%mm1 \n\t"
  786. "movq %%mm1, (%0, %2) \n\t"
  787. "movq %%mm1, 8(%0, %2) \n\t"
  788. "add %1, %0 \n\t"
  789. "cmp %3, %0 \n\t"
  790. "jb 1b \n\t"
  791. : "+r"(ptr)
  792. : "r"((x86_reg)wrap), "r"((x86_reg)width), "r"(ptr + wrap * height)
  793. );
  794. }
  795. /* top and bottom (and hopefully also the corners) */
  796. if (sides & EDGE_TOP) {
  797. for (i = 0; i < h; i += 4) {
  798. ptr = buf - (i + 1) * wrap - w;
  799. __asm__ volatile (
  800. "1: \n\t"
  801. "movq (%1, %0), %%mm0 \n\t"
  802. "movq %%mm0, (%0) \n\t"
  803. "movq %%mm0, (%0, %2) \n\t"
  804. "movq %%mm0, (%0, %2, 2) \n\t"
  805. "movq %%mm0, (%0, %3) \n\t"
  806. "add $8, %0 \n\t"
  807. "cmp %4, %0 \n\t"
  808. "jb 1b \n\t"
  809. : "+r"(ptr)
  810. : "r"((x86_reg)buf - (x86_reg)ptr - w), "r"((x86_reg) -wrap),
  811. "r"((x86_reg) -wrap * 3), "r"(ptr + width + 2 * w)
  812. );
  813. }
  814. }
  815. if (sides & EDGE_BOTTOM) {
  816. for (i = 0; i < h; i += 4) {
  817. ptr = last_line + (i + 1) * wrap - w;
  818. __asm__ volatile (
  819. "1: \n\t"
  820. "movq (%1, %0), %%mm0 \n\t"
  821. "movq %%mm0, (%0) \n\t"
  822. "movq %%mm0, (%0, %2) \n\t"
  823. "movq %%mm0, (%0, %2, 2) \n\t"
  824. "movq %%mm0, (%0, %3) \n\t"
  825. "add $8, %0 \n\t"
  826. "cmp %4, %0 \n\t"
  827. "jb 1b \n\t"
  828. : "+r"(ptr)
  829. : "r"((x86_reg)last_line - (x86_reg)ptr - w),
  830. "r"((x86_reg)wrap), "r"((x86_reg)wrap * 3),
  831. "r"(ptr + width + 2 * w)
  832. );
  833. }
  834. }
  835. }
  836. #define QPEL_V_LOW(m3, m4, m5, m6, pw_20, pw_3, rnd, \
  837. in0, in1, in2, in7, out, OP) \
  838. "paddw "#m4", "#m3" \n\t" /* x1 */ \
  839. "movq "MANGLE(ff_pw_20)", %%mm4 \n\t" /* 20 */ \
  840. "pmullw "#m3", %%mm4 \n\t" /* 20x1 */ \
  841. "movq "#in7", "#m3" \n\t" /* d */ \
  842. "movq "#in0", %%mm5 \n\t" /* D */ \
  843. "paddw "#m3", %%mm5 \n\t" /* x4 */ \
  844. "psubw %%mm5, %%mm4 \n\t" /* 20x1 - x4 */ \
  845. "movq "#in1", %%mm5 \n\t" /* C */ \
  846. "movq "#in2", %%mm6 \n\t" /* B */ \
  847. "paddw "#m6", %%mm5 \n\t" /* x3 */ \
  848. "paddw "#m5", %%mm6 \n\t" /* x2 */ \
  849. "paddw %%mm6, %%mm6 \n\t" /* 2x2 */ \
  850. "psubw %%mm6, %%mm5 \n\t" /* -2x2 + x3 */ \
  851. "pmullw "MANGLE(ff_pw_3)", %%mm5 \n\t" /* -6x2 + 3x3 */ \
  852. "paddw "#rnd", %%mm4 \n\t" /* x2 */ \
  853. "paddw %%mm4, %%mm5 \n\t" /* 20x1 - 6x2 + 3x3 - x4 */ \
  854. "psraw $5, %%mm5 \n\t" \
  855. "packuswb %%mm5, %%mm5 \n\t" \
  856. OP(%%mm5, out, %%mm7, d)
  857. #define QPEL_BASE(OPNAME, ROUNDER, RND, OP_MMX2, OP_3DNOW) \
  858. static void OPNAME ## mpeg4_qpel16_h_lowpass_mmx2(uint8_t *dst, \
  859. uint8_t *src, \
  860. int dstStride, \
  861. int srcStride, \
  862. int h) \
  863. { \
  864. uint64_t temp; \
  865. \
  866. __asm__ volatile ( \
  867. "pxor %%mm7, %%mm7 \n\t" \
  868. "1: \n\t" \
  869. "movq (%0), %%mm0 \n\t" /* ABCDEFGH */ \
  870. "movq %%mm0, %%mm1 \n\t" /* ABCDEFGH */ \
  871. "movq %%mm0, %%mm2 \n\t" /* ABCDEFGH */ \
  872. "punpcklbw %%mm7, %%mm0 \n\t" /* 0A0B0C0D */ \
  873. "punpckhbw %%mm7, %%mm1 \n\t" /* 0E0F0G0H */ \
  874. "pshufw $0x90, %%mm0, %%mm5 \n\t" /* 0A0A0B0C */ \
  875. "pshufw $0x41, %%mm0, %%mm6 \n\t" /* 0B0A0A0B */ \
  876. "movq %%mm2, %%mm3 \n\t" /* ABCDEFGH */ \
  877. "movq %%mm2, %%mm4 \n\t" /* ABCDEFGH */ \
  878. "psllq $8, %%mm2 \n\t" /* 0ABCDEFG */ \
  879. "psllq $16, %%mm3 \n\t" /* 00ABCDEF */ \
  880. "psllq $24, %%mm4 \n\t" /* 000ABCDE */ \
  881. "punpckhbw %%mm7, %%mm2 \n\t" /* 0D0E0F0G */ \
  882. "punpckhbw %%mm7, %%mm3 \n\t" /* 0C0D0E0F */ \
  883. "punpckhbw %%mm7, %%mm4 \n\t" /* 0B0C0D0E */ \
  884. "paddw %%mm3, %%mm5 \n\t" /* b */ \
  885. "paddw %%mm2, %%mm6 \n\t" /* c */ \
  886. "paddw %%mm5, %%mm5 \n\t" /* 2b */ \
  887. "psubw %%mm5, %%mm6 \n\t" /* c - 2b */ \
  888. "pshufw $0x06, %%mm0, %%mm5 \n\t" /* 0C0B0A0A */ \
  889. "pmullw "MANGLE(ff_pw_3)", %%mm6 \n\t" /* 3c - 6b */ \
  890. "paddw %%mm4, %%mm0 \n\t" /* a */ \
  891. "paddw %%mm1, %%mm5 \n\t" /* d */ \
  892. "pmullw "MANGLE(ff_pw_20)", %%mm0 \n\t" /* 20a */ \
  893. "psubw %%mm5, %%mm0 \n\t" /* 20a - d */ \
  894. "paddw %6, %%mm6 \n\t" \
  895. "paddw %%mm6, %%mm0 \n\t" /* 20a - 6b + 3c - d */ \
  896. "psraw $5, %%mm0 \n\t" \
  897. "movq %%mm0, %5 \n\t" \
  898. /* mm1 = EFGH, mm2 = DEFG, mm3 = CDEF, mm4 = BCDE, mm7 = 0 */ \
  899. \
  900. "movq 5(%0), %%mm0 \n\t" /* FGHIJKLM */ \
  901. "movq %%mm0, %%mm5 \n\t" /* FGHIJKLM */ \
  902. "movq %%mm0, %%mm6 \n\t" /* FGHIJKLM */ \
  903. "psrlq $8, %%mm0 \n\t" /* GHIJKLM0 */ \
  904. "psrlq $16, %%mm5 \n\t" /* HIJKLM00 */ \
  905. "punpcklbw %%mm7, %%mm0 \n\t" /* 0G0H0I0J */ \
  906. "punpcklbw %%mm7, %%mm5 \n\t" /* 0H0I0J0K */ \
  907. "paddw %%mm0, %%mm2 \n\t" /* b */ \
  908. "paddw %%mm5, %%mm3 \n\t" /* c */ \
  909. "paddw %%mm2, %%mm2 \n\t" /* 2b */ \
  910. "psubw %%mm2, %%mm3 \n\t" /* c - 2b */ \
  911. "movq %%mm6, %%mm2 \n\t" /* FGHIJKLM */ \
  912. "psrlq $24, %%mm6 \n\t" /* IJKLM000 */ \
  913. "punpcklbw %%mm7, %%mm2 \n\t" /* 0F0G0H0I */ \
  914. "punpcklbw %%mm7, %%mm6 \n\t" /* 0I0J0K0L */ \
  915. "pmullw "MANGLE(ff_pw_3)", %%mm3 \n\t" /* 3c - 6b */ \
  916. "paddw %%mm2, %%mm1 \n\t" /* a */ \
  917. "paddw %%mm6, %%mm4 \n\t" /* d */ \
  918. "pmullw "MANGLE(ff_pw_20)", %%mm1 \n\t" /* 20a */ \
  919. "psubw %%mm4, %%mm3 \n\t" /* - 6b +3c - d */ \
  920. "paddw %6, %%mm1 \n\t" \
  921. "paddw %%mm1, %%mm3 \n\t" /* 20a - 6b +3c - d */ \
  922. "psraw $5, %%mm3 \n\t" \
  923. "movq %5, %%mm1 \n\t" \
  924. "packuswb %%mm3, %%mm1 \n\t" \
  925. OP_MMX2(%%mm1, (%1), %%mm4, q) \
  926. /* mm0 = GHIJ, mm2 = FGHI, mm5 = HIJK, mm6 = IJKL, mm7 = 0 */ \
  927. \
  928. "movq 9(%0), %%mm1 \n\t" /* JKLMNOPQ */ \
  929. "movq %%mm1, %%mm4 \n\t" /* JKLMNOPQ */ \
  930. "movq %%mm1, %%mm3 \n\t" /* JKLMNOPQ */ \
  931. "psrlq $8, %%mm1 \n\t" /* KLMNOPQ0 */ \
  932. "psrlq $16, %%mm4 \n\t" /* LMNOPQ00 */ \
  933. "punpcklbw %%mm7, %%mm1 \n\t" /* 0K0L0M0N */ \
  934. "punpcklbw %%mm7, %%mm4 \n\t" /* 0L0M0N0O */ \
  935. "paddw %%mm1, %%mm5 \n\t" /* b */ \
  936. "paddw %%mm4, %%mm0 \n\t" /* c */ \
  937. "paddw %%mm5, %%mm5 \n\t" /* 2b */ \
  938. "psubw %%mm5, %%mm0 \n\t" /* c - 2b */ \
  939. "movq %%mm3, %%mm5 \n\t" /* JKLMNOPQ */ \
  940. "psrlq $24, %%mm3 \n\t" /* MNOPQ000 */ \
  941. "pmullw "MANGLE(ff_pw_3)", %%mm0 \n\t" /* 3c - 6b */ \
  942. "punpcklbw %%mm7, %%mm3 \n\t" /* 0M0N0O0P */ \
  943. "paddw %%mm3, %%mm2 \n\t" /* d */ \
  944. "psubw %%mm2, %%mm0 \n\t" /* -6b + 3c - d */ \
  945. "movq %%mm5, %%mm2 \n\t" /* JKLMNOPQ */ \
  946. "punpcklbw %%mm7, %%mm2 \n\t" /* 0J0K0L0M */ \
  947. "punpckhbw %%mm7, %%mm5 \n\t" /* 0N0O0P0Q */ \
  948. "paddw %%mm2, %%mm6 \n\t" /* a */ \
  949. "pmullw "MANGLE(ff_pw_20)", %%mm6 \n\t" /* 20a */ \
  950. "paddw %6, %%mm0 \n\t" \
  951. "paddw %%mm6, %%mm0 \n\t" /* 20a - 6b + 3c - d */ \
  952. "psraw $5, %%mm0 \n\t" \
  953. /* mm1 = KLMN, mm2 = JKLM, mm3 = MNOP, */ \
  954. /* mm4 = LMNO, mm5 = NOPQ mm7 = 0 */ \
  955. \
  956. "paddw %%mm5, %%mm3 \n\t" /* a */ \
  957. "pshufw $0xF9, %%mm5, %%mm6 \n\t" /* 0O0P0Q0Q */ \
  958. "paddw %%mm4, %%mm6 \n\t" /* b */ \
  959. "pshufw $0xBE, %%mm5, %%mm4 \n\t" /* 0P0Q0Q0P */ \
  960. "pshufw $0x6F, %%mm5, %%mm5 \n\t" /* 0Q0Q0P0O */ \
  961. "paddw %%mm1, %%mm4 \n\t" /* c */ \
  962. "paddw %%mm2, %%mm5 \n\t" /* d */ \
  963. "paddw %%mm6, %%mm6 \n\t" /* 2b */ \
  964. "psubw %%mm6, %%mm4 \n\t" /* c - 2b */ \
  965. "pmullw "MANGLE(ff_pw_20)", %%mm3 \n\t" /* 20a */ \
  966. "pmullw "MANGLE(ff_pw_3)", %%mm4 \n\t" /* 3c - 6b */ \
  967. "psubw %%mm5, %%mm3 \n\t" /* -6b + 3c - d */ \
  968. "paddw %6, %%mm4 \n\t" \
  969. "paddw %%mm3, %%mm4 \n\t" /* 20a - 6b + 3c - d */ \
  970. "psraw $5, %%mm4 \n\t" \
  971. "packuswb %%mm4, %%mm0 \n\t" \
  972. OP_MMX2(%%mm0, 8(%1), %%mm4, q) \
  973. \
  974. "add %3, %0 \n\t" \
  975. "add %4, %1 \n\t" \
  976. "decl %2 \n\t" \
  977. "jnz 1b \n\t" \
  978. : "+a"(src), "+c"(dst), "+D"(h) \
  979. : "d"((x86_reg)srcStride), "S"((x86_reg)dstStride), \
  980. /* "m"(ff_pw_20), "m"(ff_pw_3), */ "m"(temp), "m"(ROUNDER) \
  981. : "memory" \
  982. ); \
  983. } \
  984. \
  985. static void OPNAME ## mpeg4_qpel16_h_lowpass_3dnow(uint8_t *dst, \
  986. uint8_t *src, \
  987. int dstStride, \
  988. int srcStride, \
  989. int h) \
  990. { \
  991. int i; \
  992. int16_t temp[16]; \
  993. /* quick HACK, XXX FIXME MUST be optimized */ \
  994. for (i = 0; i < h; i++) { \
  995. temp[ 0] = (src[ 0] + src[ 1]) * 20 - (src[ 0] + src[ 2]) * 6 + \
  996. (src[ 1] + src[ 3]) * 3 - (src[ 2] + src[ 4]); \
  997. temp[ 1] = (src[ 1] + src[ 2]) * 20 - (src[ 0] + src[ 3]) * 6 + \
  998. (src[ 0] + src[ 4]) * 3 - (src[ 1] + src[ 5]); \
  999. temp[ 2] = (src[ 2] + src[ 3]) * 20 - (src[ 1] + src[ 4]) * 6 + \
  1000. (src[ 0] + src[ 5]) * 3 - (src[ 0] + src[ 6]); \
  1001. temp[ 3] = (src[ 3] + src[ 4]) * 20 - (src[ 2] + src[ 5]) * 6 + \
  1002. (src[ 1] + src[ 6]) * 3 - (src[ 0] + src[ 7]); \
  1003. temp[ 4] = (src[ 4] + src[ 5]) * 20 - (src[ 3] + src[ 6]) * 6 + \
  1004. (src[ 2] + src[ 7]) * 3 - (src[ 1] + src[ 8]); \
  1005. temp[ 5] = (src[ 5] + src[ 6]) * 20 - (src[ 4] + src[ 7]) * 6 + \
  1006. (src[ 3] + src[ 8]) * 3 - (src[ 2] + src[ 9]); \
  1007. temp[ 6] = (src[ 6] + src[ 7]) * 20 - (src[ 5] + src[ 8]) * 6 + \
  1008. (src[ 4] + src[ 9]) * 3 - (src[ 3] + src[10]); \
  1009. temp[ 7] = (src[ 7] + src[ 8]) * 20 - (src[ 6] + src[ 9]) * 6 + \
  1010. (src[ 5] + src[10]) * 3 - (src[ 4] + src[11]); \
  1011. temp[ 8] = (src[ 8] + src[ 9]) * 20 - (src[ 7] + src[10]) * 6 + \
  1012. (src[ 6] + src[11]) * 3 - (src[ 5] + src[12]); \
  1013. temp[ 9] = (src[ 9] + src[10]) * 20 - (src[ 8] + src[11]) * 6 + \
  1014. (src[ 7] + src[12]) * 3 - (src[ 6] + src[13]); \
  1015. temp[10] = (src[10] + src[11]) * 20 - (src[ 9] + src[12]) * 6 + \
  1016. (src[ 8] + src[13]) * 3 - (src[ 7] + src[14]); \
  1017. temp[11] = (src[11] + src[12]) * 20 - (src[10] + src[13]) * 6 + \
  1018. (src[ 9] + src[14]) * 3 - (src[ 8] + src[15]); \
  1019. temp[12] = (src[12] + src[13]) * 20 - (src[11] + src[14]) * 6 + \
  1020. (src[10] + src[15]) * 3 - (src[ 9] + src[16]); \
  1021. temp[13] = (src[13] + src[14]) * 20 - (src[12] + src[15]) * 6 + \
  1022. (src[11] + src[16]) * 3 - (src[10] + src[16]); \
  1023. temp[14] = (src[14] + src[15]) * 20 - (src[13] + src[16]) * 6 + \
  1024. (src[12] + src[16]) * 3 - (src[11] + src[15]); \
  1025. temp[15] = (src[15] + src[16]) * 20 - (src[14] + src[16]) * 6 + \
  1026. (src[13] + src[15]) * 3 - (src[12] + src[14]); \
  1027. __asm__ volatile ( \
  1028. "movq (%0), %%mm0 \n\t" \
  1029. "movq 8(%0), %%mm1 \n\t" \
  1030. "paddw %2, %%mm0 \n\t" \
  1031. "paddw %2, %%mm1 \n\t" \
  1032. "psraw $5, %%mm0 \n\t" \
  1033. "psraw $5, %%mm1 \n\t" \
  1034. "packuswb %%mm1, %%mm0 \n\t" \
  1035. OP_3DNOW(%%mm0, (%1), %%mm1, q) \
  1036. "movq 16(%0), %%mm0 \n\t" \
  1037. "movq 24(%0), %%mm1 \n\t" \
  1038. "paddw %2, %%mm0 \n\t" \
  1039. "paddw %2, %%mm1 \n\t" \
  1040. "psraw $5, %%mm0 \n\t" \
  1041. "psraw $5, %%mm1 \n\t" \
  1042. "packuswb %%mm1, %%mm0 \n\t" \
  1043. OP_3DNOW(%%mm0, 8(%1), %%mm1, q) \
  1044. :: "r"(temp), "r"(dst), "m"(ROUNDER) \
  1045. : "memory" \
  1046. ); \
  1047. dst += dstStride; \
  1048. src += srcStride; \
  1049. } \
  1050. } \
  1051. \
  1052. static void OPNAME ## mpeg4_qpel8_h_lowpass_mmx2(uint8_t *dst, \
  1053. uint8_t *src, \
  1054. int dstStride, \
  1055. int srcStride, \
  1056. int h) \
  1057. { \
  1058. __asm__ volatile ( \
  1059. "pxor %%mm7, %%mm7 \n\t" \
  1060. "1: \n\t" \
  1061. "movq (%0), %%mm0 \n\t" /* ABCDEFGH */ \
  1062. "movq %%mm0, %%mm1 \n\t" /* ABCDEFGH */ \
  1063. "movq %%mm0, %%mm2 \n\t" /* ABCDEFGH */ \
  1064. "punpcklbw %%mm7, %%mm0 \n\t" /* 0A0B0C0D */ \
  1065. "punpckhbw %%mm7, %%mm1 \n\t" /* 0E0F0G0H */ \
  1066. "pshufw $0x90, %%mm0, %%mm5 \n\t" /* 0A0A0B0C */ \
  1067. "pshufw $0x41, %%mm0, %%mm6 \n\t" /* 0B0A0A0B */ \
  1068. "movq %%mm2, %%mm3 \n\t" /* ABCDEFGH */ \
  1069. "movq %%mm2, %%mm4 \n\t" /* ABCDEFGH */ \
  1070. "psllq $8, %%mm2 \n\t" /* 0ABCDEFG */ \
  1071. "psllq $16, %%mm3 \n\t" /* 00ABCDEF */ \
  1072. "psllq $24, %%mm4 \n\t" /* 000ABCDE */ \
  1073. "punpckhbw %%mm7, %%mm2 \n\t" /* 0D0E0F0G */ \
  1074. "punpckhbw %%mm7, %%mm3 \n\t" /* 0C0D0E0F */ \
  1075. "punpckhbw %%mm7, %%mm4 \n\t" /* 0B0C0D0E */ \
  1076. "paddw %%mm3, %%mm5 \n\t" /* b */ \
  1077. "paddw %%mm2, %%mm6 \n\t" /* c */ \
  1078. "paddw %%mm5, %%mm5 \n\t" /* 2b */ \
  1079. "psubw %%mm5, %%mm6 \n\t" /* c - 2b */ \
  1080. "pshufw $0x06, %%mm0, %%mm5 \n\t" /* 0C0B0A0A */ \
  1081. "pmullw "MANGLE(ff_pw_3)", %%mm6 \n\t" /* 3c - 6b */ \
  1082. "paddw %%mm4, %%mm0 \n\t" /* a */ \
  1083. "paddw %%mm1, %%mm5 \n\t" /* d */ \
  1084. "pmullw "MANGLE(ff_pw_20)", %%mm0 \n\t" /* 20a */ \
  1085. "psubw %%mm5, %%mm0 \n\t" /* 20a - d */ \
  1086. "paddw %5, %%mm6 \n\t" \
  1087. "paddw %%mm6, %%mm0 \n\t" /* 20a - 6b + 3c - d */ \
  1088. "psraw $5, %%mm0 \n\t" \
  1089. /* mm1 = EFGH, mm2 = DEFG, mm3 = CDEF, mm4 = BCDE, mm7 = 0 */ \
  1090. \
  1091. "movd 5(%0), %%mm5 \n\t" /* FGHI */ \
  1092. "punpcklbw %%mm7, %%mm5 \n\t" /* 0F0G0H0I */ \
  1093. "pshufw $0xF9, %%mm5, %%mm6 \n\t" /* 0G0H0I0I */ \
  1094. "paddw %%mm5, %%mm1 \n\t" /* a */ \
  1095. "paddw %%mm6, %%mm2 \n\t" /* b */ \
  1096. "pshufw $0xBE, %%mm5, %%mm6 \n\t" /* 0H0I0I0H */ \
  1097. "pshufw $0x6F, %%mm5, %%mm5 \n\t" /* 0I0I0H0G */ \
  1098. "paddw %%mm6, %%mm3 \n\t" /* c */ \
  1099. "paddw %%mm5, %%mm4 \n\t" /* d */ \
  1100. "paddw %%mm2, %%mm2 \n\t" /* 2b */ \
  1101. "psubw %%mm2, %%mm3 \n\t" /* c - 2b */ \
  1102. "pmullw "MANGLE(ff_pw_20)", %%mm1 \n\t" /* 20a */ \
  1103. "pmullw "MANGLE(ff_pw_3)", %%mm3 \n\t" /* 3c - 6b */ \
  1104. "psubw %%mm4, %%mm3 \n\t" /* -6b + 3c - d */ \
  1105. "paddw %5, %%mm1 \n\t" \
  1106. "paddw %%mm1, %%mm3 \n\t" /* 20a - 6b + 3c - d */ \
  1107. "psraw $5, %%mm3 \n\t" \
  1108. "packuswb %%mm3, %%mm0 \n\t" \
  1109. OP_MMX2(%%mm0, (%1), %%mm4, q) \
  1110. \
  1111. "add %3, %0 \n\t" \
  1112. "add %4, %1 \n\t" \
  1113. "decl %2 \n\t" \
  1114. "jnz 1b \n\t" \
  1115. : "+a"(src), "+c"(dst), "+d"(h) \
  1116. : "S"((x86_reg)srcStride), "D"((x86_reg)dstStride), \
  1117. /* "m"(ff_pw_20), "m"(ff_pw_3), */ "m"(ROUNDER) \
  1118. : "memory" \
  1119. ); \
  1120. } \
  1121. \
  1122. static void OPNAME ## mpeg4_qpel8_h_lowpass_3dnow(uint8_t *dst, \
  1123. uint8_t *src, \
  1124. int dstStride, \
  1125. int srcStride, \
  1126. int h) \
  1127. { \
  1128. int i; \
  1129. int16_t temp[8]; \
  1130. /* quick HACK, XXX FIXME MUST be optimized */ \
  1131. for (i = 0; i < h; i++) { \
  1132. temp[0] = (src[0] + src[1]) * 20 - (src[0] + src[2]) * 6 + \
  1133. (src[1] + src[3]) * 3 - (src[2] + src[4]); \
  1134. temp[1] = (src[1] + src[2]) * 20 - (src[0] + src[3]) * 6 + \
  1135. (src[0] + src[4]) * 3 - (src[1] + src[5]); \
  1136. temp[2] = (src[2] + src[3]) * 20 - (src[1] + src[4]) * 6 + \
  1137. (src[0] + src[5]) * 3 - (src[0] + src[6]); \
  1138. temp[3] = (src[3] + src[4]) * 20 - (src[2] + src[5]) * 6 + \
  1139. (src[1] + src[6]) * 3 - (src[0] + src[7]); \
  1140. temp[4] = (src[4] + src[5]) * 20 - (src[3] + src[6]) * 6 + \
  1141. (src[2] + src[7]) * 3 - (src[1] + src[8]); \
  1142. temp[5] = (src[5] + src[6]) * 20 - (src[4] + src[7]) * 6 + \
  1143. (src[3] + src[8]) * 3 - (src[2] + src[8]); \
  1144. temp[6] = (src[6] + src[7]) * 20 - (src[5] + src[8]) * 6 + \
  1145. (src[4] + src[8]) * 3 - (src[3] + src[7]); \
  1146. temp[7] = (src[7] + src[8]) * 20 - (src[6] + src[8]) * 6 + \
  1147. (src[5] + src[7]) * 3 - (src[4] + src[6]); \
  1148. __asm__ volatile ( \
  1149. "movq (%0), %%mm0 \n\t" \
  1150. "movq 8(%0), %%mm1 \n\t" \
  1151. "paddw %2, %%mm0 \n\t" \
  1152. "paddw %2, %%mm1 \n\t" \
  1153. "psraw $5, %%mm0 \n\t" \
  1154. "psraw $5, %%mm1 \n\t" \
  1155. "packuswb %%mm1, %%mm0 \n\t" \
  1156. OP_3DNOW(%%mm0, (%1), %%mm1, q) \
  1157. :: "r"(temp), "r"(dst), "m"(ROUNDER) \
  1158. : "memory" \
  1159. ); \
  1160. dst += dstStride; \
  1161. src += srcStride; \
  1162. } \
  1163. }
  1164. #define QPEL_OP(OPNAME, ROUNDER, RND, OP, MMX) \
  1165. static void OPNAME ## mpeg4_qpel16_v_lowpass_ ## MMX(uint8_t *dst, \
  1166. uint8_t *src, \
  1167. int dstStride, \
  1168. int srcStride) \
  1169. { \
  1170. uint64_t temp[17 * 4]; \
  1171. uint64_t *temp_ptr = temp; \
  1172. int count = 17; \
  1173. \
  1174. /* FIXME unroll */ \
  1175. __asm__ volatile ( \
  1176. "pxor %%mm7, %%mm7 \n\t" \
  1177. "1: \n\t" \
  1178. "movq (%0), %%mm0 \n\t" \
  1179. "movq (%0), %%mm1 \n\t" \
  1180. "movq 8(%0), %%mm2 \n\t" \
  1181. "movq 8(%0), %%mm3 \n\t" \
  1182. "punpcklbw %%mm7, %%mm0 \n\t" \
  1183. "punpckhbw %%mm7, %%mm1 \n\t" \
  1184. "punpcklbw %%mm7, %%mm2 \n\t" \
  1185. "punpckhbw %%mm7, %%mm3 \n\t" \
  1186. "movq %%mm0, (%1) \n\t" \
  1187. "movq %%mm1, 17 * 8(%1) \n\t" \
  1188. "movq %%mm2, 2 * 17 * 8(%1) \n\t" \
  1189. "movq %%mm3, 3 * 17 * 8(%1) \n\t" \
  1190. "add $8, %1 \n\t" \
  1191. "add %3, %0 \n\t" \
  1192. "decl %2 \n\t" \
  1193. "jnz 1b \n\t" \
  1194. : "+r"(src), "+r"(temp_ptr), "+r"(count) \
  1195. : "r"((x86_reg)srcStride) \
  1196. : "memory" \
  1197. ); \
  1198. \
  1199. temp_ptr = temp; \
  1200. count = 4; \
  1201. \
  1202. /* FIXME reorder for speed */ \
  1203. __asm__ volatile ( \
  1204. /* "pxor %%mm7, %%mm7 \n\t" */ \
  1205. "1: \n\t" \
  1206. "movq (%0), %%mm0 \n\t" \
  1207. "movq 8(%0), %%mm1 \n\t" \
  1208. "movq 16(%0), %%mm2 \n\t" \
  1209. "movq 24(%0), %%mm3 \n\t" \
  1210. QPEL_V_LOW(%%mm0, %%mm1, %%mm2, %%mm3, %5, %6, %5, 16(%0), 8(%0), (%0), 32(%0), (%1), OP) \
  1211. QPEL_V_LOW(%%mm1, %%mm2, %%mm3, %%mm0, %5, %6, %5, 8(%0), (%0), (%0), 40(%0), (%1, %3), OP) \
  1212. "add %4, %1 \n\t" \
  1213. QPEL_V_LOW(%%mm2, %%mm3, %%mm0, %%mm1, %5, %6, %5, (%0), (%0), 8(%0), 48(%0), (%1), OP) \
  1214. \
  1215. QPEL_V_LOW(%%mm3, %%mm0, %%mm1, %%mm2, %5, %6, %5, (%0), 8(%0), 16(%0), 56(%0), (%1, %3), OP) \
  1216. "add %4, %1 \n\t" \
  1217. QPEL_V_LOW(%%mm0, %%mm1, %%mm2, %%mm3, %5, %6, %5, 8(%0), 16(%0), 24(%0), 64(%0), (%1), OP) \
  1218. QPEL_V_LOW(%%mm1, %%mm2, %%mm3, %%mm0, %5, %6, %5, 16(%0), 24(%0), 32(%0), 72(%0), (%1, %3), OP) \
  1219. "add %4, %1 \n\t" \
  1220. QPEL_V_LOW(%%mm2, %%mm3, %%mm0, %%mm1, %5, %6, %5, 24(%0), 32(%0), 40(%0), 80(%0), (%1), OP) \
  1221. QPEL_V_LOW(%%mm3, %%mm0, %%mm1, %%mm2, %5, %6, %5, 32(%0), 40(%0), 48(%0), 88(%0), (%1, %3), OP) \
  1222. "add %4, %1 \n\t" \
  1223. QPEL_V_LOW(%%mm0, %%mm1, %%mm2, %%mm3, %5, %6, %5, 40(%0), 48(%0), 56(%0), 96(%0), (%1), OP) \
  1224. QPEL_V_LOW(%%mm1, %%mm2, %%mm3, %%mm0, %5, %6, %5, 48(%0), 56(%0), 64(%0), 104(%0), (%1, %3), OP) \
  1225. "add %4, %1 \n\t" \
  1226. QPEL_V_LOW(%%mm2, %%mm3, %%mm0, %%mm1, %5, %6, %5, 56(%0), 64(%0), 72(%0), 112(%0), (%1), OP) \
  1227. QPEL_V_LOW(%%mm3, %%mm0, %%mm1, %%mm2, %5, %6, %5, 64(%0), 72(%0), 80(%0), 120(%0), (%1, %3), OP) \
  1228. "add %4, %1 \n\t" \
  1229. QPEL_V_LOW(%%mm0, %%mm1, %%mm2, %%mm3, %5, %6, %5, 72(%0), 80(%0), 88(%0), 128(%0), (%1), OP) \
  1230. \
  1231. QPEL_V_LOW(%%mm1, %%mm2, %%mm3, %%mm0, %5, %6, %5, 80(%0), 88(%0), 96(%0), 128(%0), (%1, %3), OP) \
  1232. "add %4, %1 \n\t" \
  1233. QPEL_V_LOW(%%mm2, %%mm3, %%mm0, %%mm1, %5, %6, %5, 88(%0), 96(%0), 104(%0), 120(%0), (%1), OP) \
  1234. QPEL_V_LOW(%%mm3, %%mm0, %%mm1, %%mm2, %5, %6, %5, 96(%0), 104(%0), 112(%0), 112(%0), (%1, %3), OP) \
  1235. \
  1236. "add $136, %0 \n\t" \
  1237. "add %6, %1 \n\t" \
  1238. "decl %2 \n\t" \
  1239. "jnz 1b \n\t" \
  1240. \
  1241. : "+r"(temp_ptr), "+r"(dst), "+g"(count) \
  1242. : "r"((x86_reg)dstStride), "r"(2 * (x86_reg)dstStride), \
  1243. /* "m"(ff_pw_20), "m"(ff_pw_3), */ "m"(ROUNDER), \
  1244. "g"(4 - 14 * (x86_reg)dstStride) \
  1245. : "memory" \
  1246. ); \
  1247. } \
  1248. \
  1249. static void OPNAME ## mpeg4_qpel8_v_lowpass_ ## MMX(uint8_t *dst, \
  1250. uint8_t *src, \
  1251. int dstStride, \
  1252. int srcStride) \
  1253. { \
  1254. uint64_t temp[9 * 2]; \
  1255. uint64_t *temp_ptr = temp; \
  1256. int count = 9; \
  1257. \
  1258. /* FIXME unroll */ \
  1259. __asm__ volatile ( \
  1260. "pxor %%mm7, %%mm7 \n\t" \
  1261. "1: \n\t" \
  1262. "movq (%0), %%mm0 \n\t" \
  1263. "movq (%0), %%mm1 \n\t" \
  1264. "punpcklbw %%mm7, %%mm0 \n\t" \
  1265. "punpckhbw %%mm7, %%mm1 \n\t" \
  1266. "movq %%mm0, (%1) \n\t" \
  1267. "movq %%mm1, 9*8(%1) \n\t" \
  1268. "add $8, %1 \n\t" \
  1269. "add %3, %0 \n\t" \
  1270. "decl %2 \n\t" \
  1271. "jnz 1b \n\t" \
  1272. : "+r"(src), "+r"(temp_ptr), "+r"(count) \
  1273. : "r"((x86_reg)srcStride) \
  1274. : "memory" \
  1275. ); \
  1276. \
  1277. temp_ptr = temp; \
  1278. count = 2; \
  1279. \
  1280. /* FIXME reorder for speed */ \
  1281. __asm__ volatile ( \
  1282. /* "pxor %%mm7, %%mm7 \n\t" */ \
  1283. "1: \n\t" \
  1284. "movq (%0), %%mm0 \n\t" \
  1285. "movq 8(%0), %%mm1 \n\t" \
  1286. "movq 16(%0), %%mm2 \n\t" \
  1287. "movq 24(%0), %%mm3 \n\t" \
  1288. QPEL_V_LOW(%%mm0, %%mm1, %%mm2, %%mm3, %5, %6, %5, 16(%0), 8(%0), (%0), 32(%0), (%1), OP) \
  1289. QPEL_V_LOW(%%mm1, %%mm2, %%mm3, %%mm0, %5, %6, %5, 8(%0), (%0), (%0), 40(%0), (%1, %3), OP) \
  1290. "add %4, %1 \n\t" \
  1291. QPEL_V_LOW(%%mm2, %%mm3, %%mm0, %%mm1, %5, %6, %5, (%0), (%0), 8(%0), 48(%0), (%1), OP) \
  1292. \
  1293. QPEL_V_LOW(%%mm3, %%mm0, %%mm1, %%mm2, %5, %6, %5, (%0), 8(%0), 16(%0), 56(%0), (%1, %3), OP) \
  1294. "add %4, %1 \n\t" \
  1295. QPEL_V_LOW(%%mm0, %%mm1, %%mm2, %%mm3, %5, %6, %5, 8(%0), 16(%0), 24(%0), 64(%0), (%1), OP) \
  1296. \
  1297. QPEL_V_LOW(%%mm1, %%mm2, %%mm3, %%mm0, %5, %6, %5, 16(%0), 24(%0), 32(%0), 64(%0), (%1, %3), OP) \
  1298. "add %4, %1 \n\t" \
  1299. QPEL_V_LOW(%%mm2, %%mm3, %%mm0, %%mm1, %5, %6, %5, 24(%0), 32(%0), 40(%0), 56(%0), (%1), OP) \
  1300. QPEL_V_LOW(%%mm3, %%mm0, %%mm1, %%mm2, %5, %6, %5, 32(%0), 40(%0), 48(%0), 48(%0), (%1, %3), OP) \
  1301. \
  1302. "add $72, %0 \n\t" \
  1303. "add %6, %1 \n\t" \
  1304. "decl %2 \n\t" \
  1305. "jnz 1b \n\t" \
  1306. \
  1307. : "+r"(temp_ptr), "+r"(dst), "+g"(count) \
  1308. : "r"((x86_reg)dstStride), "r"(2 * (x86_reg)dstStride), \
  1309. /* "m"(ff_pw_20), "m"(ff_pw_3), */ "m"(ROUNDER), \
  1310. "g"(4 - 6 * (x86_reg)dstStride) \
  1311. : "memory" \
  1312. ); \
  1313. } \
  1314. \
  1315. static void OPNAME ## qpel8_mc00_ ## MMX (uint8_t *dst, uint8_t *src, \
  1316. int stride) \
  1317. { \
  1318. OPNAME ## pixels8_ ## MMX(dst, src, stride, 8); \
  1319. } \
  1320. \
  1321. static void OPNAME ## qpel8_mc10_ ## MMX(uint8_t *dst, uint8_t *src, \
  1322. int stride) \
  1323. { \
  1324. uint64_t temp[8]; \
  1325. uint8_t * const half = (uint8_t*)temp; \
  1326. put ## RND ## mpeg4_qpel8_h_lowpass_ ## MMX(half, src, 8, \
  1327. stride, 8); \
  1328. OPNAME ## pixels8_l2_ ## MMX(dst, src, half, stride, stride, 8); \
  1329. } \
  1330. \
  1331. static void OPNAME ## qpel8_mc20_ ## MMX(uint8_t *dst, uint8_t *src, \
  1332. int stride) \
  1333. { \
  1334. OPNAME ## mpeg4_qpel8_h_lowpass_ ## MMX(dst, src, stride, \
  1335. stride, 8); \
  1336. } \
  1337. \
  1338. static void OPNAME ## qpel8_mc30_ ## MMX(uint8_t *dst, uint8_t *src, \
  1339. int stride) \
  1340. { \
  1341. uint64_t temp[8]; \
  1342. uint8_t * const half = (uint8_t*)temp; \
  1343. put ## RND ## mpeg4_qpel8_h_lowpass_ ## MMX(half, src, 8, \
  1344. stride, 8); \
  1345. OPNAME ## pixels8_l2_ ## MMX(dst, src + 1, half, stride, \
  1346. stride, 8); \
  1347. } \
  1348. \
  1349. static void OPNAME ## qpel8_mc01_ ## MMX(uint8_t *dst, uint8_t *src, \
  1350. int stride) \
  1351. { \
  1352. uint64_t temp[8]; \
  1353. uint8_t * const half = (uint8_t*)temp; \
  1354. put ## RND ## mpeg4_qpel8_v_lowpass_ ## MMX(half, src, 8, stride); \
  1355. OPNAME ## pixels8_l2_ ## MMX(dst, src, half, stride, stride, 8); \
  1356. } \
  1357. \
  1358. static void OPNAME ## qpel8_mc02_ ## MMX(uint8_t *dst, uint8_t *src, \
  1359. int stride) \
  1360. { \
  1361. OPNAME ## mpeg4_qpel8_v_lowpass_ ## MMX(dst, src, stride, stride); \
  1362. } \
  1363. \
  1364. static void OPNAME ## qpel8_mc03_ ## MMX(uint8_t *dst, uint8_t *src, \
  1365. int stride) \
  1366. { \
  1367. uint64_t temp[8]; \
  1368. uint8_t * const half = (uint8_t*)temp; \
  1369. put ## RND ## mpeg4_qpel8_v_lowpass_ ## MMX(half, src, 8, stride); \
  1370. OPNAME ## pixels8_l2_ ## MMX(dst, src + stride, half, stride, \
  1371. stride, 8); \
  1372. } \
  1373. \
  1374. static void OPNAME ## qpel8_mc11_ ## MMX(uint8_t *dst, uint8_t *src, \
  1375. int stride) \
  1376. { \
  1377. uint64_t half[8 + 9]; \
  1378. uint8_t * const halfH = ((uint8_t*)half) + 64; \
  1379. uint8_t * const halfHV = ((uint8_t*)half); \
  1380. put ## RND ## mpeg4_qpel8_h_lowpass_ ## MMX(halfH, src, 8, \
  1381. stride, 9); \
  1382. put ## RND ## pixels8_l2_ ## MMX(halfH, src, halfH, 8, stride, 9); \
  1383. put ## RND ## mpeg4_qpel8_v_lowpass_ ## MMX(halfHV, halfH, 8, 8); \
  1384. OPNAME ## pixels8_l2_ ## MMX(dst, halfH, halfHV, stride, 8, 8); \
  1385. } \
  1386. \
  1387. static void OPNAME ## qpel8_mc31_ ## MMX(uint8_t *dst, uint8_t *src, \
  1388. int stride) \
  1389. { \
  1390. uint64_t half[8 + 9]; \
  1391. uint8_t * const halfH = ((uint8_t*)half) + 64; \
  1392. uint8_t * const halfHV = ((uint8_t*)half); \
  1393. put ## RND ## mpeg4_qpel8_h_lowpass_ ## MMX(halfH, src, 8, \
  1394. stride, 9); \
  1395. put ## RND ## pixels8_l2_ ## MMX(halfH, src + 1, halfH, 8, \
  1396. stride, 9); \
  1397. put ## RND ## mpeg4_qpel8_v_lowpass_ ## MMX(halfHV, halfH, 8, 8); \
  1398. OPNAME ## pixels8_l2_ ## MMX(dst, halfH, halfHV, stride, 8, 8); \
  1399. } \
  1400. \
  1401. static void OPNAME ## qpel8_mc13_ ## MMX(uint8_t *dst, uint8_t *src, \
  1402. int stride) \
  1403. { \
  1404. uint64_t half[8 + 9]; \
  1405. uint8_t * const halfH = ((uint8_t*)half) + 64; \
  1406. uint8_t * const halfHV = ((uint8_t*)half); \
  1407. put ## RND ## mpeg4_qpel8_h_lowpass_ ## MMX(halfH, src, 8, \
  1408. stride, 9); \
  1409. put ## RND ## pixels8_l2_ ## MMX(halfH, src, halfH, 8, stride, 9); \
  1410. put ## RND ## mpeg4_qpel8_v_lowpass_ ## MMX(halfHV, halfH, 8, 8); \
  1411. OPNAME ## pixels8_l2_ ## MMX(dst, halfH + 8, halfHV, stride, 8, 8); \
  1412. } \
  1413. \
  1414. static void OPNAME ## qpel8_mc33_ ## MMX(uint8_t *dst, uint8_t *src, \
  1415. int stride) \
  1416. { \
  1417. uint64_t half[8 + 9]; \
  1418. uint8_t * const halfH = ((uint8_t*)half) + 64; \
  1419. uint8_t * const halfHV = ((uint8_t*)half); \
  1420. put ## RND ## mpeg4_qpel8_h_lowpass_ ## MMX(halfH, src, 8, \
  1421. stride, 9); \
  1422. put ## RND ## pixels8_l2_ ## MMX(halfH, src + 1, halfH, 8, \
  1423. stride, 9); \
  1424. put ## RND ## mpeg4_qpel8_v_lowpass_ ## MMX(halfHV, halfH, 8, 8); \
  1425. OPNAME ## pixels8_l2_ ## MMX(dst, halfH + 8, halfHV, stride, 8, 8); \
  1426. } \
  1427. \
  1428. static void OPNAME ## qpel8_mc21_ ## MMX(uint8_t *dst, uint8_t *src, \
  1429. int stride) \
  1430. { \
  1431. uint64_t half[8 + 9]; \
  1432. uint8_t * const halfH = ((uint8_t*)half) + 64; \
  1433. uint8_t * const halfHV = ((uint8_t*)half); \
  1434. put ## RND ## mpeg4_qpel8_h_lowpass_ ## MMX(halfH, src, 8, \
  1435. stride, 9); \
  1436. put ## RND ## mpeg4_qpel8_v_lowpass_ ## MMX(halfHV, halfH, 8, 8); \
  1437. OPNAME ## pixels8_l2_ ## MMX(dst, halfH, halfHV, stride, 8, 8); \
  1438. } \
  1439. \
  1440. static void OPNAME ## qpel8_mc23_ ## MMX(uint8_t *dst, uint8_t *src, \
  1441. int stride) \
  1442. { \
  1443. uint64_t half[8 + 9]; \
  1444. uint8_t * const halfH = ((uint8_t*)half) + 64; \
  1445. uint8_t * const halfHV = ((uint8_t*)half); \
  1446. put ## RND ## mpeg4_qpel8_h_lowpass_ ## MMX(halfH, src, 8, \
  1447. stride, 9); \
  1448. put ## RND ## mpeg4_qpel8_v_lowpass_ ## MMX(halfHV, halfH, 8, 8); \
  1449. OPNAME ## pixels8_l2_ ## MMX(dst, halfH + 8, halfHV, stride, 8, 8); \
  1450. } \
  1451. \
  1452. static void OPNAME ## qpel8_mc12_ ## MMX(uint8_t *dst, uint8_t *src, \
  1453. int stride) \
  1454. { \
  1455. uint64_t half[8 + 9]; \
  1456. uint8_t * const halfH = ((uint8_t*)half); \
  1457. put ## RND ## mpeg4_qpel8_h_lowpass_ ## MMX(halfH, src, 8, \
  1458. stride, 9); \
  1459. put ## RND ## pixels8_l2_ ## MMX(halfH, src, halfH, 8, stride, 9); \
  1460. OPNAME ## mpeg4_qpel8_v_lowpass_ ## MMX(dst, halfH, stride, 8); \
  1461. } \
  1462. \
  1463. static void OPNAME ## qpel8_mc32_ ## MMX(uint8_t *dst, uint8_t *src, \
  1464. int stride) \
  1465. { \
  1466. uint64_t half[8 + 9]; \
  1467. uint8_t * const halfH = ((uint8_t*)half); \
  1468. put ## RND ## mpeg4_qpel8_h_lowpass_ ## MMX(halfH, src, 8, \
  1469. stride, 9); \
  1470. put ## RND ## pixels8_l2_ ## MMX(halfH, src + 1, halfH, 8, \
  1471. stride, 9); \
  1472. OPNAME ## mpeg4_qpel8_v_lowpass_ ## MMX(dst, halfH, stride, 8); \
  1473. } \
  1474. \
  1475. static void OPNAME ## qpel8_mc22_ ## MMX(uint8_t *dst, uint8_t *src, \
  1476. int stride) \
  1477. { \
  1478. uint64_t half[9]; \
  1479. uint8_t * const halfH = ((uint8_t*)half); \
  1480. put ## RND ## mpeg4_qpel8_h_lowpass_ ## MMX(halfH, src, 8, \
  1481. stride, 9); \
  1482. OPNAME ## mpeg4_qpel8_v_lowpass_ ## MMX(dst, halfH, stride, 8); \
  1483. } \
  1484. \
  1485. static void OPNAME ## qpel16_mc00_ ## MMX (uint8_t *dst, uint8_t *src, \
  1486. int stride) \
  1487. { \
  1488. OPNAME ## pixels16_ ## MMX(dst, src, stride, 16); \
  1489. } \
  1490. \
  1491. static void OPNAME ## qpel16_mc10_ ## MMX(uint8_t *dst, uint8_t *src, \
  1492. int stride) \
  1493. { \
  1494. uint64_t temp[32]; \
  1495. uint8_t * const half = (uint8_t*)temp; \
  1496. put ## RND ## mpeg4_qpel16_h_lowpass_ ## MMX(half, src, 16, \
  1497. stride, 16); \
  1498. OPNAME ## pixels16_l2_ ## MMX(dst, src, half, stride, stride, 16); \
  1499. } \
  1500. \
  1501. static void OPNAME ## qpel16_mc20_ ## MMX(uint8_t *dst, uint8_t *src, \
  1502. int stride) \
  1503. { \
  1504. OPNAME ## mpeg4_qpel16_h_lowpass_ ## MMX(dst, src, \
  1505. stride, stride, 16); \
  1506. } \
  1507. \
  1508. static void OPNAME ## qpel16_mc30_ ## MMX(uint8_t *dst, uint8_t *src, \
  1509. int stride) \
  1510. { \
  1511. uint64_t temp[32]; \
  1512. uint8_t * const half = (uint8_t*)temp; \
  1513. put ## RND ## mpeg4_qpel16_h_lowpass_ ## MMX(half, src, 16, \
  1514. stride, 16); \
  1515. OPNAME ## pixels16_l2_ ## MMX(dst, src + 1, half, \
  1516. stride, stride, 16); \
  1517. } \
  1518. \
  1519. static void OPNAME ## qpel16_mc01_ ## MMX(uint8_t *dst, uint8_t *src, \
  1520. int stride) \
  1521. { \
  1522. uint64_t temp[32]; \
  1523. uint8_t * const half = (uint8_t*)temp; \
  1524. put ## RND ## mpeg4_qpel16_v_lowpass_ ## MMX(half, src, 16, \
  1525. stride); \
  1526. OPNAME ## pixels16_l2_ ## MMX(dst, src, half, stride, stride, 16); \
  1527. } \
  1528. \
  1529. static void OPNAME ## qpel16_mc02_ ## MMX(uint8_t *dst, uint8_t *src, \
  1530. int stride) \
  1531. { \
  1532. OPNAME ## mpeg4_qpel16_v_lowpass_ ## MMX(dst, src, stride, stride); \
  1533. } \
  1534. \
  1535. static void OPNAME ## qpel16_mc03_ ## MMX(uint8_t *dst, uint8_t *src, \
  1536. int stride) \
  1537. { \
  1538. uint64_t temp[32]; \
  1539. uint8_t * const half = (uint8_t*)temp; \
  1540. put ## RND ## mpeg4_qpel16_v_lowpass_ ## MMX(half, src, 16, \
  1541. stride); \
  1542. OPNAME ## pixels16_l2_ ## MMX(dst, src+stride, half, \
  1543. stride, stride, 16); \
  1544. } \
  1545. \
  1546. static void OPNAME ## qpel16_mc11_ ## MMX(uint8_t *dst, uint8_t *src, \
  1547. int stride) \
  1548. { \
  1549. uint64_t half[16 * 2 + 17 * 2]; \
  1550. uint8_t * const halfH = ((uint8_t*)half) + 256; \
  1551. uint8_t * const halfHV = ((uint8_t*)half); \
  1552. put ## RND ## mpeg4_qpel16_h_lowpass_ ## MMX(halfH, src, 16, \
  1553. stride, 17); \
  1554. put ## RND ## pixels16_l2_ ## MMX(halfH, src, halfH, 16, \
  1555. stride, 17); \
  1556. put ## RND ## mpeg4_qpel16_v_lowpass_ ## MMX(halfHV, halfH, \
  1557. 16, 16); \
  1558. OPNAME ## pixels16_l2_ ## MMX(dst, halfH, halfHV, stride, 16, 16); \
  1559. } \
  1560. \
  1561. static void OPNAME ## qpel16_mc31_ ## MMX(uint8_t *dst, uint8_t *src, \
  1562. int stride) \
  1563. { \
  1564. uint64_t half[16 * 2 + 17 * 2]; \
  1565. uint8_t * const halfH = ((uint8_t*)half) + 256; \
  1566. uint8_t * const halfHV = ((uint8_t*)half); \
  1567. put ## RND ## mpeg4_qpel16_h_lowpass_ ## MMX(halfH, src, 16, \
  1568. stride, 17); \
  1569. put ## RND ## pixels16_l2_ ## MMX(halfH, src + 1, halfH, 16, \
  1570. stride, 17); \
  1571. put ## RND ## mpeg4_qpel16_v_lowpass_ ## MMX(halfHV, halfH, \
  1572. 16, 16); \
  1573. OPNAME ## pixels16_l2_ ## MMX(dst, halfH, halfHV, stride, 16, 16); \
  1574. } \
  1575. \
  1576. static void OPNAME ## qpel16_mc13_ ## MMX(uint8_t *dst, uint8_t *src, \
  1577. int stride) \
  1578. { \
  1579. uint64_t half[16 * 2 + 17 * 2]; \
  1580. uint8_t * const halfH = ((uint8_t*)half) + 256; \
  1581. uint8_t * const halfHV = ((uint8_t*)half); \
  1582. put ## RND ## mpeg4_qpel16_h_lowpass_ ## MMX(halfH, src, 16, \
  1583. stride, 17); \
  1584. put ## RND ## pixels16_l2_ ## MMX(halfH, src, halfH, 16, \
  1585. stride, 17); \
  1586. put ## RND ## mpeg4_qpel16_v_lowpass_ ## MMX(halfHV, halfH, \
  1587. 16, 16); \
  1588. OPNAME ## pixels16_l2_ ## MMX(dst, halfH + 16, halfHV, stride, \
  1589. 16, 16); \
  1590. } \
  1591. \
  1592. static void OPNAME ## qpel16_mc33_ ## MMX(uint8_t *dst, uint8_t *src, \
  1593. int stride) \
  1594. { \
  1595. uint64_t half[16 * 2 + 17 * 2]; \
  1596. uint8_t * const halfH = ((uint8_t*)half) + 256; \
  1597. uint8_t * const halfHV = ((uint8_t*)half); \
  1598. put ## RND ## mpeg4_qpel16_h_lowpass_ ## MMX(halfH, src, 16, \
  1599. stride, 17); \
  1600. put ## RND ## pixels16_l2_ ## MMX(halfH, src + 1, halfH, 16, \
  1601. stride, 17); \
  1602. put ## RND ## mpeg4_qpel16_v_lowpass_ ## MMX(halfHV, halfH, \
  1603. 16, 16); \
  1604. OPNAME ## pixels16_l2_ ## MMX(dst, halfH + 16, halfHV, stride, \
  1605. 16, 16); \
  1606. } \
  1607. \
  1608. static void OPNAME ## qpel16_mc21_ ## MMX(uint8_t *dst, uint8_t *src, \
  1609. int stride) \
  1610. { \
  1611. uint64_t half[16 * 2 + 17 * 2]; \
  1612. uint8_t * const halfH = ((uint8_t*)half) + 256; \
  1613. uint8_t * const halfHV = ((uint8_t*)half); \
  1614. put ## RND ## mpeg4_qpel16_h_lowpass_ ## MMX(halfH, src, 16, \
  1615. stride, 17); \
  1616. put ## RND ## mpeg4_qpel16_v_lowpass_ ## MMX(halfHV, halfH, \
  1617. 16, 16); \
  1618. OPNAME ## pixels16_l2_ ## MMX(dst, halfH, halfHV, stride, 16, 16); \
  1619. } \
  1620. \
  1621. static void OPNAME ## qpel16_mc23_ ## MMX(uint8_t *dst, uint8_t *src, \
  1622. int stride) \
  1623. { \
  1624. uint64_t half[16 * 2 + 17 * 2]; \
  1625. uint8_t * const halfH = ((uint8_t*)half) + 256; \
  1626. uint8_t * const halfHV = ((uint8_t*)half); \
  1627. put ## RND ## mpeg4_qpel16_h_lowpass_ ## MMX(halfH, src, 16, \
  1628. stride, 17); \
  1629. put ## RND ## mpeg4_qpel16_v_lowpass_ ## MMX(halfHV, halfH, \
  1630. 16, 16); \
  1631. OPNAME ## pixels16_l2_ ## MMX(dst, halfH + 16, halfHV, stride, \
  1632. 16, 16); \
  1633. } \
  1634. \
  1635. static void OPNAME ## qpel16_mc12_ ## MMX(uint8_t *dst, uint8_t *src, \
  1636. int stride) \
  1637. { \
  1638. uint64_t half[17 * 2]; \
  1639. uint8_t * const halfH = ((uint8_t*)half); \
  1640. put ## RND ## mpeg4_qpel16_h_lowpass_ ## MMX(halfH, src, 16, \
  1641. stride, 17); \
  1642. put ## RND ## pixels16_l2_ ## MMX(halfH, src, halfH, 16, \
  1643. stride, 17); \
  1644. OPNAME ## mpeg4_qpel16_v_lowpass_ ## MMX(dst, halfH, stride, 16); \
  1645. } \
  1646. \
  1647. static void OPNAME ## qpel16_mc32_ ## MMX(uint8_t *dst, uint8_t *src, \
  1648. int stride) \
  1649. { \
  1650. uint64_t half[17 * 2]; \
  1651. uint8_t * const halfH = ((uint8_t*)half); \
  1652. put ## RND ## mpeg4_qpel16_h_lowpass_ ## MMX(halfH, src, 16, \
  1653. stride, 17); \
  1654. put ## RND ## pixels16_l2_ ## MMX(halfH, src + 1, halfH, 16, \
  1655. stride, 17); \
  1656. OPNAME ## mpeg4_qpel16_v_lowpass_ ## MMX(dst, halfH, stride, 16); \
  1657. } \
  1658. \
  1659. static void OPNAME ## qpel16_mc22_ ## MMX(uint8_t *dst, uint8_t *src, \
  1660. int stride) \
  1661. { \
  1662. uint64_t half[17 * 2]; \
  1663. uint8_t * const halfH = ((uint8_t*)half); \
  1664. put ## RND ## mpeg4_qpel16_h_lowpass_ ## MMX(halfH, src, 16, \
  1665. stride, 17); \
  1666. OPNAME ## mpeg4_qpel16_v_lowpass_ ## MMX(dst, halfH, stride, 16); \
  1667. }
  1668. #define PUT_OP(a, b, temp, size) \
  1669. "mov"#size" "#a", "#b" \n\t"
  1670. #define AVG_3DNOW_OP(a, b, temp, size) \
  1671. "mov"#size" "#b", "#temp" \n\t" \
  1672. "pavgusb "#temp", "#a" \n\t" \
  1673. "mov"#size" "#a", "#b" \n\t"
  1674. #define AVG_MMX2_OP(a, b, temp, size) \
  1675. "mov"#size" "#b", "#temp" \n\t" \
  1676. "pavgb "#temp", "#a" \n\t" \
  1677. "mov"#size" "#a", "#b" \n\t"
  1678. QPEL_BASE(put_, ff_pw_16, _, PUT_OP, PUT_OP)
  1679. QPEL_BASE(avg_, ff_pw_16, _, AVG_MMX2_OP, AVG_3DNOW_OP)
  1680. QPEL_BASE(put_no_rnd_, ff_pw_15, _no_rnd_, PUT_OP, PUT_OP)
  1681. QPEL_OP(put_, ff_pw_16, _, PUT_OP, 3dnow)
  1682. QPEL_OP(avg_, ff_pw_16, _, AVG_3DNOW_OP, 3dnow)
  1683. QPEL_OP(put_no_rnd_, ff_pw_15, _no_rnd_, PUT_OP, 3dnow)
  1684. QPEL_OP(put_, ff_pw_16, _, PUT_OP, mmx2)
  1685. QPEL_OP(avg_, ff_pw_16, _, AVG_MMX2_OP, mmx2)
  1686. QPEL_OP(put_no_rnd_, ff_pw_15, _no_rnd_, PUT_OP, mmx2)
  1687. /***********************************/
  1688. /* bilinear qpel: not compliant to any spec, only for -lavdopts fast */
  1689. #define QPEL_2TAP_XY(OPNAME, SIZE, MMX, XY, HPEL) \
  1690. static void OPNAME ## 2tap_qpel ## SIZE ## _mc ## XY ## _ ## MMX(uint8_t *dst, \
  1691. uint8_t *src, \
  1692. int stride) \
  1693. { \
  1694. OPNAME ## pixels ## SIZE ## HPEL(dst, src, stride, SIZE); \
  1695. }
  1696. #define QPEL_2TAP_L3(OPNAME, SIZE, MMX, XY, S0, S1, S2) \
  1697. static void OPNAME ## 2tap_qpel ## SIZE ## _mc ## XY ## _ ## MMX(uint8_t *dst, \
  1698. uint8_t *src, \
  1699. int stride) \
  1700. { \
  1701. OPNAME ## 2tap_qpel ## SIZE ## _l3_ ## MMX(dst, src + S0, stride, SIZE, \
  1702. S1, S2); \
  1703. }
  1704. #define QPEL_2TAP(OPNAME, SIZE, MMX) \
  1705. QPEL_2TAP_XY(OPNAME, SIZE, MMX, 20, _x2_ ## MMX) \
  1706. QPEL_2TAP_XY(OPNAME, SIZE, MMX, 02, _y2_ ## MMX) \
  1707. QPEL_2TAP_XY(OPNAME, SIZE, MMX, 22, _xy2_mmx) \
  1708. static const qpel_mc_func OPNAME ## 2tap_qpel ## SIZE ## _mc00_ ## MMX = \
  1709. OPNAME ## qpel ## SIZE ## _mc00_ ## MMX; \
  1710. static const qpel_mc_func OPNAME ## 2tap_qpel ## SIZE ## _mc21_ ## MMX = \
  1711. OPNAME ## 2tap_qpel ## SIZE ## _mc20_ ## MMX; \
  1712. static const qpel_mc_func OPNAME ## 2tap_qpel ## SIZE ## _mc12_ ## MMX = \
  1713. OPNAME ## 2tap_qpel ## SIZE ## _mc02_ ## MMX; \
  1714. static void OPNAME ## 2tap_qpel ## SIZE ## _mc32_ ## MMX(uint8_t *dst, \
  1715. uint8_t *src, \
  1716. int stride) \
  1717. { \
  1718. OPNAME ## pixels ## SIZE ## _y2_ ## MMX(dst, src + 1, stride, SIZE); \
  1719. } \
  1720. static void OPNAME ## 2tap_qpel ## SIZE ## _mc23_ ## MMX(uint8_t *dst, \
  1721. uint8_t *src, \
  1722. int stride) \
  1723. { \
  1724. OPNAME ## pixels ## SIZE ## _x2_ ## MMX(dst, src + stride, \
  1725. stride, SIZE); \
  1726. } \
  1727. QPEL_2TAP_L3(OPNAME, SIZE, MMX, 10, 0, 1, 0) \
  1728. QPEL_2TAP_L3(OPNAME, SIZE, MMX, 30, 1, -1, 0) \
  1729. QPEL_2TAP_L3(OPNAME, SIZE, MMX, 01, 0, stride, 0) \
  1730. QPEL_2TAP_L3(OPNAME, SIZE, MMX, 03, stride, -stride, 0) \
  1731. QPEL_2TAP_L3(OPNAME, SIZE, MMX, 11, 0, stride, 1) \
  1732. QPEL_2TAP_L3(OPNAME, SIZE, MMX, 31, 1, stride, -1) \
  1733. QPEL_2TAP_L3(OPNAME, SIZE, MMX, 13, stride, -stride, 1) \
  1734. QPEL_2TAP_L3(OPNAME, SIZE, MMX, 33, stride + 1, -stride, -1) \
  1735. QPEL_2TAP(put_, 16, mmx2)
  1736. QPEL_2TAP(avg_, 16, mmx2)
  1737. QPEL_2TAP(put_, 8, mmx2)
  1738. QPEL_2TAP(avg_, 8, mmx2)
  1739. QPEL_2TAP(put_, 16, 3dnow)
  1740. QPEL_2TAP(avg_, 16, 3dnow)
  1741. QPEL_2TAP(put_, 8, 3dnow)
  1742. QPEL_2TAP(avg_, 8, 3dnow)
  1743. void ff_put_rv40_qpel8_mc33_mmx(uint8_t *dst, uint8_t *src, int stride)
  1744. {
  1745. put_pixels8_xy2_mmx(dst, src, stride, 8);
  1746. }
  1747. void ff_put_rv40_qpel16_mc33_mmx(uint8_t *dst, uint8_t *src, int stride)
  1748. {
  1749. put_pixels16_xy2_mmx(dst, src, stride, 16);
  1750. }
  1751. void ff_avg_rv40_qpel8_mc33_mmx(uint8_t *dst, uint8_t *src, int stride)
  1752. {
  1753. avg_pixels8_xy2_mmx(dst, src, stride, 8);
  1754. }
  1755. void ff_avg_rv40_qpel16_mc33_mmx(uint8_t *dst, uint8_t *src, int stride)
  1756. {
  1757. avg_pixels16_xy2_mmx(dst, src, stride, 16);
  1758. }
  1759. #endif /* HAVE_INLINE_ASM */
  1760. #if HAVE_YASM
  1761. typedef void emu_edge_core_func(uint8_t *buf, const uint8_t *src,
  1762. x86_reg linesize, x86_reg start_y,
  1763. x86_reg end_y, x86_reg block_h,
  1764. x86_reg start_x, x86_reg end_x,
  1765. x86_reg block_w);
  1766. extern emu_edge_core_func ff_emu_edge_core_mmx;
  1767. extern emu_edge_core_func ff_emu_edge_core_sse;
  1768. static av_always_inline void emulated_edge_mc(uint8_t *buf, const uint8_t *src,
  1769. int linesize,
  1770. int block_w, int block_h,
  1771. int src_x, int src_y,
  1772. int w, int h,
  1773. emu_edge_core_func *core_fn)
  1774. {
  1775. int start_y, start_x, end_y, end_x, src_y_add = 0;
  1776. if (src_y >= h) {
  1777. src_y_add = h - 1 - src_y;
  1778. src_y = h - 1;
  1779. } else if (src_y <= -block_h) {
  1780. src_y_add = 1 - block_h - src_y;
  1781. src_y = 1 - block_h;
  1782. }
  1783. if (src_x >= w) {
  1784. src += w - 1 - src_x;
  1785. src_x = w - 1;
  1786. } else if (src_x <= -block_w) {
  1787. src += 1 - block_w - src_x;
  1788. src_x = 1 - block_w;
  1789. }
  1790. start_y = FFMAX(0, -src_y);
  1791. start_x = FFMAX(0, -src_x);
  1792. end_y = FFMIN(block_h, h-src_y);
  1793. end_x = FFMIN(block_w, w-src_x);
  1794. assert(start_x < end_x && block_w > 0);
  1795. assert(start_y < end_y && block_h > 0);
  1796. // fill in the to-be-copied part plus all above/below
  1797. src += (src_y_add + start_y) * linesize + start_x;
  1798. buf += start_x;
  1799. core_fn(buf, src, linesize, start_y, end_y,
  1800. block_h, start_x, end_x, block_w);
  1801. }
  1802. #if ARCH_X86_32
  1803. static av_noinline void emulated_edge_mc_mmx(uint8_t *buf, const uint8_t *src,
  1804. int linesize,
  1805. int block_w, int block_h,
  1806. int src_x, int src_y, int w, int h)
  1807. {
  1808. emulated_edge_mc(buf, src, linesize, block_w, block_h, src_x, src_y,
  1809. w, h, &ff_emu_edge_core_mmx);
  1810. }
  1811. #endif
  1812. static av_noinline void emulated_edge_mc_sse(uint8_t *buf, const uint8_t *src,
  1813. int linesize,
  1814. int block_w, int block_h,
  1815. int src_x, int src_y, int w, int h)
  1816. {
  1817. emulated_edge_mc(buf, src, linesize, block_w, block_h, src_x, src_y,
  1818. w, h, &ff_emu_edge_core_sse);
  1819. }
  1820. #endif /* HAVE_YASM */
  1821. #if HAVE_INLINE_ASM
  1822. static void gmc_mmx(uint8_t *dst, uint8_t *src,
  1823. int stride, int h, int ox, int oy,
  1824. int dxx, int dxy, int dyx, int dyy,
  1825. int shift, int r, int width, int height)
  1826. {
  1827. const int w = 8;
  1828. const int ix = ox >> (16 + shift);
  1829. const int iy = oy >> (16 + shift);
  1830. const int oxs = ox >> 4;
  1831. const int oys = oy >> 4;
  1832. const int dxxs = dxx >> 4;
  1833. const int dxys = dxy >> 4;
  1834. const int dyxs = dyx >> 4;
  1835. const int dyys = dyy >> 4;
  1836. const uint16_t r4[4] = { r, r, r, r };
  1837. const uint16_t dxy4[4] = { dxys, dxys, dxys, dxys };
  1838. const uint16_t dyy4[4] = { dyys, dyys, dyys, dyys };
  1839. const uint64_t shift2 = 2 * shift;
  1840. int x, y;
  1841. const int dxw = (dxx - (1 << (16 + shift))) * (w - 1);
  1842. const int dyh = (dyy - (1 << (16 + shift))) * (h - 1);
  1843. const int dxh = dxy * (h - 1);
  1844. const int dyw = dyx * (w - 1);
  1845. if ( // non-constant fullpel offset (3% of blocks)
  1846. ((ox ^ (ox + dxw)) | (ox ^ (ox + dxh)) | (ox ^ (ox + dxw + dxh)) |
  1847. (oy ^ (oy + dyw)) | (oy ^ (oy + dyh)) | (oy ^ (oy + dyw + dyh))) >> (16 + shift)
  1848. // uses more than 16 bits of subpel mv (only at huge resolution)
  1849. || (dxx | dxy | dyx | dyy) & 15 ||
  1850. (unsigned)ix >= width - w ||
  1851. (unsigned)iy >= height - h) {
  1852. // FIXME could still use mmx for some of the rows
  1853. ff_gmc_c(dst, src, stride, h, ox, oy, dxx, dxy, dyx, dyy,
  1854. shift, r, width, height);
  1855. return;
  1856. }
  1857. src += ix + iy * stride;
  1858. __asm__ volatile (
  1859. "movd %0, %%mm6 \n\t"
  1860. "pxor %%mm7, %%mm7 \n\t"
  1861. "punpcklwd %%mm6, %%mm6 \n\t"
  1862. "punpcklwd %%mm6, %%mm6 \n\t"
  1863. :: "r"(1<<shift)
  1864. );
  1865. for (x = 0; x < w; x += 4) {
  1866. uint16_t dx4[4] = { oxs - dxys + dxxs * (x + 0),
  1867. oxs - dxys + dxxs * (x + 1),
  1868. oxs - dxys + dxxs * (x + 2),
  1869. oxs - dxys + dxxs * (x + 3) };
  1870. uint16_t dy4[4] = { oys - dyys + dyxs * (x + 0),
  1871. oys - dyys + dyxs * (x + 1),
  1872. oys - dyys + dyxs * (x + 2),
  1873. oys - dyys + dyxs * (x + 3) };
  1874. for (y = 0; y < h; y++) {
  1875. __asm__ volatile (
  1876. "movq %0, %%mm4 \n\t"
  1877. "movq %1, %%mm5 \n\t"
  1878. "paddw %2, %%mm4 \n\t"
  1879. "paddw %3, %%mm5 \n\t"
  1880. "movq %%mm4, %0 \n\t"
  1881. "movq %%mm5, %1 \n\t"
  1882. "psrlw $12, %%mm4 \n\t"
  1883. "psrlw $12, %%mm5 \n\t"
  1884. : "+m"(*dx4), "+m"(*dy4)
  1885. : "m"(*dxy4), "m"(*dyy4)
  1886. );
  1887. __asm__ volatile (
  1888. "movq %%mm6, %%mm2 \n\t"
  1889. "movq %%mm6, %%mm1 \n\t"
  1890. "psubw %%mm4, %%mm2 \n\t"
  1891. "psubw %%mm5, %%mm1 \n\t"
  1892. "movq %%mm2, %%mm0 \n\t"
  1893. "movq %%mm4, %%mm3 \n\t"
  1894. "pmullw %%mm1, %%mm0 \n\t" // (s - dx) * (s - dy)
  1895. "pmullw %%mm5, %%mm3 \n\t" // dx * dy
  1896. "pmullw %%mm5, %%mm2 \n\t" // (s - dx) * dy
  1897. "pmullw %%mm4, %%mm1 \n\t" // dx * (s - dy)
  1898. "movd %4, %%mm5 \n\t"
  1899. "movd %3, %%mm4 \n\t"
  1900. "punpcklbw %%mm7, %%mm5 \n\t"
  1901. "punpcklbw %%mm7, %%mm4 \n\t"
  1902. "pmullw %%mm5, %%mm3 \n\t" // src[1, 1] * dx * dy
  1903. "pmullw %%mm4, %%mm2 \n\t" // src[0, 1] * (s - dx) * dy
  1904. "movd %2, %%mm5 \n\t"
  1905. "movd %1, %%mm4 \n\t"
  1906. "punpcklbw %%mm7, %%mm5 \n\t"
  1907. "punpcklbw %%mm7, %%mm4 \n\t"
  1908. "pmullw %%mm5, %%mm1 \n\t" // src[1, 0] * dx * (s - dy)
  1909. "pmullw %%mm4, %%mm0 \n\t" // src[0, 0] * (s - dx) * (s - dy)
  1910. "paddw %5, %%mm1 \n\t"
  1911. "paddw %%mm3, %%mm2 \n\t"
  1912. "paddw %%mm1, %%mm0 \n\t"
  1913. "paddw %%mm2, %%mm0 \n\t"
  1914. "psrlw %6, %%mm0 \n\t"
  1915. "packuswb %%mm0, %%mm0 \n\t"
  1916. "movd %%mm0, %0 \n\t"
  1917. : "=m"(dst[x + y * stride])
  1918. : "m"(src[0]), "m"(src[1]),
  1919. "m"(src[stride]), "m"(src[stride + 1]),
  1920. "m"(*r4), "m"(shift2)
  1921. );
  1922. src += stride;
  1923. }
  1924. src += 4 - h * stride;
  1925. }
  1926. }
  1927. #define PREFETCH(name, op) \
  1928. static void name(void *mem, int stride, int h) \
  1929. { \
  1930. const uint8_t *p = mem; \
  1931. do { \
  1932. __asm__ volatile (#op" %0" :: "m"(*p)); \
  1933. p += stride; \
  1934. } while (--h); \
  1935. }
  1936. PREFETCH(prefetch_mmx2, prefetcht0)
  1937. PREFETCH(prefetch_3dnow, prefetch)
  1938. #undef PREFETCH
  1939. #endif /* HAVE_INLINE_ASM */
  1940. #include "h264_qpel.c"
  1941. void ff_put_h264_chroma_mc8_mmx_rnd (uint8_t *dst, uint8_t *src,
  1942. int stride, int h, int x, int y);
  1943. void ff_avg_h264_chroma_mc8_mmx2_rnd (uint8_t *dst, uint8_t *src,
  1944. int stride, int h, int x, int y);
  1945. void ff_avg_h264_chroma_mc8_3dnow_rnd(uint8_t *dst, uint8_t *src,
  1946. int stride, int h, int x, int y);
  1947. void ff_put_h264_chroma_mc4_mmx (uint8_t *dst, uint8_t *src,
  1948. int stride, int h, int x, int y);
  1949. void ff_avg_h264_chroma_mc4_mmx2 (uint8_t *dst, uint8_t *src,
  1950. int stride, int h, int x, int y);
  1951. void ff_avg_h264_chroma_mc4_3dnow (uint8_t *dst, uint8_t *src,
  1952. int stride, int h, int x, int y);
  1953. void ff_put_h264_chroma_mc2_mmx2 (uint8_t *dst, uint8_t *src,
  1954. int stride, int h, int x, int y);
  1955. void ff_avg_h264_chroma_mc2_mmx2 (uint8_t *dst, uint8_t *src,
  1956. int stride, int h, int x, int y);
  1957. void ff_put_h264_chroma_mc8_ssse3_rnd(uint8_t *dst, uint8_t *src,
  1958. int stride, int h, int x, int y);
  1959. void ff_put_h264_chroma_mc4_ssse3 (uint8_t *dst, uint8_t *src,
  1960. int stride, int h, int x, int y);
  1961. void ff_avg_h264_chroma_mc8_ssse3_rnd(uint8_t *dst, uint8_t *src,
  1962. int stride, int h, int x, int y);
  1963. void ff_avg_h264_chroma_mc4_ssse3 (uint8_t *dst, uint8_t *src,
  1964. int stride, int h, int x, int y);
  1965. #define CHROMA_MC(OP, NUM, DEPTH, OPT) \
  1966. void ff_ ## OP ## _h264_chroma_mc ## NUM ## _ ## DEPTH ## _ ## OPT \
  1967. (uint8_t *dst, uint8_t *src, \
  1968. int stride, int h, int x, int y);
  1969. CHROMA_MC(put, 2, 10, mmx2)
  1970. CHROMA_MC(avg, 2, 10, mmx2)
  1971. CHROMA_MC(put, 4, 10, mmx2)
  1972. CHROMA_MC(avg, 4, 10, mmx2)
  1973. CHROMA_MC(put, 8, 10, sse2)
  1974. CHROMA_MC(avg, 8, 10, sse2)
  1975. CHROMA_MC(put, 8, 10, avx)
  1976. CHROMA_MC(avg, 8, 10, avx)
  1977. #if HAVE_INLINE_ASM
  1978. /* CAVS-specific */
  1979. void ff_put_cavs_qpel8_mc00_mmx2(uint8_t *dst, uint8_t *src, int stride)
  1980. {
  1981. put_pixels8_mmx(dst, src, stride, 8);
  1982. }
  1983. void ff_avg_cavs_qpel8_mc00_mmx2(uint8_t *dst, uint8_t *src, int stride)
  1984. {
  1985. avg_pixels8_mmx(dst, src, stride, 8);
  1986. }
  1987. void ff_put_cavs_qpel16_mc00_mmx2(uint8_t *dst, uint8_t *src, int stride)
  1988. {
  1989. put_pixels16_mmx(dst, src, stride, 16);
  1990. }
  1991. void ff_avg_cavs_qpel16_mc00_mmx2(uint8_t *dst, uint8_t *src, int stride)
  1992. {
  1993. avg_pixels16_mmx(dst, src, stride, 16);
  1994. }
  1995. /* VC-1-specific */
  1996. void ff_put_vc1_mspel_mc00_mmx(uint8_t *dst, const uint8_t *src,
  1997. int stride, int rnd)
  1998. {
  1999. put_pixels8_mmx(dst, src, stride, 8);
  2000. }
  2001. void ff_avg_vc1_mspel_mc00_mmx2(uint8_t *dst, const uint8_t *src,
  2002. int stride, int rnd)
  2003. {
  2004. avg_pixels8_mmx2(dst, src, stride, 8);
  2005. }
  2006. static void vorbis_inverse_coupling_3dnow(float *mag, float *ang, int blocksize)
  2007. {
  2008. int i;
  2009. __asm__ volatile ("pxor %%mm7, %%mm7":);
  2010. for (i = 0; i < blocksize; i += 2) {
  2011. __asm__ volatile (
  2012. "movq %0, %%mm0 \n\t"
  2013. "movq %1, %%mm1 \n\t"
  2014. "movq %%mm0, %%mm2 \n\t"
  2015. "movq %%mm1, %%mm3 \n\t"
  2016. "pfcmpge %%mm7, %%mm2 \n\t" // m <= 0.0
  2017. "pfcmpge %%mm7, %%mm3 \n\t" // a <= 0.0
  2018. "pslld $31, %%mm2 \n\t" // keep only the sign bit
  2019. "pxor %%mm2, %%mm1 \n\t"
  2020. "movq %%mm3, %%mm4 \n\t"
  2021. "pand %%mm1, %%mm3 \n\t"
  2022. "pandn %%mm1, %%mm4 \n\t"
  2023. "pfadd %%mm0, %%mm3 \n\t" // a = m + ((a < 0) & (a ^ sign(m)))
  2024. "pfsub %%mm4, %%mm0 \n\t" // m = m + ((a > 0) & (a ^ sign(m)))
  2025. "movq %%mm3, %1 \n\t"
  2026. "movq %%mm0, %0 \n\t"
  2027. : "+m"(mag[i]), "+m"(ang[i])
  2028. :: "memory"
  2029. );
  2030. }
  2031. __asm__ volatile ("femms");
  2032. }
  2033. static void vorbis_inverse_coupling_sse(float *mag, float *ang, int blocksize)
  2034. {
  2035. int i;
  2036. __asm__ volatile (
  2037. "movaps %0, %%xmm5 \n\t"
  2038. :: "m"(ff_pdw_80000000[0])
  2039. );
  2040. for (i = 0; i < blocksize; i += 4) {
  2041. __asm__ volatile (
  2042. "movaps %0, %%xmm0 \n\t"
  2043. "movaps %1, %%xmm1 \n\t"
  2044. "xorps %%xmm2, %%xmm2 \n\t"
  2045. "xorps %%xmm3, %%xmm3 \n\t"
  2046. "cmpleps %%xmm0, %%xmm2 \n\t" // m <= 0.0
  2047. "cmpleps %%xmm1, %%xmm3 \n\t" // a <= 0.0
  2048. "andps %%xmm5, %%xmm2 \n\t" // keep only the sign bit
  2049. "xorps %%xmm2, %%xmm1 \n\t"
  2050. "movaps %%xmm3, %%xmm4 \n\t"
  2051. "andps %%xmm1, %%xmm3 \n\t"
  2052. "andnps %%xmm1, %%xmm4 \n\t"
  2053. "addps %%xmm0, %%xmm3 \n\t" // a = m + ((a < 0) & (a ^ sign(m)))
  2054. "subps %%xmm4, %%xmm0 \n\t" // m = m + ((a > 0) & (a ^ sign(m)))
  2055. "movaps %%xmm3, %1 \n\t"
  2056. "movaps %%xmm0, %0 \n\t"
  2057. : "+m"(mag[i]), "+m"(ang[i])
  2058. :: "memory"
  2059. );
  2060. }
  2061. }
  2062. #if HAVE_6REGS
  2063. static void vector_fmul_window_3dnowext(float *dst, const float *src0,
  2064. const float *src1, const float *win,
  2065. int len)
  2066. {
  2067. x86_reg i = -len * 4;
  2068. x86_reg j = len * 4 - 8;
  2069. __asm__ volatile (
  2070. "1: \n"
  2071. "pswapd (%5, %1), %%mm1 \n"
  2072. "movq (%5, %0), %%mm0 \n"
  2073. "pswapd (%4, %1), %%mm5 \n"
  2074. "movq (%3, %0), %%mm4 \n"
  2075. "movq %%mm0, %%mm2 \n"
  2076. "movq %%mm1, %%mm3 \n"
  2077. "pfmul %%mm4, %%mm2 \n" // src0[len + i] * win[len + i]
  2078. "pfmul %%mm5, %%mm3 \n" // src1[j] * win[len + j]
  2079. "pfmul %%mm4, %%mm1 \n" // src0[len + i] * win[len + j]
  2080. "pfmul %%mm5, %%mm0 \n" // src1[j] * win[len + i]
  2081. "pfadd %%mm3, %%mm2 \n"
  2082. "pfsub %%mm0, %%mm1 \n"
  2083. "pswapd %%mm2, %%mm2 \n"
  2084. "movq %%mm1, (%2, %0) \n"
  2085. "movq %%mm2, (%2, %1) \n"
  2086. "sub $8, %1 \n"
  2087. "add $8, %0 \n"
  2088. "jl 1b \n"
  2089. "femms \n"
  2090. : "+r"(i), "+r"(j)
  2091. : "r"(dst + len), "r"(src0 + len), "r"(src1), "r"(win + len)
  2092. );
  2093. }
  2094. static void vector_fmul_window_sse(float *dst, const float *src0,
  2095. const float *src1, const float *win, int len)
  2096. {
  2097. x86_reg i = -len * 4;
  2098. x86_reg j = len * 4 - 16;
  2099. __asm__ volatile (
  2100. "1: \n"
  2101. "movaps (%5, %1), %%xmm1 \n"
  2102. "movaps (%5, %0), %%xmm0 \n"
  2103. "movaps (%4, %1), %%xmm5 \n"
  2104. "movaps (%3, %0), %%xmm4 \n"
  2105. "shufps $0x1b, %%xmm1, %%xmm1 \n"
  2106. "shufps $0x1b, %%xmm5, %%xmm5 \n"
  2107. "movaps %%xmm0, %%xmm2 \n"
  2108. "movaps %%xmm1, %%xmm3 \n"
  2109. "mulps %%xmm4, %%xmm2 \n" // src0[len + i] * win[len + i]
  2110. "mulps %%xmm5, %%xmm3 \n" // src1[j] * win[len + j]
  2111. "mulps %%xmm4, %%xmm1 \n" // src0[len + i] * win[len + j]
  2112. "mulps %%xmm5, %%xmm0 \n" // src1[j] * win[len + i]
  2113. "addps %%xmm3, %%xmm2 \n"
  2114. "subps %%xmm0, %%xmm1 \n"
  2115. "shufps $0x1b, %%xmm2, %%xmm2 \n"
  2116. "movaps %%xmm1, (%2, %0) \n"
  2117. "movaps %%xmm2, (%2, %1) \n"
  2118. "sub $16, %1 \n"
  2119. "add $16, %0 \n"
  2120. "jl 1b \n"
  2121. : "+r"(i), "+r"(j)
  2122. : "r"(dst + len), "r"(src0 + len), "r"(src1), "r"(win + len)
  2123. );
  2124. }
  2125. #endif /* HAVE_6REGS */
  2126. static void vector_clipf_sse(float *dst, const float *src,
  2127. float min, float max, int len)
  2128. {
  2129. x86_reg i = (len - 16) * 4;
  2130. __asm__ volatile (
  2131. "movss %3, %%xmm4 \n\t"
  2132. "movss %4, %%xmm5 \n\t"
  2133. "shufps $0, %%xmm4, %%xmm4 \n\t"
  2134. "shufps $0, %%xmm5, %%xmm5 \n\t"
  2135. "1: \n\t"
  2136. "movaps (%2, %0), %%xmm0 \n\t" // 3/1 on intel
  2137. "movaps 16(%2, %0), %%xmm1 \n\t"
  2138. "movaps 32(%2, %0), %%xmm2 \n\t"
  2139. "movaps 48(%2, %0), %%xmm3 \n\t"
  2140. "maxps %%xmm4, %%xmm0 \n\t"
  2141. "maxps %%xmm4, %%xmm1 \n\t"
  2142. "maxps %%xmm4, %%xmm2 \n\t"
  2143. "maxps %%xmm4, %%xmm3 \n\t"
  2144. "minps %%xmm5, %%xmm0 \n\t"
  2145. "minps %%xmm5, %%xmm1 \n\t"
  2146. "minps %%xmm5, %%xmm2 \n\t"
  2147. "minps %%xmm5, %%xmm3 \n\t"
  2148. "movaps %%xmm0, (%1, %0) \n\t"
  2149. "movaps %%xmm1, 16(%1, %0) \n\t"
  2150. "movaps %%xmm2, 32(%1, %0) \n\t"
  2151. "movaps %%xmm3, 48(%1, %0) \n\t"
  2152. "sub $64, %0 \n\t"
  2153. "jge 1b \n\t"
  2154. : "+&r"(i)
  2155. : "r"(dst), "r"(src), "m"(min), "m"(max)
  2156. : "memory"
  2157. );
  2158. }
  2159. #endif /* HAVE_INLINE_ASM */
  2160. int32_t ff_scalarproduct_int16_mmx2(const int16_t *v1, const int16_t *v2,
  2161. int order);
  2162. int32_t ff_scalarproduct_int16_sse2(const int16_t *v1, const int16_t *v2,
  2163. int order);
  2164. int32_t ff_scalarproduct_and_madd_int16_mmx2(int16_t *v1, const int16_t *v2,
  2165. const int16_t *v3,
  2166. int order, int mul);
  2167. int32_t ff_scalarproduct_and_madd_int16_sse2(int16_t *v1, const int16_t *v2,
  2168. const int16_t *v3,
  2169. int order, int mul);
  2170. int32_t ff_scalarproduct_and_madd_int16_ssse3(int16_t *v1, const int16_t *v2,
  2171. const int16_t *v3,
  2172. int order, int mul);
  2173. void ff_apply_window_int16_mmxext (int16_t *output, const int16_t *input,
  2174. const int16_t *window, unsigned int len);
  2175. void ff_apply_window_int16_mmxext_ba (int16_t *output, const int16_t *input,
  2176. const int16_t *window, unsigned int len);
  2177. void ff_apply_window_int16_sse2 (int16_t *output, const int16_t *input,
  2178. const int16_t *window, unsigned int len);
  2179. void ff_apply_window_int16_sse2_ba (int16_t *output, const int16_t *input,
  2180. const int16_t *window, unsigned int len);
  2181. void ff_apply_window_int16_ssse3 (int16_t *output, const int16_t *input,
  2182. const int16_t *window, unsigned int len);
  2183. void ff_apply_window_int16_ssse3_atom(int16_t *output, const int16_t *input,
  2184. const int16_t *window, unsigned int len);
  2185. void ff_bswap32_buf_ssse3(uint32_t *dst, const uint32_t *src, int w);
  2186. void ff_bswap32_buf_sse2(uint32_t *dst, const uint32_t *src, int w);
  2187. void ff_add_hfyu_median_prediction_mmx2(uint8_t *dst, const uint8_t *top,
  2188. const uint8_t *diff, int w,
  2189. int *left, int *left_top);
  2190. int ff_add_hfyu_left_prediction_ssse3(uint8_t *dst, const uint8_t *src,
  2191. int w, int left);
  2192. int ff_add_hfyu_left_prediction_sse4(uint8_t *dst, const uint8_t *src,
  2193. int w, int left);
  2194. float ff_scalarproduct_float_sse(const float *v1, const float *v2, int order);
  2195. void ff_vector_fmul_reverse_sse(float *dst, const float *src0,
  2196. const float *src1, int len);
  2197. void ff_vector_fmul_reverse_avx(float *dst, const float *src0,
  2198. const float *src1, int len);
  2199. void ff_vector_fmul_add_sse(float *dst, const float *src0, const float *src1,
  2200. const float *src2, int len);
  2201. void ff_vector_fmul_add_avx(float *dst, const float *src0, const float *src1,
  2202. const float *src2, int len);
  2203. void ff_vector_clip_int32_mmx (int32_t *dst, const int32_t *src,
  2204. int32_t min, int32_t max, unsigned int len);
  2205. void ff_vector_clip_int32_sse2 (int32_t *dst, const int32_t *src,
  2206. int32_t min, int32_t max, unsigned int len);
  2207. void ff_vector_clip_int32_int_sse2(int32_t *dst, const int32_t *src,
  2208. int32_t min, int32_t max, unsigned int len);
  2209. void ff_vector_clip_int32_sse4 (int32_t *dst, const int32_t *src,
  2210. int32_t min, int32_t max, unsigned int len);
  2211. extern void ff_butterflies_float_interleave_sse(float *dst, const float *src0,
  2212. const float *src1, int len);
  2213. extern void ff_butterflies_float_interleave_avx(float *dst, const float *src0,
  2214. const float *src1, int len);
  2215. #define SET_QPEL_FUNCS(PFX, IDX, SIZE, CPU, PREFIX) \
  2216. do { \
  2217. c->PFX ## _pixels_tab[IDX][ 0] = PREFIX ## PFX ## SIZE ## _mc00_ ## CPU; \
  2218. c->PFX ## _pixels_tab[IDX][ 1] = PREFIX ## PFX ## SIZE ## _mc10_ ## CPU; \
  2219. c->PFX ## _pixels_tab[IDX][ 2] = PREFIX ## PFX ## SIZE ## _mc20_ ## CPU; \
  2220. c->PFX ## _pixels_tab[IDX][ 3] = PREFIX ## PFX ## SIZE ## _mc30_ ## CPU; \
  2221. c->PFX ## _pixels_tab[IDX][ 4] = PREFIX ## PFX ## SIZE ## _mc01_ ## CPU; \
  2222. c->PFX ## _pixels_tab[IDX][ 5] = PREFIX ## PFX ## SIZE ## _mc11_ ## CPU; \
  2223. c->PFX ## _pixels_tab[IDX][ 6] = PREFIX ## PFX ## SIZE ## _mc21_ ## CPU; \
  2224. c->PFX ## _pixels_tab[IDX][ 7] = PREFIX ## PFX ## SIZE ## _mc31_ ## CPU; \
  2225. c->PFX ## _pixels_tab[IDX][ 8] = PREFIX ## PFX ## SIZE ## _mc02_ ## CPU; \
  2226. c->PFX ## _pixels_tab[IDX][ 9] = PREFIX ## PFX ## SIZE ## _mc12_ ## CPU; \
  2227. c->PFX ## _pixels_tab[IDX][10] = PREFIX ## PFX ## SIZE ## _mc22_ ## CPU; \
  2228. c->PFX ## _pixels_tab[IDX][11] = PREFIX ## PFX ## SIZE ## _mc32_ ## CPU; \
  2229. c->PFX ## _pixels_tab[IDX][12] = PREFIX ## PFX ## SIZE ## _mc03_ ## CPU; \
  2230. c->PFX ## _pixels_tab[IDX][13] = PREFIX ## PFX ## SIZE ## _mc13_ ## CPU; \
  2231. c->PFX ## _pixels_tab[IDX][14] = PREFIX ## PFX ## SIZE ## _mc23_ ## CPU; \
  2232. c->PFX ## _pixels_tab[IDX][15] = PREFIX ## PFX ## SIZE ## _mc33_ ## CPU; \
  2233. } while (0)
  2234. #define SET_HPEL_FUNCS(PFX, IDX, SIZE, CPU) \
  2235. do { \
  2236. c->PFX ## _pixels_tab[IDX][0] = PFX ## _pixels ## SIZE ## _ ## CPU; \
  2237. c->PFX ## _pixels_tab[IDX][1] = PFX ## _pixels ## SIZE ## _x2_ ## CPU; \
  2238. c->PFX ## _pixels_tab[IDX][2] = PFX ## _pixels ## SIZE ## _y2_ ## CPU; \
  2239. c->PFX ## _pixels_tab[IDX][3] = PFX ## _pixels ## SIZE ## _xy2_ ## CPU; \
  2240. } while (0)
  2241. #define H264_QPEL_FUNCS(x, y, CPU) \
  2242. do { \
  2243. c->put_h264_qpel_pixels_tab[0][x + y * 4] = put_h264_qpel16_mc ## x ## y ## _ ## CPU; \
  2244. c->put_h264_qpel_pixels_tab[1][x + y * 4] = put_h264_qpel8_mc ## x ## y ## _ ## CPU; \
  2245. c->avg_h264_qpel_pixels_tab[0][x + y * 4] = avg_h264_qpel16_mc ## x ## y ## _ ## CPU; \
  2246. c->avg_h264_qpel_pixels_tab[1][x + y * 4] = avg_h264_qpel8_mc ## x ## y ## _ ## CPU; \
  2247. } while (0)
  2248. #define H264_QPEL_FUNCS_10(x, y, CPU) \
  2249. do { \
  2250. c->put_h264_qpel_pixels_tab[0][x + y * 4] = ff_put_h264_qpel16_mc ## x ## y ## _10_ ## CPU; \
  2251. c->put_h264_qpel_pixels_tab[1][x + y * 4] = ff_put_h264_qpel8_mc ## x ## y ## _10_ ## CPU; \
  2252. c->avg_h264_qpel_pixels_tab[0][x + y * 4] = ff_avg_h264_qpel16_mc ## x ## y ## _10_ ## CPU; \
  2253. c->avg_h264_qpel_pixels_tab[1][x + y * 4] = ff_avg_h264_qpel8_mc ## x ## y ## _10_ ## CPU; \
  2254. } while (0)
  2255. static void dsputil_init_mmx(DSPContext *c, AVCodecContext *avctx, int mm_flags)
  2256. {
  2257. const int high_bit_depth = avctx->bits_per_raw_sample > 8;
  2258. #if HAVE_INLINE_ASM
  2259. c->put_pixels_clamped = ff_put_pixels_clamped_mmx;
  2260. c->put_signed_pixels_clamped = ff_put_signed_pixels_clamped_mmx;
  2261. c->add_pixels_clamped = ff_add_pixels_clamped_mmx;
  2262. if (!high_bit_depth) {
  2263. c->clear_block = clear_block_mmx;
  2264. c->clear_blocks = clear_blocks_mmx;
  2265. c->draw_edges = draw_edges_mmx;
  2266. SET_HPEL_FUNCS(put, 0, 16, mmx);
  2267. SET_HPEL_FUNCS(put_no_rnd, 0, 16, mmx);
  2268. SET_HPEL_FUNCS(avg, 0, 16, mmx);
  2269. SET_HPEL_FUNCS(avg_no_rnd, 0, 16, mmx);
  2270. SET_HPEL_FUNCS(put, 1, 8, mmx);
  2271. SET_HPEL_FUNCS(put_no_rnd, 1, 8, mmx);
  2272. SET_HPEL_FUNCS(avg, 1, 8, mmx);
  2273. SET_HPEL_FUNCS(avg_no_rnd, 1, 8, mmx);
  2274. switch (avctx->idct_algo) {
  2275. case FF_IDCT_AUTO:
  2276. case FF_IDCT_SIMPLEMMX:
  2277. c->idct_put = ff_simple_idct_put_mmx;
  2278. c->idct_add = ff_simple_idct_add_mmx;
  2279. c->idct = ff_simple_idct_mmx;
  2280. c->idct_permutation_type = FF_SIMPLE_IDCT_PERM;
  2281. break;
  2282. case FF_IDCT_XVIDMMX:
  2283. c->idct_put = ff_idct_xvid_mmx_put;
  2284. c->idct_add = ff_idct_xvid_mmx_add;
  2285. c->idct = ff_idct_xvid_mmx;
  2286. break;
  2287. }
  2288. }
  2289. c->gmc = gmc_mmx;
  2290. c->add_bytes = add_bytes_mmx;
  2291. if (CONFIG_H263_DECODER || CONFIG_H263_ENCODER) {
  2292. c->h263_v_loop_filter = h263_v_loop_filter_mmx;
  2293. c->h263_h_loop_filter = h263_h_loop_filter_mmx;
  2294. }
  2295. #endif /* HAVE_INLINE_ASM */
  2296. #if HAVE_YASM
  2297. #if ARCH_X86_32
  2298. if (!high_bit_depth)
  2299. c->emulated_edge_mc = emulated_edge_mc_mmx;
  2300. #endif
  2301. if (!high_bit_depth && CONFIG_H264CHROMA) {
  2302. c->put_h264_chroma_pixels_tab[0] = ff_put_h264_chroma_mc8_mmx_rnd;
  2303. c->put_h264_chroma_pixels_tab[1] = ff_put_h264_chroma_mc4_mmx;
  2304. }
  2305. c->vector_clip_int32 = ff_vector_clip_int32_mmx;
  2306. #endif
  2307. }
  2308. static void dsputil_init_mmx2(DSPContext *c, AVCodecContext *avctx,
  2309. int mm_flags)
  2310. {
  2311. const int bit_depth = avctx->bits_per_raw_sample;
  2312. const int high_bit_depth = bit_depth > 8;
  2313. #if HAVE_INLINE_ASM
  2314. c->prefetch = prefetch_mmx2;
  2315. if (!high_bit_depth) {
  2316. c->put_pixels_tab[0][1] = put_pixels16_x2_mmx2;
  2317. c->put_pixels_tab[0][2] = put_pixels16_y2_mmx2;
  2318. c->avg_pixels_tab[0][0] = avg_pixels16_mmx2;
  2319. c->avg_pixels_tab[0][1] = avg_pixels16_x2_mmx2;
  2320. c->avg_pixels_tab[0][2] = avg_pixels16_y2_mmx2;
  2321. c->put_pixels_tab[1][1] = put_pixels8_x2_mmx2;
  2322. c->put_pixels_tab[1][2] = put_pixels8_y2_mmx2;
  2323. c->avg_pixels_tab[1][0] = avg_pixels8_mmx2;
  2324. c->avg_pixels_tab[1][1] = avg_pixels8_x2_mmx2;
  2325. c->avg_pixels_tab[1][2] = avg_pixels8_y2_mmx2;
  2326. }
  2327. if (!(avctx->flags & CODEC_FLAG_BITEXACT)) {
  2328. if (!high_bit_depth) {
  2329. c->put_no_rnd_pixels_tab[0][1] = put_no_rnd_pixels16_x2_mmx2;
  2330. c->put_no_rnd_pixels_tab[0][2] = put_no_rnd_pixels16_y2_mmx2;
  2331. c->put_no_rnd_pixels_tab[1][1] = put_no_rnd_pixels8_x2_mmx2;
  2332. c->put_no_rnd_pixels_tab[1][2] = put_no_rnd_pixels8_y2_mmx2;
  2333. c->avg_pixels_tab[0][3] = avg_pixels16_xy2_mmx2;
  2334. c->avg_pixels_tab[1][3] = avg_pixels8_xy2_mmx2;
  2335. }
  2336. }
  2337. if (!high_bit_depth && avctx->idct_algo == FF_IDCT_XVIDMMX) {
  2338. c->idct_put = ff_idct_xvid_mmx2_put;
  2339. c->idct_add = ff_idct_xvid_mmx2_add;
  2340. c->idct = ff_idct_xvid_mmx2;
  2341. }
  2342. if (CONFIG_VP3_DECODER && (avctx->codec_id == AV_CODEC_ID_VP3 ||
  2343. avctx->codec_id == AV_CODEC_ID_THEORA)) {
  2344. c->put_no_rnd_pixels_tab[1][1] = put_no_rnd_pixels8_x2_exact_mmx2;
  2345. c->put_no_rnd_pixels_tab[1][2] = put_no_rnd_pixels8_y2_exact_mmx2;
  2346. }
  2347. #endif /* HAVE_INLINE_ASM */
  2348. if (CONFIG_H264QPEL) {
  2349. #if HAVE_INLINE_ASM
  2350. SET_QPEL_FUNCS(put_qpel, 0, 16, mmx2, );
  2351. SET_QPEL_FUNCS(put_qpel, 1, 8, mmx2, );
  2352. SET_QPEL_FUNCS(put_no_rnd_qpel, 0, 16, mmx2, );
  2353. SET_QPEL_FUNCS(put_no_rnd_qpel, 1, 8, mmx2, );
  2354. SET_QPEL_FUNCS(avg_qpel, 0, 16, mmx2, );
  2355. SET_QPEL_FUNCS(avg_qpel, 1, 8, mmx2, );
  2356. #endif /* HAVE_INLINE_ASM */
  2357. if (!high_bit_depth) {
  2358. #if HAVE_INLINE_ASM
  2359. SET_QPEL_FUNCS(put_h264_qpel, 0, 16, mmx2, );
  2360. SET_QPEL_FUNCS(put_h264_qpel, 1, 8, mmx2, );
  2361. SET_QPEL_FUNCS(put_h264_qpel, 2, 4, mmx2, );
  2362. SET_QPEL_FUNCS(avg_h264_qpel, 0, 16, mmx2, );
  2363. SET_QPEL_FUNCS(avg_h264_qpel, 1, 8, mmx2, );
  2364. SET_QPEL_FUNCS(avg_h264_qpel, 2, 4, mmx2, );
  2365. #endif /* HAVE_INLINE_ASM */
  2366. } else if (bit_depth == 10) {
  2367. #if HAVE_YASM
  2368. #if !ARCH_X86_64
  2369. SET_QPEL_FUNCS(avg_h264_qpel, 0, 16, 10_mmxext, ff_);
  2370. SET_QPEL_FUNCS(put_h264_qpel, 0, 16, 10_mmxext, ff_);
  2371. SET_QPEL_FUNCS(put_h264_qpel, 1, 8, 10_mmxext, ff_);
  2372. SET_QPEL_FUNCS(avg_h264_qpel, 1, 8, 10_mmxext, ff_);
  2373. #endif
  2374. SET_QPEL_FUNCS(put_h264_qpel, 2, 4, 10_mmxext, ff_);
  2375. SET_QPEL_FUNCS(avg_h264_qpel, 2, 4, 10_mmxext, ff_);
  2376. #endif /* HAVE_YASM */
  2377. }
  2378. #if HAVE_INLINE_ASM
  2379. SET_QPEL_FUNCS(put_2tap_qpel, 0, 16, mmx2, );
  2380. SET_QPEL_FUNCS(put_2tap_qpel, 1, 8, mmx2, );
  2381. SET_QPEL_FUNCS(avg_2tap_qpel, 0, 16, mmx2, );
  2382. SET_QPEL_FUNCS(avg_2tap_qpel, 1, 8, mmx2, );
  2383. #endif /* HAVE_INLINE_ASM */
  2384. }
  2385. #if HAVE_YASM
  2386. if (!high_bit_depth && CONFIG_H264CHROMA) {
  2387. c->avg_h264_chroma_pixels_tab[0] = ff_avg_h264_chroma_mc8_mmx2_rnd;
  2388. c->avg_h264_chroma_pixels_tab[1] = ff_avg_h264_chroma_mc4_mmx2;
  2389. c->avg_h264_chroma_pixels_tab[2] = ff_avg_h264_chroma_mc2_mmx2;
  2390. c->put_h264_chroma_pixels_tab[2] = ff_put_h264_chroma_mc2_mmx2;
  2391. }
  2392. if (bit_depth == 10 && CONFIG_H264CHROMA) {
  2393. c->put_h264_chroma_pixels_tab[2] = ff_put_h264_chroma_mc2_10_mmx2;
  2394. c->avg_h264_chroma_pixels_tab[2] = ff_avg_h264_chroma_mc2_10_mmx2;
  2395. c->put_h264_chroma_pixels_tab[1] = ff_put_h264_chroma_mc4_10_mmx2;
  2396. c->avg_h264_chroma_pixels_tab[1] = ff_avg_h264_chroma_mc4_10_mmx2;
  2397. }
  2398. /* slower than cmov version on AMD */
  2399. if (!(mm_flags & AV_CPU_FLAG_3DNOW))
  2400. c->add_hfyu_median_prediction = ff_add_hfyu_median_prediction_mmx2;
  2401. c->scalarproduct_int16 = ff_scalarproduct_int16_mmx2;
  2402. c->scalarproduct_and_madd_int16 = ff_scalarproduct_and_madd_int16_mmx2;
  2403. if (avctx->flags & CODEC_FLAG_BITEXACT) {
  2404. c->apply_window_int16 = ff_apply_window_int16_mmxext_ba;
  2405. } else {
  2406. c->apply_window_int16 = ff_apply_window_int16_mmxext;
  2407. }
  2408. #endif /* HAVE_YASM */
  2409. }
  2410. static void dsputil_init_3dnow(DSPContext *c, AVCodecContext *avctx,
  2411. int mm_flags)
  2412. {
  2413. const int high_bit_depth = avctx->bits_per_raw_sample > 8;
  2414. #if HAVE_INLINE_ASM
  2415. c->prefetch = prefetch_3dnow;
  2416. if (!high_bit_depth) {
  2417. c->put_pixels_tab[0][1] = put_pixels16_x2_3dnow;
  2418. c->put_pixels_tab[0][2] = put_pixels16_y2_3dnow;
  2419. c->avg_pixels_tab[0][0] = avg_pixels16_3dnow;
  2420. c->avg_pixels_tab[0][1] = avg_pixels16_x2_3dnow;
  2421. c->avg_pixels_tab[0][2] = avg_pixels16_y2_3dnow;
  2422. c->put_pixels_tab[1][1] = put_pixels8_x2_3dnow;
  2423. c->put_pixels_tab[1][2] = put_pixels8_y2_3dnow;
  2424. c->avg_pixels_tab[1][0] = avg_pixels8_3dnow;
  2425. c->avg_pixels_tab[1][1] = avg_pixels8_x2_3dnow;
  2426. c->avg_pixels_tab[1][2] = avg_pixels8_y2_3dnow;
  2427. if (!(avctx->flags & CODEC_FLAG_BITEXACT)){
  2428. c->put_no_rnd_pixels_tab[0][1] = put_no_rnd_pixels16_x2_3dnow;
  2429. c->put_no_rnd_pixels_tab[0][2] = put_no_rnd_pixels16_y2_3dnow;
  2430. c->put_no_rnd_pixels_tab[1][1] = put_no_rnd_pixels8_x2_3dnow;
  2431. c->put_no_rnd_pixels_tab[1][2] = put_no_rnd_pixels8_y2_3dnow;
  2432. c->avg_pixels_tab[0][3] = avg_pixels16_xy2_3dnow;
  2433. c->avg_pixels_tab[1][3] = avg_pixels8_xy2_3dnow;
  2434. }
  2435. }
  2436. if (CONFIG_VP3_DECODER && (avctx->codec_id == AV_CODEC_ID_VP3 ||
  2437. avctx->codec_id == AV_CODEC_ID_THEORA)) {
  2438. c->put_no_rnd_pixels_tab[1][1] = put_no_rnd_pixels8_x2_exact_3dnow;
  2439. c->put_no_rnd_pixels_tab[1][2] = put_no_rnd_pixels8_y2_exact_3dnow;
  2440. }
  2441. if (CONFIG_H264QPEL) {
  2442. SET_QPEL_FUNCS(put_qpel, 0, 16, 3dnow, );
  2443. SET_QPEL_FUNCS(put_qpel, 1, 8, 3dnow, );
  2444. SET_QPEL_FUNCS(put_no_rnd_qpel, 0, 16, 3dnow, );
  2445. SET_QPEL_FUNCS(put_no_rnd_qpel, 1, 8, 3dnow, );
  2446. SET_QPEL_FUNCS(avg_qpel, 0, 16, 3dnow, );
  2447. SET_QPEL_FUNCS(avg_qpel, 1, 8, 3dnow, );
  2448. if (!high_bit_depth) {
  2449. SET_QPEL_FUNCS(put_h264_qpel, 0, 16, 3dnow, );
  2450. SET_QPEL_FUNCS(put_h264_qpel, 1, 8, 3dnow, );
  2451. SET_QPEL_FUNCS(put_h264_qpel, 2, 4, 3dnow, );
  2452. SET_QPEL_FUNCS(avg_h264_qpel, 0, 16, 3dnow, );
  2453. SET_QPEL_FUNCS(avg_h264_qpel, 1, 8, 3dnow, );
  2454. SET_QPEL_FUNCS(avg_h264_qpel, 2, 4, 3dnow, );
  2455. }
  2456. SET_QPEL_FUNCS(put_2tap_qpel, 0, 16, 3dnow, );
  2457. SET_QPEL_FUNCS(put_2tap_qpel, 1, 8, 3dnow, );
  2458. SET_QPEL_FUNCS(avg_2tap_qpel, 0, 16, 3dnow, );
  2459. SET_QPEL_FUNCS(avg_2tap_qpel, 1, 8, 3dnow, );
  2460. }
  2461. c->vorbis_inverse_coupling = vorbis_inverse_coupling_3dnow;
  2462. #endif /* HAVE_INLINE_ASM */
  2463. #if HAVE_YASM
  2464. if (!high_bit_depth && CONFIG_H264CHROMA) {
  2465. c->avg_h264_chroma_pixels_tab[0] = ff_avg_h264_chroma_mc8_3dnow_rnd;
  2466. c->avg_h264_chroma_pixels_tab[1] = ff_avg_h264_chroma_mc4_3dnow;
  2467. }
  2468. #endif /* HAVE_YASM */
  2469. }
  2470. static void dsputil_init_3dnowext(DSPContext *c, AVCodecContext *avctx,
  2471. int mm_flags)
  2472. {
  2473. #if HAVE_AMD3DNOWEXT_INLINE && HAVE_6REGS
  2474. c->vector_fmul_window = vector_fmul_window_3dnowext;
  2475. #endif
  2476. }
  2477. static void dsputil_init_sse(DSPContext *c, AVCodecContext *avctx, int mm_flags)
  2478. {
  2479. const int high_bit_depth = avctx->bits_per_raw_sample > 8;
  2480. #if HAVE_INLINE_ASM
  2481. if (!high_bit_depth) {
  2482. if (!(CONFIG_MPEG_XVMC_DECODER && avctx->xvmc_acceleration > 1)) {
  2483. /* XvMCCreateBlocks() may not allocate 16-byte aligned blocks */
  2484. c->clear_block = clear_block_sse;
  2485. c->clear_blocks = clear_blocks_sse;
  2486. }
  2487. }
  2488. c->vorbis_inverse_coupling = vorbis_inverse_coupling_sse;
  2489. #if HAVE_6REGS
  2490. c->vector_fmul_window = vector_fmul_window_sse;
  2491. #endif
  2492. c->vector_clipf = vector_clipf_sse;
  2493. #endif /* HAVE_INLINE_ASM */
  2494. #if HAVE_YASM
  2495. c->vector_fmul_reverse = ff_vector_fmul_reverse_sse;
  2496. c->vector_fmul_add = ff_vector_fmul_add_sse;
  2497. c->scalarproduct_float = ff_scalarproduct_float_sse;
  2498. c->butterflies_float_interleave = ff_butterflies_float_interleave_sse;
  2499. if (!high_bit_depth)
  2500. c->emulated_edge_mc = emulated_edge_mc_sse;
  2501. #endif /* HAVE_YASM */
  2502. }
  2503. static void dsputil_init_sse2(DSPContext *c, AVCodecContext *avctx,
  2504. int mm_flags)
  2505. {
  2506. const int bit_depth = avctx->bits_per_raw_sample;
  2507. #if HAVE_INLINE_ASM
  2508. const int high_bit_depth = bit_depth > 8;
  2509. if (!(mm_flags & AV_CPU_FLAG_SSE2SLOW)) {
  2510. // these functions are slower than mmx on AMD, but faster on Intel
  2511. if (!high_bit_depth) {
  2512. c->put_pixels_tab[0][0] = put_pixels16_sse2;
  2513. c->put_no_rnd_pixels_tab[0][0] = put_pixels16_sse2;
  2514. c->avg_pixels_tab[0][0] = avg_pixels16_sse2;
  2515. if (CONFIG_H264QPEL)
  2516. H264_QPEL_FUNCS(0, 0, sse2);
  2517. }
  2518. }
  2519. if (!high_bit_depth && CONFIG_H264QPEL) {
  2520. H264_QPEL_FUNCS(0, 1, sse2);
  2521. H264_QPEL_FUNCS(0, 2, sse2);
  2522. H264_QPEL_FUNCS(0, 3, sse2);
  2523. H264_QPEL_FUNCS(1, 1, sse2);
  2524. H264_QPEL_FUNCS(1, 2, sse2);
  2525. H264_QPEL_FUNCS(1, 3, sse2);
  2526. H264_QPEL_FUNCS(2, 1, sse2);
  2527. H264_QPEL_FUNCS(2, 2, sse2);
  2528. H264_QPEL_FUNCS(2, 3, sse2);
  2529. H264_QPEL_FUNCS(3, 1, sse2);
  2530. H264_QPEL_FUNCS(3, 2, sse2);
  2531. H264_QPEL_FUNCS(3, 3, sse2);
  2532. }
  2533. if (!high_bit_depth && avctx->idct_algo == FF_IDCT_XVIDMMX) {
  2534. c->idct_put = ff_idct_xvid_sse2_put;
  2535. c->idct_add = ff_idct_xvid_sse2_add;
  2536. c->idct = ff_idct_xvid_sse2;
  2537. c->idct_permutation_type = FF_SSE2_IDCT_PERM;
  2538. }
  2539. #endif /* HAVE_INLINE_ASM */
  2540. #if HAVE_YASM
  2541. if (bit_depth == 10) {
  2542. if (CONFIG_H264QPEL) {
  2543. SET_QPEL_FUNCS(put_h264_qpel, 0, 16, 10_sse2, ff_);
  2544. SET_QPEL_FUNCS(put_h264_qpel, 1, 8, 10_sse2, ff_);
  2545. SET_QPEL_FUNCS(avg_h264_qpel, 0, 16, 10_sse2, ff_);
  2546. SET_QPEL_FUNCS(avg_h264_qpel, 1, 8, 10_sse2, ff_);
  2547. H264_QPEL_FUNCS_10(1, 0, sse2_cache64);
  2548. H264_QPEL_FUNCS_10(2, 0, sse2_cache64);
  2549. H264_QPEL_FUNCS_10(3, 0, sse2_cache64);
  2550. }
  2551. if (CONFIG_H264CHROMA) {
  2552. c->put_h264_chroma_pixels_tab[0] = ff_put_h264_chroma_mc8_10_sse2;
  2553. c->avg_h264_chroma_pixels_tab[0] = ff_avg_h264_chroma_mc8_10_sse2;
  2554. }
  2555. }
  2556. c->scalarproduct_int16 = ff_scalarproduct_int16_sse2;
  2557. c->scalarproduct_and_madd_int16 = ff_scalarproduct_and_madd_int16_sse2;
  2558. if (mm_flags & AV_CPU_FLAG_ATOM) {
  2559. c->vector_clip_int32 = ff_vector_clip_int32_int_sse2;
  2560. } else {
  2561. c->vector_clip_int32 = ff_vector_clip_int32_sse2;
  2562. }
  2563. if (avctx->flags & CODEC_FLAG_BITEXACT) {
  2564. c->apply_window_int16 = ff_apply_window_int16_sse2_ba;
  2565. } else if (!(mm_flags & AV_CPU_FLAG_SSE2SLOW)) {
  2566. c->apply_window_int16 = ff_apply_window_int16_sse2;
  2567. }
  2568. c->bswap_buf = ff_bswap32_buf_sse2;
  2569. #endif /* HAVE_YASM */
  2570. }
  2571. static void dsputil_init_ssse3(DSPContext *c, AVCodecContext *avctx,
  2572. int mm_flags)
  2573. {
  2574. const int high_bit_depth = avctx->bits_per_raw_sample > 8;
  2575. const int bit_depth = avctx->bits_per_raw_sample;
  2576. #if HAVE_SSSE3_INLINE
  2577. if (!high_bit_depth && CONFIG_H264QPEL) {
  2578. H264_QPEL_FUNCS(1, 0, ssse3);
  2579. H264_QPEL_FUNCS(1, 1, ssse3);
  2580. H264_QPEL_FUNCS(1, 2, ssse3);
  2581. H264_QPEL_FUNCS(1, 3, ssse3);
  2582. H264_QPEL_FUNCS(2, 0, ssse3);
  2583. H264_QPEL_FUNCS(2, 1, ssse3);
  2584. H264_QPEL_FUNCS(2, 2, ssse3);
  2585. H264_QPEL_FUNCS(2, 3, ssse3);
  2586. H264_QPEL_FUNCS(3, 0, ssse3);
  2587. H264_QPEL_FUNCS(3, 1, ssse3);
  2588. H264_QPEL_FUNCS(3, 2, ssse3);
  2589. H264_QPEL_FUNCS(3, 3, ssse3);
  2590. }
  2591. #endif /* HAVE_SSSE3_INLINE */
  2592. #if HAVE_SSSE3_EXTERNAL
  2593. if (bit_depth == 10 && CONFIG_H264QPEL) {
  2594. H264_QPEL_FUNCS_10(1, 0, ssse3_cache64);
  2595. H264_QPEL_FUNCS_10(2, 0, ssse3_cache64);
  2596. H264_QPEL_FUNCS_10(3, 0, ssse3_cache64);
  2597. }
  2598. if (!high_bit_depth && CONFIG_H264CHROMA) {
  2599. c->put_h264_chroma_pixels_tab[0] = ff_put_h264_chroma_mc8_ssse3_rnd;
  2600. c->avg_h264_chroma_pixels_tab[0] = ff_avg_h264_chroma_mc8_ssse3_rnd;
  2601. c->put_h264_chroma_pixels_tab[1] = ff_put_h264_chroma_mc4_ssse3;
  2602. c->avg_h264_chroma_pixels_tab[1] = ff_avg_h264_chroma_mc4_ssse3;
  2603. }
  2604. c->add_hfyu_left_prediction = ff_add_hfyu_left_prediction_ssse3;
  2605. if (mm_flags & AV_CPU_FLAG_SSE4) // not really sse4, just slow on Conroe
  2606. c->add_hfyu_left_prediction = ff_add_hfyu_left_prediction_sse4;
  2607. if (mm_flags & AV_CPU_FLAG_ATOM)
  2608. c->apply_window_int16 = ff_apply_window_int16_ssse3_atom;
  2609. else
  2610. c->apply_window_int16 = ff_apply_window_int16_ssse3;
  2611. if (!(mm_flags & (AV_CPU_FLAG_SSE42|AV_CPU_FLAG_3DNOW))) // cachesplit
  2612. c->scalarproduct_and_madd_int16 = ff_scalarproduct_and_madd_int16_ssse3;
  2613. c->bswap_buf = ff_bswap32_buf_ssse3;
  2614. #endif /* HAVE_SSSE3_EXTERNAL */
  2615. }
  2616. static void dsputil_init_sse4(DSPContext *c, AVCodecContext *avctx,
  2617. int mm_flags)
  2618. {
  2619. #if HAVE_SSE4_EXTERNAL
  2620. c->vector_clip_int32 = ff_vector_clip_int32_sse4;
  2621. #endif /* HAVE_SSE4_EXTERNAL */
  2622. }
  2623. static void dsputil_init_avx(DSPContext *c, AVCodecContext *avctx, int mm_flags)
  2624. {
  2625. #if HAVE_AVX_EXTERNAL
  2626. const int bit_depth = avctx->bits_per_raw_sample;
  2627. if (bit_depth == 10) {
  2628. // AVX implies !cache64.
  2629. // TODO: Port cache(32|64) detection from x264.
  2630. if (CONFIG_H264QPEL) {
  2631. H264_QPEL_FUNCS_10(1, 0, sse2);
  2632. H264_QPEL_FUNCS_10(2, 0, sse2);
  2633. H264_QPEL_FUNCS_10(3, 0, sse2);
  2634. }
  2635. if (CONFIG_H264CHROMA) {
  2636. c->put_h264_chroma_pixels_tab[0] = ff_put_h264_chroma_mc8_10_avx;
  2637. c->avg_h264_chroma_pixels_tab[0] = ff_avg_h264_chroma_mc8_10_avx;
  2638. }
  2639. }
  2640. c->butterflies_float_interleave = ff_butterflies_float_interleave_avx;
  2641. c->vector_fmul_reverse = ff_vector_fmul_reverse_avx;
  2642. c->vector_fmul_add = ff_vector_fmul_add_avx;
  2643. #endif /* HAVE_AVX_EXTERNAL */
  2644. }
  2645. void ff_dsputil_init_mmx(DSPContext *c, AVCodecContext *avctx)
  2646. {
  2647. int mm_flags = av_get_cpu_flags();
  2648. #if HAVE_7REGS && HAVE_INLINE_ASM
  2649. if (mm_flags & AV_CPU_FLAG_CMOV)
  2650. c->add_hfyu_median_prediction = add_hfyu_median_prediction_cmov;
  2651. #endif
  2652. if (mm_flags & AV_CPU_FLAG_MMX)
  2653. dsputil_init_mmx(c, avctx, mm_flags);
  2654. if (mm_flags & AV_CPU_FLAG_MMXEXT)
  2655. dsputil_init_mmx2(c, avctx, mm_flags);
  2656. if (mm_flags & AV_CPU_FLAG_3DNOW)
  2657. dsputil_init_3dnow(c, avctx, mm_flags);
  2658. if (mm_flags & AV_CPU_FLAG_3DNOWEXT)
  2659. dsputil_init_3dnowext(c, avctx, mm_flags);
  2660. if (mm_flags & AV_CPU_FLAG_SSE)
  2661. dsputil_init_sse(c, avctx, mm_flags);
  2662. if (mm_flags & AV_CPU_FLAG_SSE2)
  2663. dsputil_init_sse2(c, avctx, mm_flags);
  2664. if (mm_flags & AV_CPU_FLAG_SSSE3)
  2665. dsputil_init_ssse3(c, avctx, mm_flags);
  2666. if (mm_flags & AV_CPU_FLAG_SSE4)
  2667. dsputil_init_sse4(c, avctx, mm_flags);
  2668. if (mm_flags & AV_CPU_FLAG_AVX)
  2669. dsputil_init_avx(c, avctx, mm_flags);
  2670. if (CONFIG_ENCODERS)
  2671. ff_dsputilenc_init_mmx(c, avctx);
  2672. }