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.

2934 lines
147KB

  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. typedef void emulated_edge_mc_func(uint8_t *dst, const uint8_t *src,
  1823. int linesize, int block_w, int block_h,
  1824. int src_x, int src_y, int w, int h);
  1825. static av_always_inline void gmc(uint8_t *dst, uint8_t *src,
  1826. int stride, int h, int ox, int oy,
  1827. int dxx, int dxy, int dyx, int dyy,
  1828. int shift, int r, int width, int height,
  1829. emulated_edge_mc_func *emu_edge_fn)
  1830. {
  1831. const int w = 8;
  1832. const int ix = ox >> (16 + shift);
  1833. const int iy = oy >> (16 + shift);
  1834. const int oxs = ox >> 4;
  1835. const int oys = oy >> 4;
  1836. const int dxxs = dxx >> 4;
  1837. const int dxys = dxy >> 4;
  1838. const int dyxs = dyx >> 4;
  1839. const int dyys = dyy >> 4;
  1840. const uint16_t r4[4] = { r, r, r, r };
  1841. const uint16_t dxy4[4] = { dxys, dxys, dxys, dxys };
  1842. const uint16_t dyy4[4] = { dyys, dyys, dyys, dyys };
  1843. const uint64_t shift2 = 2 * shift;
  1844. uint8_t edge_buf[(h + 1) * stride];
  1845. int x, y;
  1846. const int dxw = (dxx - (1 << (16 + shift))) * (w - 1);
  1847. const int dyh = (dyy - (1 << (16 + shift))) * (h - 1);
  1848. const int dxh = dxy * (h - 1);
  1849. const int dyw = dyx * (w - 1);
  1850. if ( // non-constant fullpel offset (3% of blocks)
  1851. ((ox ^ (ox + dxw)) | (ox ^ (ox + dxh)) | (ox ^ (ox + dxw + dxh)) |
  1852. (oy ^ (oy + dyw)) | (oy ^ (oy + dyh)) | (oy ^ (oy + dyw + dyh))) >> (16 + shift)
  1853. // uses more than 16 bits of subpel mv (only at huge resolution)
  1854. || (dxx | dxy | dyx | dyy) & 15) {
  1855. // FIXME could still use mmx for some of the rows
  1856. ff_gmc_c(dst, src, stride, h, ox, oy, dxx, dxy, dyx, dyy,
  1857. shift, r, width, height);
  1858. return;
  1859. }
  1860. src += ix + iy * stride;
  1861. if ((unsigned)ix >= width - w ||
  1862. (unsigned)iy >= height - h) {
  1863. emu_edge_fn(edge_buf, src, stride, w + 1, h + 1, ix, iy, width, height);
  1864. src = edge_buf;
  1865. }
  1866. __asm__ volatile (
  1867. "movd %0, %%mm6 \n\t"
  1868. "pxor %%mm7, %%mm7 \n\t"
  1869. "punpcklwd %%mm6, %%mm6 \n\t"
  1870. "punpcklwd %%mm6, %%mm6 \n\t"
  1871. :: "r"(1<<shift)
  1872. );
  1873. for (x = 0; x < w; x += 4) {
  1874. uint16_t dx4[4] = { oxs - dxys + dxxs * (x + 0),
  1875. oxs - dxys + dxxs * (x + 1),
  1876. oxs - dxys + dxxs * (x + 2),
  1877. oxs - dxys + dxxs * (x + 3) };
  1878. uint16_t dy4[4] = { oys - dyys + dyxs * (x + 0),
  1879. oys - dyys + dyxs * (x + 1),
  1880. oys - dyys + dyxs * (x + 2),
  1881. oys - dyys + dyxs * (x + 3) };
  1882. for (y = 0; y < h; y++) {
  1883. __asm__ volatile (
  1884. "movq %0, %%mm4 \n\t"
  1885. "movq %1, %%mm5 \n\t"
  1886. "paddw %2, %%mm4 \n\t"
  1887. "paddw %3, %%mm5 \n\t"
  1888. "movq %%mm4, %0 \n\t"
  1889. "movq %%mm5, %1 \n\t"
  1890. "psrlw $12, %%mm4 \n\t"
  1891. "psrlw $12, %%mm5 \n\t"
  1892. : "+m"(*dx4), "+m"(*dy4)
  1893. : "m"(*dxy4), "m"(*dyy4)
  1894. );
  1895. __asm__ volatile (
  1896. "movq %%mm6, %%mm2 \n\t"
  1897. "movq %%mm6, %%mm1 \n\t"
  1898. "psubw %%mm4, %%mm2 \n\t"
  1899. "psubw %%mm5, %%mm1 \n\t"
  1900. "movq %%mm2, %%mm0 \n\t"
  1901. "movq %%mm4, %%mm3 \n\t"
  1902. "pmullw %%mm1, %%mm0 \n\t" // (s - dx) * (s - dy)
  1903. "pmullw %%mm5, %%mm3 \n\t" // dx * dy
  1904. "pmullw %%mm5, %%mm2 \n\t" // (s - dx) * dy
  1905. "pmullw %%mm4, %%mm1 \n\t" // dx * (s - dy)
  1906. "movd %4, %%mm5 \n\t"
  1907. "movd %3, %%mm4 \n\t"
  1908. "punpcklbw %%mm7, %%mm5 \n\t"
  1909. "punpcklbw %%mm7, %%mm4 \n\t"
  1910. "pmullw %%mm5, %%mm3 \n\t" // src[1, 1] * dx * dy
  1911. "pmullw %%mm4, %%mm2 \n\t" // src[0, 1] * (s - dx) * dy
  1912. "movd %2, %%mm5 \n\t"
  1913. "movd %1, %%mm4 \n\t"
  1914. "punpcklbw %%mm7, %%mm5 \n\t"
  1915. "punpcklbw %%mm7, %%mm4 \n\t"
  1916. "pmullw %%mm5, %%mm1 \n\t" // src[1, 0] * dx * (s - dy)
  1917. "pmullw %%mm4, %%mm0 \n\t" // src[0, 0] * (s - dx) * (s - dy)
  1918. "paddw %5, %%mm1 \n\t"
  1919. "paddw %%mm3, %%mm2 \n\t"
  1920. "paddw %%mm1, %%mm0 \n\t"
  1921. "paddw %%mm2, %%mm0 \n\t"
  1922. "psrlw %6, %%mm0 \n\t"
  1923. "packuswb %%mm0, %%mm0 \n\t"
  1924. "movd %%mm0, %0 \n\t"
  1925. : "=m"(dst[x + y * stride])
  1926. : "m"(src[0]), "m"(src[1]),
  1927. "m"(src[stride]), "m"(src[stride + 1]),
  1928. "m"(*r4), "m"(shift2)
  1929. );
  1930. src += stride;
  1931. }
  1932. src += 4 - h * stride;
  1933. }
  1934. }
  1935. #if HAVE_YASM
  1936. #if ARCH_X86_32
  1937. static void gmc_mmx(uint8_t *dst, uint8_t *src,
  1938. int stride, int h, int ox, int oy,
  1939. int dxx, int dxy, int dyx, int dyy,
  1940. int shift, int r, int width, int height)
  1941. {
  1942. gmc(dst, src, stride, h, ox, oy, dxx, dxy, dyx, dyy, shift, r,
  1943. width, height, &emulated_edge_mc_mmx);
  1944. }
  1945. #endif
  1946. static void gmc_sse(uint8_t *dst, uint8_t *src,
  1947. int stride, int h, int ox, int oy,
  1948. int dxx, int dxy, int dyx, int dyy,
  1949. int shift, int r, int width, int height)
  1950. {
  1951. gmc(dst, src, stride, h, ox, oy, dxx, dxy, dyx, dyy, shift, r,
  1952. width, height, &emulated_edge_mc_sse);
  1953. }
  1954. #else
  1955. static void gmc_mmx(uint8_t *dst, uint8_t *src,
  1956. int stride, int h, int ox, int oy,
  1957. int dxx, int dxy, int dyx, int dyy,
  1958. int shift, int r, int width, int height)
  1959. {
  1960. gmc(dst, src, stride, h, ox, oy, dxx, dxy, dyx, dyy, shift, r,
  1961. width, height, &ff_emulated_edge_mc_8);
  1962. }
  1963. #endif
  1964. #define PREFETCH(name, op) \
  1965. static void name(void *mem, int stride, int h) \
  1966. { \
  1967. const uint8_t *p = mem; \
  1968. do { \
  1969. __asm__ volatile (#op" %0" :: "m"(*p)); \
  1970. p += stride; \
  1971. } while (--h); \
  1972. }
  1973. PREFETCH(prefetch_mmx2, prefetcht0)
  1974. PREFETCH(prefetch_3dnow, prefetch)
  1975. #undef PREFETCH
  1976. #endif /* HAVE_INLINE_ASM */
  1977. #include "h264_qpel.c"
  1978. void ff_put_h264_chroma_mc8_mmx_rnd (uint8_t *dst, uint8_t *src,
  1979. int stride, int h, int x, int y);
  1980. void ff_avg_h264_chroma_mc8_mmx2_rnd (uint8_t *dst, uint8_t *src,
  1981. int stride, int h, int x, int y);
  1982. void ff_avg_h264_chroma_mc8_3dnow_rnd(uint8_t *dst, uint8_t *src,
  1983. int stride, int h, int x, int y);
  1984. void ff_put_h264_chroma_mc4_mmx (uint8_t *dst, uint8_t *src,
  1985. int stride, int h, int x, int y);
  1986. void ff_avg_h264_chroma_mc4_mmx2 (uint8_t *dst, uint8_t *src,
  1987. int stride, int h, int x, int y);
  1988. void ff_avg_h264_chroma_mc4_3dnow (uint8_t *dst, uint8_t *src,
  1989. int stride, int h, int x, int y);
  1990. void ff_put_h264_chroma_mc2_mmx2 (uint8_t *dst, uint8_t *src,
  1991. int stride, int h, int x, int y);
  1992. void ff_avg_h264_chroma_mc2_mmx2 (uint8_t *dst, uint8_t *src,
  1993. int stride, int h, int x, int y);
  1994. void ff_put_h264_chroma_mc8_ssse3_rnd(uint8_t *dst, uint8_t *src,
  1995. int stride, int h, int x, int y);
  1996. void ff_put_h264_chroma_mc4_ssse3 (uint8_t *dst, uint8_t *src,
  1997. int stride, int h, int x, int y);
  1998. void ff_avg_h264_chroma_mc8_ssse3_rnd(uint8_t *dst, uint8_t *src,
  1999. int stride, int h, int x, int y);
  2000. void ff_avg_h264_chroma_mc4_ssse3 (uint8_t *dst, uint8_t *src,
  2001. int stride, int h, int x, int y);
  2002. #define CHROMA_MC(OP, NUM, DEPTH, OPT) \
  2003. void ff_ ## OP ## _h264_chroma_mc ## NUM ## _ ## DEPTH ## _ ## OPT \
  2004. (uint8_t *dst, uint8_t *src, \
  2005. int stride, int h, int x, int y);
  2006. CHROMA_MC(put, 2, 10, mmx2)
  2007. CHROMA_MC(avg, 2, 10, mmx2)
  2008. CHROMA_MC(put, 4, 10, mmx2)
  2009. CHROMA_MC(avg, 4, 10, mmx2)
  2010. CHROMA_MC(put, 8, 10, sse2)
  2011. CHROMA_MC(avg, 8, 10, sse2)
  2012. CHROMA_MC(put, 8, 10, avx)
  2013. CHROMA_MC(avg, 8, 10, avx)
  2014. #if HAVE_INLINE_ASM
  2015. /* CAVS-specific */
  2016. void ff_put_cavs_qpel8_mc00_mmx2(uint8_t *dst, uint8_t *src, int stride)
  2017. {
  2018. put_pixels8_mmx(dst, src, stride, 8);
  2019. }
  2020. void ff_avg_cavs_qpel8_mc00_mmx2(uint8_t *dst, uint8_t *src, int stride)
  2021. {
  2022. avg_pixels8_mmx(dst, src, stride, 8);
  2023. }
  2024. void ff_put_cavs_qpel16_mc00_mmx2(uint8_t *dst, uint8_t *src, int stride)
  2025. {
  2026. put_pixels16_mmx(dst, src, stride, 16);
  2027. }
  2028. void ff_avg_cavs_qpel16_mc00_mmx2(uint8_t *dst, uint8_t *src, int stride)
  2029. {
  2030. avg_pixels16_mmx(dst, src, stride, 16);
  2031. }
  2032. /* VC-1-specific */
  2033. void ff_put_vc1_mspel_mc00_mmx(uint8_t *dst, const uint8_t *src,
  2034. int stride, int rnd)
  2035. {
  2036. put_pixels8_mmx(dst, src, stride, 8);
  2037. }
  2038. void ff_avg_vc1_mspel_mc00_mmx2(uint8_t *dst, const uint8_t *src,
  2039. int stride, int rnd)
  2040. {
  2041. avg_pixels8_mmx2(dst, src, stride, 8);
  2042. }
  2043. static void vorbis_inverse_coupling_3dnow(float *mag, float *ang, int blocksize)
  2044. {
  2045. int i;
  2046. __asm__ volatile ("pxor %%mm7, %%mm7":);
  2047. for (i = 0; i < blocksize; i += 2) {
  2048. __asm__ volatile (
  2049. "movq %0, %%mm0 \n\t"
  2050. "movq %1, %%mm1 \n\t"
  2051. "movq %%mm0, %%mm2 \n\t"
  2052. "movq %%mm1, %%mm3 \n\t"
  2053. "pfcmpge %%mm7, %%mm2 \n\t" // m <= 0.0
  2054. "pfcmpge %%mm7, %%mm3 \n\t" // a <= 0.0
  2055. "pslld $31, %%mm2 \n\t" // keep only the sign bit
  2056. "pxor %%mm2, %%mm1 \n\t"
  2057. "movq %%mm3, %%mm4 \n\t"
  2058. "pand %%mm1, %%mm3 \n\t"
  2059. "pandn %%mm1, %%mm4 \n\t"
  2060. "pfadd %%mm0, %%mm3 \n\t" // a = m + ((a < 0) & (a ^ sign(m)))
  2061. "pfsub %%mm4, %%mm0 \n\t" // m = m + ((a > 0) & (a ^ sign(m)))
  2062. "movq %%mm3, %1 \n\t"
  2063. "movq %%mm0, %0 \n\t"
  2064. : "+m"(mag[i]), "+m"(ang[i])
  2065. :: "memory"
  2066. );
  2067. }
  2068. __asm__ volatile ("femms");
  2069. }
  2070. static void vorbis_inverse_coupling_sse(float *mag, float *ang, int blocksize)
  2071. {
  2072. int i;
  2073. __asm__ volatile (
  2074. "movaps %0, %%xmm5 \n\t"
  2075. :: "m"(ff_pdw_80000000[0])
  2076. );
  2077. for (i = 0; i < blocksize; i += 4) {
  2078. __asm__ volatile (
  2079. "movaps %0, %%xmm0 \n\t"
  2080. "movaps %1, %%xmm1 \n\t"
  2081. "xorps %%xmm2, %%xmm2 \n\t"
  2082. "xorps %%xmm3, %%xmm3 \n\t"
  2083. "cmpleps %%xmm0, %%xmm2 \n\t" // m <= 0.0
  2084. "cmpleps %%xmm1, %%xmm3 \n\t" // a <= 0.0
  2085. "andps %%xmm5, %%xmm2 \n\t" // keep only the sign bit
  2086. "xorps %%xmm2, %%xmm1 \n\t"
  2087. "movaps %%xmm3, %%xmm4 \n\t"
  2088. "andps %%xmm1, %%xmm3 \n\t"
  2089. "andnps %%xmm1, %%xmm4 \n\t"
  2090. "addps %%xmm0, %%xmm3 \n\t" // a = m + ((a < 0) & (a ^ sign(m)))
  2091. "subps %%xmm4, %%xmm0 \n\t" // m = m + ((a > 0) & (a ^ sign(m)))
  2092. "movaps %%xmm3, %1 \n\t"
  2093. "movaps %%xmm0, %0 \n\t"
  2094. : "+m"(mag[i]), "+m"(ang[i])
  2095. :: "memory"
  2096. );
  2097. }
  2098. }
  2099. #if HAVE_6REGS
  2100. static void vector_fmul_window_3dnowext(float *dst, const float *src0,
  2101. const float *src1, const float *win,
  2102. int len)
  2103. {
  2104. x86_reg i = -len * 4;
  2105. x86_reg j = len * 4 - 8;
  2106. __asm__ volatile (
  2107. "1: \n"
  2108. "pswapd (%5, %1), %%mm1 \n"
  2109. "movq (%5, %0), %%mm0 \n"
  2110. "pswapd (%4, %1), %%mm5 \n"
  2111. "movq (%3, %0), %%mm4 \n"
  2112. "movq %%mm0, %%mm2 \n"
  2113. "movq %%mm1, %%mm3 \n"
  2114. "pfmul %%mm4, %%mm2 \n" // src0[len + i] * win[len + i]
  2115. "pfmul %%mm5, %%mm3 \n" // src1[j] * win[len + j]
  2116. "pfmul %%mm4, %%mm1 \n" // src0[len + i] * win[len + j]
  2117. "pfmul %%mm5, %%mm0 \n" // src1[j] * win[len + i]
  2118. "pfadd %%mm3, %%mm2 \n"
  2119. "pfsub %%mm0, %%mm1 \n"
  2120. "pswapd %%mm2, %%mm2 \n"
  2121. "movq %%mm1, (%2, %0) \n"
  2122. "movq %%mm2, (%2, %1) \n"
  2123. "sub $8, %1 \n"
  2124. "add $8, %0 \n"
  2125. "jl 1b \n"
  2126. "femms \n"
  2127. : "+r"(i), "+r"(j)
  2128. : "r"(dst + len), "r"(src0 + len), "r"(src1), "r"(win + len)
  2129. );
  2130. }
  2131. static void vector_fmul_window_sse(float *dst, const float *src0,
  2132. const float *src1, const float *win, int len)
  2133. {
  2134. x86_reg i = -len * 4;
  2135. x86_reg j = len * 4 - 16;
  2136. __asm__ volatile (
  2137. "1: \n"
  2138. "movaps (%5, %1), %%xmm1 \n"
  2139. "movaps (%5, %0), %%xmm0 \n"
  2140. "movaps (%4, %1), %%xmm5 \n"
  2141. "movaps (%3, %0), %%xmm4 \n"
  2142. "shufps $0x1b, %%xmm1, %%xmm1 \n"
  2143. "shufps $0x1b, %%xmm5, %%xmm5 \n"
  2144. "movaps %%xmm0, %%xmm2 \n"
  2145. "movaps %%xmm1, %%xmm3 \n"
  2146. "mulps %%xmm4, %%xmm2 \n" // src0[len + i] * win[len + i]
  2147. "mulps %%xmm5, %%xmm3 \n" // src1[j] * win[len + j]
  2148. "mulps %%xmm4, %%xmm1 \n" // src0[len + i] * win[len + j]
  2149. "mulps %%xmm5, %%xmm0 \n" // src1[j] * win[len + i]
  2150. "addps %%xmm3, %%xmm2 \n"
  2151. "subps %%xmm0, %%xmm1 \n"
  2152. "shufps $0x1b, %%xmm2, %%xmm2 \n"
  2153. "movaps %%xmm1, (%2, %0) \n"
  2154. "movaps %%xmm2, (%2, %1) \n"
  2155. "sub $16, %1 \n"
  2156. "add $16, %0 \n"
  2157. "jl 1b \n"
  2158. : "+r"(i), "+r"(j)
  2159. : "r"(dst + len), "r"(src0 + len), "r"(src1), "r"(win + len)
  2160. );
  2161. }
  2162. #endif /* HAVE_6REGS */
  2163. static void vector_clipf_sse(float *dst, const float *src,
  2164. float min, float max, int len)
  2165. {
  2166. x86_reg i = (len - 16) * 4;
  2167. __asm__ volatile (
  2168. "movss %3, %%xmm4 \n\t"
  2169. "movss %4, %%xmm5 \n\t"
  2170. "shufps $0, %%xmm4, %%xmm4 \n\t"
  2171. "shufps $0, %%xmm5, %%xmm5 \n\t"
  2172. "1: \n\t"
  2173. "movaps (%2, %0), %%xmm0 \n\t" // 3/1 on intel
  2174. "movaps 16(%2, %0), %%xmm1 \n\t"
  2175. "movaps 32(%2, %0), %%xmm2 \n\t"
  2176. "movaps 48(%2, %0), %%xmm3 \n\t"
  2177. "maxps %%xmm4, %%xmm0 \n\t"
  2178. "maxps %%xmm4, %%xmm1 \n\t"
  2179. "maxps %%xmm4, %%xmm2 \n\t"
  2180. "maxps %%xmm4, %%xmm3 \n\t"
  2181. "minps %%xmm5, %%xmm0 \n\t"
  2182. "minps %%xmm5, %%xmm1 \n\t"
  2183. "minps %%xmm5, %%xmm2 \n\t"
  2184. "minps %%xmm5, %%xmm3 \n\t"
  2185. "movaps %%xmm0, (%1, %0) \n\t"
  2186. "movaps %%xmm1, 16(%1, %0) \n\t"
  2187. "movaps %%xmm2, 32(%1, %0) \n\t"
  2188. "movaps %%xmm3, 48(%1, %0) \n\t"
  2189. "sub $64, %0 \n\t"
  2190. "jge 1b \n\t"
  2191. : "+&r"(i)
  2192. : "r"(dst), "r"(src), "m"(min), "m"(max)
  2193. : "memory"
  2194. );
  2195. }
  2196. #endif /* HAVE_INLINE_ASM */
  2197. int32_t ff_scalarproduct_int16_mmx2(const int16_t *v1, const int16_t *v2,
  2198. int order);
  2199. int32_t ff_scalarproduct_int16_sse2(const int16_t *v1, const int16_t *v2,
  2200. int order);
  2201. int32_t ff_scalarproduct_and_madd_int16_mmx2(int16_t *v1, const int16_t *v2,
  2202. const int16_t *v3,
  2203. int order, int mul);
  2204. int32_t ff_scalarproduct_and_madd_int16_sse2(int16_t *v1, const int16_t *v2,
  2205. const int16_t *v3,
  2206. int order, int mul);
  2207. int32_t ff_scalarproduct_and_madd_int16_ssse3(int16_t *v1, const int16_t *v2,
  2208. const int16_t *v3,
  2209. int order, int mul);
  2210. void ff_apply_window_int16_mmxext (int16_t *output, const int16_t *input,
  2211. const int16_t *window, unsigned int len);
  2212. void ff_apply_window_int16_mmxext_ba (int16_t *output, const int16_t *input,
  2213. const int16_t *window, unsigned int len);
  2214. void ff_apply_window_int16_sse2 (int16_t *output, const int16_t *input,
  2215. const int16_t *window, unsigned int len);
  2216. void ff_apply_window_int16_sse2_ba (int16_t *output, const int16_t *input,
  2217. const int16_t *window, unsigned int len);
  2218. void ff_apply_window_int16_ssse3 (int16_t *output, const int16_t *input,
  2219. const int16_t *window, unsigned int len);
  2220. void ff_apply_window_int16_ssse3_atom(int16_t *output, const int16_t *input,
  2221. const int16_t *window, unsigned int len);
  2222. void ff_bswap32_buf_ssse3(uint32_t *dst, const uint32_t *src, int w);
  2223. void ff_bswap32_buf_sse2(uint32_t *dst, const uint32_t *src, int w);
  2224. void ff_add_hfyu_median_prediction_mmx2(uint8_t *dst, const uint8_t *top,
  2225. const uint8_t *diff, int w,
  2226. int *left, int *left_top);
  2227. int ff_add_hfyu_left_prediction_ssse3(uint8_t *dst, const uint8_t *src,
  2228. int w, int left);
  2229. int ff_add_hfyu_left_prediction_sse4(uint8_t *dst, const uint8_t *src,
  2230. int w, int left);
  2231. float ff_scalarproduct_float_sse(const float *v1, const float *v2, int order);
  2232. void ff_vector_fmul_reverse_sse(float *dst, const float *src0,
  2233. const float *src1, int len);
  2234. void ff_vector_fmul_reverse_avx(float *dst, const float *src0,
  2235. const float *src1, int len);
  2236. void ff_vector_fmul_add_sse(float *dst, const float *src0, const float *src1,
  2237. const float *src2, int len);
  2238. void ff_vector_fmul_add_avx(float *dst, const float *src0, const float *src1,
  2239. const float *src2, int len);
  2240. void ff_vector_clip_int32_mmx (int32_t *dst, const int32_t *src,
  2241. int32_t min, int32_t max, unsigned int len);
  2242. void ff_vector_clip_int32_sse2 (int32_t *dst, const int32_t *src,
  2243. int32_t min, int32_t max, unsigned int len);
  2244. void ff_vector_clip_int32_int_sse2(int32_t *dst, const int32_t *src,
  2245. int32_t min, int32_t max, unsigned int len);
  2246. void ff_vector_clip_int32_sse4 (int32_t *dst, const int32_t *src,
  2247. int32_t min, int32_t max, unsigned int len);
  2248. extern void ff_butterflies_float_interleave_sse(float *dst, const float *src0,
  2249. const float *src1, int len);
  2250. extern void ff_butterflies_float_interleave_avx(float *dst, const float *src0,
  2251. const float *src1, int len);
  2252. #define SET_QPEL_FUNCS(PFX, IDX, SIZE, CPU, PREFIX) \
  2253. do { \
  2254. c->PFX ## _pixels_tab[IDX][ 0] = PREFIX ## PFX ## SIZE ## _mc00_ ## CPU; \
  2255. c->PFX ## _pixels_tab[IDX][ 1] = PREFIX ## PFX ## SIZE ## _mc10_ ## CPU; \
  2256. c->PFX ## _pixels_tab[IDX][ 2] = PREFIX ## PFX ## SIZE ## _mc20_ ## CPU; \
  2257. c->PFX ## _pixels_tab[IDX][ 3] = PREFIX ## PFX ## SIZE ## _mc30_ ## CPU; \
  2258. c->PFX ## _pixels_tab[IDX][ 4] = PREFIX ## PFX ## SIZE ## _mc01_ ## CPU; \
  2259. c->PFX ## _pixels_tab[IDX][ 5] = PREFIX ## PFX ## SIZE ## _mc11_ ## CPU; \
  2260. c->PFX ## _pixels_tab[IDX][ 6] = PREFIX ## PFX ## SIZE ## _mc21_ ## CPU; \
  2261. c->PFX ## _pixels_tab[IDX][ 7] = PREFIX ## PFX ## SIZE ## _mc31_ ## CPU; \
  2262. c->PFX ## _pixels_tab[IDX][ 8] = PREFIX ## PFX ## SIZE ## _mc02_ ## CPU; \
  2263. c->PFX ## _pixels_tab[IDX][ 9] = PREFIX ## PFX ## SIZE ## _mc12_ ## CPU; \
  2264. c->PFX ## _pixels_tab[IDX][10] = PREFIX ## PFX ## SIZE ## _mc22_ ## CPU; \
  2265. c->PFX ## _pixels_tab[IDX][11] = PREFIX ## PFX ## SIZE ## _mc32_ ## CPU; \
  2266. c->PFX ## _pixels_tab[IDX][12] = PREFIX ## PFX ## SIZE ## _mc03_ ## CPU; \
  2267. c->PFX ## _pixels_tab[IDX][13] = PREFIX ## PFX ## SIZE ## _mc13_ ## CPU; \
  2268. c->PFX ## _pixels_tab[IDX][14] = PREFIX ## PFX ## SIZE ## _mc23_ ## CPU; \
  2269. c->PFX ## _pixels_tab[IDX][15] = PREFIX ## PFX ## SIZE ## _mc33_ ## CPU; \
  2270. } while (0)
  2271. #define SET_HPEL_FUNCS(PFX, IDX, SIZE, CPU) \
  2272. do { \
  2273. c->PFX ## _pixels_tab[IDX][0] = PFX ## _pixels ## SIZE ## _ ## CPU; \
  2274. c->PFX ## _pixels_tab[IDX][1] = PFX ## _pixels ## SIZE ## _x2_ ## CPU; \
  2275. c->PFX ## _pixels_tab[IDX][2] = PFX ## _pixels ## SIZE ## _y2_ ## CPU; \
  2276. c->PFX ## _pixels_tab[IDX][3] = PFX ## _pixels ## SIZE ## _xy2_ ## CPU; \
  2277. } while (0)
  2278. #define H264_QPEL_FUNCS(x, y, CPU) \
  2279. do { \
  2280. c->put_h264_qpel_pixels_tab[0][x + y * 4] = put_h264_qpel16_mc ## x ## y ## _ ## CPU; \
  2281. c->put_h264_qpel_pixels_tab[1][x + y * 4] = put_h264_qpel8_mc ## x ## y ## _ ## CPU; \
  2282. c->avg_h264_qpel_pixels_tab[0][x + y * 4] = avg_h264_qpel16_mc ## x ## y ## _ ## CPU; \
  2283. c->avg_h264_qpel_pixels_tab[1][x + y * 4] = avg_h264_qpel8_mc ## x ## y ## _ ## CPU; \
  2284. } while (0)
  2285. #define H264_QPEL_FUNCS_10(x, y, CPU) \
  2286. do { \
  2287. c->put_h264_qpel_pixels_tab[0][x + y * 4] = ff_put_h264_qpel16_mc ## x ## y ## _10_ ## CPU; \
  2288. c->put_h264_qpel_pixels_tab[1][x + y * 4] = ff_put_h264_qpel8_mc ## x ## y ## _10_ ## CPU; \
  2289. c->avg_h264_qpel_pixels_tab[0][x + y * 4] = ff_avg_h264_qpel16_mc ## x ## y ## _10_ ## CPU; \
  2290. c->avg_h264_qpel_pixels_tab[1][x + y * 4] = ff_avg_h264_qpel8_mc ## x ## y ## _10_ ## CPU; \
  2291. } while (0)
  2292. static void dsputil_init_mmx(DSPContext *c, AVCodecContext *avctx, int mm_flags)
  2293. {
  2294. const int high_bit_depth = avctx->bits_per_raw_sample > 8;
  2295. #if HAVE_INLINE_ASM
  2296. c->put_pixels_clamped = ff_put_pixels_clamped_mmx;
  2297. c->put_signed_pixels_clamped = ff_put_signed_pixels_clamped_mmx;
  2298. c->add_pixels_clamped = ff_add_pixels_clamped_mmx;
  2299. if (!high_bit_depth) {
  2300. c->clear_block = clear_block_mmx;
  2301. c->clear_blocks = clear_blocks_mmx;
  2302. c->draw_edges = draw_edges_mmx;
  2303. SET_HPEL_FUNCS(put, 0, 16, mmx);
  2304. SET_HPEL_FUNCS(put_no_rnd, 0, 16, mmx);
  2305. SET_HPEL_FUNCS(avg, 0, 16, mmx);
  2306. SET_HPEL_FUNCS(avg_no_rnd, 0, 16, mmx);
  2307. SET_HPEL_FUNCS(put, 1, 8, mmx);
  2308. SET_HPEL_FUNCS(put_no_rnd, 1, 8, mmx);
  2309. SET_HPEL_FUNCS(avg, 1, 8, mmx);
  2310. SET_HPEL_FUNCS(avg_no_rnd, 1, 8, mmx);
  2311. switch (avctx->idct_algo) {
  2312. case FF_IDCT_AUTO:
  2313. case FF_IDCT_SIMPLEMMX:
  2314. c->idct_put = ff_simple_idct_put_mmx;
  2315. c->idct_add = ff_simple_idct_add_mmx;
  2316. c->idct = ff_simple_idct_mmx;
  2317. c->idct_permutation_type = FF_SIMPLE_IDCT_PERM;
  2318. break;
  2319. case FF_IDCT_XVIDMMX:
  2320. c->idct_put = ff_idct_xvid_mmx_put;
  2321. c->idct_add = ff_idct_xvid_mmx_add;
  2322. c->idct = ff_idct_xvid_mmx;
  2323. break;
  2324. }
  2325. }
  2326. #if ARCH_X86_32 || !HAVE_YASM
  2327. c->gmc = gmc_mmx;
  2328. #endif
  2329. c->add_bytes = add_bytes_mmx;
  2330. if (CONFIG_H263_DECODER || CONFIG_H263_ENCODER) {
  2331. c->h263_v_loop_filter = h263_v_loop_filter_mmx;
  2332. c->h263_h_loop_filter = h263_h_loop_filter_mmx;
  2333. }
  2334. #endif /* HAVE_INLINE_ASM */
  2335. #if HAVE_YASM
  2336. #if ARCH_X86_32
  2337. if (!high_bit_depth)
  2338. c->emulated_edge_mc = emulated_edge_mc_mmx;
  2339. #endif
  2340. if (!high_bit_depth && CONFIG_H264CHROMA) {
  2341. c->put_h264_chroma_pixels_tab[0] = ff_put_h264_chroma_mc8_mmx_rnd;
  2342. c->put_h264_chroma_pixels_tab[1] = ff_put_h264_chroma_mc4_mmx;
  2343. }
  2344. c->vector_clip_int32 = ff_vector_clip_int32_mmx;
  2345. #endif
  2346. }
  2347. static void dsputil_init_mmx2(DSPContext *c, AVCodecContext *avctx,
  2348. int mm_flags)
  2349. {
  2350. const int bit_depth = avctx->bits_per_raw_sample;
  2351. const int high_bit_depth = bit_depth > 8;
  2352. #if HAVE_INLINE_ASM
  2353. c->prefetch = prefetch_mmx2;
  2354. if (!high_bit_depth) {
  2355. c->put_pixels_tab[0][1] = put_pixels16_x2_mmx2;
  2356. c->put_pixels_tab[0][2] = put_pixels16_y2_mmx2;
  2357. c->avg_pixels_tab[0][0] = avg_pixels16_mmx2;
  2358. c->avg_pixels_tab[0][1] = avg_pixels16_x2_mmx2;
  2359. c->avg_pixels_tab[0][2] = avg_pixels16_y2_mmx2;
  2360. c->put_pixels_tab[1][1] = put_pixels8_x2_mmx2;
  2361. c->put_pixels_tab[1][2] = put_pixels8_y2_mmx2;
  2362. c->avg_pixels_tab[1][0] = avg_pixels8_mmx2;
  2363. c->avg_pixels_tab[1][1] = avg_pixels8_x2_mmx2;
  2364. c->avg_pixels_tab[1][2] = avg_pixels8_y2_mmx2;
  2365. }
  2366. if (!(avctx->flags & CODEC_FLAG_BITEXACT)) {
  2367. if (!high_bit_depth) {
  2368. c->put_no_rnd_pixels_tab[0][1] = put_no_rnd_pixels16_x2_mmx2;
  2369. c->put_no_rnd_pixels_tab[0][2] = put_no_rnd_pixels16_y2_mmx2;
  2370. c->put_no_rnd_pixels_tab[1][1] = put_no_rnd_pixels8_x2_mmx2;
  2371. c->put_no_rnd_pixels_tab[1][2] = put_no_rnd_pixels8_y2_mmx2;
  2372. c->avg_pixels_tab[0][3] = avg_pixels16_xy2_mmx2;
  2373. c->avg_pixels_tab[1][3] = avg_pixels8_xy2_mmx2;
  2374. }
  2375. }
  2376. if (!high_bit_depth && avctx->idct_algo == FF_IDCT_XVIDMMX) {
  2377. c->idct_put = ff_idct_xvid_mmx2_put;
  2378. c->idct_add = ff_idct_xvid_mmx2_add;
  2379. c->idct = ff_idct_xvid_mmx2;
  2380. }
  2381. if (CONFIG_VP3_DECODER && (avctx->codec_id == AV_CODEC_ID_VP3 ||
  2382. avctx->codec_id == AV_CODEC_ID_THEORA)) {
  2383. c->put_no_rnd_pixels_tab[1][1] = put_no_rnd_pixels8_x2_exact_mmx2;
  2384. c->put_no_rnd_pixels_tab[1][2] = put_no_rnd_pixels8_y2_exact_mmx2;
  2385. }
  2386. #endif /* HAVE_INLINE_ASM */
  2387. if (CONFIG_H264QPEL) {
  2388. #if HAVE_INLINE_ASM
  2389. SET_QPEL_FUNCS(put_qpel, 0, 16, mmx2, );
  2390. SET_QPEL_FUNCS(put_qpel, 1, 8, mmx2, );
  2391. SET_QPEL_FUNCS(put_no_rnd_qpel, 0, 16, mmx2, );
  2392. SET_QPEL_FUNCS(put_no_rnd_qpel, 1, 8, mmx2, );
  2393. SET_QPEL_FUNCS(avg_qpel, 0, 16, mmx2, );
  2394. SET_QPEL_FUNCS(avg_qpel, 1, 8, mmx2, );
  2395. #endif /* HAVE_INLINE_ASM */
  2396. if (!high_bit_depth) {
  2397. #if HAVE_INLINE_ASM
  2398. SET_QPEL_FUNCS(put_h264_qpel, 0, 16, mmx2, );
  2399. SET_QPEL_FUNCS(put_h264_qpel, 1, 8, mmx2, );
  2400. SET_QPEL_FUNCS(put_h264_qpel, 2, 4, mmx2, );
  2401. SET_QPEL_FUNCS(avg_h264_qpel, 0, 16, mmx2, );
  2402. SET_QPEL_FUNCS(avg_h264_qpel, 1, 8, mmx2, );
  2403. SET_QPEL_FUNCS(avg_h264_qpel, 2, 4, mmx2, );
  2404. #endif /* HAVE_INLINE_ASM */
  2405. } else if (bit_depth == 10) {
  2406. #if HAVE_YASM
  2407. #if !ARCH_X86_64
  2408. SET_QPEL_FUNCS(avg_h264_qpel, 0, 16, 10_mmxext, ff_);
  2409. SET_QPEL_FUNCS(put_h264_qpel, 0, 16, 10_mmxext, ff_);
  2410. SET_QPEL_FUNCS(put_h264_qpel, 1, 8, 10_mmxext, ff_);
  2411. SET_QPEL_FUNCS(avg_h264_qpel, 1, 8, 10_mmxext, ff_);
  2412. #endif
  2413. SET_QPEL_FUNCS(put_h264_qpel, 2, 4, 10_mmxext, ff_);
  2414. SET_QPEL_FUNCS(avg_h264_qpel, 2, 4, 10_mmxext, ff_);
  2415. #endif /* HAVE_YASM */
  2416. }
  2417. #if HAVE_INLINE_ASM
  2418. SET_QPEL_FUNCS(put_2tap_qpel, 0, 16, mmx2, );
  2419. SET_QPEL_FUNCS(put_2tap_qpel, 1, 8, mmx2, );
  2420. SET_QPEL_FUNCS(avg_2tap_qpel, 0, 16, mmx2, );
  2421. SET_QPEL_FUNCS(avg_2tap_qpel, 1, 8, mmx2, );
  2422. #endif /* HAVE_INLINE_ASM */
  2423. }
  2424. #if HAVE_YASM
  2425. if (!high_bit_depth && CONFIG_H264CHROMA) {
  2426. c->avg_h264_chroma_pixels_tab[0] = ff_avg_h264_chroma_mc8_mmx2_rnd;
  2427. c->avg_h264_chroma_pixels_tab[1] = ff_avg_h264_chroma_mc4_mmx2;
  2428. c->avg_h264_chroma_pixels_tab[2] = ff_avg_h264_chroma_mc2_mmx2;
  2429. c->put_h264_chroma_pixels_tab[2] = ff_put_h264_chroma_mc2_mmx2;
  2430. }
  2431. if (bit_depth == 10 && CONFIG_H264CHROMA) {
  2432. c->put_h264_chroma_pixels_tab[2] = ff_put_h264_chroma_mc2_10_mmx2;
  2433. c->avg_h264_chroma_pixels_tab[2] = ff_avg_h264_chroma_mc2_10_mmx2;
  2434. c->put_h264_chroma_pixels_tab[1] = ff_put_h264_chroma_mc4_10_mmx2;
  2435. c->avg_h264_chroma_pixels_tab[1] = ff_avg_h264_chroma_mc4_10_mmx2;
  2436. }
  2437. /* slower than cmov version on AMD */
  2438. if (!(mm_flags & AV_CPU_FLAG_3DNOW))
  2439. c->add_hfyu_median_prediction = ff_add_hfyu_median_prediction_mmx2;
  2440. c->scalarproduct_int16 = ff_scalarproduct_int16_mmx2;
  2441. c->scalarproduct_and_madd_int16 = ff_scalarproduct_and_madd_int16_mmx2;
  2442. if (avctx->flags & CODEC_FLAG_BITEXACT) {
  2443. c->apply_window_int16 = ff_apply_window_int16_mmxext_ba;
  2444. } else {
  2445. c->apply_window_int16 = ff_apply_window_int16_mmxext;
  2446. }
  2447. #endif /* HAVE_YASM */
  2448. }
  2449. static void dsputil_init_3dnow(DSPContext *c, AVCodecContext *avctx,
  2450. int mm_flags)
  2451. {
  2452. const int high_bit_depth = avctx->bits_per_raw_sample > 8;
  2453. #if HAVE_INLINE_ASM
  2454. c->prefetch = prefetch_3dnow;
  2455. if (!high_bit_depth) {
  2456. c->put_pixels_tab[0][1] = put_pixels16_x2_3dnow;
  2457. c->put_pixels_tab[0][2] = put_pixels16_y2_3dnow;
  2458. c->avg_pixels_tab[0][0] = avg_pixels16_3dnow;
  2459. c->avg_pixels_tab[0][1] = avg_pixels16_x2_3dnow;
  2460. c->avg_pixels_tab[0][2] = avg_pixels16_y2_3dnow;
  2461. c->put_pixels_tab[1][1] = put_pixels8_x2_3dnow;
  2462. c->put_pixels_tab[1][2] = put_pixels8_y2_3dnow;
  2463. c->avg_pixels_tab[1][0] = avg_pixels8_3dnow;
  2464. c->avg_pixels_tab[1][1] = avg_pixels8_x2_3dnow;
  2465. c->avg_pixels_tab[1][2] = avg_pixels8_y2_3dnow;
  2466. if (!(avctx->flags & CODEC_FLAG_BITEXACT)){
  2467. c->put_no_rnd_pixels_tab[0][1] = put_no_rnd_pixels16_x2_3dnow;
  2468. c->put_no_rnd_pixels_tab[0][2] = put_no_rnd_pixels16_y2_3dnow;
  2469. c->put_no_rnd_pixels_tab[1][1] = put_no_rnd_pixels8_x2_3dnow;
  2470. c->put_no_rnd_pixels_tab[1][2] = put_no_rnd_pixels8_y2_3dnow;
  2471. c->avg_pixels_tab[0][3] = avg_pixels16_xy2_3dnow;
  2472. c->avg_pixels_tab[1][3] = avg_pixels8_xy2_3dnow;
  2473. }
  2474. }
  2475. if (CONFIG_VP3_DECODER && (avctx->codec_id == AV_CODEC_ID_VP3 ||
  2476. avctx->codec_id == AV_CODEC_ID_THEORA)) {
  2477. c->put_no_rnd_pixels_tab[1][1] = put_no_rnd_pixels8_x2_exact_3dnow;
  2478. c->put_no_rnd_pixels_tab[1][2] = put_no_rnd_pixels8_y2_exact_3dnow;
  2479. }
  2480. if (CONFIG_H264QPEL) {
  2481. SET_QPEL_FUNCS(put_qpel, 0, 16, 3dnow, );
  2482. SET_QPEL_FUNCS(put_qpel, 1, 8, 3dnow, );
  2483. SET_QPEL_FUNCS(put_no_rnd_qpel, 0, 16, 3dnow, );
  2484. SET_QPEL_FUNCS(put_no_rnd_qpel, 1, 8, 3dnow, );
  2485. SET_QPEL_FUNCS(avg_qpel, 0, 16, 3dnow, );
  2486. SET_QPEL_FUNCS(avg_qpel, 1, 8, 3dnow, );
  2487. if (!high_bit_depth) {
  2488. SET_QPEL_FUNCS(put_h264_qpel, 0, 16, 3dnow, );
  2489. SET_QPEL_FUNCS(put_h264_qpel, 1, 8, 3dnow, );
  2490. SET_QPEL_FUNCS(put_h264_qpel, 2, 4, 3dnow, );
  2491. SET_QPEL_FUNCS(avg_h264_qpel, 0, 16, 3dnow, );
  2492. SET_QPEL_FUNCS(avg_h264_qpel, 1, 8, 3dnow, );
  2493. SET_QPEL_FUNCS(avg_h264_qpel, 2, 4, 3dnow, );
  2494. }
  2495. SET_QPEL_FUNCS(put_2tap_qpel, 0, 16, 3dnow, );
  2496. SET_QPEL_FUNCS(put_2tap_qpel, 1, 8, 3dnow, );
  2497. SET_QPEL_FUNCS(avg_2tap_qpel, 0, 16, 3dnow, );
  2498. SET_QPEL_FUNCS(avg_2tap_qpel, 1, 8, 3dnow, );
  2499. }
  2500. c->vorbis_inverse_coupling = vorbis_inverse_coupling_3dnow;
  2501. #endif /* HAVE_INLINE_ASM */
  2502. #if HAVE_YASM
  2503. if (!high_bit_depth && CONFIG_H264CHROMA) {
  2504. c->avg_h264_chroma_pixels_tab[0] = ff_avg_h264_chroma_mc8_3dnow_rnd;
  2505. c->avg_h264_chroma_pixels_tab[1] = ff_avg_h264_chroma_mc4_3dnow;
  2506. }
  2507. #endif /* HAVE_YASM */
  2508. }
  2509. static void dsputil_init_3dnowext(DSPContext *c, AVCodecContext *avctx,
  2510. int mm_flags)
  2511. {
  2512. #if HAVE_AMD3DNOWEXT_INLINE && HAVE_6REGS
  2513. c->vector_fmul_window = vector_fmul_window_3dnowext;
  2514. #endif
  2515. }
  2516. static void dsputil_init_sse(DSPContext *c, AVCodecContext *avctx, int mm_flags)
  2517. {
  2518. const int high_bit_depth = avctx->bits_per_raw_sample > 8;
  2519. #if HAVE_INLINE_ASM
  2520. if (!high_bit_depth) {
  2521. if (!(CONFIG_MPEG_XVMC_DECODER && avctx->xvmc_acceleration > 1)) {
  2522. /* XvMCCreateBlocks() may not allocate 16-byte aligned blocks */
  2523. c->clear_block = clear_block_sse;
  2524. c->clear_blocks = clear_blocks_sse;
  2525. }
  2526. }
  2527. c->vorbis_inverse_coupling = vorbis_inverse_coupling_sse;
  2528. #if HAVE_6REGS
  2529. c->vector_fmul_window = vector_fmul_window_sse;
  2530. #endif
  2531. c->vector_clipf = vector_clipf_sse;
  2532. #endif /* HAVE_INLINE_ASM */
  2533. #if HAVE_YASM
  2534. c->vector_fmul_reverse = ff_vector_fmul_reverse_sse;
  2535. c->vector_fmul_add = ff_vector_fmul_add_sse;
  2536. c->scalarproduct_float = ff_scalarproduct_float_sse;
  2537. c->butterflies_float_interleave = ff_butterflies_float_interleave_sse;
  2538. if (!high_bit_depth)
  2539. c->emulated_edge_mc = emulated_edge_mc_sse;
  2540. #if HAVE_INLINE_ASM
  2541. c->gmc = gmc_sse;
  2542. #endif
  2543. #endif /* HAVE_YASM */
  2544. }
  2545. static void dsputil_init_sse2(DSPContext *c, AVCodecContext *avctx,
  2546. int mm_flags)
  2547. {
  2548. const int bit_depth = avctx->bits_per_raw_sample;
  2549. #if HAVE_INLINE_ASM
  2550. const int high_bit_depth = bit_depth > 8;
  2551. if (!(mm_flags & AV_CPU_FLAG_SSE2SLOW)) {
  2552. // these functions are slower than mmx on AMD, but faster on Intel
  2553. if (!high_bit_depth) {
  2554. c->put_pixels_tab[0][0] = put_pixels16_sse2;
  2555. c->put_no_rnd_pixels_tab[0][0] = put_pixels16_sse2;
  2556. c->avg_pixels_tab[0][0] = avg_pixels16_sse2;
  2557. if (CONFIG_H264QPEL)
  2558. H264_QPEL_FUNCS(0, 0, sse2);
  2559. }
  2560. }
  2561. if (!high_bit_depth && CONFIG_H264QPEL) {
  2562. H264_QPEL_FUNCS(0, 1, sse2);
  2563. H264_QPEL_FUNCS(0, 2, sse2);
  2564. H264_QPEL_FUNCS(0, 3, sse2);
  2565. H264_QPEL_FUNCS(1, 1, sse2);
  2566. H264_QPEL_FUNCS(1, 2, sse2);
  2567. H264_QPEL_FUNCS(1, 3, sse2);
  2568. H264_QPEL_FUNCS(2, 1, sse2);
  2569. H264_QPEL_FUNCS(2, 2, sse2);
  2570. H264_QPEL_FUNCS(2, 3, sse2);
  2571. H264_QPEL_FUNCS(3, 1, sse2);
  2572. H264_QPEL_FUNCS(3, 2, sse2);
  2573. H264_QPEL_FUNCS(3, 3, sse2);
  2574. }
  2575. if (!high_bit_depth && avctx->idct_algo == FF_IDCT_XVIDMMX) {
  2576. c->idct_put = ff_idct_xvid_sse2_put;
  2577. c->idct_add = ff_idct_xvid_sse2_add;
  2578. c->idct = ff_idct_xvid_sse2;
  2579. c->idct_permutation_type = FF_SSE2_IDCT_PERM;
  2580. }
  2581. #endif /* HAVE_INLINE_ASM */
  2582. #if HAVE_YASM
  2583. if (bit_depth == 10) {
  2584. if (CONFIG_H264QPEL) {
  2585. SET_QPEL_FUNCS(put_h264_qpel, 0, 16, 10_sse2, ff_);
  2586. SET_QPEL_FUNCS(put_h264_qpel, 1, 8, 10_sse2, ff_);
  2587. SET_QPEL_FUNCS(avg_h264_qpel, 0, 16, 10_sse2, ff_);
  2588. SET_QPEL_FUNCS(avg_h264_qpel, 1, 8, 10_sse2, ff_);
  2589. H264_QPEL_FUNCS_10(1, 0, sse2_cache64);
  2590. H264_QPEL_FUNCS_10(2, 0, sse2_cache64);
  2591. H264_QPEL_FUNCS_10(3, 0, sse2_cache64);
  2592. }
  2593. if (CONFIG_H264CHROMA) {
  2594. c->put_h264_chroma_pixels_tab[0] = ff_put_h264_chroma_mc8_10_sse2;
  2595. c->avg_h264_chroma_pixels_tab[0] = ff_avg_h264_chroma_mc8_10_sse2;
  2596. }
  2597. }
  2598. c->scalarproduct_int16 = ff_scalarproduct_int16_sse2;
  2599. c->scalarproduct_and_madd_int16 = ff_scalarproduct_and_madd_int16_sse2;
  2600. if (mm_flags & AV_CPU_FLAG_ATOM) {
  2601. c->vector_clip_int32 = ff_vector_clip_int32_int_sse2;
  2602. } else {
  2603. c->vector_clip_int32 = ff_vector_clip_int32_sse2;
  2604. }
  2605. if (avctx->flags & CODEC_FLAG_BITEXACT) {
  2606. c->apply_window_int16 = ff_apply_window_int16_sse2_ba;
  2607. } else if (!(mm_flags & AV_CPU_FLAG_SSE2SLOW)) {
  2608. c->apply_window_int16 = ff_apply_window_int16_sse2;
  2609. }
  2610. c->bswap_buf = ff_bswap32_buf_sse2;
  2611. #endif /* HAVE_YASM */
  2612. }
  2613. static void dsputil_init_ssse3(DSPContext *c, AVCodecContext *avctx,
  2614. int mm_flags)
  2615. {
  2616. const int high_bit_depth = avctx->bits_per_raw_sample > 8;
  2617. const int bit_depth = avctx->bits_per_raw_sample;
  2618. #if HAVE_SSSE3_INLINE
  2619. if (!high_bit_depth && CONFIG_H264QPEL) {
  2620. H264_QPEL_FUNCS(1, 0, ssse3);
  2621. H264_QPEL_FUNCS(1, 1, ssse3);
  2622. H264_QPEL_FUNCS(1, 2, ssse3);
  2623. H264_QPEL_FUNCS(1, 3, ssse3);
  2624. H264_QPEL_FUNCS(2, 0, ssse3);
  2625. H264_QPEL_FUNCS(2, 1, ssse3);
  2626. H264_QPEL_FUNCS(2, 2, ssse3);
  2627. H264_QPEL_FUNCS(2, 3, ssse3);
  2628. H264_QPEL_FUNCS(3, 0, ssse3);
  2629. H264_QPEL_FUNCS(3, 1, ssse3);
  2630. H264_QPEL_FUNCS(3, 2, ssse3);
  2631. H264_QPEL_FUNCS(3, 3, ssse3);
  2632. }
  2633. #endif /* HAVE_SSSE3_INLINE */
  2634. #if HAVE_SSSE3_EXTERNAL
  2635. if (bit_depth == 10 && CONFIG_H264QPEL) {
  2636. H264_QPEL_FUNCS_10(1, 0, ssse3_cache64);
  2637. H264_QPEL_FUNCS_10(2, 0, ssse3_cache64);
  2638. H264_QPEL_FUNCS_10(3, 0, ssse3_cache64);
  2639. }
  2640. if (!high_bit_depth && CONFIG_H264CHROMA) {
  2641. c->put_h264_chroma_pixels_tab[0] = ff_put_h264_chroma_mc8_ssse3_rnd;
  2642. c->avg_h264_chroma_pixels_tab[0] = ff_avg_h264_chroma_mc8_ssse3_rnd;
  2643. c->put_h264_chroma_pixels_tab[1] = ff_put_h264_chroma_mc4_ssse3;
  2644. c->avg_h264_chroma_pixels_tab[1] = ff_avg_h264_chroma_mc4_ssse3;
  2645. }
  2646. c->add_hfyu_left_prediction = ff_add_hfyu_left_prediction_ssse3;
  2647. if (mm_flags & AV_CPU_FLAG_SSE4) // not really sse4, just slow on Conroe
  2648. c->add_hfyu_left_prediction = ff_add_hfyu_left_prediction_sse4;
  2649. if (mm_flags & AV_CPU_FLAG_ATOM)
  2650. c->apply_window_int16 = ff_apply_window_int16_ssse3_atom;
  2651. else
  2652. c->apply_window_int16 = ff_apply_window_int16_ssse3;
  2653. if (!(mm_flags & (AV_CPU_FLAG_SSE42|AV_CPU_FLAG_3DNOW))) // cachesplit
  2654. c->scalarproduct_and_madd_int16 = ff_scalarproduct_and_madd_int16_ssse3;
  2655. c->bswap_buf = ff_bswap32_buf_ssse3;
  2656. #endif /* HAVE_SSSE3_EXTERNAL */
  2657. }
  2658. static void dsputil_init_sse4(DSPContext *c, AVCodecContext *avctx,
  2659. int mm_flags)
  2660. {
  2661. #if HAVE_SSE4_EXTERNAL
  2662. c->vector_clip_int32 = ff_vector_clip_int32_sse4;
  2663. #endif /* HAVE_SSE4_EXTERNAL */
  2664. }
  2665. static void dsputil_init_avx(DSPContext *c, AVCodecContext *avctx, int mm_flags)
  2666. {
  2667. #if HAVE_AVX_EXTERNAL
  2668. const int bit_depth = avctx->bits_per_raw_sample;
  2669. if (bit_depth == 10) {
  2670. // AVX implies !cache64.
  2671. // TODO: Port cache(32|64) detection from x264.
  2672. if (CONFIG_H264QPEL) {
  2673. H264_QPEL_FUNCS_10(1, 0, sse2);
  2674. H264_QPEL_FUNCS_10(2, 0, sse2);
  2675. H264_QPEL_FUNCS_10(3, 0, sse2);
  2676. }
  2677. if (CONFIG_H264CHROMA) {
  2678. c->put_h264_chroma_pixels_tab[0] = ff_put_h264_chroma_mc8_10_avx;
  2679. c->avg_h264_chroma_pixels_tab[0] = ff_avg_h264_chroma_mc8_10_avx;
  2680. }
  2681. }
  2682. c->butterflies_float_interleave = ff_butterflies_float_interleave_avx;
  2683. c->vector_fmul_reverse = ff_vector_fmul_reverse_avx;
  2684. c->vector_fmul_add = ff_vector_fmul_add_avx;
  2685. #endif /* HAVE_AVX_EXTERNAL */
  2686. }
  2687. void ff_dsputil_init_mmx(DSPContext *c, AVCodecContext *avctx)
  2688. {
  2689. int mm_flags = av_get_cpu_flags();
  2690. #if HAVE_7REGS && HAVE_INLINE_ASM
  2691. if (mm_flags & AV_CPU_FLAG_CMOV)
  2692. c->add_hfyu_median_prediction = add_hfyu_median_prediction_cmov;
  2693. #endif
  2694. if (mm_flags & AV_CPU_FLAG_MMX)
  2695. dsputil_init_mmx(c, avctx, mm_flags);
  2696. if (mm_flags & AV_CPU_FLAG_MMXEXT)
  2697. dsputil_init_mmx2(c, avctx, mm_flags);
  2698. if (mm_flags & AV_CPU_FLAG_3DNOW)
  2699. dsputil_init_3dnow(c, avctx, mm_flags);
  2700. if (mm_flags & AV_CPU_FLAG_3DNOWEXT)
  2701. dsputil_init_3dnowext(c, avctx, mm_flags);
  2702. if (mm_flags & AV_CPU_FLAG_SSE)
  2703. dsputil_init_sse(c, avctx, mm_flags);
  2704. if (mm_flags & AV_CPU_FLAG_SSE2)
  2705. dsputil_init_sse2(c, avctx, mm_flags);
  2706. if (mm_flags & AV_CPU_FLAG_SSSE3)
  2707. dsputil_init_ssse3(c, avctx, mm_flags);
  2708. if (mm_flags & AV_CPU_FLAG_SSE4)
  2709. dsputil_init_sse4(c, avctx, mm_flags);
  2710. if (mm_flags & AV_CPU_FLAG_AVX)
  2711. dsputil_init_avx(c, avctx, mm_flags);
  2712. if (CONFIG_ENCODERS)
  2713. ff_dsputilenc_init_mmx(c, avctx);
  2714. }