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.

3699 lines
138KB

  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. * This file is part of FFmpeg.
  7. *
  8. * FFmpeg is free software; you can redistribute it and/or
  9. * modify it under the terms of the GNU Lesser General Public
  10. * License as published by the Free Software Foundation; either
  11. * version 2.1 of the License, or (at your option) any later version.
  12. *
  13. * FFmpeg is distributed in the hope that it will be useful,
  14. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  16. * Lesser General Public License for more details.
  17. *
  18. * You should have received a copy of the GNU Lesser General Public
  19. * License along with FFmpeg; if not, write to the Free Software
  20. * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
  21. *
  22. * MMX optimization by Nick Kurshev <nickols_k@mail.ru>
  23. */
  24. #include "dsputil.h"
  25. #include "simple_idct.h"
  26. #include "mpegvideo.h"
  27. #include "x86_cpu.h"
  28. #include "mmx.h"
  29. #include "vp3dsp_mmx.h"
  30. #include "vp3dsp_sse2.h"
  31. #include "h263.h"
  32. //#undef NDEBUG
  33. //#include <assert.h>
  34. extern void ff_idct_xvid_mmx(short *block);
  35. extern void ff_idct_xvid_mmx2(short *block);
  36. int mm_flags; /* multimedia extension flags */
  37. /* pixel operations */
  38. static const uint64_t mm_bone attribute_used __attribute__ ((aligned(8))) = 0x0101010101010101ULL;
  39. static const uint64_t mm_wone attribute_used __attribute__ ((aligned(8))) = 0x0001000100010001ULL;
  40. static const uint64_t mm_wtwo attribute_used __attribute__ ((aligned(8))) = 0x0002000200020002ULL;
  41. static const uint64_t ff_pdw_80000000[2] attribute_used __attribute__ ((aligned(16))) =
  42. {0x8000000080000000ULL, 0x8000000080000000ULL};
  43. static const uint64_t ff_pw_20 attribute_used __attribute__ ((aligned(8))) = 0x0014001400140014ULL;
  44. static const uint64_t ff_pw_3 attribute_used __attribute__ ((aligned(8))) = 0x0003000300030003ULL;
  45. static const uint64_t ff_pw_4 attribute_used __attribute__ ((aligned(8))) = 0x0004000400040004ULL;
  46. static const uint64_t ff_pw_5 attribute_used __attribute__ ((aligned(8))) = 0x0005000500050005ULL;
  47. static const uint64_t ff_pw_8 attribute_used __attribute__ ((aligned(8))) = 0x0008000800080008ULL;
  48. static const uint64_t ff_pw_16 attribute_used __attribute__ ((aligned(8))) = 0x0010001000100010ULL;
  49. static const uint64_t ff_pw_32 attribute_used __attribute__ ((aligned(8))) = 0x0020002000200020ULL;
  50. static const uint64_t ff_pw_64 attribute_used __attribute__ ((aligned(8))) = 0x0040004000400040ULL;
  51. static const uint64_t ff_pw_15 attribute_used __attribute__ ((aligned(8))) = 0x000F000F000F000FULL;
  52. static const uint64_t ff_pb_1 attribute_used __attribute__ ((aligned(8))) = 0x0101010101010101ULL;
  53. static const uint64_t ff_pb_3 attribute_used __attribute__ ((aligned(8))) = 0x0303030303030303ULL;
  54. static const uint64_t ff_pb_7 attribute_used __attribute__ ((aligned(8))) = 0x0707070707070707ULL;
  55. static const uint64_t ff_pb_3F attribute_used __attribute__ ((aligned(8))) = 0x3F3F3F3F3F3F3F3FULL;
  56. static const uint64_t ff_pb_A1 attribute_used __attribute__ ((aligned(8))) = 0xA1A1A1A1A1A1A1A1ULL;
  57. static const uint64_t ff_pb_5F attribute_used __attribute__ ((aligned(8))) = 0x5F5F5F5F5F5F5F5FULL;
  58. static const uint64_t ff_pb_FC attribute_used __attribute__ ((aligned(8))) = 0xFCFCFCFCFCFCFCFCULL;
  59. #define JUMPALIGN() __asm __volatile (ASMALIGN(3)::)
  60. #define MOVQ_ZERO(regd) __asm __volatile ("pxor %%" #regd ", %%" #regd ::)
  61. #define MOVQ_WONE(regd) \
  62. __asm __volatile ( \
  63. "pcmpeqd %%" #regd ", %%" #regd " \n\t" \
  64. "psrlw $15, %%" #regd ::)
  65. #define MOVQ_BFE(regd) \
  66. __asm __volatile ( \
  67. "pcmpeqd %%" #regd ", %%" #regd " \n\t"\
  68. "paddb %%" #regd ", %%" #regd " \n\t" ::)
  69. #ifndef PIC
  70. #define MOVQ_BONE(regd) __asm __volatile ("movq %0, %%" #regd " \n\t" ::"m"(mm_bone))
  71. #define MOVQ_WTWO(regd) __asm __volatile ("movq %0, %%" #regd " \n\t" ::"m"(mm_wtwo))
  72. #else
  73. // for shared library it's better to use this way for accessing constants
  74. // pcmpeqd -> -1
  75. #define MOVQ_BONE(regd) \
  76. __asm __volatile ( \
  77. "pcmpeqd %%" #regd ", %%" #regd " \n\t" \
  78. "psrlw $15, %%" #regd " \n\t" \
  79. "packuswb %%" #regd ", %%" #regd " \n\t" ::)
  80. #define MOVQ_WTWO(regd) \
  81. __asm __volatile ( \
  82. "pcmpeqd %%" #regd ", %%" #regd " \n\t" \
  83. "psrlw $15, %%" #regd " \n\t" \
  84. "psllw $1, %%" #regd " \n\t"::)
  85. #endif
  86. // using regr as temporary and for the output result
  87. // first argument is unmodifed and second is trashed
  88. // regfe is supposed to contain 0xfefefefefefefefe
  89. #define PAVGB_MMX_NO_RND(rega, regb, regr, regfe) \
  90. "movq " #rega ", " #regr " \n\t"\
  91. "pand " #regb ", " #regr " \n\t"\
  92. "pxor " #rega ", " #regb " \n\t"\
  93. "pand " #regfe "," #regb " \n\t"\
  94. "psrlq $1, " #regb " \n\t"\
  95. "paddb " #regb ", " #regr " \n\t"
  96. #define PAVGB_MMX(rega, regb, regr, regfe) \
  97. "movq " #rega ", " #regr " \n\t"\
  98. "por " #regb ", " #regr " \n\t"\
  99. "pxor " #rega ", " #regb " \n\t"\
  100. "pand " #regfe "," #regb " \n\t"\
  101. "psrlq $1, " #regb " \n\t"\
  102. "psubb " #regb ", " #regr " \n\t"
  103. // mm6 is supposed to contain 0xfefefefefefefefe
  104. #define PAVGBP_MMX_NO_RND(rega, regb, regr, regc, regd, regp) \
  105. "movq " #rega ", " #regr " \n\t"\
  106. "movq " #regc ", " #regp " \n\t"\
  107. "pand " #regb ", " #regr " \n\t"\
  108. "pand " #regd ", " #regp " \n\t"\
  109. "pxor " #rega ", " #regb " \n\t"\
  110. "pxor " #regc ", " #regd " \n\t"\
  111. "pand %%mm6, " #regb " \n\t"\
  112. "pand %%mm6, " #regd " \n\t"\
  113. "psrlq $1, " #regb " \n\t"\
  114. "psrlq $1, " #regd " \n\t"\
  115. "paddb " #regb ", " #regr " \n\t"\
  116. "paddb " #regd ", " #regp " \n\t"
  117. #define PAVGBP_MMX(rega, regb, regr, regc, regd, regp) \
  118. "movq " #rega ", " #regr " \n\t"\
  119. "movq " #regc ", " #regp " \n\t"\
  120. "por " #regb ", " #regr " \n\t"\
  121. "por " #regd ", " #regp " \n\t"\
  122. "pxor " #rega ", " #regb " \n\t"\
  123. "pxor " #regc ", " #regd " \n\t"\
  124. "pand %%mm6, " #regb " \n\t"\
  125. "pand %%mm6, " #regd " \n\t"\
  126. "psrlq $1, " #regd " \n\t"\
  127. "psrlq $1, " #regb " \n\t"\
  128. "psubb " #regb ", " #regr " \n\t"\
  129. "psubb " #regd ", " #regp " \n\t"
  130. /***********************************/
  131. /* MMX no rounding */
  132. #define DEF(x, y) x ## _no_rnd_ ## y ##_mmx
  133. #define SET_RND MOVQ_WONE
  134. #define PAVGBP(a, b, c, d, e, f) PAVGBP_MMX_NO_RND(a, b, c, d, e, f)
  135. #define PAVGB(a, b, c, e) PAVGB_MMX_NO_RND(a, b, c, e)
  136. #include "dsputil_mmx_rnd.h"
  137. #undef DEF
  138. #undef SET_RND
  139. #undef PAVGBP
  140. #undef PAVGB
  141. /***********************************/
  142. /* MMX rounding */
  143. #define DEF(x, y) x ## _ ## y ##_mmx
  144. #define SET_RND MOVQ_WTWO
  145. #define PAVGBP(a, b, c, d, e, f) PAVGBP_MMX(a, b, c, d, e, f)
  146. #define PAVGB(a, b, c, e) PAVGB_MMX(a, b, c, e)
  147. #include "dsputil_mmx_rnd.h"
  148. #undef DEF
  149. #undef SET_RND
  150. #undef PAVGBP
  151. #undef PAVGB
  152. /***********************************/
  153. /* 3Dnow specific */
  154. #define DEF(x) x ## _3dnow
  155. #define PAVGB "pavgusb"
  156. #include "dsputil_mmx_avg.h"
  157. #undef DEF
  158. #undef PAVGB
  159. /***********************************/
  160. /* MMX2 specific */
  161. #define DEF(x) x ## _mmx2
  162. /* Introduced only in MMX2 set */
  163. #define PAVGB "pavgb"
  164. #include "dsputil_mmx_avg.h"
  165. #undef DEF
  166. #undef PAVGB
  167. #define SBUTTERFLY(a,b,t,n,m)\
  168. "mov" #m " " #a ", " #t " \n\t" /* abcd */\
  169. "punpckl" #n " " #b ", " #a " \n\t" /* aebf */\
  170. "punpckh" #n " " #b ", " #t " \n\t" /* cgdh */\
  171. #define TRANSPOSE4(a,b,c,d,t)\
  172. SBUTTERFLY(a,b,t,wd,q) /* a=aebf t=cgdh */\
  173. SBUTTERFLY(c,d,b,wd,q) /* c=imjn b=kolp */\
  174. SBUTTERFLY(a,c,d,dq,q) /* a=aeim d=bfjn */\
  175. SBUTTERFLY(t,b,c,dq,q) /* t=cgko c=dhlp */
  176. /***********************************/
  177. /* standard MMX */
  178. #ifdef CONFIG_ENCODERS
  179. static void get_pixels_mmx(DCTELEM *block, const uint8_t *pixels, int line_size)
  180. {
  181. asm volatile(
  182. "mov $-128, %%"REG_a" \n\t"
  183. "pxor %%mm7, %%mm7 \n\t"
  184. ASMALIGN(4)
  185. "1: \n\t"
  186. "movq (%0), %%mm0 \n\t"
  187. "movq (%0, %2), %%mm2 \n\t"
  188. "movq %%mm0, %%mm1 \n\t"
  189. "movq %%mm2, %%mm3 \n\t"
  190. "punpcklbw %%mm7, %%mm0 \n\t"
  191. "punpckhbw %%mm7, %%mm1 \n\t"
  192. "punpcklbw %%mm7, %%mm2 \n\t"
  193. "punpckhbw %%mm7, %%mm3 \n\t"
  194. "movq %%mm0, (%1, %%"REG_a") \n\t"
  195. "movq %%mm1, 8(%1, %%"REG_a") \n\t"
  196. "movq %%mm2, 16(%1, %%"REG_a") \n\t"
  197. "movq %%mm3, 24(%1, %%"REG_a") \n\t"
  198. "add %3, %0 \n\t"
  199. "add $32, %%"REG_a" \n\t"
  200. "js 1b \n\t"
  201. : "+r" (pixels)
  202. : "r" (block+64), "r" ((long)line_size), "r" ((long)line_size*2)
  203. : "%"REG_a
  204. );
  205. }
  206. static inline void diff_pixels_mmx(DCTELEM *block, const uint8_t *s1, const uint8_t *s2, int stride)
  207. {
  208. asm volatile(
  209. "pxor %%mm7, %%mm7 \n\t"
  210. "mov $-128, %%"REG_a" \n\t"
  211. ASMALIGN(4)
  212. "1: \n\t"
  213. "movq (%0), %%mm0 \n\t"
  214. "movq (%1), %%mm2 \n\t"
  215. "movq %%mm0, %%mm1 \n\t"
  216. "movq %%mm2, %%mm3 \n\t"
  217. "punpcklbw %%mm7, %%mm0 \n\t"
  218. "punpckhbw %%mm7, %%mm1 \n\t"
  219. "punpcklbw %%mm7, %%mm2 \n\t"
  220. "punpckhbw %%mm7, %%mm3 \n\t"
  221. "psubw %%mm2, %%mm0 \n\t"
  222. "psubw %%mm3, %%mm1 \n\t"
  223. "movq %%mm0, (%2, %%"REG_a") \n\t"
  224. "movq %%mm1, 8(%2, %%"REG_a") \n\t"
  225. "add %3, %0 \n\t"
  226. "add %3, %1 \n\t"
  227. "add $16, %%"REG_a" \n\t"
  228. "jnz 1b \n\t"
  229. : "+r" (s1), "+r" (s2)
  230. : "r" (block+64), "r" ((long)stride)
  231. : "%"REG_a
  232. );
  233. }
  234. #endif //CONFIG_ENCODERS
  235. void put_pixels_clamped_mmx(const DCTELEM *block, uint8_t *pixels, int line_size)
  236. {
  237. const DCTELEM *p;
  238. uint8_t *pix;
  239. /* read the pixels */
  240. p = block;
  241. pix = pixels;
  242. /* unrolled loop */
  243. __asm __volatile(
  244. "movq %3, %%mm0 \n\t"
  245. "movq 8%3, %%mm1 \n\t"
  246. "movq 16%3, %%mm2 \n\t"
  247. "movq 24%3, %%mm3 \n\t"
  248. "movq 32%3, %%mm4 \n\t"
  249. "movq 40%3, %%mm5 \n\t"
  250. "movq 48%3, %%mm6 \n\t"
  251. "movq 56%3, %%mm7 \n\t"
  252. "packuswb %%mm1, %%mm0 \n\t"
  253. "packuswb %%mm3, %%mm2 \n\t"
  254. "packuswb %%mm5, %%mm4 \n\t"
  255. "packuswb %%mm7, %%mm6 \n\t"
  256. "movq %%mm0, (%0) \n\t"
  257. "movq %%mm2, (%0, %1) \n\t"
  258. "movq %%mm4, (%0, %1, 2) \n\t"
  259. "movq %%mm6, (%0, %2) \n\t"
  260. ::"r" (pix), "r" ((long)line_size), "r" ((long)line_size*3), "m"(*p)
  261. :"memory");
  262. pix += line_size*4;
  263. p += 32;
  264. // if here would be an exact copy of the code above
  265. // compiler would generate some very strange code
  266. // thus using "r"
  267. __asm __volatile(
  268. "movq (%3), %%mm0 \n\t"
  269. "movq 8(%3), %%mm1 \n\t"
  270. "movq 16(%3), %%mm2 \n\t"
  271. "movq 24(%3), %%mm3 \n\t"
  272. "movq 32(%3), %%mm4 \n\t"
  273. "movq 40(%3), %%mm5 \n\t"
  274. "movq 48(%3), %%mm6 \n\t"
  275. "movq 56(%3), %%mm7 \n\t"
  276. "packuswb %%mm1, %%mm0 \n\t"
  277. "packuswb %%mm3, %%mm2 \n\t"
  278. "packuswb %%mm5, %%mm4 \n\t"
  279. "packuswb %%mm7, %%mm6 \n\t"
  280. "movq %%mm0, (%0) \n\t"
  281. "movq %%mm2, (%0, %1) \n\t"
  282. "movq %%mm4, (%0, %1, 2) \n\t"
  283. "movq %%mm6, (%0, %2) \n\t"
  284. ::"r" (pix), "r" ((long)line_size), "r" ((long)line_size*3), "r"(p)
  285. :"memory");
  286. }
  287. static DECLARE_ALIGNED_8(const unsigned char, vector128[8]) =
  288. { 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80 };
  289. void put_signed_pixels_clamped_mmx(const DCTELEM *block, uint8_t *pixels, int line_size)
  290. {
  291. int i;
  292. movq_m2r(*vector128, mm1);
  293. for (i = 0; i < 8; i++) {
  294. movq_m2r(*(block), mm0);
  295. packsswb_m2r(*(block + 4), mm0);
  296. block += 8;
  297. paddb_r2r(mm1, mm0);
  298. movq_r2m(mm0, *pixels);
  299. pixels += line_size;
  300. }
  301. }
  302. void add_pixels_clamped_mmx(const DCTELEM *block, uint8_t *pixels, int line_size)
  303. {
  304. const DCTELEM *p;
  305. uint8_t *pix;
  306. int i;
  307. /* read the pixels */
  308. p = block;
  309. pix = pixels;
  310. MOVQ_ZERO(mm7);
  311. i = 4;
  312. do {
  313. __asm __volatile(
  314. "movq (%2), %%mm0 \n\t"
  315. "movq 8(%2), %%mm1 \n\t"
  316. "movq 16(%2), %%mm2 \n\t"
  317. "movq 24(%2), %%mm3 \n\t"
  318. "movq %0, %%mm4 \n\t"
  319. "movq %1, %%mm6 \n\t"
  320. "movq %%mm4, %%mm5 \n\t"
  321. "punpcklbw %%mm7, %%mm4 \n\t"
  322. "punpckhbw %%mm7, %%mm5 \n\t"
  323. "paddsw %%mm4, %%mm0 \n\t"
  324. "paddsw %%mm5, %%mm1 \n\t"
  325. "movq %%mm6, %%mm5 \n\t"
  326. "punpcklbw %%mm7, %%mm6 \n\t"
  327. "punpckhbw %%mm7, %%mm5 \n\t"
  328. "paddsw %%mm6, %%mm2 \n\t"
  329. "paddsw %%mm5, %%mm3 \n\t"
  330. "packuswb %%mm1, %%mm0 \n\t"
  331. "packuswb %%mm3, %%mm2 \n\t"
  332. "movq %%mm0, %0 \n\t"
  333. "movq %%mm2, %1 \n\t"
  334. :"+m"(*pix), "+m"(*(pix+line_size))
  335. :"r"(p)
  336. :"memory");
  337. pix += line_size*2;
  338. p += 16;
  339. } while (--i);
  340. }
  341. static void put_pixels4_mmx(uint8_t *block, const uint8_t *pixels, int line_size, int h)
  342. {
  343. __asm __volatile(
  344. "lea (%3, %3), %%"REG_a" \n\t"
  345. ASMALIGN(3)
  346. "1: \n\t"
  347. "movd (%1), %%mm0 \n\t"
  348. "movd (%1, %3), %%mm1 \n\t"
  349. "movd %%mm0, (%2) \n\t"
  350. "movd %%mm1, (%2, %3) \n\t"
  351. "add %%"REG_a", %1 \n\t"
  352. "add %%"REG_a", %2 \n\t"
  353. "movd (%1), %%mm0 \n\t"
  354. "movd (%1, %3), %%mm1 \n\t"
  355. "movd %%mm0, (%2) \n\t"
  356. "movd %%mm1, (%2, %3) \n\t"
  357. "add %%"REG_a", %1 \n\t"
  358. "add %%"REG_a", %2 \n\t"
  359. "subl $4, %0 \n\t"
  360. "jnz 1b \n\t"
  361. : "+g"(h), "+r" (pixels), "+r" (block)
  362. : "r"((long)line_size)
  363. : "%"REG_a, "memory"
  364. );
  365. }
  366. static void put_pixels8_mmx(uint8_t *block, const uint8_t *pixels, int line_size, int h)
  367. {
  368. __asm __volatile(
  369. "lea (%3, %3), %%"REG_a" \n\t"
  370. ASMALIGN(3)
  371. "1: \n\t"
  372. "movq (%1), %%mm0 \n\t"
  373. "movq (%1, %3), %%mm1 \n\t"
  374. "movq %%mm0, (%2) \n\t"
  375. "movq %%mm1, (%2, %3) \n\t"
  376. "add %%"REG_a", %1 \n\t"
  377. "add %%"REG_a", %2 \n\t"
  378. "movq (%1), %%mm0 \n\t"
  379. "movq (%1, %3), %%mm1 \n\t"
  380. "movq %%mm0, (%2) \n\t"
  381. "movq %%mm1, (%2, %3) \n\t"
  382. "add %%"REG_a", %1 \n\t"
  383. "add %%"REG_a", %2 \n\t"
  384. "subl $4, %0 \n\t"
  385. "jnz 1b \n\t"
  386. : "+g"(h), "+r" (pixels), "+r" (block)
  387. : "r"((long)line_size)
  388. : "%"REG_a, "memory"
  389. );
  390. }
  391. static void put_pixels16_mmx(uint8_t *block, const uint8_t *pixels, int line_size, int h)
  392. {
  393. __asm __volatile(
  394. "lea (%3, %3), %%"REG_a" \n\t"
  395. ASMALIGN(3)
  396. "1: \n\t"
  397. "movq (%1), %%mm0 \n\t"
  398. "movq 8(%1), %%mm4 \n\t"
  399. "movq (%1, %3), %%mm1 \n\t"
  400. "movq 8(%1, %3), %%mm5 \n\t"
  401. "movq %%mm0, (%2) \n\t"
  402. "movq %%mm4, 8(%2) \n\t"
  403. "movq %%mm1, (%2, %3) \n\t"
  404. "movq %%mm5, 8(%2, %3) \n\t"
  405. "add %%"REG_a", %1 \n\t"
  406. "add %%"REG_a", %2 \n\t"
  407. "movq (%1), %%mm0 \n\t"
  408. "movq 8(%1), %%mm4 \n\t"
  409. "movq (%1, %3), %%mm1 \n\t"
  410. "movq 8(%1, %3), %%mm5 \n\t"
  411. "movq %%mm0, (%2) \n\t"
  412. "movq %%mm4, 8(%2) \n\t"
  413. "movq %%mm1, (%2, %3) \n\t"
  414. "movq %%mm5, 8(%2, %3) \n\t"
  415. "add %%"REG_a", %1 \n\t"
  416. "add %%"REG_a", %2 \n\t"
  417. "subl $4, %0 \n\t"
  418. "jnz 1b \n\t"
  419. : "+g"(h), "+r" (pixels), "+r" (block)
  420. : "r"((long)line_size)
  421. : "%"REG_a, "memory"
  422. );
  423. }
  424. static void clear_blocks_mmx(DCTELEM *blocks)
  425. {
  426. __asm __volatile(
  427. "pxor %%mm7, %%mm7 \n\t"
  428. "mov $-128*6, %%"REG_a" \n\t"
  429. "1: \n\t"
  430. "movq %%mm7, (%0, %%"REG_a") \n\t"
  431. "movq %%mm7, 8(%0, %%"REG_a") \n\t"
  432. "movq %%mm7, 16(%0, %%"REG_a") \n\t"
  433. "movq %%mm7, 24(%0, %%"REG_a") \n\t"
  434. "add $32, %%"REG_a" \n\t"
  435. " js 1b \n\t"
  436. : : "r" (((uint8_t *)blocks)+128*6)
  437. : "%"REG_a
  438. );
  439. }
  440. #ifdef CONFIG_ENCODERS
  441. static int pix_sum16_mmx(uint8_t * pix, int line_size){
  442. const int h=16;
  443. int sum;
  444. long index= -line_size*h;
  445. __asm __volatile(
  446. "pxor %%mm7, %%mm7 \n\t"
  447. "pxor %%mm6, %%mm6 \n\t"
  448. "1: \n\t"
  449. "movq (%2, %1), %%mm0 \n\t"
  450. "movq (%2, %1), %%mm1 \n\t"
  451. "movq 8(%2, %1), %%mm2 \n\t"
  452. "movq 8(%2, %1), %%mm3 \n\t"
  453. "punpcklbw %%mm7, %%mm0 \n\t"
  454. "punpckhbw %%mm7, %%mm1 \n\t"
  455. "punpcklbw %%mm7, %%mm2 \n\t"
  456. "punpckhbw %%mm7, %%mm3 \n\t"
  457. "paddw %%mm0, %%mm1 \n\t"
  458. "paddw %%mm2, %%mm3 \n\t"
  459. "paddw %%mm1, %%mm3 \n\t"
  460. "paddw %%mm3, %%mm6 \n\t"
  461. "add %3, %1 \n\t"
  462. " js 1b \n\t"
  463. "movq %%mm6, %%mm5 \n\t"
  464. "psrlq $32, %%mm6 \n\t"
  465. "paddw %%mm5, %%mm6 \n\t"
  466. "movq %%mm6, %%mm5 \n\t"
  467. "psrlq $16, %%mm6 \n\t"
  468. "paddw %%mm5, %%mm6 \n\t"
  469. "movd %%mm6, %0 \n\t"
  470. "andl $0xFFFF, %0 \n\t"
  471. : "=&r" (sum), "+r" (index)
  472. : "r" (pix - index), "r" ((long)line_size)
  473. );
  474. return sum;
  475. }
  476. #endif //CONFIG_ENCODERS
  477. static void add_bytes_mmx(uint8_t *dst, uint8_t *src, int w){
  478. long i=0;
  479. asm volatile(
  480. "1: \n\t"
  481. "movq (%1, %0), %%mm0 \n\t"
  482. "movq (%2, %0), %%mm1 \n\t"
  483. "paddb %%mm0, %%mm1 \n\t"
  484. "movq %%mm1, (%2, %0) \n\t"
  485. "movq 8(%1, %0), %%mm0 \n\t"
  486. "movq 8(%2, %0), %%mm1 \n\t"
  487. "paddb %%mm0, %%mm1 \n\t"
  488. "movq %%mm1, 8(%2, %0) \n\t"
  489. "add $16, %0 \n\t"
  490. "cmp %3, %0 \n\t"
  491. " jb 1b \n\t"
  492. : "+r" (i)
  493. : "r"(src), "r"(dst), "r"((long)w-15)
  494. );
  495. for(; i<w; i++)
  496. dst[i+0] += src[i+0];
  497. }
  498. #define H263_LOOP_FILTER \
  499. "pxor %%mm7, %%mm7 \n\t"\
  500. "movq %0, %%mm0 \n\t"\
  501. "movq %0, %%mm1 \n\t"\
  502. "movq %3, %%mm2 \n\t"\
  503. "movq %3, %%mm3 \n\t"\
  504. "punpcklbw %%mm7, %%mm0 \n\t"\
  505. "punpckhbw %%mm7, %%mm1 \n\t"\
  506. "punpcklbw %%mm7, %%mm2 \n\t"\
  507. "punpckhbw %%mm7, %%mm3 \n\t"\
  508. "psubw %%mm2, %%mm0 \n\t"\
  509. "psubw %%mm3, %%mm1 \n\t"\
  510. "movq %1, %%mm2 \n\t"\
  511. "movq %1, %%mm3 \n\t"\
  512. "movq %2, %%mm4 \n\t"\
  513. "movq %2, %%mm5 \n\t"\
  514. "punpcklbw %%mm7, %%mm2 \n\t"\
  515. "punpckhbw %%mm7, %%mm3 \n\t"\
  516. "punpcklbw %%mm7, %%mm4 \n\t"\
  517. "punpckhbw %%mm7, %%mm5 \n\t"\
  518. "psubw %%mm2, %%mm4 \n\t"\
  519. "psubw %%mm3, %%mm5 \n\t"\
  520. "psllw $2, %%mm4 \n\t"\
  521. "psllw $2, %%mm5 \n\t"\
  522. "paddw %%mm0, %%mm4 \n\t"\
  523. "paddw %%mm1, %%mm5 \n\t"\
  524. "pxor %%mm6, %%mm6 \n\t"\
  525. "pcmpgtw %%mm4, %%mm6 \n\t"\
  526. "pcmpgtw %%mm5, %%mm7 \n\t"\
  527. "pxor %%mm6, %%mm4 \n\t"\
  528. "pxor %%mm7, %%mm5 \n\t"\
  529. "psubw %%mm6, %%mm4 \n\t"\
  530. "psubw %%mm7, %%mm5 \n\t"\
  531. "psrlw $3, %%mm4 \n\t"\
  532. "psrlw $3, %%mm5 \n\t"\
  533. "packuswb %%mm5, %%mm4 \n\t"\
  534. "packsswb %%mm7, %%mm6 \n\t"\
  535. "pxor %%mm7, %%mm7 \n\t"\
  536. "movd %4, %%mm2 \n\t"\
  537. "punpcklbw %%mm2, %%mm2 \n\t"\
  538. "punpcklbw %%mm2, %%mm2 \n\t"\
  539. "punpcklbw %%mm2, %%mm2 \n\t"\
  540. "psubusb %%mm4, %%mm2 \n\t"\
  541. "movq %%mm2, %%mm3 \n\t"\
  542. "psubusb %%mm4, %%mm3 \n\t"\
  543. "psubb %%mm3, %%mm2 \n\t"\
  544. "movq %1, %%mm3 \n\t"\
  545. "movq %2, %%mm4 \n\t"\
  546. "pxor %%mm6, %%mm3 \n\t"\
  547. "pxor %%mm6, %%mm4 \n\t"\
  548. "paddusb %%mm2, %%mm3 \n\t"\
  549. "psubusb %%mm2, %%mm4 \n\t"\
  550. "pxor %%mm6, %%mm3 \n\t"\
  551. "pxor %%mm6, %%mm4 \n\t"\
  552. "paddusb %%mm2, %%mm2 \n\t"\
  553. "packsswb %%mm1, %%mm0 \n\t"\
  554. "pcmpgtb %%mm0, %%mm7 \n\t"\
  555. "pxor %%mm7, %%mm0 \n\t"\
  556. "psubb %%mm7, %%mm0 \n\t"\
  557. "movq %%mm0, %%mm1 \n\t"\
  558. "psubusb %%mm2, %%mm0 \n\t"\
  559. "psubb %%mm0, %%mm1 \n\t"\
  560. "pand %5, %%mm1 \n\t"\
  561. "psrlw $2, %%mm1 \n\t"\
  562. "pxor %%mm7, %%mm1 \n\t"\
  563. "psubb %%mm7, %%mm1 \n\t"\
  564. "movq %0, %%mm5 \n\t"\
  565. "movq %3, %%mm6 \n\t"\
  566. "psubb %%mm1, %%mm5 \n\t"\
  567. "paddb %%mm1, %%mm6 \n\t"
  568. static void h263_v_loop_filter_mmx(uint8_t *src, int stride, int qscale){
  569. if(ENABLE_ANY_H263) {
  570. const int strength= ff_h263_loop_filter_strength[qscale];
  571. asm volatile(
  572. H263_LOOP_FILTER
  573. "movq %%mm3, %1 \n\t"
  574. "movq %%mm4, %2 \n\t"
  575. "movq %%mm5, %0 \n\t"
  576. "movq %%mm6, %3 \n\t"
  577. : "+m" (*(uint64_t*)(src - 2*stride)),
  578. "+m" (*(uint64_t*)(src - 1*stride)),
  579. "+m" (*(uint64_t*)(src + 0*stride)),
  580. "+m" (*(uint64_t*)(src + 1*stride))
  581. : "g" (2*strength), "m"(ff_pb_FC)
  582. );
  583. }
  584. }
  585. static inline void transpose4x4(uint8_t *dst, uint8_t *src, int dst_stride, int src_stride){
  586. asm volatile( //FIXME could save 1 instruction if done as 8x4 ...
  587. "movd %4, %%mm0 \n\t"
  588. "movd %5, %%mm1 \n\t"
  589. "movd %6, %%mm2 \n\t"
  590. "movd %7, %%mm3 \n\t"
  591. "punpcklbw %%mm1, %%mm0 \n\t"
  592. "punpcklbw %%mm3, %%mm2 \n\t"
  593. "movq %%mm0, %%mm1 \n\t"
  594. "punpcklwd %%mm2, %%mm0 \n\t"
  595. "punpckhwd %%mm2, %%mm1 \n\t"
  596. "movd %%mm0, %0 \n\t"
  597. "punpckhdq %%mm0, %%mm0 \n\t"
  598. "movd %%mm0, %1 \n\t"
  599. "movd %%mm1, %2 \n\t"
  600. "punpckhdq %%mm1, %%mm1 \n\t"
  601. "movd %%mm1, %3 \n\t"
  602. : "=m" (*(uint32_t*)(dst + 0*dst_stride)),
  603. "=m" (*(uint32_t*)(dst + 1*dst_stride)),
  604. "=m" (*(uint32_t*)(dst + 2*dst_stride)),
  605. "=m" (*(uint32_t*)(dst + 3*dst_stride))
  606. : "m" (*(uint32_t*)(src + 0*src_stride)),
  607. "m" (*(uint32_t*)(src + 1*src_stride)),
  608. "m" (*(uint32_t*)(src + 2*src_stride)),
  609. "m" (*(uint32_t*)(src + 3*src_stride))
  610. );
  611. }
  612. static void h263_h_loop_filter_mmx(uint8_t *src, int stride, int qscale){
  613. if(ENABLE_ANY_H263) {
  614. const int strength= ff_h263_loop_filter_strength[qscale];
  615. uint64_t temp[4] __attribute__ ((aligned(8)));
  616. uint8_t *btemp= (uint8_t*)temp;
  617. src -= 2;
  618. transpose4x4(btemp , src , 8, stride);
  619. transpose4x4(btemp+4, src + 4*stride, 8, stride);
  620. asm volatile(
  621. H263_LOOP_FILTER // 5 3 4 6
  622. : "+m" (temp[0]),
  623. "+m" (temp[1]),
  624. "+m" (temp[2]),
  625. "+m" (temp[3])
  626. : "g" (2*strength), "m"(ff_pb_FC)
  627. );
  628. asm volatile(
  629. "movq %%mm5, %%mm1 \n\t"
  630. "movq %%mm4, %%mm0 \n\t"
  631. "punpcklbw %%mm3, %%mm5 \n\t"
  632. "punpcklbw %%mm6, %%mm4 \n\t"
  633. "punpckhbw %%mm3, %%mm1 \n\t"
  634. "punpckhbw %%mm6, %%mm0 \n\t"
  635. "movq %%mm5, %%mm3 \n\t"
  636. "movq %%mm1, %%mm6 \n\t"
  637. "punpcklwd %%mm4, %%mm5 \n\t"
  638. "punpcklwd %%mm0, %%mm1 \n\t"
  639. "punpckhwd %%mm4, %%mm3 \n\t"
  640. "punpckhwd %%mm0, %%mm6 \n\t"
  641. "movd %%mm5, (%0) \n\t"
  642. "punpckhdq %%mm5, %%mm5 \n\t"
  643. "movd %%mm5, (%0,%2) \n\t"
  644. "movd %%mm3, (%0,%2,2) \n\t"
  645. "punpckhdq %%mm3, %%mm3 \n\t"
  646. "movd %%mm3, (%0,%3) \n\t"
  647. "movd %%mm1, (%1) \n\t"
  648. "punpckhdq %%mm1, %%mm1 \n\t"
  649. "movd %%mm1, (%1,%2) \n\t"
  650. "movd %%mm6, (%1,%2,2) \n\t"
  651. "punpckhdq %%mm6, %%mm6 \n\t"
  652. "movd %%mm6, (%1,%3) \n\t"
  653. :: "r" (src),
  654. "r" (src + 4*stride),
  655. "r" ((long) stride ),
  656. "r" ((long)(3*stride))
  657. );
  658. }
  659. }
  660. #ifdef CONFIG_ENCODERS
  661. static int pix_norm1_mmx(uint8_t *pix, int line_size) {
  662. int tmp;
  663. asm volatile (
  664. "movl $16,%%ecx\n"
  665. "pxor %%mm0,%%mm0\n"
  666. "pxor %%mm7,%%mm7\n"
  667. "1:\n"
  668. "movq (%0),%%mm2\n" /* mm2 = pix[0-7] */
  669. "movq 8(%0),%%mm3\n" /* mm3 = pix[8-15] */
  670. "movq %%mm2,%%mm1\n" /* mm1 = mm2 = pix[0-7] */
  671. "punpckhbw %%mm0,%%mm1\n" /* mm1 = [pix4-7] */
  672. "punpcklbw %%mm0,%%mm2\n" /* mm2 = [pix0-3] */
  673. "movq %%mm3,%%mm4\n" /* mm4 = mm3 = pix[8-15] */
  674. "punpckhbw %%mm0,%%mm3\n" /* mm3 = [pix12-15] */
  675. "punpcklbw %%mm0,%%mm4\n" /* mm4 = [pix8-11] */
  676. "pmaddwd %%mm1,%%mm1\n" /* mm1 = (pix0^2+pix1^2,pix2^2+pix3^2) */
  677. "pmaddwd %%mm2,%%mm2\n" /* mm2 = (pix4^2+pix5^2,pix6^2+pix7^2) */
  678. "pmaddwd %%mm3,%%mm3\n"
  679. "pmaddwd %%mm4,%%mm4\n"
  680. "paddd %%mm1,%%mm2\n" /* mm2 = (pix0^2+pix1^2+pix4^2+pix5^2,
  681. pix2^2+pix3^2+pix6^2+pix7^2) */
  682. "paddd %%mm3,%%mm4\n"
  683. "paddd %%mm2,%%mm7\n"
  684. "add %2, %0\n"
  685. "paddd %%mm4,%%mm7\n"
  686. "dec %%ecx\n"
  687. "jnz 1b\n"
  688. "movq %%mm7,%%mm1\n"
  689. "psrlq $32, %%mm7\n" /* shift hi dword to lo */
  690. "paddd %%mm7,%%mm1\n"
  691. "movd %%mm1,%1\n"
  692. : "+r" (pix), "=r"(tmp) : "r" ((long)line_size) : "%ecx" );
  693. return tmp;
  694. }
  695. static int sse8_mmx(void *v, uint8_t * pix1, uint8_t * pix2, int line_size, int h) {
  696. int tmp;
  697. asm volatile (
  698. "movl %4,%%ecx\n"
  699. "shr $1,%%ecx\n"
  700. "pxor %%mm0,%%mm0\n" /* mm0 = 0 */
  701. "pxor %%mm7,%%mm7\n" /* mm7 holds the sum */
  702. "1:\n"
  703. "movq (%0),%%mm1\n" /* mm1 = pix1[0][0-7] */
  704. "movq (%1),%%mm2\n" /* mm2 = pix2[0][0-7] */
  705. "movq (%0,%3),%%mm3\n" /* mm3 = pix1[1][0-7] */
  706. "movq (%1,%3),%%mm4\n" /* mm4 = pix2[1][0-7] */
  707. /* todo: mm1-mm2, mm3-mm4 */
  708. /* algo: substract mm1 from mm2 with saturation and vice versa */
  709. /* OR the results to get absolute difference */
  710. "movq %%mm1,%%mm5\n"
  711. "movq %%mm3,%%mm6\n"
  712. "psubusb %%mm2,%%mm1\n"
  713. "psubusb %%mm4,%%mm3\n"
  714. "psubusb %%mm5,%%mm2\n"
  715. "psubusb %%mm6,%%mm4\n"
  716. "por %%mm1,%%mm2\n"
  717. "por %%mm3,%%mm4\n"
  718. /* now convert to 16-bit vectors so we can square them */
  719. "movq %%mm2,%%mm1\n"
  720. "movq %%mm4,%%mm3\n"
  721. "punpckhbw %%mm0,%%mm2\n"
  722. "punpckhbw %%mm0,%%mm4\n"
  723. "punpcklbw %%mm0,%%mm1\n" /* mm1 now spread over (mm1,mm2) */
  724. "punpcklbw %%mm0,%%mm3\n" /* mm4 now spread over (mm3,mm4) */
  725. "pmaddwd %%mm2,%%mm2\n"
  726. "pmaddwd %%mm4,%%mm4\n"
  727. "pmaddwd %%mm1,%%mm1\n"
  728. "pmaddwd %%mm3,%%mm3\n"
  729. "lea (%0,%3,2), %0\n" /* pix1 += 2*line_size */
  730. "lea (%1,%3,2), %1\n" /* pix2 += 2*line_size */
  731. "paddd %%mm2,%%mm1\n"
  732. "paddd %%mm4,%%mm3\n"
  733. "paddd %%mm1,%%mm7\n"
  734. "paddd %%mm3,%%mm7\n"
  735. "decl %%ecx\n"
  736. "jnz 1b\n"
  737. "movq %%mm7,%%mm1\n"
  738. "psrlq $32, %%mm7\n" /* shift hi dword to lo */
  739. "paddd %%mm7,%%mm1\n"
  740. "movd %%mm1,%2\n"
  741. : "+r" (pix1), "+r" (pix2), "=r"(tmp)
  742. : "r" ((long)line_size) , "m" (h)
  743. : "%ecx");
  744. return tmp;
  745. }
  746. static int sse16_mmx(void *v, uint8_t * pix1, uint8_t * pix2, int line_size, int h) {
  747. int tmp;
  748. asm volatile (
  749. "movl %4,%%ecx\n"
  750. "pxor %%mm0,%%mm0\n" /* mm0 = 0 */
  751. "pxor %%mm7,%%mm7\n" /* mm7 holds the sum */
  752. "1:\n"
  753. "movq (%0),%%mm1\n" /* mm1 = pix1[0-7] */
  754. "movq (%1),%%mm2\n" /* mm2 = pix2[0-7] */
  755. "movq 8(%0),%%mm3\n" /* mm3 = pix1[8-15] */
  756. "movq 8(%1),%%mm4\n" /* mm4 = pix2[8-15] */
  757. /* todo: mm1-mm2, mm3-mm4 */
  758. /* algo: substract mm1 from mm2 with saturation and vice versa */
  759. /* OR the results to get absolute difference */
  760. "movq %%mm1,%%mm5\n"
  761. "movq %%mm3,%%mm6\n"
  762. "psubusb %%mm2,%%mm1\n"
  763. "psubusb %%mm4,%%mm3\n"
  764. "psubusb %%mm5,%%mm2\n"
  765. "psubusb %%mm6,%%mm4\n"
  766. "por %%mm1,%%mm2\n"
  767. "por %%mm3,%%mm4\n"
  768. /* now convert to 16-bit vectors so we can square them */
  769. "movq %%mm2,%%mm1\n"
  770. "movq %%mm4,%%mm3\n"
  771. "punpckhbw %%mm0,%%mm2\n"
  772. "punpckhbw %%mm0,%%mm4\n"
  773. "punpcklbw %%mm0,%%mm1\n" /* mm1 now spread over (mm1,mm2) */
  774. "punpcklbw %%mm0,%%mm3\n" /* mm4 now spread over (mm3,mm4) */
  775. "pmaddwd %%mm2,%%mm2\n"
  776. "pmaddwd %%mm4,%%mm4\n"
  777. "pmaddwd %%mm1,%%mm1\n"
  778. "pmaddwd %%mm3,%%mm3\n"
  779. "add %3,%0\n"
  780. "add %3,%1\n"
  781. "paddd %%mm2,%%mm1\n"
  782. "paddd %%mm4,%%mm3\n"
  783. "paddd %%mm1,%%mm7\n"
  784. "paddd %%mm3,%%mm7\n"
  785. "decl %%ecx\n"
  786. "jnz 1b\n"
  787. "movq %%mm7,%%mm1\n"
  788. "psrlq $32, %%mm7\n" /* shift hi dword to lo */
  789. "paddd %%mm7,%%mm1\n"
  790. "movd %%mm1,%2\n"
  791. : "+r" (pix1), "+r" (pix2), "=r"(tmp)
  792. : "r" ((long)line_size) , "m" (h)
  793. : "%ecx");
  794. return tmp;
  795. }
  796. static int sse16_sse2(void *v, uint8_t * pix1, uint8_t * pix2, int line_size, int h) {
  797. int tmp;
  798. asm volatile (
  799. "shr $1,%2\n"
  800. "pxor %%xmm0,%%xmm0\n" /* mm0 = 0 */
  801. "pxor %%xmm7,%%xmm7\n" /* mm7 holds the sum */
  802. "1:\n"
  803. "movdqu (%0),%%xmm1\n" /* mm1 = pix1[0][0-15] */
  804. "movdqu (%1),%%xmm2\n" /* mm2 = pix2[0][0-15] */
  805. "movdqu (%0,%4),%%xmm3\n" /* mm3 = pix1[1][0-15] */
  806. "movdqu (%1,%4),%%xmm4\n" /* mm4 = pix2[1][0-15] */
  807. /* todo: mm1-mm2, mm3-mm4 */
  808. /* algo: substract mm1 from mm2 with saturation and vice versa */
  809. /* OR the results to get absolute difference */
  810. "movdqa %%xmm1,%%xmm5\n"
  811. "movdqa %%xmm3,%%xmm6\n"
  812. "psubusb %%xmm2,%%xmm1\n"
  813. "psubusb %%xmm4,%%xmm3\n"
  814. "psubusb %%xmm5,%%xmm2\n"
  815. "psubusb %%xmm6,%%xmm4\n"
  816. "por %%xmm1,%%xmm2\n"
  817. "por %%xmm3,%%xmm4\n"
  818. /* now convert to 16-bit vectors so we can square them */
  819. "movdqa %%xmm2,%%xmm1\n"
  820. "movdqa %%xmm4,%%xmm3\n"
  821. "punpckhbw %%xmm0,%%xmm2\n"
  822. "punpckhbw %%xmm0,%%xmm4\n"
  823. "punpcklbw %%xmm0,%%xmm1\n" /* mm1 now spread over (mm1,mm2) */
  824. "punpcklbw %%xmm0,%%xmm3\n" /* mm4 now spread over (mm3,mm4) */
  825. "pmaddwd %%xmm2,%%xmm2\n"
  826. "pmaddwd %%xmm4,%%xmm4\n"
  827. "pmaddwd %%xmm1,%%xmm1\n"
  828. "pmaddwd %%xmm3,%%xmm3\n"
  829. "lea (%0,%4,2), %0\n" /* pix1 += 2*line_size */
  830. "lea (%1,%4,2), %1\n" /* pix2 += 2*line_size */
  831. "paddd %%xmm2,%%xmm1\n"
  832. "paddd %%xmm4,%%xmm3\n"
  833. "paddd %%xmm1,%%xmm7\n"
  834. "paddd %%xmm3,%%xmm7\n"
  835. "decl %2\n"
  836. "jnz 1b\n"
  837. "movdqa %%xmm7,%%xmm1\n"
  838. "psrldq $8, %%xmm7\n" /* shift hi qword to lo */
  839. "paddd %%xmm1,%%xmm7\n"
  840. "movdqa %%xmm7,%%xmm1\n"
  841. "psrldq $4, %%xmm7\n" /* shift hi dword to lo */
  842. "paddd %%xmm1,%%xmm7\n"
  843. "movd %%xmm7,%3\n"
  844. : "+r" (pix1), "+r" (pix2), "+r"(h), "=r"(tmp)
  845. : "r" ((long)line_size));
  846. return tmp;
  847. }
  848. static int hf_noise8_mmx(uint8_t * pix1, int line_size, int h) {
  849. int tmp;
  850. asm volatile (
  851. "movl %3,%%ecx\n"
  852. "pxor %%mm7,%%mm7\n"
  853. "pxor %%mm6,%%mm6\n"
  854. "movq (%0),%%mm0\n"
  855. "movq %%mm0, %%mm1\n"
  856. "psllq $8, %%mm0\n"
  857. "psrlq $8, %%mm1\n"
  858. "psrlq $8, %%mm0\n"
  859. "movq %%mm0, %%mm2\n"
  860. "movq %%mm1, %%mm3\n"
  861. "punpcklbw %%mm7,%%mm0\n"
  862. "punpcklbw %%mm7,%%mm1\n"
  863. "punpckhbw %%mm7,%%mm2\n"
  864. "punpckhbw %%mm7,%%mm3\n"
  865. "psubw %%mm1, %%mm0\n"
  866. "psubw %%mm3, %%mm2\n"
  867. "add %2,%0\n"
  868. "movq (%0),%%mm4\n"
  869. "movq %%mm4, %%mm1\n"
  870. "psllq $8, %%mm4\n"
  871. "psrlq $8, %%mm1\n"
  872. "psrlq $8, %%mm4\n"
  873. "movq %%mm4, %%mm5\n"
  874. "movq %%mm1, %%mm3\n"
  875. "punpcklbw %%mm7,%%mm4\n"
  876. "punpcklbw %%mm7,%%mm1\n"
  877. "punpckhbw %%mm7,%%mm5\n"
  878. "punpckhbw %%mm7,%%mm3\n"
  879. "psubw %%mm1, %%mm4\n"
  880. "psubw %%mm3, %%mm5\n"
  881. "psubw %%mm4, %%mm0\n"
  882. "psubw %%mm5, %%mm2\n"
  883. "pxor %%mm3, %%mm3\n"
  884. "pxor %%mm1, %%mm1\n"
  885. "pcmpgtw %%mm0, %%mm3\n\t"
  886. "pcmpgtw %%mm2, %%mm1\n\t"
  887. "pxor %%mm3, %%mm0\n"
  888. "pxor %%mm1, %%mm2\n"
  889. "psubw %%mm3, %%mm0\n"
  890. "psubw %%mm1, %%mm2\n"
  891. "paddw %%mm0, %%mm2\n"
  892. "paddw %%mm2, %%mm6\n"
  893. "add %2,%0\n"
  894. "1:\n"
  895. "movq (%0),%%mm0\n"
  896. "movq %%mm0, %%mm1\n"
  897. "psllq $8, %%mm0\n"
  898. "psrlq $8, %%mm1\n"
  899. "psrlq $8, %%mm0\n"
  900. "movq %%mm0, %%mm2\n"
  901. "movq %%mm1, %%mm3\n"
  902. "punpcklbw %%mm7,%%mm0\n"
  903. "punpcklbw %%mm7,%%mm1\n"
  904. "punpckhbw %%mm7,%%mm2\n"
  905. "punpckhbw %%mm7,%%mm3\n"
  906. "psubw %%mm1, %%mm0\n"
  907. "psubw %%mm3, %%mm2\n"
  908. "psubw %%mm0, %%mm4\n"
  909. "psubw %%mm2, %%mm5\n"
  910. "pxor %%mm3, %%mm3\n"
  911. "pxor %%mm1, %%mm1\n"
  912. "pcmpgtw %%mm4, %%mm3\n\t"
  913. "pcmpgtw %%mm5, %%mm1\n\t"
  914. "pxor %%mm3, %%mm4\n"
  915. "pxor %%mm1, %%mm5\n"
  916. "psubw %%mm3, %%mm4\n"
  917. "psubw %%mm1, %%mm5\n"
  918. "paddw %%mm4, %%mm5\n"
  919. "paddw %%mm5, %%mm6\n"
  920. "add %2,%0\n"
  921. "movq (%0),%%mm4\n"
  922. "movq %%mm4, %%mm1\n"
  923. "psllq $8, %%mm4\n"
  924. "psrlq $8, %%mm1\n"
  925. "psrlq $8, %%mm4\n"
  926. "movq %%mm4, %%mm5\n"
  927. "movq %%mm1, %%mm3\n"
  928. "punpcklbw %%mm7,%%mm4\n"
  929. "punpcklbw %%mm7,%%mm1\n"
  930. "punpckhbw %%mm7,%%mm5\n"
  931. "punpckhbw %%mm7,%%mm3\n"
  932. "psubw %%mm1, %%mm4\n"
  933. "psubw %%mm3, %%mm5\n"
  934. "psubw %%mm4, %%mm0\n"
  935. "psubw %%mm5, %%mm2\n"
  936. "pxor %%mm3, %%mm3\n"
  937. "pxor %%mm1, %%mm1\n"
  938. "pcmpgtw %%mm0, %%mm3\n\t"
  939. "pcmpgtw %%mm2, %%mm1\n\t"
  940. "pxor %%mm3, %%mm0\n"
  941. "pxor %%mm1, %%mm2\n"
  942. "psubw %%mm3, %%mm0\n"
  943. "psubw %%mm1, %%mm2\n"
  944. "paddw %%mm0, %%mm2\n"
  945. "paddw %%mm2, %%mm6\n"
  946. "add %2,%0\n"
  947. "subl $2, %%ecx\n"
  948. " jnz 1b\n"
  949. "movq %%mm6, %%mm0\n"
  950. "punpcklwd %%mm7,%%mm0\n"
  951. "punpckhwd %%mm7,%%mm6\n"
  952. "paddd %%mm0, %%mm6\n"
  953. "movq %%mm6,%%mm0\n"
  954. "psrlq $32, %%mm6\n"
  955. "paddd %%mm6,%%mm0\n"
  956. "movd %%mm0,%1\n"
  957. : "+r" (pix1), "=r"(tmp)
  958. : "r" ((long)line_size) , "g" (h-2)
  959. : "%ecx");
  960. return tmp;
  961. }
  962. static int hf_noise16_mmx(uint8_t * pix1, int line_size, int h) {
  963. int tmp;
  964. uint8_t * pix= pix1;
  965. asm volatile (
  966. "movl %3,%%ecx\n"
  967. "pxor %%mm7,%%mm7\n"
  968. "pxor %%mm6,%%mm6\n"
  969. "movq (%0),%%mm0\n"
  970. "movq 1(%0),%%mm1\n"
  971. "movq %%mm0, %%mm2\n"
  972. "movq %%mm1, %%mm3\n"
  973. "punpcklbw %%mm7,%%mm0\n"
  974. "punpcklbw %%mm7,%%mm1\n"
  975. "punpckhbw %%mm7,%%mm2\n"
  976. "punpckhbw %%mm7,%%mm3\n"
  977. "psubw %%mm1, %%mm0\n"
  978. "psubw %%mm3, %%mm2\n"
  979. "add %2,%0\n"
  980. "movq (%0),%%mm4\n"
  981. "movq 1(%0),%%mm1\n"
  982. "movq %%mm4, %%mm5\n"
  983. "movq %%mm1, %%mm3\n"
  984. "punpcklbw %%mm7,%%mm4\n"
  985. "punpcklbw %%mm7,%%mm1\n"
  986. "punpckhbw %%mm7,%%mm5\n"
  987. "punpckhbw %%mm7,%%mm3\n"
  988. "psubw %%mm1, %%mm4\n"
  989. "psubw %%mm3, %%mm5\n"
  990. "psubw %%mm4, %%mm0\n"
  991. "psubw %%mm5, %%mm2\n"
  992. "pxor %%mm3, %%mm3\n"
  993. "pxor %%mm1, %%mm1\n"
  994. "pcmpgtw %%mm0, %%mm3\n\t"
  995. "pcmpgtw %%mm2, %%mm1\n\t"
  996. "pxor %%mm3, %%mm0\n"
  997. "pxor %%mm1, %%mm2\n"
  998. "psubw %%mm3, %%mm0\n"
  999. "psubw %%mm1, %%mm2\n"
  1000. "paddw %%mm0, %%mm2\n"
  1001. "paddw %%mm2, %%mm6\n"
  1002. "add %2,%0\n"
  1003. "1:\n"
  1004. "movq (%0),%%mm0\n"
  1005. "movq 1(%0),%%mm1\n"
  1006. "movq %%mm0, %%mm2\n"
  1007. "movq %%mm1, %%mm3\n"
  1008. "punpcklbw %%mm7,%%mm0\n"
  1009. "punpcklbw %%mm7,%%mm1\n"
  1010. "punpckhbw %%mm7,%%mm2\n"
  1011. "punpckhbw %%mm7,%%mm3\n"
  1012. "psubw %%mm1, %%mm0\n"
  1013. "psubw %%mm3, %%mm2\n"
  1014. "psubw %%mm0, %%mm4\n"
  1015. "psubw %%mm2, %%mm5\n"
  1016. "pxor %%mm3, %%mm3\n"
  1017. "pxor %%mm1, %%mm1\n"
  1018. "pcmpgtw %%mm4, %%mm3\n\t"
  1019. "pcmpgtw %%mm5, %%mm1\n\t"
  1020. "pxor %%mm3, %%mm4\n"
  1021. "pxor %%mm1, %%mm5\n"
  1022. "psubw %%mm3, %%mm4\n"
  1023. "psubw %%mm1, %%mm5\n"
  1024. "paddw %%mm4, %%mm5\n"
  1025. "paddw %%mm5, %%mm6\n"
  1026. "add %2,%0\n"
  1027. "movq (%0),%%mm4\n"
  1028. "movq 1(%0),%%mm1\n"
  1029. "movq %%mm4, %%mm5\n"
  1030. "movq %%mm1, %%mm3\n"
  1031. "punpcklbw %%mm7,%%mm4\n"
  1032. "punpcklbw %%mm7,%%mm1\n"
  1033. "punpckhbw %%mm7,%%mm5\n"
  1034. "punpckhbw %%mm7,%%mm3\n"
  1035. "psubw %%mm1, %%mm4\n"
  1036. "psubw %%mm3, %%mm5\n"
  1037. "psubw %%mm4, %%mm0\n"
  1038. "psubw %%mm5, %%mm2\n"
  1039. "pxor %%mm3, %%mm3\n"
  1040. "pxor %%mm1, %%mm1\n"
  1041. "pcmpgtw %%mm0, %%mm3\n\t"
  1042. "pcmpgtw %%mm2, %%mm1\n\t"
  1043. "pxor %%mm3, %%mm0\n"
  1044. "pxor %%mm1, %%mm2\n"
  1045. "psubw %%mm3, %%mm0\n"
  1046. "psubw %%mm1, %%mm2\n"
  1047. "paddw %%mm0, %%mm2\n"
  1048. "paddw %%mm2, %%mm6\n"
  1049. "add %2,%0\n"
  1050. "subl $2, %%ecx\n"
  1051. " jnz 1b\n"
  1052. "movq %%mm6, %%mm0\n"
  1053. "punpcklwd %%mm7,%%mm0\n"
  1054. "punpckhwd %%mm7,%%mm6\n"
  1055. "paddd %%mm0, %%mm6\n"
  1056. "movq %%mm6,%%mm0\n"
  1057. "psrlq $32, %%mm6\n"
  1058. "paddd %%mm6,%%mm0\n"
  1059. "movd %%mm0,%1\n"
  1060. : "+r" (pix1), "=r"(tmp)
  1061. : "r" ((long)line_size) , "g" (h-2)
  1062. : "%ecx");
  1063. return tmp + hf_noise8_mmx(pix+8, line_size, h);
  1064. }
  1065. static int nsse16_mmx(void *p, uint8_t * pix1, uint8_t * pix2, int line_size, int h) {
  1066. MpegEncContext *c = p;
  1067. int score1, score2;
  1068. if(c) score1 = c->dsp.sse[0](c, pix1, pix2, line_size, h);
  1069. else score1 = sse16_mmx(c, pix1, pix2, line_size, h);
  1070. score2= hf_noise16_mmx(pix1, line_size, h) - hf_noise16_mmx(pix2, line_size, h);
  1071. if(c) return score1 + FFABS(score2)*c->avctx->nsse_weight;
  1072. else return score1 + FFABS(score2)*8;
  1073. }
  1074. static int nsse8_mmx(void *p, uint8_t * pix1, uint8_t * pix2, int line_size, int h) {
  1075. MpegEncContext *c = p;
  1076. int score1= sse8_mmx(c, pix1, pix2, line_size, h);
  1077. int score2= hf_noise8_mmx(pix1, line_size, h) - hf_noise8_mmx(pix2, line_size, h);
  1078. if(c) return score1 + FFABS(score2)*c->avctx->nsse_weight;
  1079. else return score1 + FFABS(score2)*8;
  1080. }
  1081. static int vsad_intra16_mmx(void *v, uint8_t * pix, uint8_t * dummy, int line_size, int h) {
  1082. int tmp;
  1083. assert( (((int)pix) & 7) == 0);
  1084. assert((line_size &7) ==0);
  1085. #define SUM(in0, in1, out0, out1) \
  1086. "movq (%0), %%mm2\n"\
  1087. "movq 8(%0), %%mm3\n"\
  1088. "add %2,%0\n"\
  1089. "movq %%mm2, " #out0 "\n"\
  1090. "movq %%mm3, " #out1 "\n"\
  1091. "psubusb " #in0 ", %%mm2\n"\
  1092. "psubusb " #in1 ", %%mm3\n"\
  1093. "psubusb " #out0 ", " #in0 "\n"\
  1094. "psubusb " #out1 ", " #in1 "\n"\
  1095. "por %%mm2, " #in0 "\n"\
  1096. "por %%mm3, " #in1 "\n"\
  1097. "movq " #in0 ", %%mm2\n"\
  1098. "movq " #in1 ", %%mm3\n"\
  1099. "punpcklbw %%mm7, " #in0 "\n"\
  1100. "punpcklbw %%mm7, " #in1 "\n"\
  1101. "punpckhbw %%mm7, %%mm2\n"\
  1102. "punpckhbw %%mm7, %%mm3\n"\
  1103. "paddw " #in1 ", " #in0 "\n"\
  1104. "paddw %%mm3, %%mm2\n"\
  1105. "paddw %%mm2, " #in0 "\n"\
  1106. "paddw " #in0 ", %%mm6\n"
  1107. asm volatile (
  1108. "movl %3,%%ecx\n"
  1109. "pxor %%mm6,%%mm6\n"
  1110. "pxor %%mm7,%%mm7\n"
  1111. "movq (%0),%%mm0\n"
  1112. "movq 8(%0),%%mm1\n"
  1113. "add %2,%0\n"
  1114. "subl $2, %%ecx\n"
  1115. SUM(%%mm0, %%mm1, %%mm4, %%mm5)
  1116. "1:\n"
  1117. SUM(%%mm4, %%mm5, %%mm0, %%mm1)
  1118. SUM(%%mm0, %%mm1, %%mm4, %%mm5)
  1119. "subl $2, %%ecx\n"
  1120. "jnz 1b\n"
  1121. "movq %%mm6,%%mm0\n"
  1122. "psrlq $32, %%mm6\n"
  1123. "paddw %%mm6,%%mm0\n"
  1124. "movq %%mm0,%%mm6\n"
  1125. "psrlq $16, %%mm0\n"
  1126. "paddw %%mm6,%%mm0\n"
  1127. "movd %%mm0,%1\n"
  1128. : "+r" (pix), "=r"(tmp)
  1129. : "r" ((long)line_size) , "m" (h)
  1130. : "%ecx");
  1131. return tmp & 0xFFFF;
  1132. }
  1133. #undef SUM
  1134. static int vsad_intra16_mmx2(void *v, uint8_t * pix, uint8_t * dummy, int line_size, int h) {
  1135. int tmp;
  1136. assert( (((int)pix) & 7) == 0);
  1137. assert((line_size &7) ==0);
  1138. #define SUM(in0, in1, out0, out1) \
  1139. "movq (%0), " #out0 "\n"\
  1140. "movq 8(%0), " #out1 "\n"\
  1141. "add %2,%0\n"\
  1142. "psadbw " #out0 ", " #in0 "\n"\
  1143. "psadbw " #out1 ", " #in1 "\n"\
  1144. "paddw " #in1 ", " #in0 "\n"\
  1145. "paddw " #in0 ", %%mm6\n"
  1146. asm volatile (
  1147. "movl %3,%%ecx\n"
  1148. "pxor %%mm6,%%mm6\n"
  1149. "pxor %%mm7,%%mm7\n"
  1150. "movq (%0),%%mm0\n"
  1151. "movq 8(%0),%%mm1\n"
  1152. "add %2,%0\n"
  1153. "subl $2, %%ecx\n"
  1154. SUM(%%mm0, %%mm1, %%mm4, %%mm5)
  1155. "1:\n"
  1156. SUM(%%mm4, %%mm5, %%mm0, %%mm1)
  1157. SUM(%%mm0, %%mm1, %%mm4, %%mm5)
  1158. "subl $2, %%ecx\n"
  1159. "jnz 1b\n"
  1160. "movd %%mm6,%1\n"
  1161. : "+r" (pix), "=r"(tmp)
  1162. : "r" ((long)line_size) , "m" (h)
  1163. : "%ecx");
  1164. return tmp;
  1165. }
  1166. #undef SUM
  1167. static int vsad16_mmx(void *v, uint8_t * pix1, uint8_t * pix2, int line_size, int h) {
  1168. int tmp;
  1169. assert( (((int)pix1) & 7) == 0);
  1170. assert( (((int)pix2) & 7) == 0);
  1171. assert((line_size &7) ==0);
  1172. #define SUM(in0, in1, out0, out1) \
  1173. "movq (%0),%%mm2\n"\
  1174. "movq (%1)," #out0 "\n"\
  1175. "movq 8(%0),%%mm3\n"\
  1176. "movq 8(%1)," #out1 "\n"\
  1177. "add %3,%0\n"\
  1178. "add %3,%1\n"\
  1179. "psubb " #out0 ", %%mm2\n"\
  1180. "psubb " #out1 ", %%mm3\n"\
  1181. "pxor %%mm7, %%mm2\n"\
  1182. "pxor %%mm7, %%mm3\n"\
  1183. "movq %%mm2, " #out0 "\n"\
  1184. "movq %%mm3, " #out1 "\n"\
  1185. "psubusb " #in0 ", %%mm2\n"\
  1186. "psubusb " #in1 ", %%mm3\n"\
  1187. "psubusb " #out0 ", " #in0 "\n"\
  1188. "psubusb " #out1 ", " #in1 "\n"\
  1189. "por %%mm2, " #in0 "\n"\
  1190. "por %%mm3, " #in1 "\n"\
  1191. "movq " #in0 ", %%mm2\n"\
  1192. "movq " #in1 ", %%mm3\n"\
  1193. "punpcklbw %%mm7, " #in0 "\n"\
  1194. "punpcklbw %%mm7, " #in1 "\n"\
  1195. "punpckhbw %%mm7, %%mm2\n"\
  1196. "punpckhbw %%mm7, %%mm3\n"\
  1197. "paddw " #in1 ", " #in0 "\n"\
  1198. "paddw %%mm3, %%mm2\n"\
  1199. "paddw %%mm2, " #in0 "\n"\
  1200. "paddw " #in0 ", %%mm6\n"
  1201. asm volatile (
  1202. "movl %4,%%ecx\n"
  1203. "pxor %%mm6,%%mm6\n"
  1204. "pcmpeqw %%mm7,%%mm7\n"
  1205. "psllw $15, %%mm7\n"
  1206. "packsswb %%mm7, %%mm7\n"
  1207. "movq (%0),%%mm0\n"
  1208. "movq (%1),%%mm2\n"
  1209. "movq 8(%0),%%mm1\n"
  1210. "movq 8(%1),%%mm3\n"
  1211. "add %3,%0\n"
  1212. "add %3,%1\n"
  1213. "subl $2, %%ecx\n"
  1214. "psubb %%mm2, %%mm0\n"
  1215. "psubb %%mm3, %%mm1\n"
  1216. "pxor %%mm7, %%mm0\n"
  1217. "pxor %%mm7, %%mm1\n"
  1218. SUM(%%mm0, %%mm1, %%mm4, %%mm5)
  1219. "1:\n"
  1220. SUM(%%mm4, %%mm5, %%mm0, %%mm1)
  1221. SUM(%%mm0, %%mm1, %%mm4, %%mm5)
  1222. "subl $2, %%ecx\n"
  1223. "jnz 1b\n"
  1224. "movq %%mm6,%%mm0\n"
  1225. "psrlq $32, %%mm6\n"
  1226. "paddw %%mm6,%%mm0\n"
  1227. "movq %%mm0,%%mm6\n"
  1228. "psrlq $16, %%mm0\n"
  1229. "paddw %%mm6,%%mm0\n"
  1230. "movd %%mm0,%2\n"
  1231. : "+r" (pix1), "+r" (pix2), "=r"(tmp)
  1232. : "r" ((long)line_size) , "m" (h)
  1233. : "%ecx");
  1234. return tmp & 0x7FFF;
  1235. }
  1236. #undef SUM
  1237. static int vsad16_mmx2(void *v, uint8_t * pix1, uint8_t * pix2, int line_size, int h) {
  1238. int tmp;
  1239. assert( (((int)pix1) & 7) == 0);
  1240. assert( (((int)pix2) & 7) == 0);
  1241. assert((line_size &7) ==0);
  1242. #define SUM(in0, in1, out0, out1) \
  1243. "movq (%0)," #out0 "\n"\
  1244. "movq (%1),%%mm2\n"\
  1245. "movq 8(%0)," #out1 "\n"\
  1246. "movq 8(%1),%%mm3\n"\
  1247. "add %3,%0\n"\
  1248. "add %3,%1\n"\
  1249. "psubb %%mm2, " #out0 "\n"\
  1250. "psubb %%mm3, " #out1 "\n"\
  1251. "pxor %%mm7, " #out0 "\n"\
  1252. "pxor %%mm7, " #out1 "\n"\
  1253. "psadbw " #out0 ", " #in0 "\n"\
  1254. "psadbw " #out1 ", " #in1 "\n"\
  1255. "paddw " #in1 ", " #in0 "\n"\
  1256. "paddw " #in0 ", %%mm6\n"
  1257. asm volatile (
  1258. "movl %4,%%ecx\n"
  1259. "pxor %%mm6,%%mm6\n"
  1260. "pcmpeqw %%mm7,%%mm7\n"
  1261. "psllw $15, %%mm7\n"
  1262. "packsswb %%mm7, %%mm7\n"
  1263. "movq (%0),%%mm0\n"
  1264. "movq (%1),%%mm2\n"
  1265. "movq 8(%0),%%mm1\n"
  1266. "movq 8(%1),%%mm3\n"
  1267. "add %3,%0\n"
  1268. "add %3,%1\n"
  1269. "subl $2, %%ecx\n"
  1270. "psubb %%mm2, %%mm0\n"
  1271. "psubb %%mm3, %%mm1\n"
  1272. "pxor %%mm7, %%mm0\n"
  1273. "pxor %%mm7, %%mm1\n"
  1274. SUM(%%mm0, %%mm1, %%mm4, %%mm5)
  1275. "1:\n"
  1276. SUM(%%mm4, %%mm5, %%mm0, %%mm1)
  1277. SUM(%%mm0, %%mm1, %%mm4, %%mm5)
  1278. "subl $2, %%ecx\n"
  1279. "jnz 1b\n"
  1280. "movd %%mm6,%2\n"
  1281. : "+r" (pix1), "+r" (pix2), "=r"(tmp)
  1282. : "r" ((long)line_size) , "m" (h)
  1283. : "%ecx");
  1284. return tmp;
  1285. }
  1286. #undef SUM
  1287. static void diff_bytes_mmx(uint8_t *dst, uint8_t *src1, uint8_t *src2, int w){
  1288. long i=0;
  1289. asm volatile(
  1290. "1: \n\t"
  1291. "movq (%2, %0), %%mm0 \n\t"
  1292. "movq (%1, %0), %%mm1 \n\t"
  1293. "psubb %%mm0, %%mm1 \n\t"
  1294. "movq %%mm1, (%3, %0) \n\t"
  1295. "movq 8(%2, %0), %%mm0 \n\t"
  1296. "movq 8(%1, %0), %%mm1 \n\t"
  1297. "psubb %%mm0, %%mm1 \n\t"
  1298. "movq %%mm1, 8(%3, %0) \n\t"
  1299. "add $16, %0 \n\t"
  1300. "cmp %4, %0 \n\t"
  1301. " jb 1b \n\t"
  1302. : "+r" (i)
  1303. : "r"(src1), "r"(src2), "r"(dst), "r"((long)w-15)
  1304. );
  1305. for(; i<w; i++)
  1306. dst[i+0] = src1[i+0]-src2[i+0];
  1307. }
  1308. static void sub_hfyu_median_prediction_mmx2(uint8_t *dst, uint8_t *src1, uint8_t *src2, int w, int *left, int *left_top){
  1309. long i=0;
  1310. uint8_t l, lt;
  1311. asm volatile(
  1312. "1: \n\t"
  1313. "movq -1(%1, %0), %%mm0 \n\t" // LT
  1314. "movq (%1, %0), %%mm1 \n\t" // T
  1315. "movq -1(%2, %0), %%mm2 \n\t" // L
  1316. "movq (%2, %0), %%mm3 \n\t" // X
  1317. "movq %%mm2, %%mm4 \n\t" // L
  1318. "psubb %%mm0, %%mm2 \n\t"
  1319. "paddb %%mm1, %%mm2 \n\t" // L + T - LT
  1320. "movq %%mm4, %%mm5 \n\t" // L
  1321. "pmaxub %%mm1, %%mm4 \n\t" // max(T, L)
  1322. "pminub %%mm5, %%mm1 \n\t" // min(T, L)
  1323. "pminub %%mm2, %%mm4 \n\t"
  1324. "pmaxub %%mm1, %%mm4 \n\t"
  1325. "psubb %%mm4, %%mm3 \n\t" // dst - pred
  1326. "movq %%mm3, (%3, %0) \n\t"
  1327. "add $8, %0 \n\t"
  1328. "cmp %4, %0 \n\t"
  1329. " jb 1b \n\t"
  1330. : "+r" (i)
  1331. : "r"(src1), "r"(src2), "r"(dst), "r"((long)w)
  1332. );
  1333. l= *left;
  1334. lt= *left_top;
  1335. dst[0]= src2[0] - mid_pred(l, src1[0], (l + src1[0] - lt)&0xFF);
  1336. *left_top= src1[w-1];
  1337. *left = src2[w-1];
  1338. }
  1339. #define DIFF_PIXELS_1(m,a,t,p1,p2)\
  1340. "mov"#m" "#p1", "#a" \n\t"\
  1341. "mov"#m" "#p2", "#t" \n\t"\
  1342. "punpcklbw "#a", "#t" \n\t"\
  1343. "punpcklbw "#a", "#a" \n\t"\
  1344. "psubw "#t", "#a" \n\t"\
  1345. #define DIFF_PIXELS_8(m0,m1,mm,p1,p2,stride,temp) {\
  1346. uint8_t *p1b=p1, *p2b=p2;\
  1347. asm volatile(\
  1348. DIFF_PIXELS_1(m0, mm##0, mm##7, (%1), (%2))\
  1349. DIFF_PIXELS_1(m0, mm##1, mm##7, (%1,%3), (%2,%3))\
  1350. DIFF_PIXELS_1(m0, mm##2, mm##7, (%1,%3,2), (%2,%3,2))\
  1351. "add %4, %1 \n\t"\
  1352. "add %4, %2 \n\t"\
  1353. DIFF_PIXELS_1(m0, mm##3, mm##7, (%1), (%2))\
  1354. DIFF_PIXELS_1(m0, mm##4, mm##7, (%1,%3), (%2,%3))\
  1355. DIFF_PIXELS_1(m0, mm##5, mm##7, (%1,%3,2), (%2,%3,2))\
  1356. DIFF_PIXELS_1(m0, mm##6, mm##7, (%1,%4), (%2,%4))\
  1357. "mov"#m1" "#mm"0, %0 \n\t"\
  1358. DIFF_PIXELS_1(m0, mm##7, mm##0, (%1,%3,4), (%2,%3,4))\
  1359. "mov"#m1" %0, "#mm"0 \n\t"\
  1360. : "=m"(temp), "+r"(p1b), "+r"(p2b)\
  1361. : "r"((long)stride), "r"((long)stride*3)\
  1362. );\
  1363. }
  1364. #define DIFF_PIXELS_4x8(p1,p2,stride,temp) DIFF_PIXELS_8(d, q, %%mm, p1, p2, stride, temp)
  1365. #define DIFF_PIXELS_8x8(p1,p2,stride,temp) DIFF_PIXELS_8(q, dqa, %%xmm, p1, p2, stride, temp)
  1366. #ifdef ARCH_X86_64
  1367. // permutes 01234567 -> 05736421
  1368. #define TRANSPOSE8(a,b,c,d,e,f,g,h,t)\
  1369. SBUTTERFLY(a,b,%%xmm8,wd,dqa)\
  1370. SBUTTERFLY(c,d,b,wd,dqa)\
  1371. SBUTTERFLY(e,f,d,wd,dqa)\
  1372. SBUTTERFLY(g,h,f,wd,dqa)\
  1373. SBUTTERFLY(a,c,h,dq,dqa)\
  1374. SBUTTERFLY(%%xmm8,b,c,dq,dqa)\
  1375. SBUTTERFLY(e,g,b,dq,dqa)\
  1376. SBUTTERFLY(d,f,g,dq,dqa)\
  1377. SBUTTERFLY(a,e,f,qdq,dqa)\
  1378. SBUTTERFLY(%%xmm8,d,e,qdq,dqa)\
  1379. SBUTTERFLY(h,b,d,qdq,dqa)\
  1380. SBUTTERFLY(c,g,b,qdq,dqa)\
  1381. "movdqa %%xmm8, "#g" \n\t"
  1382. #else
  1383. #define TRANSPOSE8(a,b,c,d,e,f,g,h,t)\
  1384. "movdqa "#h", "#t" \n\t"\
  1385. SBUTTERFLY(a,b,h,wd,dqa)\
  1386. "movdqa "#h", 16"#t" \n\t"\
  1387. "movdqa "#t", "#h" \n\t"\
  1388. SBUTTERFLY(c,d,b,wd,dqa)\
  1389. SBUTTERFLY(e,f,d,wd,dqa)\
  1390. SBUTTERFLY(g,h,f,wd,dqa)\
  1391. SBUTTERFLY(a,c,h,dq,dqa)\
  1392. "movdqa "#h", "#t" \n\t"\
  1393. "movdqa 16"#t", "#h" \n\t"\
  1394. SBUTTERFLY(h,b,c,dq,dqa)\
  1395. SBUTTERFLY(e,g,b,dq,dqa)\
  1396. SBUTTERFLY(d,f,g,dq,dqa)\
  1397. SBUTTERFLY(a,e,f,qdq,dqa)\
  1398. SBUTTERFLY(h,d,e,qdq,dqa)\
  1399. "movdqa "#h", 16"#t" \n\t"\
  1400. "movdqa "#t", "#h" \n\t"\
  1401. SBUTTERFLY(h,b,d,qdq,dqa)\
  1402. SBUTTERFLY(c,g,b,qdq,dqa)\
  1403. "movdqa 16"#t", "#g" \n\t"
  1404. #endif
  1405. #define LBUTTERFLY2(a1,b1,a2,b2)\
  1406. "paddw " #b1 ", " #a1 " \n\t"\
  1407. "paddw " #b2 ", " #a2 " \n\t"\
  1408. "paddw " #b1 ", " #b1 " \n\t"\
  1409. "paddw " #b2 ", " #b2 " \n\t"\
  1410. "psubw " #a1 ", " #b1 " \n\t"\
  1411. "psubw " #a2 ", " #b2 " \n\t"
  1412. #define HADAMARD8(m0, m1, m2, m3, m4, m5, m6, m7)\
  1413. LBUTTERFLY2(m0, m1, m2, m3)\
  1414. LBUTTERFLY2(m4, m5, m6, m7)\
  1415. LBUTTERFLY2(m0, m2, m1, m3)\
  1416. LBUTTERFLY2(m4, m6, m5, m7)\
  1417. LBUTTERFLY2(m0, m4, m1, m5)\
  1418. LBUTTERFLY2(m2, m6, m3, m7)\
  1419. #define HADAMARD48 HADAMARD8(%%mm0, %%mm1, %%mm2, %%mm3, %%mm4, %%mm5, %%mm6, %%mm7)
  1420. #define MMABS_MMX(a,z)\
  1421. "pxor " #z ", " #z " \n\t"\
  1422. "pcmpgtw " #a ", " #z " \n\t"\
  1423. "pxor " #z ", " #a " \n\t"\
  1424. "psubw " #z ", " #a " \n\t"
  1425. #define MMABS_MMX2(a,z)\
  1426. "pxor " #z ", " #z " \n\t"\
  1427. "psubw " #a ", " #z " \n\t"\
  1428. "pmaxsw " #z ", " #a " \n\t"
  1429. #define MMABS_SSSE3(a,z)\
  1430. "pabsw " #a ", " #a " \n\t"
  1431. #define MMABS_SUM(a,z, sum)\
  1432. MMABS(a,z)\
  1433. "paddusw " #a ", " #sum " \n\t"
  1434. #define MMABS_SUM_8x8_NOSPILL\
  1435. MMABS(%%xmm0, %%xmm8)\
  1436. MMABS(%%xmm1, %%xmm9)\
  1437. MMABS_SUM(%%xmm2, %%xmm8, %%xmm0)\
  1438. MMABS_SUM(%%xmm3, %%xmm9, %%xmm1)\
  1439. MMABS_SUM(%%xmm4, %%xmm8, %%xmm0)\
  1440. MMABS_SUM(%%xmm5, %%xmm9, %%xmm1)\
  1441. MMABS_SUM(%%xmm6, %%xmm8, %%xmm0)\
  1442. MMABS_SUM(%%xmm7, %%xmm9, %%xmm1)\
  1443. "paddusw %%xmm1, %%xmm0 \n\t"
  1444. #ifdef ARCH_X86_64
  1445. #define MMABS_SUM_8x8_SSE2 MMABS_SUM_8x8_NOSPILL
  1446. #else
  1447. #define MMABS_SUM_8x8_SSE2\
  1448. "movdqa %%xmm7, (%1) \n\t"\
  1449. MMABS(%%xmm0, %%xmm7)\
  1450. MMABS(%%xmm1, %%xmm7)\
  1451. MMABS_SUM(%%xmm2, %%xmm7, %%xmm0)\
  1452. MMABS_SUM(%%xmm3, %%xmm7, %%xmm1)\
  1453. MMABS_SUM(%%xmm4, %%xmm7, %%xmm0)\
  1454. MMABS_SUM(%%xmm5, %%xmm7, %%xmm1)\
  1455. MMABS_SUM(%%xmm6, %%xmm7, %%xmm0)\
  1456. "movdqa (%1), %%xmm2 \n\t"\
  1457. MMABS_SUM(%%xmm2, %%xmm7, %%xmm1)\
  1458. "paddusw %%xmm1, %%xmm0 \n\t"
  1459. #endif
  1460. #define LOAD4(o, a, b, c, d)\
  1461. "movq "#o"(%1), "#a" \n\t"\
  1462. "movq "#o"+8(%1), "#b" \n\t"\
  1463. "movq "#o"+16(%1), "#c" \n\t"\
  1464. "movq "#o"+24(%1), "#d" \n\t"\
  1465. #define STORE4(o, a, b, c, d)\
  1466. "movq "#a", "#o"(%1) \n\t"\
  1467. "movq "#b", "#o"+8(%1) \n\t"\
  1468. "movq "#c", "#o"+16(%1) \n\t"\
  1469. "movq "#d", "#o"+24(%1) \n\t"\
  1470. /* FIXME: HSUM_* saturates at 64k, while an 8x8 hadamard or dct block can get up to
  1471. * about 100k on extreme inputs. But that's very unlikely to occur in natural video,
  1472. * and it's even more unlikely to not have any alternative mvs/modes with lower cost. */
  1473. #define HSUM_MMX(a, t, dst)\
  1474. "movq "#a", "#t" \n\t"\
  1475. "psrlq $32, "#a" \n\t"\
  1476. "paddusw "#t", "#a" \n\t"\
  1477. "movq "#a", "#t" \n\t"\
  1478. "psrlq $16, "#a" \n\t"\
  1479. "paddusw "#t", "#a" \n\t"\
  1480. "movd "#a", "#dst" \n\t"\
  1481. #define HSUM_MMX2(a, t, dst)\
  1482. "pshufw $0x0E, "#a", "#t" \n\t"\
  1483. "paddusw "#t", "#a" \n\t"\
  1484. "pshufw $0x01, "#a", "#t" \n\t"\
  1485. "paddusw "#t", "#a" \n\t"\
  1486. "movd "#a", "#dst" \n\t"\
  1487. #define HSUM_SSE2(a, t, dst)\
  1488. "movhlps "#a", "#t" \n\t"\
  1489. "paddusw "#t", "#a" \n\t"\
  1490. "pshuflw $0x0E, "#a", "#t" \n\t"\
  1491. "paddusw "#t", "#a" \n\t"\
  1492. "pshuflw $0x01, "#a", "#t" \n\t"\
  1493. "paddusw "#t", "#a" \n\t"\
  1494. "movd "#a", "#dst" \n\t"\
  1495. #define HADAMARD8_DIFF_MMX(cpu) \
  1496. static int hadamard8_diff_##cpu(void *s, uint8_t *src1, uint8_t *src2, int stride, int h){\
  1497. DECLARE_ALIGNED_8(uint64_t, temp[13]);\
  1498. int sum;\
  1499. \
  1500. assert(h==8);\
  1501. \
  1502. DIFF_PIXELS_4x8(src1, src2, stride, temp[0]);\
  1503. \
  1504. asm volatile(\
  1505. HADAMARD48\
  1506. \
  1507. "movq %%mm7, 96(%1) \n\t"\
  1508. \
  1509. TRANSPOSE4(%%mm0, %%mm1, %%mm2, %%mm3, %%mm7)\
  1510. STORE4(0 , %%mm0, %%mm3, %%mm7, %%mm2)\
  1511. \
  1512. "movq 96(%1), %%mm7 \n\t"\
  1513. TRANSPOSE4(%%mm4, %%mm5, %%mm6, %%mm7, %%mm0)\
  1514. STORE4(64, %%mm4, %%mm7, %%mm0, %%mm6)\
  1515. \
  1516. : "=r" (sum)\
  1517. : "r"(temp)\
  1518. );\
  1519. \
  1520. DIFF_PIXELS_4x8(src1+4, src2+4, stride, temp[4]);\
  1521. \
  1522. asm volatile(\
  1523. HADAMARD48\
  1524. \
  1525. "movq %%mm7, 96(%1) \n\t"\
  1526. \
  1527. TRANSPOSE4(%%mm0, %%mm1, %%mm2, %%mm3, %%mm7)\
  1528. STORE4(32, %%mm0, %%mm3, %%mm7, %%mm2)\
  1529. \
  1530. "movq 96(%1), %%mm7 \n\t"\
  1531. TRANSPOSE4(%%mm4, %%mm5, %%mm6, %%mm7, %%mm0)\
  1532. "movq %%mm7, %%mm5 \n\t"/*FIXME remove*/\
  1533. "movq %%mm6, %%mm7 \n\t"\
  1534. "movq %%mm0, %%mm6 \n\t"\
  1535. \
  1536. LOAD4(64, %%mm0, %%mm1, %%mm2, %%mm3)\
  1537. \
  1538. HADAMARD48\
  1539. "movq %%mm7, 64(%1) \n\t"\
  1540. MMABS(%%mm0, %%mm7)\
  1541. MMABS(%%mm1, %%mm7)\
  1542. MMABS_SUM(%%mm2, %%mm7, %%mm0)\
  1543. MMABS_SUM(%%mm3, %%mm7, %%mm1)\
  1544. MMABS_SUM(%%mm4, %%mm7, %%mm0)\
  1545. MMABS_SUM(%%mm5, %%mm7, %%mm1)\
  1546. MMABS_SUM(%%mm6, %%mm7, %%mm0)\
  1547. "movq 64(%1), %%mm2 \n\t"\
  1548. MMABS_SUM(%%mm2, %%mm7, %%mm1)\
  1549. "paddusw %%mm1, %%mm0 \n\t"\
  1550. "movq %%mm0, 64(%1) \n\t"\
  1551. \
  1552. LOAD4(0 , %%mm0, %%mm1, %%mm2, %%mm3)\
  1553. LOAD4(32, %%mm4, %%mm5, %%mm6, %%mm7)\
  1554. \
  1555. HADAMARD48\
  1556. "movq %%mm7, (%1) \n\t"\
  1557. MMABS(%%mm0, %%mm7)\
  1558. MMABS(%%mm1, %%mm7)\
  1559. MMABS_SUM(%%mm2, %%mm7, %%mm0)\
  1560. MMABS_SUM(%%mm3, %%mm7, %%mm1)\
  1561. MMABS_SUM(%%mm4, %%mm7, %%mm0)\
  1562. MMABS_SUM(%%mm5, %%mm7, %%mm1)\
  1563. MMABS_SUM(%%mm6, %%mm7, %%mm0)\
  1564. "movq (%1), %%mm2 \n\t"\
  1565. MMABS_SUM(%%mm2, %%mm7, %%mm1)\
  1566. "paddusw 64(%1), %%mm0 \n\t"\
  1567. "paddusw %%mm1, %%mm0 \n\t"\
  1568. \
  1569. HSUM(%%mm0, %%mm1, %0)\
  1570. \
  1571. : "=r" (sum)\
  1572. : "r"(temp)\
  1573. );\
  1574. return sum&0xFFFF;\
  1575. }\
  1576. WARPER8_16_SQ(hadamard8_diff_##cpu, hadamard8_diff16_##cpu)
  1577. #define HADAMARD8_DIFF_SSE2(cpu) \
  1578. static int hadamard8_diff_##cpu(void *s, uint8_t *src1, uint8_t *src2, int stride, int h){\
  1579. DECLARE_ALIGNED_16(uint64_t, temp[4]);\
  1580. int sum;\
  1581. \
  1582. assert(h==8);\
  1583. \
  1584. DIFF_PIXELS_8x8(src1, src2, stride, temp[0]);\
  1585. \
  1586. asm volatile(\
  1587. HADAMARD8(%%xmm0, %%xmm1, %%xmm2, %%xmm3, %%xmm4, %%xmm5, %%xmm6, %%xmm7)\
  1588. TRANSPOSE8(%%xmm0, %%xmm1, %%xmm2, %%xmm3, %%xmm4, %%xmm5, %%xmm6, %%xmm7, (%1))\
  1589. HADAMARD8(%%xmm0, %%xmm5, %%xmm7, %%xmm3, %%xmm6, %%xmm4, %%xmm2, %%xmm1)\
  1590. MMABS_SUM_8x8\
  1591. HSUM_SSE2(%%xmm0, %%xmm1, %0)\
  1592. : "=r" (sum)\
  1593. : "r"(temp)\
  1594. );\
  1595. return sum&0xFFFF;\
  1596. }\
  1597. WARPER8_16_SQ(hadamard8_diff_##cpu, hadamard8_diff16_##cpu)
  1598. #define MMABS(a,z) MMABS_MMX(a,z)
  1599. #define HSUM(a,t,dst) HSUM_MMX(a,t,dst)
  1600. HADAMARD8_DIFF_MMX(mmx)
  1601. #undef MMABS
  1602. #undef HSUM
  1603. #define MMABS(a,z) MMABS_MMX2(a,z)
  1604. #define MMABS_SUM_8x8 MMABS_SUM_8x8_SSE2
  1605. #define HSUM(a,t,dst) HSUM_MMX2(a,t,dst)
  1606. HADAMARD8_DIFF_MMX(mmx2)
  1607. HADAMARD8_DIFF_SSE2(sse2)
  1608. #undef MMABS
  1609. #undef MMABS_SUM_8x8
  1610. #undef HSUM
  1611. #ifdef HAVE_SSSE3
  1612. #define MMABS(a,z) MMABS_SSSE3(a,z)
  1613. #define MMABS_SUM_8x8 MMABS_SUM_8x8_NOSPILL
  1614. HADAMARD8_DIFF_SSE2(ssse3)
  1615. #undef MMABS
  1616. #undef MMABS_SUM_8x8
  1617. #endif
  1618. #define DCT_SAD4(m,mm,o)\
  1619. "mov"#m" "#o"+ 0(%1), "#mm"2 \n\t"\
  1620. "mov"#m" "#o"+16(%1), "#mm"3 \n\t"\
  1621. "mov"#m" "#o"+32(%1), "#mm"4 \n\t"\
  1622. "mov"#m" "#o"+48(%1), "#mm"5 \n\t"\
  1623. MMABS_SUM(mm##2, mm##6, mm##0)\
  1624. MMABS_SUM(mm##3, mm##7, mm##1)\
  1625. MMABS_SUM(mm##4, mm##6, mm##0)\
  1626. MMABS_SUM(mm##5, mm##7, mm##1)\
  1627. #define DCT_SAD_MMX\
  1628. "pxor %%mm0, %%mm0 \n\t"\
  1629. "pxor %%mm1, %%mm1 \n\t"\
  1630. DCT_SAD4(q, %%mm, 0)\
  1631. DCT_SAD4(q, %%mm, 8)\
  1632. DCT_SAD4(q, %%mm, 64)\
  1633. DCT_SAD4(q, %%mm, 72)\
  1634. "paddusw %%mm1, %%mm0 \n\t"\
  1635. HSUM(%%mm0, %%mm1, %0)
  1636. #define DCT_SAD_SSE2\
  1637. "pxor %%xmm0, %%xmm0 \n\t"\
  1638. "pxor %%xmm1, %%xmm1 \n\t"\
  1639. DCT_SAD4(dqa, %%xmm, 0)\
  1640. DCT_SAD4(dqa, %%xmm, 64)\
  1641. "paddusw %%xmm1, %%xmm0 \n\t"\
  1642. HSUM(%%xmm0, %%xmm1, %0)
  1643. #define DCT_SAD_FUNC(cpu) \
  1644. static int sum_abs_dctelem_##cpu(DCTELEM *block){\
  1645. int sum;\
  1646. asm volatile(\
  1647. DCT_SAD\
  1648. :"=r"(sum)\
  1649. :"r"(block)\
  1650. );\
  1651. return sum&0xFFFF;\
  1652. }
  1653. #define DCT_SAD DCT_SAD_MMX
  1654. #define HSUM(a,t,dst) HSUM_MMX(a,t,dst)
  1655. #define MMABS(a,z) MMABS_MMX(a,z)
  1656. DCT_SAD_FUNC(mmx)
  1657. #undef MMABS
  1658. #undef HSUM
  1659. #define HSUM(a,t,dst) HSUM_MMX2(a,t,dst)
  1660. #define MMABS(a,z) MMABS_MMX2(a,z)
  1661. DCT_SAD_FUNC(mmx2)
  1662. #undef HSUM
  1663. #undef DCT_SAD
  1664. #define DCT_SAD DCT_SAD_SSE2
  1665. #define HSUM(a,t,dst) HSUM_SSE2(a,t,dst)
  1666. DCT_SAD_FUNC(sse2)
  1667. #undef MMABS
  1668. #ifdef HAVE_SSSE3
  1669. #define MMABS(a,z) MMABS_SSSE3(a,z)
  1670. DCT_SAD_FUNC(ssse3)
  1671. #undef MMABS
  1672. #endif
  1673. #undef HSUM
  1674. #undef DCT_SAD
  1675. static int ssd_int8_vs_int16_mmx(const int8_t *pix1, const int16_t *pix2, int size){
  1676. int sum;
  1677. long i=size;
  1678. asm volatile(
  1679. "pxor %%mm4, %%mm4 \n"
  1680. "1: \n"
  1681. "sub $8, %0 \n"
  1682. "movq (%2,%0), %%mm2 \n"
  1683. "movq (%3,%0,2), %%mm0 \n"
  1684. "movq 8(%3,%0,2), %%mm1 \n"
  1685. "punpckhbw %%mm2, %%mm3 \n"
  1686. "punpcklbw %%mm2, %%mm2 \n"
  1687. "psraw $8, %%mm3 \n"
  1688. "psraw $8, %%mm2 \n"
  1689. "psubw %%mm3, %%mm1 \n"
  1690. "psubw %%mm2, %%mm0 \n"
  1691. "pmaddwd %%mm1, %%mm1 \n"
  1692. "pmaddwd %%mm0, %%mm0 \n"
  1693. "paddd %%mm1, %%mm4 \n"
  1694. "paddd %%mm0, %%mm4 \n"
  1695. "jg 1b \n"
  1696. "movq %%mm4, %%mm3 \n"
  1697. "psrlq $32, %%mm3 \n"
  1698. "paddd %%mm3, %%mm4 \n"
  1699. "movd %%mm4, %1 \n"
  1700. :"+r"(i), "=r"(sum)
  1701. :"r"(pix1), "r"(pix2)
  1702. );
  1703. return sum;
  1704. }
  1705. #endif //CONFIG_ENCODERS
  1706. #define put_no_rnd_pixels8_mmx(a,b,c,d) put_pixels8_mmx(a,b,c,d)
  1707. #define put_no_rnd_pixels16_mmx(a,b,c,d) put_pixels16_mmx(a,b,c,d)
  1708. #define QPEL_V_LOW(m3,m4,m5,m6, pw_20, pw_3, rnd, in0, in1, in2, in7, out, OP)\
  1709. "paddw " #m4 ", " #m3 " \n\t" /* x1 */\
  1710. "movq "MANGLE(ff_pw_20)", %%mm4 \n\t" /* 20 */\
  1711. "pmullw " #m3 ", %%mm4 \n\t" /* 20x1 */\
  1712. "movq "#in7", " #m3 " \n\t" /* d */\
  1713. "movq "#in0", %%mm5 \n\t" /* D */\
  1714. "paddw " #m3 ", %%mm5 \n\t" /* x4 */\
  1715. "psubw %%mm5, %%mm4 \n\t" /* 20x1 - x4 */\
  1716. "movq "#in1", %%mm5 \n\t" /* C */\
  1717. "movq "#in2", %%mm6 \n\t" /* B */\
  1718. "paddw " #m6 ", %%mm5 \n\t" /* x3 */\
  1719. "paddw " #m5 ", %%mm6 \n\t" /* x2 */\
  1720. "paddw %%mm6, %%mm6 \n\t" /* 2x2 */\
  1721. "psubw %%mm6, %%mm5 \n\t" /* -2x2 + x3 */\
  1722. "pmullw "MANGLE(ff_pw_3)", %%mm5 \n\t" /* -6x2 + 3x3 */\
  1723. "paddw " #rnd ", %%mm4 \n\t" /* x2 */\
  1724. "paddw %%mm4, %%mm5 \n\t" /* 20x1 - 6x2 + 3x3 - x4 */\
  1725. "psraw $5, %%mm5 \n\t"\
  1726. "packuswb %%mm5, %%mm5 \n\t"\
  1727. OP(%%mm5, out, %%mm7, d)
  1728. #define QPEL_BASE(OPNAME, ROUNDER, RND, OP_MMX2, OP_3DNOW)\
  1729. static void OPNAME ## mpeg4_qpel16_h_lowpass_mmx2(uint8_t *dst, uint8_t *src, int dstStride, int srcStride, int h){\
  1730. uint64_t temp;\
  1731. \
  1732. asm volatile(\
  1733. "pxor %%mm7, %%mm7 \n\t"\
  1734. "1: \n\t"\
  1735. "movq (%0), %%mm0 \n\t" /* ABCDEFGH */\
  1736. "movq %%mm0, %%mm1 \n\t" /* ABCDEFGH */\
  1737. "movq %%mm0, %%mm2 \n\t" /* ABCDEFGH */\
  1738. "punpcklbw %%mm7, %%mm0 \n\t" /* 0A0B0C0D */\
  1739. "punpckhbw %%mm7, %%mm1 \n\t" /* 0E0F0G0H */\
  1740. "pshufw $0x90, %%mm0, %%mm5 \n\t" /* 0A0A0B0C */\
  1741. "pshufw $0x41, %%mm0, %%mm6 \n\t" /* 0B0A0A0B */\
  1742. "movq %%mm2, %%mm3 \n\t" /* ABCDEFGH */\
  1743. "movq %%mm2, %%mm4 \n\t" /* ABCDEFGH */\
  1744. "psllq $8, %%mm2 \n\t" /* 0ABCDEFG */\
  1745. "psllq $16, %%mm3 \n\t" /* 00ABCDEF */\
  1746. "psllq $24, %%mm4 \n\t" /* 000ABCDE */\
  1747. "punpckhbw %%mm7, %%mm2 \n\t" /* 0D0E0F0G */\
  1748. "punpckhbw %%mm7, %%mm3 \n\t" /* 0C0D0E0F */\
  1749. "punpckhbw %%mm7, %%mm4 \n\t" /* 0B0C0D0E */\
  1750. "paddw %%mm3, %%mm5 \n\t" /* b */\
  1751. "paddw %%mm2, %%mm6 \n\t" /* c */\
  1752. "paddw %%mm5, %%mm5 \n\t" /* 2b */\
  1753. "psubw %%mm5, %%mm6 \n\t" /* c - 2b */\
  1754. "pshufw $0x06, %%mm0, %%mm5 \n\t" /* 0C0B0A0A */\
  1755. "pmullw "MANGLE(ff_pw_3)", %%mm6 \n\t" /* 3c - 6b */\
  1756. "paddw %%mm4, %%mm0 \n\t" /* a */\
  1757. "paddw %%mm1, %%mm5 \n\t" /* d */\
  1758. "pmullw "MANGLE(ff_pw_20)", %%mm0 \n\t" /* 20a */\
  1759. "psubw %%mm5, %%mm0 \n\t" /* 20a - d */\
  1760. "paddw %6, %%mm6 \n\t"\
  1761. "paddw %%mm6, %%mm0 \n\t" /* 20a - 6b + 3c - d */\
  1762. "psraw $5, %%mm0 \n\t"\
  1763. "movq %%mm0, %5 \n\t"\
  1764. /* mm1=EFGH, mm2=DEFG, mm3=CDEF, mm4=BCDE, mm7=0 */\
  1765. \
  1766. "movq 5(%0), %%mm0 \n\t" /* FGHIJKLM */\
  1767. "movq %%mm0, %%mm5 \n\t" /* FGHIJKLM */\
  1768. "movq %%mm0, %%mm6 \n\t" /* FGHIJKLM */\
  1769. "psrlq $8, %%mm0 \n\t" /* GHIJKLM0 */\
  1770. "psrlq $16, %%mm5 \n\t" /* HIJKLM00 */\
  1771. "punpcklbw %%mm7, %%mm0 \n\t" /* 0G0H0I0J */\
  1772. "punpcklbw %%mm7, %%mm5 \n\t" /* 0H0I0J0K */\
  1773. "paddw %%mm0, %%mm2 \n\t" /* b */\
  1774. "paddw %%mm5, %%mm3 \n\t" /* c */\
  1775. "paddw %%mm2, %%mm2 \n\t" /* 2b */\
  1776. "psubw %%mm2, %%mm3 \n\t" /* c - 2b */\
  1777. "movq %%mm6, %%mm2 \n\t" /* FGHIJKLM */\
  1778. "psrlq $24, %%mm6 \n\t" /* IJKLM000 */\
  1779. "punpcklbw %%mm7, %%mm2 \n\t" /* 0F0G0H0I */\
  1780. "punpcklbw %%mm7, %%mm6 \n\t" /* 0I0J0K0L */\
  1781. "pmullw "MANGLE(ff_pw_3)", %%mm3 \n\t" /* 3c - 6b */\
  1782. "paddw %%mm2, %%mm1 \n\t" /* a */\
  1783. "paddw %%mm6, %%mm4 \n\t" /* d */\
  1784. "pmullw "MANGLE(ff_pw_20)", %%mm1 \n\t" /* 20a */\
  1785. "psubw %%mm4, %%mm3 \n\t" /* - 6b +3c - d */\
  1786. "paddw %6, %%mm1 \n\t"\
  1787. "paddw %%mm1, %%mm3 \n\t" /* 20a - 6b +3c - d */\
  1788. "psraw $5, %%mm3 \n\t"\
  1789. "movq %5, %%mm1 \n\t"\
  1790. "packuswb %%mm3, %%mm1 \n\t"\
  1791. OP_MMX2(%%mm1, (%1),%%mm4, q)\
  1792. /* mm0= GHIJ, mm2=FGHI, mm5=HIJK, mm6=IJKL, mm7=0 */\
  1793. \
  1794. "movq 9(%0), %%mm1 \n\t" /* JKLMNOPQ */\
  1795. "movq %%mm1, %%mm4 \n\t" /* JKLMNOPQ */\
  1796. "movq %%mm1, %%mm3 \n\t" /* JKLMNOPQ */\
  1797. "psrlq $8, %%mm1 \n\t" /* KLMNOPQ0 */\
  1798. "psrlq $16, %%mm4 \n\t" /* LMNOPQ00 */\
  1799. "punpcklbw %%mm7, %%mm1 \n\t" /* 0K0L0M0N */\
  1800. "punpcklbw %%mm7, %%mm4 \n\t" /* 0L0M0N0O */\
  1801. "paddw %%mm1, %%mm5 \n\t" /* b */\
  1802. "paddw %%mm4, %%mm0 \n\t" /* c */\
  1803. "paddw %%mm5, %%mm5 \n\t" /* 2b */\
  1804. "psubw %%mm5, %%mm0 \n\t" /* c - 2b */\
  1805. "movq %%mm3, %%mm5 \n\t" /* JKLMNOPQ */\
  1806. "psrlq $24, %%mm3 \n\t" /* MNOPQ000 */\
  1807. "pmullw "MANGLE(ff_pw_3)", %%mm0 \n\t" /* 3c - 6b */\
  1808. "punpcklbw %%mm7, %%mm3 \n\t" /* 0M0N0O0P */\
  1809. "paddw %%mm3, %%mm2 \n\t" /* d */\
  1810. "psubw %%mm2, %%mm0 \n\t" /* -6b + 3c - d */\
  1811. "movq %%mm5, %%mm2 \n\t" /* JKLMNOPQ */\
  1812. "punpcklbw %%mm7, %%mm2 \n\t" /* 0J0K0L0M */\
  1813. "punpckhbw %%mm7, %%mm5 \n\t" /* 0N0O0P0Q */\
  1814. "paddw %%mm2, %%mm6 \n\t" /* a */\
  1815. "pmullw "MANGLE(ff_pw_20)", %%mm6 \n\t" /* 20a */\
  1816. "paddw %6, %%mm0 \n\t"\
  1817. "paddw %%mm6, %%mm0 \n\t" /* 20a - 6b + 3c - d */\
  1818. "psraw $5, %%mm0 \n\t"\
  1819. /* mm1=KLMN, mm2=JKLM, mm3=MNOP, mm4=LMNO, mm5=NOPQ mm7=0 */\
  1820. \
  1821. "paddw %%mm5, %%mm3 \n\t" /* a */\
  1822. "pshufw $0xF9, %%mm5, %%mm6 \n\t" /* 0O0P0Q0Q */\
  1823. "paddw %%mm4, %%mm6 \n\t" /* b */\
  1824. "pshufw $0xBE, %%mm5, %%mm4 \n\t" /* 0P0Q0Q0P */\
  1825. "pshufw $0x6F, %%mm5, %%mm5 \n\t" /* 0Q0Q0P0O */\
  1826. "paddw %%mm1, %%mm4 \n\t" /* c */\
  1827. "paddw %%mm2, %%mm5 \n\t" /* d */\
  1828. "paddw %%mm6, %%mm6 \n\t" /* 2b */\
  1829. "psubw %%mm6, %%mm4 \n\t" /* c - 2b */\
  1830. "pmullw "MANGLE(ff_pw_20)", %%mm3 \n\t" /* 20a */\
  1831. "pmullw "MANGLE(ff_pw_3)", %%mm4 \n\t" /* 3c - 6b */\
  1832. "psubw %%mm5, %%mm3 \n\t" /* -6b + 3c - d */\
  1833. "paddw %6, %%mm4 \n\t"\
  1834. "paddw %%mm3, %%mm4 \n\t" /* 20a - 6b + 3c - d */\
  1835. "psraw $5, %%mm4 \n\t"\
  1836. "packuswb %%mm4, %%mm0 \n\t"\
  1837. OP_MMX2(%%mm0, 8(%1), %%mm4, q)\
  1838. \
  1839. "add %3, %0 \n\t"\
  1840. "add %4, %1 \n\t"\
  1841. "decl %2 \n\t"\
  1842. " jnz 1b \n\t"\
  1843. : "+a"(src), "+c"(dst), "+m"(h)\
  1844. : "d"((long)srcStride), "S"((long)dstStride), /*"m"(ff_pw_20), "m"(ff_pw_3),*/ "m"(temp), "m"(ROUNDER)\
  1845. : "memory"\
  1846. );\
  1847. }\
  1848. \
  1849. static void OPNAME ## mpeg4_qpel16_h_lowpass_3dnow(uint8_t *dst, uint8_t *src, int dstStride, int srcStride, int h){\
  1850. int i;\
  1851. int16_t temp[16];\
  1852. /* quick HACK, XXX FIXME MUST be optimized */\
  1853. for(i=0; i<h; i++)\
  1854. {\
  1855. temp[ 0]= (src[ 0]+src[ 1])*20 - (src[ 0]+src[ 2])*6 + (src[ 1]+src[ 3])*3 - (src[ 2]+src[ 4]);\
  1856. temp[ 1]= (src[ 1]+src[ 2])*20 - (src[ 0]+src[ 3])*6 + (src[ 0]+src[ 4])*3 - (src[ 1]+src[ 5]);\
  1857. temp[ 2]= (src[ 2]+src[ 3])*20 - (src[ 1]+src[ 4])*6 + (src[ 0]+src[ 5])*3 - (src[ 0]+src[ 6]);\
  1858. temp[ 3]= (src[ 3]+src[ 4])*20 - (src[ 2]+src[ 5])*6 + (src[ 1]+src[ 6])*3 - (src[ 0]+src[ 7]);\
  1859. temp[ 4]= (src[ 4]+src[ 5])*20 - (src[ 3]+src[ 6])*6 + (src[ 2]+src[ 7])*3 - (src[ 1]+src[ 8]);\
  1860. temp[ 5]= (src[ 5]+src[ 6])*20 - (src[ 4]+src[ 7])*6 + (src[ 3]+src[ 8])*3 - (src[ 2]+src[ 9]);\
  1861. temp[ 6]= (src[ 6]+src[ 7])*20 - (src[ 5]+src[ 8])*6 + (src[ 4]+src[ 9])*3 - (src[ 3]+src[10]);\
  1862. temp[ 7]= (src[ 7]+src[ 8])*20 - (src[ 6]+src[ 9])*6 + (src[ 5]+src[10])*3 - (src[ 4]+src[11]);\
  1863. temp[ 8]= (src[ 8]+src[ 9])*20 - (src[ 7]+src[10])*6 + (src[ 6]+src[11])*3 - (src[ 5]+src[12]);\
  1864. temp[ 9]= (src[ 9]+src[10])*20 - (src[ 8]+src[11])*6 + (src[ 7]+src[12])*3 - (src[ 6]+src[13]);\
  1865. temp[10]= (src[10]+src[11])*20 - (src[ 9]+src[12])*6 + (src[ 8]+src[13])*3 - (src[ 7]+src[14]);\
  1866. temp[11]= (src[11]+src[12])*20 - (src[10]+src[13])*6 + (src[ 9]+src[14])*3 - (src[ 8]+src[15]);\
  1867. temp[12]= (src[12]+src[13])*20 - (src[11]+src[14])*6 + (src[10]+src[15])*3 - (src[ 9]+src[16]);\
  1868. temp[13]= (src[13]+src[14])*20 - (src[12]+src[15])*6 + (src[11]+src[16])*3 - (src[10]+src[16]);\
  1869. temp[14]= (src[14]+src[15])*20 - (src[13]+src[16])*6 + (src[12]+src[16])*3 - (src[11]+src[15]);\
  1870. temp[15]= (src[15]+src[16])*20 - (src[14]+src[16])*6 + (src[13]+src[15])*3 - (src[12]+src[14]);\
  1871. asm volatile(\
  1872. "movq (%0), %%mm0 \n\t"\
  1873. "movq 8(%0), %%mm1 \n\t"\
  1874. "paddw %2, %%mm0 \n\t"\
  1875. "paddw %2, %%mm1 \n\t"\
  1876. "psraw $5, %%mm0 \n\t"\
  1877. "psraw $5, %%mm1 \n\t"\
  1878. "packuswb %%mm1, %%mm0 \n\t"\
  1879. OP_3DNOW(%%mm0, (%1), %%mm1, q)\
  1880. "movq 16(%0), %%mm0 \n\t"\
  1881. "movq 24(%0), %%mm1 \n\t"\
  1882. "paddw %2, %%mm0 \n\t"\
  1883. "paddw %2, %%mm1 \n\t"\
  1884. "psraw $5, %%mm0 \n\t"\
  1885. "psraw $5, %%mm1 \n\t"\
  1886. "packuswb %%mm1, %%mm0 \n\t"\
  1887. OP_3DNOW(%%mm0, 8(%1), %%mm1, q)\
  1888. :: "r"(temp), "r"(dst), "m"(ROUNDER)\
  1889. : "memory"\
  1890. );\
  1891. dst+=dstStride;\
  1892. src+=srcStride;\
  1893. }\
  1894. }\
  1895. \
  1896. static void OPNAME ## mpeg4_qpel8_h_lowpass_mmx2(uint8_t *dst, uint8_t *src, int dstStride, int srcStride, int h){\
  1897. uint64_t temp;\
  1898. \
  1899. asm volatile(\
  1900. "pxor %%mm7, %%mm7 \n\t"\
  1901. "1: \n\t"\
  1902. "movq (%0), %%mm0 \n\t" /* ABCDEFGH */\
  1903. "movq %%mm0, %%mm1 \n\t" /* ABCDEFGH */\
  1904. "movq %%mm0, %%mm2 \n\t" /* ABCDEFGH */\
  1905. "punpcklbw %%mm7, %%mm0 \n\t" /* 0A0B0C0D */\
  1906. "punpckhbw %%mm7, %%mm1 \n\t" /* 0E0F0G0H */\
  1907. "pshufw $0x90, %%mm0, %%mm5 \n\t" /* 0A0A0B0C */\
  1908. "pshufw $0x41, %%mm0, %%mm6 \n\t" /* 0B0A0A0B */\
  1909. "movq %%mm2, %%mm3 \n\t" /* ABCDEFGH */\
  1910. "movq %%mm2, %%mm4 \n\t" /* ABCDEFGH */\
  1911. "psllq $8, %%mm2 \n\t" /* 0ABCDEFG */\
  1912. "psllq $16, %%mm3 \n\t" /* 00ABCDEF */\
  1913. "psllq $24, %%mm4 \n\t" /* 000ABCDE */\
  1914. "punpckhbw %%mm7, %%mm2 \n\t" /* 0D0E0F0G */\
  1915. "punpckhbw %%mm7, %%mm3 \n\t" /* 0C0D0E0F */\
  1916. "punpckhbw %%mm7, %%mm4 \n\t" /* 0B0C0D0E */\
  1917. "paddw %%mm3, %%mm5 \n\t" /* b */\
  1918. "paddw %%mm2, %%mm6 \n\t" /* c */\
  1919. "paddw %%mm5, %%mm5 \n\t" /* 2b */\
  1920. "psubw %%mm5, %%mm6 \n\t" /* c - 2b */\
  1921. "pshufw $0x06, %%mm0, %%mm5 \n\t" /* 0C0B0A0A */\
  1922. "pmullw "MANGLE(ff_pw_3)", %%mm6 \n\t" /* 3c - 6b */\
  1923. "paddw %%mm4, %%mm0 \n\t" /* a */\
  1924. "paddw %%mm1, %%mm5 \n\t" /* d */\
  1925. "pmullw "MANGLE(ff_pw_20)", %%mm0 \n\t" /* 20a */\
  1926. "psubw %%mm5, %%mm0 \n\t" /* 20a - d */\
  1927. "paddw %6, %%mm6 \n\t"\
  1928. "paddw %%mm6, %%mm0 \n\t" /* 20a - 6b + 3c - d */\
  1929. "psraw $5, %%mm0 \n\t"\
  1930. /* mm1=EFGH, mm2=DEFG, mm3=CDEF, mm4=BCDE, mm7=0 */\
  1931. \
  1932. "movd 5(%0), %%mm5 \n\t" /* FGHI */\
  1933. "punpcklbw %%mm7, %%mm5 \n\t" /* 0F0G0H0I */\
  1934. "pshufw $0xF9, %%mm5, %%mm6 \n\t" /* 0G0H0I0I */\
  1935. "paddw %%mm5, %%mm1 \n\t" /* a */\
  1936. "paddw %%mm6, %%mm2 \n\t" /* b */\
  1937. "pshufw $0xBE, %%mm5, %%mm6 \n\t" /* 0H0I0I0H */\
  1938. "pshufw $0x6F, %%mm5, %%mm5 \n\t" /* 0I0I0H0G */\
  1939. "paddw %%mm6, %%mm3 \n\t" /* c */\
  1940. "paddw %%mm5, %%mm4 \n\t" /* d */\
  1941. "paddw %%mm2, %%mm2 \n\t" /* 2b */\
  1942. "psubw %%mm2, %%mm3 \n\t" /* c - 2b */\
  1943. "pmullw "MANGLE(ff_pw_20)", %%mm1 \n\t" /* 20a */\
  1944. "pmullw "MANGLE(ff_pw_3)", %%mm3 \n\t" /* 3c - 6b */\
  1945. "psubw %%mm4, %%mm3 \n\t" /* -6b + 3c - d */\
  1946. "paddw %6, %%mm1 \n\t"\
  1947. "paddw %%mm1, %%mm3 \n\t" /* 20a - 6b + 3c - d */\
  1948. "psraw $5, %%mm3 \n\t"\
  1949. "packuswb %%mm3, %%mm0 \n\t"\
  1950. OP_MMX2(%%mm0, (%1), %%mm4, q)\
  1951. \
  1952. "add %3, %0 \n\t"\
  1953. "add %4, %1 \n\t"\
  1954. "decl %2 \n\t"\
  1955. " jnz 1b \n\t"\
  1956. : "+a"(src), "+c"(dst), "+m"(h)\
  1957. : "S"((long)srcStride), "D"((long)dstStride), /*"m"(ff_pw_20), "m"(ff_pw_3),*/ "m"(temp), "m"(ROUNDER)\
  1958. : "memory"\
  1959. );\
  1960. }\
  1961. \
  1962. static void OPNAME ## mpeg4_qpel8_h_lowpass_3dnow(uint8_t *dst, uint8_t *src, int dstStride, int srcStride, int h){\
  1963. int i;\
  1964. int16_t temp[8];\
  1965. /* quick HACK, XXX FIXME MUST be optimized */\
  1966. for(i=0; i<h; i++)\
  1967. {\
  1968. temp[ 0]= (src[ 0]+src[ 1])*20 - (src[ 0]+src[ 2])*6 + (src[ 1]+src[ 3])*3 - (src[ 2]+src[ 4]);\
  1969. temp[ 1]= (src[ 1]+src[ 2])*20 - (src[ 0]+src[ 3])*6 + (src[ 0]+src[ 4])*3 - (src[ 1]+src[ 5]);\
  1970. temp[ 2]= (src[ 2]+src[ 3])*20 - (src[ 1]+src[ 4])*6 + (src[ 0]+src[ 5])*3 - (src[ 0]+src[ 6]);\
  1971. temp[ 3]= (src[ 3]+src[ 4])*20 - (src[ 2]+src[ 5])*6 + (src[ 1]+src[ 6])*3 - (src[ 0]+src[ 7]);\
  1972. temp[ 4]= (src[ 4]+src[ 5])*20 - (src[ 3]+src[ 6])*6 + (src[ 2]+src[ 7])*3 - (src[ 1]+src[ 8]);\
  1973. temp[ 5]= (src[ 5]+src[ 6])*20 - (src[ 4]+src[ 7])*6 + (src[ 3]+src[ 8])*3 - (src[ 2]+src[ 8]);\
  1974. temp[ 6]= (src[ 6]+src[ 7])*20 - (src[ 5]+src[ 8])*6 + (src[ 4]+src[ 8])*3 - (src[ 3]+src[ 7]);\
  1975. temp[ 7]= (src[ 7]+src[ 8])*20 - (src[ 6]+src[ 8])*6 + (src[ 5]+src[ 7])*3 - (src[ 4]+src[ 6]);\
  1976. asm volatile(\
  1977. "movq (%0), %%mm0 \n\t"\
  1978. "movq 8(%0), %%mm1 \n\t"\
  1979. "paddw %2, %%mm0 \n\t"\
  1980. "paddw %2, %%mm1 \n\t"\
  1981. "psraw $5, %%mm0 \n\t"\
  1982. "psraw $5, %%mm1 \n\t"\
  1983. "packuswb %%mm1, %%mm0 \n\t"\
  1984. OP_3DNOW(%%mm0, (%1), %%mm1, q)\
  1985. :: "r"(temp), "r"(dst), "m"(ROUNDER)\
  1986. :"memory"\
  1987. );\
  1988. dst+=dstStride;\
  1989. src+=srcStride;\
  1990. }\
  1991. }
  1992. #define QPEL_OP(OPNAME, ROUNDER, RND, OP, MMX)\
  1993. \
  1994. static void OPNAME ## mpeg4_qpel16_v_lowpass_ ## MMX(uint8_t *dst, uint8_t *src, int dstStride, int srcStride){\
  1995. uint64_t temp[17*4];\
  1996. uint64_t *temp_ptr= temp;\
  1997. int count= 17;\
  1998. \
  1999. /*FIXME unroll */\
  2000. asm volatile(\
  2001. "pxor %%mm7, %%mm7 \n\t"\
  2002. "1: \n\t"\
  2003. "movq (%0), %%mm0 \n\t"\
  2004. "movq (%0), %%mm1 \n\t"\
  2005. "movq 8(%0), %%mm2 \n\t"\
  2006. "movq 8(%0), %%mm3 \n\t"\
  2007. "punpcklbw %%mm7, %%mm0 \n\t"\
  2008. "punpckhbw %%mm7, %%mm1 \n\t"\
  2009. "punpcklbw %%mm7, %%mm2 \n\t"\
  2010. "punpckhbw %%mm7, %%mm3 \n\t"\
  2011. "movq %%mm0, (%1) \n\t"\
  2012. "movq %%mm1, 17*8(%1) \n\t"\
  2013. "movq %%mm2, 2*17*8(%1) \n\t"\
  2014. "movq %%mm3, 3*17*8(%1) \n\t"\
  2015. "add $8, %1 \n\t"\
  2016. "add %3, %0 \n\t"\
  2017. "decl %2 \n\t"\
  2018. " jnz 1b \n\t"\
  2019. : "+r" (src), "+r" (temp_ptr), "+r"(count)\
  2020. : "r" ((long)srcStride)\
  2021. : "memory"\
  2022. );\
  2023. \
  2024. temp_ptr= temp;\
  2025. count=4;\
  2026. \
  2027. /*FIXME reorder for speed */\
  2028. asm volatile(\
  2029. /*"pxor %%mm7, %%mm7 \n\t"*/\
  2030. "1: \n\t"\
  2031. "movq (%0), %%mm0 \n\t"\
  2032. "movq 8(%0), %%mm1 \n\t"\
  2033. "movq 16(%0), %%mm2 \n\t"\
  2034. "movq 24(%0), %%mm3 \n\t"\
  2035. QPEL_V_LOW(%%mm0, %%mm1, %%mm2, %%mm3, %5, %6, %5, 16(%0), 8(%0), (%0), 32(%0), (%1), OP)\
  2036. QPEL_V_LOW(%%mm1, %%mm2, %%mm3, %%mm0, %5, %6, %5, 8(%0), (%0), (%0), 40(%0), (%1, %3), OP)\
  2037. "add %4, %1 \n\t"\
  2038. QPEL_V_LOW(%%mm2, %%mm3, %%mm0, %%mm1, %5, %6, %5, (%0), (%0), 8(%0), 48(%0), (%1), OP)\
  2039. \
  2040. QPEL_V_LOW(%%mm3, %%mm0, %%mm1, %%mm2, %5, %6, %5, (%0), 8(%0), 16(%0), 56(%0), (%1, %3), OP)\
  2041. "add %4, %1 \n\t"\
  2042. QPEL_V_LOW(%%mm0, %%mm1, %%mm2, %%mm3, %5, %6, %5, 8(%0), 16(%0), 24(%0), 64(%0), (%1), OP)\
  2043. QPEL_V_LOW(%%mm1, %%mm2, %%mm3, %%mm0, %5, %6, %5, 16(%0), 24(%0), 32(%0), 72(%0), (%1, %3), OP)\
  2044. "add %4, %1 \n\t"\
  2045. QPEL_V_LOW(%%mm2, %%mm3, %%mm0, %%mm1, %5, %6, %5, 24(%0), 32(%0), 40(%0), 80(%0), (%1), OP)\
  2046. QPEL_V_LOW(%%mm3, %%mm0, %%mm1, %%mm2, %5, %6, %5, 32(%0), 40(%0), 48(%0), 88(%0), (%1, %3), OP)\
  2047. "add %4, %1 \n\t"\
  2048. QPEL_V_LOW(%%mm0, %%mm1, %%mm2, %%mm3, %5, %6, %5, 40(%0), 48(%0), 56(%0), 96(%0), (%1), OP)\
  2049. QPEL_V_LOW(%%mm1, %%mm2, %%mm3, %%mm0, %5, %6, %5, 48(%0), 56(%0), 64(%0),104(%0), (%1, %3), OP)\
  2050. "add %4, %1 \n\t"\
  2051. QPEL_V_LOW(%%mm2, %%mm3, %%mm0, %%mm1, %5, %6, %5, 56(%0), 64(%0), 72(%0),112(%0), (%1), OP)\
  2052. QPEL_V_LOW(%%mm3, %%mm0, %%mm1, %%mm2, %5, %6, %5, 64(%0), 72(%0), 80(%0),120(%0), (%1, %3), OP)\
  2053. "add %4, %1 \n\t"\
  2054. QPEL_V_LOW(%%mm0, %%mm1, %%mm2, %%mm3, %5, %6, %5, 72(%0), 80(%0), 88(%0),128(%0), (%1), OP)\
  2055. \
  2056. QPEL_V_LOW(%%mm1, %%mm2, %%mm3, %%mm0, %5, %6, %5, 80(%0), 88(%0), 96(%0),128(%0), (%1, %3), OP)\
  2057. "add %4, %1 \n\t" \
  2058. QPEL_V_LOW(%%mm2, %%mm3, %%mm0, %%mm1, %5, %6, %5, 88(%0), 96(%0),104(%0),120(%0), (%1), OP)\
  2059. QPEL_V_LOW(%%mm3, %%mm0, %%mm1, %%mm2, %5, %6, %5, 96(%0),104(%0),112(%0),112(%0), (%1, %3), OP)\
  2060. \
  2061. "add $136, %0 \n\t"\
  2062. "add %6, %1 \n\t"\
  2063. "decl %2 \n\t"\
  2064. " jnz 1b \n\t"\
  2065. \
  2066. : "+r"(temp_ptr), "+r"(dst), "+g"(count)\
  2067. : "r"((long)dstStride), "r"(2*(long)dstStride), /*"m"(ff_pw_20), "m"(ff_pw_3),*/ "m"(ROUNDER), "g"(4-14*(long)dstStride)\
  2068. :"memory"\
  2069. );\
  2070. }\
  2071. \
  2072. static void OPNAME ## mpeg4_qpel8_v_lowpass_ ## MMX(uint8_t *dst, uint8_t *src, int dstStride, int srcStride){\
  2073. uint64_t temp[9*2];\
  2074. uint64_t *temp_ptr= temp;\
  2075. int count= 9;\
  2076. \
  2077. /*FIXME unroll */\
  2078. asm volatile(\
  2079. "pxor %%mm7, %%mm7 \n\t"\
  2080. "1: \n\t"\
  2081. "movq (%0), %%mm0 \n\t"\
  2082. "movq (%0), %%mm1 \n\t"\
  2083. "punpcklbw %%mm7, %%mm0 \n\t"\
  2084. "punpckhbw %%mm7, %%mm1 \n\t"\
  2085. "movq %%mm0, (%1) \n\t"\
  2086. "movq %%mm1, 9*8(%1) \n\t"\
  2087. "add $8, %1 \n\t"\
  2088. "add %3, %0 \n\t"\
  2089. "decl %2 \n\t"\
  2090. " jnz 1b \n\t"\
  2091. : "+r" (src), "+r" (temp_ptr), "+r"(count)\
  2092. : "r" ((long)srcStride)\
  2093. : "memory"\
  2094. );\
  2095. \
  2096. temp_ptr= temp;\
  2097. count=2;\
  2098. \
  2099. /*FIXME reorder for speed */\
  2100. asm volatile(\
  2101. /*"pxor %%mm7, %%mm7 \n\t"*/\
  2102. "1: \n\t"\
  2103. "movq (%0), %%mm0 \n\t"\
  2104. "movq 8(%0), %%mm1 \n\t"\
  2105. "movq 16(%0), %%mm2 \n\t"\
  2106. "movq 24(%0), %%mm3 \n\t"\
  2107. QPEL_V_LOW(%%mm0, %%mm1, %%mm2, %%mm3, %5, %6, %5, 16(%0), 8(%0), (%0), 32(%0), (%1), OP)\
  2108. QPEL_V_LOW(%%mm1, %%mm2, %%mm3, %%mm0, %5, %6, %5, 8(%0), (%0), (%0), 40(%0), (%1, %3), OP)\
  2109. "add %4, %1 \n\t"\
  2110. QPEL_V_LOW(%%mm2, %%mm3, %%mm0, %%mm1, %5, %6, %5, (%0), (%0), 8(%0), 48(%0), (%1), OP)\
  2111. \
  2112. QPEL_V_LOW(%%mm3, %%mm0, %%mm1, %%mm2, %5, %6, %5, (%0), 8(%0), 16(%0), 56(%0), (%1, %3), OP)\
  2113. "add %4, %1 \n\t"\
  2114. QPEL_V_LOW(%%mm0, %%mm1, %%mm2, %%mm3, %5, %6, %5, 8(%0), 16(%0), 24(%0), 64(%0), (%1), OP)\
  2115. \
  2116. QPEL_V_LOW(%%mm1, %%mm2, %%mm3, %%mm0, %5, %6, %5, 16(%0), 24(%0), 32(%0), 64(%0), (%1, %3), OP)\
  2117. "add %4, %1 \n\t"\
  2118. QPEL_V_LOW(%%mm2, %%mm3, %%mm0, %%mm1, %5, %6, %5, 24(%0), 32(%0), 40(%0), 56(%0), (%1), OP)\
  2119. QPEL_V_LOW(%%mm3, %%mm0, %%mm1, %%mm2, %5, %6, %5, 32(%0), 40(%0), 48(%0), 48(%0), (%1, %3), OP)\
  2120. \
  2121. "add $72, %0 \n\t"\
  2122. "add %6, %1 \n\t"\
  2123. "decl %2 \n\t"\
  2124. " jnz 1b \n\t"\
  2125. \
  2126. : "+r"(temp_ptr), "+r"(dst), "+g"(count)\
  2127. : "r"((long)dstStride), "r"(2*(long)dstStride), /*"m"(ff_pw_20), "m"(ff_pw_3),*/ "m"(ROUNDER), "g"(4-6*(long)dstStride)\
  2128. : "memory"\
  2129. );\
  2130. }\
  2131. \
  2132. static void OPNAME ## qpel8_mc00_ ## MMX (uint8_t *dst, uint8_t *src, int stride){\
  2133. OPNAME ## pixels8_mmx(dst, src, stride, 8);\
  2134. }\
  2135. \
  2136. static void OPNAME ## qpel8_mc10_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  2137. uint64_t temp[8];\
  2138. uint8_t * const half= (uint8_t*)temp;\
  2139. put ## RND ## mpeg4_qpel8_h_lowpass_ ## MMX(half, src, 8, stride, 8);\
  2140. OPNAME ## pixels8_l2_ ## MMX(dst, src, half, stride, stride, 8);\
  2141. }\
  2142. \
  2143. static void OPNAME ## qpel8_mc20_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  2144. OPNAME ## mpeg4_qpel8_h_lowpass_ ## MMX(dst, src, stride, stride, 8);\
  2145. }\
  2146. \
  2147. static void OPNAME ## qpel8_mc30_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  2148. uint64_t temp[8];\
  2149. uint8_t * const half= (uint8_t*)temp;\
  2150. put ## RND ## mpeg4_qpel8_h_lowpass_ ## MMX(half, src, 8, stride, 8);\
  2151. OPNAME ## pixels8_l2_ ## MMX(dst, src+1, half, stride, stride, 8);\
  2152. }\
  2153. \
  2154. static void OPNAME ## qpel8_mc01_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  2155. uint64_t temp[8];\
  2156. uint8_t * const half= (uint8_t*)temp;\
  2157. put ## RND ## mpeg4_qpel8_v_lowpass_ ## MMX(half, src, 8, stride);\
  2158. OPNAME ## pixels8_l2_ ## MMX(dst, src, half, stride, stride, 8);\
  2159. }\
  2160. \
  2161. static void OPNAME ## qpel8_mc02_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  2162. OPNAME ## mpeg4_qpel8_v_lowpass_ ## MMX(dst, src, stride, stride);\
  2163. }\
  2164. \
  2165. static void OPNAME ## qpel8_mc03_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  2166. uint64_t temp[8];\
  2167. uint8_t * const half= (uint8_t*)temp;\
  2168. put ## RND ## mpeg4_qpel8_v_lowpass_ ## MMX(half, src, 8, stride);\
  2169. OPNAME ## pixels8_l2_ ## MMX(dst, src+stride, half, stride, stride, 8);\
  2170. }\
  2171. static void OPNAME ## qpel8_mc11_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  2172. uint64_t half[8 + 9];\
  2173. uint8_t * const halfH= ((uint8_t*)half) + 64;\
  2174. uint8_t * const halfHV= ((uint8_t*)half);\
  2175. put ## RND ## mpeg4_qpel8_h_lowpass_ ## MMX(halfH, src, 8, stride, 9);\
  2176. put ## RND ## pixels8_l2_ ## MMX(halfH, src, halfH, 8, stride, 9);\
  2177. put ## RND ## mpeg4_qpel8_v_lowpass_ ## MMX(halfHV, halfH, 8, 8);\
  2178. OPNAME ## pixels8_l2_ ## MMX(dst, halfH, halfHV, stride, 8, 8);\
  2179. }\
  2180. static void OPNAME ## qpel8_mc31_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  2181. uint64_t half[8 + 9];\
  2182. uint8_t * const halfH= ((uint8_t*)half) + 64;\
  2183. uint8_t * const halfHV= ((uint8_t*)half);\
  2184. put ## RND ## mpeg4_qpel8_h_lowpass_ ## MMX(halfH, src, 8, stride, 9);\
  2185. put ## RND ## pixels8_l2_ ## MMX(halfH, src+1, halfH, 8, stride, 9);\
  2186. put ## RND ## mpeg4_qpel8_v_lowpass_ ## MMX(halfHV, halfH, 8, 8);\
  2187. OPNAME ## pixels8_l2_ ## MMX(dst, halfH, halfHV, stride, 8, 8);\
  2188. }\
  2189. static void OPNAME ## qpel8_mc13_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  2190. uint64_t half[8 + 9];\
  2191. uint8_t * const halfH= ((uint8_t*)half) + 64;\
  2192. uint8_t * const halfHV= ((uint8_t*)half);\
  2193. put ## RND ## mpeg4_qpel8_h_lowpass_ ## MMX(halfH, src, 8, stride, 9);\
  2194. put ## RND ## pixels8_l2_ ## MMX(halfH, src, halfH, 8, stride, 9);\
  2195. put ## RND ## mpeg4_qpel8_v_lowpass_ ## MMX(halfHV, halfH, 8, 8);\
  2196. OPNAME ## pixels8_l2_ ## MMX(dst, halfH+8, halfHV, stride, 8, 8);\
  2197. }\
  2198. static void OPNAME ## qpel8_mc33_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  2199. uint64_t half[8 + 9];\
  2200. uint8_t * const halfH= ((uint8_t*)half) + 64;\
  2201. uint8_t * const halfHV= ((uint8_t*)half);\
  2202. put ## RND ## mpeg4_qpel8_h_lowpass_ ## MMX(halfH, src, 8, stride, 9);\
  2203. put ## RND ## pixels8_l2_ ## MMX(halfH, src+1, halfH, 8, stride, 9);\
  2204. put ## RND ## mpeg4_qpel8_v_lowpass_ ## MMX(halfHV, halfH, 8, 8);\
  2205. OPNAME ## pixels8_l2_ ## MMX(dst, halfH+8, halfHV, stride, 8, 8);\
  2206. }\
  2207. static void OPNAME ## qpel8_mc21_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  2208. uint64_t half[8 + 9];\
  2209. uint8_t * const halfH= ((uint8_t*)half) + 64;\
  2210. uint8_t * const halfHV= ((uint8_t*)half);\
  2211. put ## RND ## mpeg4_qpel8_h_lowpass_ ## MMX(halfH, src, 8, stride, 9);\
  2212. put ## RND ## mpeg4_qpel8_v_lowpass_ ## MMX(halfHV, halfH, 8, 8);\
  2213. OPNAME ## pixels8_l2_ ## MMX(dst, halfH, halfHV, stride, 8, 8);\
  2214. }\
  2215. static void OPNAME ## qpel8_mc23_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  2216. uint64_t half[8 + 9];\
  2217. uint8_t * const halfH= ((uint8_t*)half) + 64;\
  2218. uint8_t * const halfHV= ((uint8_t*)half);\
  2219. put ## RND ## mpeg4_qpel8_h_lowpass_ ## MMX(halfH, src, 8, stride, 9);\
  2220. put ## RND ## mpeg4_qpel8_v_lowpass_ ## MMX(halfHV, halfH, 8, 8);\
  2221. OPNAME ## pixels8_l2_ ## MMX(dst, halfH+8, halfHV, stride, 8, 8);\
  2222. }\
  2223. static void OPNAME ## qpel8_mc12_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  2224. uint64_t half[8 + 9];\
  2225. uint8_t * const halfH= ((uint8_t*)half);\
  2226. put ## RND ## mpeg4_qpel8_h_lowpass_ ## MMX(halfH, src, 8, stride, 9);\
  2227. put ## RND ## pixels8_l2_ ## MMX(halfH, src, halfH, 8, stride, 9);\
  2228. OPNAME ## mpeg4_qpel8_v_lowpass_ ## MMX(dst, halfH, stride, 8);\
  2229. }\
  2230. static void OPNAME ## qpel8_mc32_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  2231. uint64_t half[8 + 9];\
  2232. uint8_t * const halfH= ((uint8_t*)half);\
  2233. put ## RND ## mpeg4_qpel8_h_lowpass_ ## MMX(halfH, src, 8, stride, 9);\
  2234. put ## RND ## pixels8_l2_ ## MMX(halfH, src+1, halfH, 8, stride, 9);\
  2235. OPNAME ## mpeg4_qpel8_v_lowpass_ ## MMX(dst, halfH, stride, 8);\
  2236. }\
  2237. static void OPNAME ## qpel8_mc22_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  2238. uint64_t half[9];\
  2239. uint8_t * const halfH= ((uint8_t*)half);\
  2240. put ## RND ## mpeg4_qpel8_h_lowpass_ ## MMX(halfH, src, 8, stride, 9);\
  2241. OPNAME ## mpeg4_qpel8_v_lowpass_ ## MMX(dst, halfH, stride, 8);\
  2242. }\
  2243. static void OPNAME ## qpel16_mc00_ ## MMX (uint8_t *dst, uint8_t *src, int stride){\
  2244. OPNAME ## pixels16_mmx(dst, src, stride, 16);\
  2245. }\
  2246. \
  2247. static void OPNAME ## qpel16_mc10_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  2248. uint64_t temp[32];\
  2249. uint8_t * const half= (uint8_t*)temp;\
  2250. put ## RND ## mpeg4_qpel16_h_lowpass_ ## MMX(half, src, 16, stride, 16);\
  2251. OPNAME ## pixels16_l2_ ## MMX(dst, src, half, stride, stride, 16);\
  2252. }\
  2253. \
  2254. static void OPNAME ## qpel16_mc20_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  2255. OPNAME ## mpeg4_qpel16_h_lowpass_ ## MMX(dst, src, stride, stride, 16);\
  2256. }\
  2257. \
  2258. static void OPNAME ## qpel16_mc30_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  2259. uint64_t temp[32];\
  2260. uint8_t * const half= (uint8_t*)temp;\
  2261. put ## RND ## mpeg4_qpel16_h_lowpass_ ## MMX(half, src, 16, stride, 16);\
  2262. OPNAME ## pixels16_l2_ ## MMX(dst, src+1, half, stride, stride, 16);\
  2263. }\
  2264. \
  2265. static void OPNAME ## qpel16_mc01_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  2266. uint64_t temp[32];\
  2267. uint8_t * const half= (uint8_t*)temp;\
  2268. put ## RND ## mpeg4_qpel16_v_lowpass_ ## MMX(half, src, 16, stride);\
  2269. OPNAME ## pixels16_l2_ ## MMX(dst, src, half, stride, stride, 16);\
  2270. }\
  2271. \
  2272. static void OPNAME ## qpel16_mc02_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  2273. OPNAME ## mpeg4_qpel16_v_lowpass_ ## MMX(dst, src, stride, stride);\
  2274. }\
  2275. \
  2276. static void OPNAME ## qpel16_mc03_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  2277. uint64_t temp[32];\
  2278. uint8_t * const half= (uint8_t*)temp;\
  2279. put ## RND ## mpeg4_qpel16_v_lowpass_ ## MMX(half, src, 16, stride);\
  2280. OPNAME ## pixels16_l2_ ## MMX(dst, src+stride, half, stride, stride, 16);\
  2281. }\
  2282. static void OPNAME ## qpel16_mc11_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  2283. uint64_t half[16*2 + 17*2];\
  2284. uint8_t * const halfH= ((uint8_t*)half) + 256;\
  2285. uint8_t * const halfHV= ((uint8_t*)half);\
  2286. put ## RND ## mpeg4_qpel16_h_lowpass_ ## MMX(halfH, src, 16, stride, 17);\
  2287. put ## RND ## pixels16_l2_ ## MMX(halfH, src, halfH, 16, stride, 17);\
  2288. put ## RND ## mpeg4_qpel16_v_lowpass_ ## MMX(halfHV, halfH, 16, 16);\
  2289. OPNAME ## pixels16_l2_ ## MMX(dst, halfH, halfHV, stride, 16, 16);\
  2290. }\
  2291. static void OPNAME ## qpel16_mc31_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  2292. uint64_t half[16*2 + 17*2];\
  2293. uint8_t * const halfH= ((uint8_t*)half) + 256;\
  2294. uint8_t * const halfHV= ((uint8_t*)half);\
  2295. put ## RND ## mpeg4_qpel16_h_lowpass_ ## MMX(halfH, src, 16, stride, 17);\
  2296. put ## RND ## pixels16_l2_ ## MMX(halfH, src+1, halfH, 16, stride, 17);\
  2297. put ## RND ## mpeg4_qpel16_v_lowpass_ ## MMX(halfHV, halfH, 16, 16);\
  2298. OPNAME ## pixels16_l2_ ## MMX(dst, halfH, halfHV, stride, 16, 16);\
  2299. }\
  2300. static void OPNAME ## qpel16_mc13_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  2301. uint64_t half[16*2 + 17*2];\
  2302. uint8_t * const halfH= ((uint8_t*)half) + 256;\
  2303. uint8_t * const halfHV= ((uint8_t*)half);\
  2304. put ## RND ## mpeg4_qpel16_h_lowpass_ ## MMX(halfH, src, 16, stride, 17);\
  2305. put ## RND ## pixels16_l2_ ## MMX(halfH, src, halfH, 16, stride, 17);\
  2306. put ## RND ## mpeg4_qpel16_v_lowpass_ ## MMX(halfHV, halfH, 16, 16);\
  2307. OPNAME ## pixels16_l2_ ## MMX(dst, halfH+16, halfHV, stride, 16, 16);\
  2308. }\
  2309. static void OPNAME ## qpel16_mc33_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  2310. uint64_t half[16*2 + 17*2];\
  2311. uint8_t * const halfH= ((uint8_t*)half) + 256;\
  2312. uint8_t * const halfHV= ((uint8_t*)half);\
  2313. put ## RND ## mpeg4_qpel16_h_lowpass_ ## MMX(halfH, src, 16, stride, 17);\
  2314. put ## RND ## pixels16_l2_ ## MMX(halfH, src+1, halfH, 16, stride, 17);\
  2315. put ## RND ## mpeg4_qpel16_v_lowpass_ ## MMX(halfHV, halfH, 16, 16);\
  2316. OPNAME ## pixels16_l2_ ## MMX(dst, halfH+16, halfHV, stride, 16, 16);\
  2317. }\
  2318. static void OPNAME ## qpel16_mc21_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  2319. uint64_t half[16*2 + 17*2];\
  2320. uint8_t * const halfH= ((uint8_t*)half) + 256;\
  2321. uint8_t * const halfHV= ((uint8_t*)half);\
  2322. put ## RND ## mpeg4_qpel16_h_lowpass_ ## MMX(halfH, src, 16, stride, 17);\
  2323. put ## RND ## mpeg4_qpel16_v_lowpass_ ## MMX(halfHV, halfH, 16, 16);\
  2324. OPNAME ## pixels16_l2_ ## MMX(dst, halfH, halfHV, stride, 16, 16);\
  2325. }\
  2326. static void OPNAME ## qpel16_mc23_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  2327. uint64_t half[16*2 + 17*2];\
  2328. uint8_t * const halfH= ((uint8_t*)half) + 256;\
  2329. uint8_t * const halfHV= ((uint8_t*)half);\
  2330. put ## RND ## mpeg4_qpel16_h_lowpass_ ## MMX(halfH, src, 16, stride, 17);\
  2331. put ## RND ## mpeg4_qpel16_v_lowpass_ ## MMX(halfHV, halfH, 16, 16);\
  2332. OPNAME ## pixels16_l2_ ## MMX(dst, halfH+16, halfHV, stride, 16, 16);\
  2333. }\
  2334. static void OPNAME ## qpel16_mc12_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  2335. uint64_t half[17*2];\
  2336. uint8_t * const halfH= ((uint8_t*)half);\
  2337. put ## RND ## mpeg4_qpel16_h_lowpass_ ## MMX(halfH, src, 16, stride, 17);\
  2338. put ## RND ## pixels16_l2_ ## MMX(halfH, src, halfH, 16, stride, 17);\
  2339. OPNAME ## mpeg4_qpel16_v_lowpass_ ## MMX(dst, halfH, stride, 16);\
  2340. }\
  2341. static void OPNAME ## qpel16_mc32_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  2342. uint64_t half[17*2];\
  2343. uint8_t * const halfH= ((uint8_t*)half);\
  2344. put ## RND ## mpeg4_qpel16_h_lowpass_ ## MMX(halfH, src, 16, stride, 17);\
  2345. put ## RND ## pixels16_l2_ ## MMX(halfH, src+1, halfH, 16, stride, 17);\
  2346. OPNAME ## mpeg4_qpel16_v_lowpass_ ## MMX(dst, halfH, stride, 16);\
  2347. }\
  2348. static void OPNAME ## qpel16_mc22_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  2349. uint64_t half[17*2];\
  2350. uint8_t * const halfH= ((uint8_t*)half);\
  2351. put ## RND ## mpeg4_qpel16_h_lowpass_ ## MMX(halfH, src, 16, stride, 17);\
  2352. OPNAME ## mpeg4_qpel16_v_lowpass_ ## MMX(dst, halfH, stride, 16);\
  2353. }
  2354. #define PUT_OP(a,b,temp, size) "mov" #size " " #a ", " #b " \n\t"
  2355. #define AVG_3DNOW_OP(a,b,temp, size) \
  2356. "mov" #size " " #b ", " #temp " \n\t"\
  2357. "pavgusb " #temp ", " #a " \n\t"\
  2358. "mov" #size " " #a ", " #b " \n\t"
  2359. #define AVG_MMX2_OP(a,b,temp, size) \
  2360. "mov" #size " " #b ", " #temp " \n\t"\
  2361. "pavgb " #temp ", " #a " \n\t"\
  2362. "mov" #size " " #a ", " #b " \n\t"
  2363. QPEL_BASE(put_ , ff_pw_16, _ , PUT_OP, PUT_OP)
  2364. QPEL_BASE(avg_ , ff_pw_16, _ , AVG_MMX2_OP, AVG_3DNOW_OP)
  2365. QPEL_BASE(put_no_rnd_, ff_pw_15, _no_rnd_, PUT_OP, PUT_OP)
  2366. QPEL_OP(put_ , ff_pw_16, _ , PUT_OP, 3dnow)
  2367. QPEL_OP(avg_ , ff_pw_16, _ , AVG_3DNOW_OP, 3dnow)
  2368. QPEL_OP(put_no_rnd_, ff_pw_15, _no_rnd_, PUT_OP, 3dnow)
  2369. QPEL_OP(put_ , ff_pw_16, _ , PUT_OP, mmx2)
  2370. QPEL_OP(avg_ , ff_pw_16, _ , AVG_MMX2_OP, mmx2)
  2371. QPEL_OP(put_no_rnd_, ff_pw_15, _no_rnd_, PUT_OP, mmx2)
  2372. /***********************************/
  2373. /* bilinear qpel: not compliant to any spec, only for -lavdopts fast */
  2374. #define QPEL_2TAP_XY(OPNAME, SIZE, MMX, XY, HPEL)\
  2375. static void OPNAME ## 2tap_qpel ## SIZE ## _mc ## XY ## _ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  2376. OPNAME ## pixels ## SIZE ## HPEL(dst, src, stride, SIZE);\
  2377. }
  2378. #define QPEL_2TAP_L3(OPNAME, SIZE, MMX, XY, S0, S1, S2)\
  2379. static void OPNAME ## 2tap_qpel ## SIZE ## _mc ## XY ## _ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  2380. OPNAME ## 2tap_qpel ## SIZE ## _l3_ ## MMX(dst, src+S0, stride, SIZE, S1, S2);\
  2381. }
  2382. #define QPEL_2TAP(OPNAME, SIZE, MMX)\
  2383. QPEL_2TAP_XY(OPNAME, SIZE, MMX, 20, _x2_ ## MMX)\
  2384. QPEL_2TAP_XY(OPNAME, SIZE, MMX, 02, _y2_ ## MMX)\
  2385. QPEL_2TAP_XY(OPNAME, SIZE, MMX, 22, _xy2_mmx)\
  2386. static const qpel_mc_func OPNAME ## 2tap_qpel ## SIZE ## _mc00_ ## MMX =\
  2387. OPNAME ## qpel ## SIZE ## _mc00_ ## MMX;\
  2388. static const qpel_mc_func OPNAME ## 2tap_qpel ## SIZE ## _mc21_ ## MMX =\
  2389. OPNAME ## 2tap_qpel ## SIZE ## _mc20_ ## MMX;\
  2390. static const qpel_mc_func OPNAME ## 2tap_qpel ## SIZE ## _mc12_ ## MMX =\
  2391. OPNAME ## 2tap_qpel ## SIZE ## _mc02_ ## MMX;\
  2392. static void OPNAME ## 2tap_qpel ## SIZE ## _mc32_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  2393. OPNAME ## pixels ## SIZE ## _y2_ ## MMX(dst, src+1, stride, SIZE);\
  2394. }\
  2395. static void OPNAME ## 2tap_qpel ## SIZE ## _mc23_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  2396. OPNAME ## pixels ## SIZE ## _x2_ ## MMX(dst, src+stride, stride, SIZE);\
  2397. }\
  2398. QPEL_2TAP_L3(OPNAME, SIZE, MMX, 10, 0, 1, 0)\
  2399. QPEL_2TAP_L3(OPNAME, SIZE, MMX, 30, 1, -1, 0)\
  2400. QPEL_2TAP_L3(OPNAME, SIZE, MMX, 01, 0, stride, 0)\
  2401. QPEL_2TAP_L3(OPNAME, SIZE, MMX, 03, stride, -stride, 0)\
  2402. QPEL_2TAP_L3(OPNAME, SIZE, MMX, 11, 0, stride, 1)\
  2403. QPEL_2TAP_L3(OPNAME, SIZE, MMX, 31, 1, stride, -1)\
  2404. QPEL_2TAP_L3(OPNAME, SIZE, MMX, 13, stride, -stride, 1)\
  2405. QPEL_2TAP_L3(OPNAME, SIZE, MMX, 33, stride+1, -stride, -1)\
  2406. QPEL_2TAP(put_, 16, mmx2)
  2407. QPEL_2TAP(avg_, 16, mmx2)
  2408. QPEL_2TAP(put_, 8, mmx2)
  2409. QPEL_2TAP(avg_, 8, mmx2)
  2410. QPEL_2TAP(put_, 16, 3dnow)
  2411. QPEL_2TAP(avg_, 16, 3dnow)
  2412. QPEL_2TAP(put_, 8, 3dnow)
  2413. QPEL_2TAP(avg_, 8, 3dnow)
  2414. #if 0
  2415. static void just_return() { return; }
  2416. #endif
  2417. #define SET_QPEL_FUNC(postfix1, postfix2) \
  2418. c->put_ ## postfix1 = put_ ## postfix2;\
  2419. c->put_no_rnd_ ## postfix1 = put_no_rnd_ ## postfix2;\
  2420. c->avg_ ## postfix1 = avg_ ## postfix2;
  2421. static void gmc_mmx(uint8_t *dst, uint8_t *src, int stride, int h, int ox, int oy,
  2422. int dxx, int dxy, int dyx, int dyy, int shift, int r, int width, int height){
  2423. const int w = 8;
  2424. const int ix = ox>>(16+shift);
  2425. const int iy = oy>>(16+shift);
  2426. const int oxs = ox>>4;
  2427. const int oys = oy>>4;
  2428. const int dxxs = dxx>>4;
  2429. const int dxys = dxy>>4;
  2430. const int dyxs = dyx>>4;
  2431. const int dyys = dyy>>4;
  2432. const uint16_t r4[4] = {r,r,r,r};
  2433. const uint16_t dxy4[4] = {dxys,dxys,dxys,dxys};
  2434. const uint16_t dyy4[4] = {dyys,dyys,dyys,dyys};
  2435. const uint64_t shift2 = 2*shift;
  2436. uint8_t edge_buf[(h+1)*stride];
  2437. int x, y;
  2438. const int dxw = (dxx-(1<<(16+shift)))*(w-1);
  2439. const int dyh = (dyy-(1<<(16+shift)))*(h-1);
  2440. const int dxh = dxy*(h-1);
  2441. const int dyw = dyx*(w-1);
  2442. if( // non-constant fullpel offset (3% of blocks)
  2443. (ox^(ox+dxw) | ox^(ox+dxh) | ox^(ox+dxw+dxh) |
  2444. oy^(oy+dyw) | oy^(oy+dyh) | oy^(oy+dyw+dyh)) >> (16+shift)
  2445. // uses more than 16 bits of subpel mv (only at huge resolution)
  2446. || (dxx|dxy|dyx|dyy)&15 )
  2447. {
  2448. //FIXME could still use mmx for some of the rows
  2449. ff_gmc_c(dst, src, stride, h, ox, oy, dxx, dxy, dyx, dyy, shift, r, width, height);
  2450. return;
  2451. }
  2452. src += ix + iy*stride;
  2453. if( (unsigned)ix >= width-w ||
  2454. (unsigned)iy >= height-h )
  2455. {
  2456. ff_emulated_edge_mc(edge_buf, src, stride, w+1, h+1, ix, iy, width, height);
  2457. src = edge_buf;
  2458. }
  2459. asm volatile(
  2460. "movd %0, %%mm6 \n\t"
  2461. "pxor %%mm7, %%mm7 \n\t"
  2462. "punpcklwd %%mm6, %%mm6 \n\t"
  2463. "punpcklwd %%mm6, %%mm6 \n\t"
  2464. :: "r"(1<<shift)
  2465. );
  2466. for(x=0; x<w; x+=4){
  2467. uint16_t dx4[4] = { oxs - dxys + dxxs*(x+0),
  2468. oxs - dxys + dxxs*(x+1),
  2469. oxs - dxys + dxxs*(x+2),
  2470. oxs - dxys + dxxs*(x+3) };
  2471. uint16_t dy4[4] = { oys - dyys + dyxs*(x+0),
  2472. oys - dyys + dyxs*(x+1),
  2473. oys - dyys + dyxs*(x+2),
  2474. oys - dyys + dyxs*(x+3) };
  2475. for(y=0; y<h; y++){
  2476. asm volatile(
  2477. "movq %0, %%mm4 \n\t"
  2478. "movq %1, %%mm5 \n\t"
  2479. "paddw %2, %%mm4 \n\t"
  2480. "paddw %3, %%mm5 \n\t"
  2481. "movq %%mm4, %0 \n\t"
  2482. "movq %%mm5, %1 \n\t"
  2483. "psrlw $12, %%mm4 \n\t"
  2484. "psrlw $12, %%mm5 \n\t"
  2485. : "+m"(*dx4), "+m"(*dy4)
  2486. : "m"(*dxy4), "m"(*dyy4)
  2487. );
  2488. asm volatile(
  2489. "movq %%mm6, %%mm2 \n\t"
  2490. "movq %%mm6, %%mm1 \n\t"
  2491. "psubw %%mm4, %%mm2 \n\t"
  2492. "psubw %%mm5, %%mm1 \n\t"
  2493. "movq %%mm2, %%mm0 \n\t"
  2494. "movq %%mm4, %%mm3 \n\t"
  2495. "pmullw %%mm1, %%mm0 \n\t" // (s-dx)*(s-dy)
  2496. "pmullw %%mm5, %%mm3 \n\t" // dx*dy
  2497. "pmullw %%mm5, %%mm2 \n\t" // (s-dx)*dy
  2498. "pmullw %%mm4, %%mm1 \n\t" // dx*(s-dy)
  2499. "movd %4, %%mm5 \n\t"
  2500. "movd %3, %%mm4 \n\t"
  2501. "punpcklbw %%mm7, %%mm5 \n\t"
  2502. "punpcklbw %%mm7, %%mm4 \n\t"
  2503. "pmullw %%mm5, %%mm3 \n\t" // src[1,1] * dx*dy
  2504. "pmullw %%mm4, %%mm2 \n\t" // src[0,1] * (s-dx)*dy
  2505. "movd %2, %%mm5 \n\t"
  2506. "movd %1, %%mm4 \n\t"
  2507. "punpcklbw %%mm7, %%mm5 \n\t"
  2508. "punpcklbw %%mm7, %%mm4 \n\t"
  2509. "pmullw %%mm5, %%mm1 \n\t" // src[1,0] * dx*(s-dy)
  2510. "pmullw %%mm4, %%mm0 \n\t" // src[0,0] * (s-dx)*(s-dy)
  2511. "paddw %5, %%mm1 \n\t"
  2512. "paddw %%mm3, %%mm2 \n\t"
  2513. "paddw %%mm1, %%mm0 \n\t"
  2514. "paddw %%mm2, %%mm0 \n\t"
  2515. "psrlw %6, %%mm0 \n\t"
  2516. "packuswb %%mm0, %%mm0 \n\t"
  2517. "movd %%mm0, %0 \n\t"
  2518. : "=m"(dst[x+y*stride])
  2519. : "m"(src[0]), "m"(src[1]),
  2520. "m"(src[stride]), "m"(src[stride+1]),
  2521. "m"(*r4), "m"(shift2)
  2522. );
  2523. src += stride;
  2524. }
  2525. src += 4-h*stride;
  2526. }
  2527. }
  2528. #ifdef CONFIG_ENCODERS
  2529. #define PHADDD(a, t)\
  2530. "movq "#a", "#t" \n\t"\
  2531. "psrlq $32, "#a" \n\t"\
  2532. "paddd "#t", "#a" \n\t"
  2533. /*
  2534. pmulhw: dst[0-15]=(src[0-15]*dst[0-15])[16-31]
  2535. pmulhrw: dst[0-15]=(src[0-15]*dst[0-15] + 0x8000)[16-31]
  2536. pmulhrsw: dst[0-15]=(src[0-15]*dst[0-15] + 0x4000)[15-30]
  2537. */
  2538. #define PMULHRW(x, y, s, o)\
  2539. "pmulhw " #s ", "#x " \n\t"\
  2540. "pmulhw " #s ", "#y " \n\t"\
  2541. "paddw " #o ", "#x " \n\t"\
  2542. "paddw " #o ", "#y " \n\t"\
  2543. "psraw $1, "#x " \n\t"\
  2544. "psraw $1, "#y " \n\t"
  2545. #define DEF(x) x ## _mmx
  2546. #define SET_RND MOVQ_WONE
  2547. #define SCALE_OFFSET 1
  2548. #include "dsputil_mmx_qns.h"
  2549. #undef DEF
  2550. #undef SET_RND
  2551. #undef SCALE_OFFSET
  2552. #undef PMULHRW
  2553. #define DEF(x) x ## _3dnow
  2554. #define SET_RND(x)
  2555. #define SCALE_OFFSET 0
  2556. #define PMULHRW(x, y, s, o)\
  2557. "pmulhrw " #s ", "#x " \n\t"\
  2558. "pmulhrw " #s ", "#y " \n\t"
  2559. #include "dsputil_mmx_qns.h"
  2560. #undef DEF
  2561. #undef SET_RND
  2562. #undef SCALE_OFFSET
  2563. #undef PMULHRW
  2564. #ifdef HAVE_SSSE3
  2565. #undef PHADDD
  2566. #define DEF(x) x ## _ssse3
  2567. #define SET_RND(x)
  2568. #define SCALE_OFFSET -1
  2569. #define PHADDD(a, t)\
  2570. "pshufw $0x0E, "#a", "#t" \n\t"\
  2571. "paddd "#t", "#a" \n\t" /* faster than phaddd on core2 */
  2572. #define PMULHRW(x, y, s, o)\
  2573. "pmulhrsw " #s ", "#x " \n\t"\
  2574. "pmulhrsw " #s ", "#y " \n\t"
  2575. #include "dsputil_mmx_qns.h"
  2576. #undef DEF
  2577. #undef SET_RND
  2578. #undef SCALE_OFFSET
  2579. #undef PMULHRW
  2580. #undef PHADDD
  2581. #endif //HAVE_SSSE3
  2582. #endif /* CONFIG_ENCODERS */
  2583. #define PREFETCH(name, op) \
  2584. static void name(void *mem, int stride, int h){\
  2585. const uint8_t *p= mem;\
  2586. do{\
  2587. asm volatile(#op" %0" :: "m"(*p));\
  2588. p+= stride;\
  2589. }while(--h);\
  2590. }
  2591. PREFETCH(prefetch_mmx2, prefetcht0)
  2592. PREFETCH(prefetch_3dnow, prefetch)
  2593. #undef PREFETCH
  2594. #include "h264dsp_mmx.c"
  2595. /* AVS specific */
  2596. void ff_cavsdsp_init_mmx2(DSPContext* c, AVCodecContext *avctx);
  2597. void ff_put_cavs_qpel8_mc00_mmx2(uint8_t *dst, uint8_t *src, int stride) {
  2598. put_pixels8_mmx(dst, src, stride, 8);
  2599. }
  2600. void ff_avg_cavs_qpel8_mc00_mmx2(uint8_t *dst, uint8_t *src, int stride) {
  2601. avg_pixels8_mmx(dst, src, stride, 8);
  2602. }
  2603. void ff_put_cavs_qpel16_mc00_mmx2(uint8_t *dst, uint8_t *src, int stride) {
  2604. put_pixels16_mmx(dst, src, stride, 16);
  2605. }
  2606. void ff_avg_cavs_qpel16_mc00_mmx2(uint8_t *dst, uint8_t *src, int stride) {
  2607. avg_pixels16_mmx(dst, src, stride, 16);
  2608. }
  2609. /* external functions, from idct_mmx.c */
  2610. void ff_mmx_idct(DCTELEM *block);
  2611. void ff_mmxext_idct(DCTELEM *block);
  2612. /* XXX: those functions should be suppressed ASAP when all IDCTs are
  2613. converted */
  2614. #ifdef CONFIG_GPL
  2615. static void ff_libmpeg2mmx_idct_put(uint8_t *dest, int line_size, DCTELEM *block)
  2616. {
  2617. ff_mmx_idct (block);
  2618. put_pixels_clamped_mmx(block, dest, line_size);
  2619. }
  2620. static void ff_libmpeg2mmx_idct_add(uint8_t *dest, int line_size, DCTELEM *block)
  2621. {
  2622. ff_mmx_idct (block);
  2623. add_pixels_clamped_mmx(block, dest, line_size);
  2624. }
  2625. static void ff_libmpeg2mmx2_idct_put(uint8_t *dest, int line_size, DCTELEM *block)
  2626. {
  2627. ff_mmxext_idct (block);
  2628. put_pixels_clamped_mmx(block, dest, line_size);
  2629. }
  2630. static void ff_libmpeg2mmx2_idct_add(uint8_t *dest, int line_size, DCTELEM *block)
  2631. {
  2632. ff_mmxext_idct (block);
  2633. add_pixels_clamped_mmx(block, dest, line_size);
  2634. }
  2635. #endif
  2636. static void ff_idct_xvid_mmx_put(uint8_t *dest, int line_size, DCTELEM *block)
  2637. {
  2638. ff_idct_xvid_mmx (block);
  2639. put_pixels_clamped_mmx(block, dest, line_size);
  2640. }
  2641. static void ff_idct_xvid_mmx_add(uint8_t *dest, int line_size, DCTELEM *block)
  2642. {
  2643. ff_idct_xvid_mmx (block);
  2644. add_pixels_clamped_mmx(block, dest, line_size);
  2645. }
  2646. static void ff_idct_xvid_mmx2_put(uint8_t *dest, int line_size, DCTELEM *block)
  2647. {
  2648. ff_idct_xvid_mmx2 (block);
  2649. put_pixels_clamped_mmx(block, dest, line_size);
  2650. }
  2651. static void ff_idct_xvid_mmx2_add(uint8_t *dest, int line_size, DCTELEM *block)
  2652. {
  2653. ff_idct_xvid_mmx2 (block);
  2654. add_pixels_clamped_mmx(block, dest, line_size);
  2655. }
  2656. static void vorbis_inverse_coupling_3dnow(float *mag, float *ang, int blocksize)
  2657. {
  2658. int i;
  2659. asm volatile("pxor %%mm7, %%mm7":);
  2660. for(i=0; i<blocksize; i+=2) {
  2661. asm volatile(
  2662. "movq %0, %%mm0 \n\t"
  2663. "movq %1, %%mm1 \n\t"
  2664. "movq %%mm0, %%mm2 \n\t"
  2665. "movq %%mm1, %%mm3 \n\t"
  2666. "pfcmpge %%mm7, %%mm2 \n\t" // m <= 0.0
  2667. "pfcmpge %%mm7, %%mm3 \n\t" // a <= 0.0
  2668. "pslld $31, %%mm2 \n\t" // keep only the sign bit
  2669. "pxor %%mm2, %%mm1 \n\t"
  2670. "movq %%mm3, %%mm4 \n\t"
  2671. "pand %%mm1, %%mm3 \n\t"
  2672. "pandn %%mm1, %%mm4 \n\t"
  2673. "pfadd %%mm0, %%mm3 \n\t" // a = m + ((a<0) & (a ^ sign(m)))
  2674. "pfsub %%mm4, %%mm0 \n\t" // m = m + ((a>0) & (a ^ sign(m)))
  2675. "movq %%mm3, %1 \n\t"
  2676. "movq %%mm0, %0 \n\t"
  2677. :"+m"(mag[i]), "+m"(ang[i])
  2678. ::"memory"
  2679. );
  2680. }
  2681. asm volatile("femms");
  2682. }
  2683. static void vorbis_inverse_coupling_sse(float *mag, float *ang, int blocksize)
  2684. {
  2685. int i;
  2686. asm volatile(
  2687. "movaps %0, %%xmm5 \n\t"
  2688. ::"m"(ff_pdw_80000000[0])
  2689. );
  2690. for(i=0; i<blocksize; i+=4) {
  2691. asm volatile(
  2692. "movaps %0, %%xmm0 \n\t"
  2693. "movaps %1, %%xmm1 \n\t"
  2694. "xorps %%xmm2, %%xmm2 \n\t"
  2695. "xorps %%xmm3, %%xmm3 \n\t"
  2696. "cmpleps %%xmm0, %%xmm2 \n\t" // m <= 0.0
  2697. "cmpleps %%xmm1, %%xmm3 \n\t" // a <= 0.0
  2698. "andps %%xmm5, %%xmm2 \n\t" // keep only the sign bit
  2699. "xorps %%xmm2, %%xmm1 \n\t"
  2700. "movaps %%xmm3, %%xmm4 \n\t"
  2701. "andps %%xmm1, %%xmm3 \n\t"
  2702. "andnps %%xmm1, %%xmm4 \n\t"
  2703. "addps %%xmm0, %%xmm3 \n\t" // a = m + ((a<0) & (a ^ sign(m)))
  2704. "subps %%xmm4, %%xmm0 \n\t" // m = m + ((a>0) & (a ^ sign(m)))
  2705. "movaps %%xmm3, %1 \n\t"
  2706. "movaps %%xmm0, %0 \n\t"
  2707. :"+m"(mag[i]), "+m"(ang[i])
  2708. ::"memory"
  2709. );
  2710. }
  2711. }
  2712. static void vector_fmul_3dnow(float *dst, const float *src, int len){
  2713. long i = (len-4)*4;
  2714. asm volatile(
  2715. "1: \n\t"
  2716. "movq (%1,%0), %%mm0 \n\t"
  2717. "movq 8(%1,%0), %%mm1 \n\t"
  2718. "pfmul (%2,%0), %%mm0 \n\t"
  2719. "pfmul 8(%2,%0), %%mm1 \n\t"
  2720. "movq %%mm0, (%1,%0) \n\t"
  2721. "movq %%mm1, 8(%1,%0) \n\t"
  2722. "sub $16, %0 \n\t"
  2723. "jge 1b \n\t"
  2724. "femms \n\t"
  2725. :"+r"(i)
  2726. :"r"(dst), "r"(src)
  2727. :"memory"
  2728. );
  2729. }
  2730. static void vector_fmul_sse(float *dst, const float *src, int len){
  2731. long i = (len-8)*4;
  2732. asm volatile(
  2733. "1: \n\t"
  2734. "movaps (%1,%0), %%xmm0 \n\t"
  2735. "movaps 16(%1,%0), %%xmm1 \n\t"
  2736. "mulps (%2,%0), %%xmm0 \n\t"
  2737. "mulps 16(%2,%0), %%xmm1 \n\t"
  2738. "movaps %%xmm0, (%1,%0) \n\t"
  2739. "movaps %%xmm1, 16(%1,%0) \n\t"
  2740. "sub $32, %0 \n\t"
  2741. "jge 1b \n\t"
  2742. :"+r"(i)
  2743. :"r"(dst), "r"(src)
  2744. :"memory"
  2745. );
  2746. }
  2747. static void vector_fmul_reverse_3dnow2(float *dst, const float *src0, const float *src1, int len){
  2748. long i = len*4-16;
  2749. asm volatile(
  2750. "1: \n\t"
  2751. "pswapd 8(%1), %%mm0 \n\t"
  2752. "pswapd (%1), %%mm1 \n\t"
  2753. "pfmul (%3,%0), %%mm0 \n\t"
  2754. "pfmul 8(%3,%0), %%mm1 \n\t"
  2755. "movq %%mm0, (%2,%0) \n\t"
  2756. "movq %%mm1, 8(%2,%0) \n\t"
  2757. "add $16, %1 \n\t"
  2758. "sub $16, %0 \n\t"
  2759. "jge 1b \n\t"
  2760. :"+r"(i), "+r"(src1)
  2761. :"r"(dst), "r"(src0)
  2762. );
  2763. asm volatile("femms");
  2764. }
  2765. static void vector_fmul_reverse_sse(float *dst, const float *src0, const float *src1, int len){
  2766. long i = len*4-32;
  2767. asm volatile(
  2768. "1: \n\t"
  2769. "movaps 16(%1), %%xmm0 \n\t"
  2770. "movaps (%1), %%xmm1 \n\t"
  2771. "shufps $0x1b, %%xmm0, %%xmm0 \n\t"
  2772. "shufps $0x1b, %%xmm1, %%xmm1 \n\t"
  2773. "mulps (%3,%0), %%xmm0 \n\t"
  2774. "mulps 16(%3,%0), %%xmm1 \n\t"
  2775. "movaps %%xmm0, (%2,%0) \n\t"
  2776. "movaps %%xmm1, 16(%2,%0) \n\t"
  2777. "add $32, %1 \n\t"
  2778. "sub $32, %0 \n\t"
  2779. "jge 1b \n\t"
  2780. :"+r"(i), "+r"(src1)
  2781. :"r"(dst), "r"(src0)
  2782. );
  2783. }
  2784. static void vector_fmul_add_add_3dnow(float *dst, const float *src0, const float *src1,
  2785. const float *src2, int src3, int len, int step){
  2786. long i = (len-4)*4;
  2787. if(step == 2 && src3 == 0){
  2788. dst += (len-4)*2;
  2789. asm volatile(
  2790. "1: \n\t"
  2791. "movq (%2,%0), %%mm0 \n\t"
  2792. "movq 8(%2,%0), %%mm1 \n\t"
  2793. "pfmul (%3,%0), %%mm0 \n\t"
  2794. "pfmul 8(%3,%0), %%mm1 \n\t"
  2795. "pfadd (%4,%0), %%mm0 \n\t"
  2796. "pfadd 8(%4,%0), %%mm1 \n\t"
  2797. "movd %%mm0, (%1) \n\t"
  2798. "movd %%mm1, 16(%1) \n\t"
  2799. "psrlq $32, %%mm0 \n\t"
  2800. "psrlq $32, %%mm1 \n\t"
  2801. "movd %%mm0, 8(%1) \n\t"
  2802. "movd %%mm1, 24(%1) \n\t"
  2803. "sub $32, %1 \n\t"
  2804. "sub $16, %0 \n\t"
  2805. "jge 1b \n\t"
  2806. :"+r"(i), "+r"(dst)
  2807. :"r"(src0), "r"(src1), "r"(src2)
  2808. :"memory"
  2809. );
  2810. }
  2811. else if(step == 1 && src3 == 0){
  2812. asm volatile(
  2813. "1: \n\t"
  2814. "movq (%2,%0), %%mm0 \n\t"
  2815. "movq 8(%2,%0), %%mm1 \n\t"
  2816. "pfmul (%3,%0), %%mm0 \n\t"
  2817. "pfmul 8(%3,%0), %%mm1 \n\t"
  2818. "pfadd (%4,%0), %%mm0 \n\t"
  2819. "pfadd 8(%4,%0), %%mm1 \n\t"
  2820. "movq %%mm0, (%1,%0) \n\t"
  2821. "movq %%mm1, 8(%1,%0) \n\t"
  2822. "sub $16, %0 \n\t"
  2823. "jge 1b \n\t"
  2824. :"+r"(i)
  2825. :"r"(dst), "r"(src0), "r"(src1), "r"(src2)
  2826. :"memory"
  2827. );
  2828. }
  2829. else
  2830. ff_vector_fmul_add_add_c(dst, src0, src1, src2, src3, len, step);
  2831. asm volatile("femms");
  2832. }
  2833. static void vector_fmul_add_add_sse(float *dst, const float *src0, const float *src1,
  2834. const float *src2, int src3, int len, int step){
  2835. long i = (len-8)*4;
  2836. if(step == 2 && src3 == 0){
  2837. dst += (len-8)*2;
  2838. asm volatile(
  2839. "1: \n\t"
  2840. "movaps (%2,%0), %%xmm0 \n\t"
  2841. "movaps 16(%2,%0), %%xmm1 \n\t"
  2842. "mulps (%3,%0), %%xmm0 \n\t"
  2843. "mulps 16(%3,%0), %%xmm1 \n\t"
  2844. "addps (%4,%0), %%xmm0 \n\t"
  2845. "addps 16(%4,%0), %%xmm1 \n\t"
  2846. "movss %%xmm0, (%1) \n\t"
  2847. "movss %%xmm1, 32(%1) \n\t"
  2848. "movhlps %%xmm0, %%xmm2 \n\t"
  2849. "movhlps %%xmm1, %%xmm3 \n\t"
  2850. "movss %%xmm2, 16(%1) \n\t"
  2851. "movss %%xmm3, 48(%1) \n\t"
  2852. "shufps $0xb1, %%xmm0, %%xmm0 \n\t"
  2853. "shufps $0xb1, %%xmm1, %%xmm1 \n\t"
  2854. "movss %%xmm0, 8(%1) \n\t"
  2855. "movss %%xmm1, 40(%1) \n\t"
  2856. "movhlps %%xmm0, %%xmm2 \n\t"
  2857. "movhlps %%xmm1, %%xmm3 \n\t"
  2858. "movss %%xmm2, 24(%1) \n\t"
  2859. "movss %%xmm3, 56(%1) \n\t"
  2860. "sub $64, %1 \n\t"
  2861. "sub $32, %0 \n\t"
  2862. "jge 1b \n\t"
  2863. :"+r"(i), "+r"(dst)
  2864. :"r"(src0), "r"(src1), "r"(src2)
  2865. :"memory"
  2866. );
  2867. }
  2868. else if(step == 1 && src3 == 0){
  2869. asm volatile(
  2870. "1: \n\t"
  2871. "movaps (%2,%0), %%xmm0 \n\t"
  2872. "movaps 16(%2,%0), %%xmm1 \n\t"
  2873. "mulps (%3,%0), %%xmm0 \n\t"
  2874. "mulps 16(%3,%0), %%xmm1 \n\t"
  2875. "addps (%4,%0), %%xmm0 \n\t"
  2876. "addps 16(%4,%0), %%xmm1 \n\t"
  2877. "movaps %%xmm0, (%1,%0) \n\t"
  2878. "movaps %%xmm1, 16(%1,%0) \n\t"
  2879. "sub $32, %0 \n\t"
  2880. "jge 1b \n\t"
  2881. :"+r"(i)
  2882. :"r"(dst), "r"(src0), "r"(src1), "r"(src2)
  2883. :"memory"
  2884. );
  2885. }
  2886. else
  2887. ff_vector_fmul_add_add_c(dst, src0, src1, src2, src3, len, step);
  2888. }
  2889. static void float_to_int16_3dnow(int16_t *dst, const float *src, int len){
  2890. // not bit-exact: pf2id uses different rounding than C and SSE
  2891. int i;
  2892. for(i=0; i<len; i+=4) {
  2893. asm volatile(
  2894. "pf2id %1, %%mm0 \n\t"
  2895. "pf2id %2, %%mm1 \n\t"
  2896. "packssdw %%mm1, %%mm0 \n\t"
  2897. "movq %%mm0, %0 \n\t"
  2898. :"=m"(dst[i])
  2899. :"m"(src[i]), "m"(src[i+2])
  2900. );
  2901. }
  2902. asm volatile("femms");
  2903. }
  2904. static void float_to_int16_sse(int16_t *dst, const float *src, int len){
  2905. int i;
  2906. for(i=0; i<len; i+=4) {
  2907. asm volatile(
  2908. "cvtps2pi %1, %%mm0 \n\t"
  2909. "cvtps2pi %2, %%mm1 \n\t"
  2910. "packssdw %%mm1, %%mm0 \n\t"
  2911. "movq %%mm0, %0 \n\t"
  2912. :"=m"(dst[i])
  2913. :"m"(src[i]), "m"(src[i+2])
  2914. );
  2915. }
  2916. asm volatile("emms");
  2917. }
  2918. #ifdef CONFIG_SNOW_DECODER
  2919. extern void ff_snow_horizontal_compose97i_sse2(DWTELEM *b, int width);
  2920. extern void ff_snow_horizontal_compose97i_mmx(DWTELEM *b, int width);
  2921. extern void ff_snow_vertical_compose97i_sse2(DWTELEM *b0, DWTELEM *b1, DWTELEM *b2, DWTELEM *b3, DWTELEM *b4, DWTELEM *b5, int width);
  2922. extern void ff_snow_vertical_compose97i_mmx(DWTELEM *b0, DWTELEM *b1, DWTELEM *b2, DWTELEM *b3, DWTELEM *b4, DWTELEM *b5, int width);
  2923. extern void ff_snow_inner_add_yblock_sse2(const uint8_t *obmc, const int obmc_stride, uint8_t * * block, int b_w, int b_h,
  2924. int src_x, int src_y, int src_stride, slice_buffer * sb, int add, uint8_t * dst8);
  2925. extern void ff_snow_inner_add_yblock_mmx(const uint8_t *obmc, const int obmc_stride, uint8_t * * block, int b_w, int b_h,
  2926. int src_x, int src_y, int src_stride, slice_buffer * sb, int add, uint8_t * dst8);
  2927. #endif
  2928. void dsputil_init_mmx(DSPContext* c, AVCodecContext *avctx)
  2929. {
  2930. mm_flags = mm_support();
  2931. if (avctx->dsp_mask) {
  2932. if (avctx->dsp_mask & FF_MM_FORCE)
  2933. mm_flags |= (avctx->dsp_mask & 0xffff);
  2934. else
  2935. mm_flags &= ~(avctx->dsp_mask & 0xffff);
  2936. }
  2937. #if 0
  2938. av_log(avctx, AV_LOG_INFO, "libavcodec: CPU flags:");
  2939. if (mm_flags & MM_MMX)
  2940. av_log(avctx, AV_LOG_INFO, " mmx");
  2941. if (mm_flags & MM_MMXEXT)
  2942. av_log(avctx, AV_LOG_INFO, " mmxext");
  2943. if (mm_flags & MM_3DNOW)
  2944. av_log(avctx, AV_LOG_INFO, " 3dnow");
  2945. if (mm_flags & MM_SSE)
  2946. av_log(avctx, AV_LOG_INFO, " sse");
  2947. if (mm_flags & MM_SSE2)
  2948. av_log(avctx, AV_LOG_INFO, " sse2");
  2949. av_log(avctx, AV_LOG_INFO, "\n");
  2950. #endif
  2951. if (mm_flags & MM_MMX) {
  2952. const int idct_algo= avctx->idct_algo;
  2953. #ifdef CONFIG_ENCODERS
  2954. const int dct_algo = avctx->dct_algo;
  2955. if(dct_algo==FF_DCT_AUTO || dct_algo==FF_DCT_MMX){
  2956. if(mm_flags & MM_SSE2){
  2957. c->fdct = ff_fdct_sse2;
  2958. }else if(mm_flags & MM_MMXEXT){
  2959. c->fdct = ff_fdct_mmx2;
  2960. }else{
  2961. c->fdct = ff_fdct_mmx;
  2962. }
  2963. }
  2964. #endif //CONFIG_ENCODERS
  2965. if(avctx->lowres==0){
  2966. if(idct_algo==FF_IDCT_AUTO || idct_algo==FF_IDCT_SIMPLEMMX){
  2967. c->idct_put= ff_simple_idct_put_mmx;
  2968. c->idct_add= ff_simple_idct_add_mmx;
  2969. c->idct = ff_simple_idct_mmx;
  2970. c->idct_permutation_type= FF_SIMPLE_IDCT_PERM;
  2971. #ifdef CONFIG_GPL
  2972. }else if(idct_algo==FF_IDCT_LIBMPEG2MMX){
  2973. if(mm_flags & MM_MMXEXT){
  2974. c->idct_put= ff_libmpeg2mmx2_idct_put;
  2975. c->idct_add= ff_libmpeg2mmx2_idct_add;
  2976. c->idct = ff_mmxext_idct;
  2977. }else{
  2978. c->idct_put= ff_libmpeg2mmx_idct_put;
  2979. c->idct_add= ff_libmpeg2mmx_idct_add;
  2980. c->idct = ff_mmx_idct;
  2981. }
  2982. c->idct_permutation_type= FF_LIBMPEG2_IDCT_PERM;
  2983. #endif
  2984. }else if((ENABLE_VP3_DECODER || ENABLE_VP5_DECODER || ENABLE_VP6_DECODER) &&
  2985. idct_algo==FF_IDCT_VP3 &&
  2986. avctx->codec->id!=CODEC_ID_THEORA &&
  2987. !(avctx->flags & CODEC_FLAG_BITEXACT)){
  2988. if(mm_flags & MM_SSE2){
  2989. c->idct_put= ff_vp3_idct_put_sse2;
  2990. c->idct_add= ff_vp3_idct_add_sse2;
  2991. c->idct = ff_vp3_idct_sse2;
  2992. c->idct_permutation_type= FF_TRANSPOSE_IDCT_PERM;
  2993. }else{
  2994. ff_vp3_dsp_init_mmx();
  2995. c->idct_put= ff_vp3_idct_put_mmx;
  2996. c->idct_add= ff_vp3_idct_add_mmx;
  2997. c->idct = ff_vp3_idct_mmx;
  2998. c->idct_permutation_type= FF_PARTTRANS_IDCT_PERM;
  2999. }
  3000. }else if(idct_algo==FF_IDCT_CAVS){
  3001. c->idct_permutation_type= FF_TRANSPOSE_IDCT_PERM;
  3002. }else if(idct_algo==FF_IDCT_XVIDMMX){
  3003. if(mm_flags & MM_MMXEXT){
  3004. c->idct_put= ff_idct_xvid_mmx2_put;
  3005. c->idct_add= ff_idct_xvid_mmx2_add;
  3006. c->idct = ff_idct_xvid_mmx2;
  3007. }else{
  3008. c->idct_put= ff_idct_xvid_mmx_put;
  3009. c->idct_add= ff_idct_xvid_mmx_add;
  3010. c->idct = ff_idct_xvid_mmx;
  3011. }
  3012. }
  3013. }
  3014. #ifdef CONFIG_ENCODERS
  3015. c->get_pixels = get_pixels_mmx;
  3016. c->diff_pixels = diff_pixels_mmx;
  3017. #endif //CONFIG_ENCODERS
  3018. c->put_pixels_clamped = put_pixels_clamped_mmx;
  3019. c->put_signed_pixels_clamped = put_signed_pixels_clamped_mmx;
  3020. c->add_pixels_clamped = add_pixels_clamped_mmx;
  3021. c->clear_blocks = clear_blocks_mmx;
  3022. #ifdef CONFIG_ENCODERS
  3023. c->pix_sum = pix_sum16_mmx;
  3024. #endif //CONFIG_ENCODERS
  3025. c->put_pixels_tab[0][0] = put_pixels16_mmx;
  3026. c->put_pixels_tab[0][1] = put_pixels16_x2_mmx;
  3027. c->put_pixels_tab[0][2] = put_pixels16_y2_mmx;
  3028. c->put_pixels_tab[0][3] = put_pixels16_xy2_mmx;
  3029. c->put_no_rnd_pixels_tab[0][0] = put_pixels16_mmx;
  3030. c->put_no_rnd_pixels_tab[0][1] = put_no_rnd_pixels16_x2_mmx;
  3031. c->put_no_rnd_pixels_tab[0][2] = put_no_rnd_pixels16_y2_mmx;
  3032. c->put_no_rnd_pixels_tab[0][3] = put_no_rnd_pixels16_xy2_mmx;
  3033. c->avg_pixels_tab[0][0] = avg_pixels16_mmx;
  3034. c->avg_pixels_tab[0][1] = avg_pixels16_x2_mmx;
  3035. c->avg_pixels_tab[0][2] = avg_pixels16_y2_mmx;
  3036. c->avg_pixels_tab[0][3] = avg_pixels16_xy2_mmx;
  3037. c->avg_no_rnd_pixels_tab[0][0] = avg_no_rnd_pixels16_mmx;
  3038. c->avg_no_rnd_pixels_tab[0][1] = avg_no_rnd_pixels16_x2_mmx;
  3039. c->avg_no_rnd_pixels_tab[0][2] = avg_no_rnd_pixels16_y2_mmx;
  3040. c->avg_no_rnd_pixels_tab[0][3] = avg_no_rnd_pixels16_xy2_mmx;
  3041. c->put_pixels_tab[1][0] = put_pixels8_mmx;
  3042. c->put_pixels_tab[1][1] = put_pixels8_x2_mmx;
  3043. c->put_pixels_tab[1][2] = put_pixels8_y2_mmx;
  3044. c->put_pixels_tab[1][3] = put_pixels8_xy2_mmx;
  3045. c->put_no_rnd_pixels_tab[1][0] = put_pixels8_mmx;
  3046. c->put_no_rnd_pixels_tab[1][1] = put_no_rnd_pixels8_x2_mmx;
  3047. c->put_no_rnd_pixels_tab[1][2] = put_no_rnd_pixels8_y2_mmx;
  3048. c->put_no_rnd_pixels_tab[1][3] = put_no_rnd_pixels8_xy2_mmx;
  3049. c->avg_pixels_tab[1][0] = avg_pixels8_mmx;
  3050. c->avg_pixels_tab[1][1] = avg_pixels8_x2_mmx;
  3051. c->avg_pixels_tab[1][2] = avg_pixels8_y2_mmx;
  3052. c->avg_pixels_tab[1][3] = avg_pixels8_xy2_mmx;
  3053. c->avg_no_rnd_pixels_tab[1][0] = avg_no_rnd_pixels8_mmx;
  3054. c->avg_no_rnd_pixels_tab[1][1] = avg_no_rnd_pixels8_x2_mmx;
  3055. c->avg_no_rnd_pixels_tab[1][2] = avg_no_rnd_pixels8_y2_mmx;
  3056. c->avg_no_rnd_pixels_tab[1][3] = avg_no_rnd_pixels8_xy2_mmx;
  3057. c->gmc= gmc_mmx;
  3058. c->add_bytes= add_bytes_mmx;
  3059. #ifdef CONFIG_ENCODERS
  3060. c->diff_bytes= diff_bytes_mmx;
  3061. c->sum_abs_dctelem= sum_abs_dctelem_mmx;
  3062. c->hadamard8_diff[0]= hadamard8_diff16_mmx;
  3063. c->hadamard8_diff[1]= hadamard8_diff_mmx;
  3064. c->pix_norm1 = pix_norm1_mmx;
  3065. c->sse[0] = (mm_flags & MM_SSE2) ? sse16_sse2 : sse16_mmx;
  3066. c->sse[1] = sse8_mmx;
  3067. c->vsad[4]= vsad_intra16_mmx;
  3068. c->nsse[0] = nsse16_mmx;
  3069. c->nsse[1] = nsse8_mmx;
  3070. if(!(avctx->flags & CODEC_FLAG_BITEXACT)){
  3071. c->vsad[0] = vsad16_mmx;
  3072. }
  3073. if(!(avctx->flags & CODEC_FLAG_BITEXACT)){
  3074. c->try_8x8basis= try_8x8basis_mmx;
  3075. }
  3076. c->add_8x8basis= add_8x8basis_mmx;
  3077. c->ssd_int8_vs_int16 = ssd_int8_vs_int16_mmx;
  3078. #endif //CONFIG_ENCODERS
  3079. if (ENABLE_ANY_H263) {
  3080. c->h263_v_loop_filter= h263_v_loop_filter_mmx;
  3081. c->h263_h_loop_filter= h263_h_loop_filter_mmx;
  3082. }
  3083. c->put_h264_chroma_pixels_tab[0]= put_h264_chroma_mc8_mmx;
  3084. c->put_h264_chroma_pixels_tab[1]= put_h264_chroma_mc4_mmx;
  3085. c->h264_idct_dc_add=
  3086. c->h264_idct_add= ff_h264_idct_add_mmx;
  3087. c->h264_idct8_dc_add=
  3088. c->h264_idct8_add= ff_h264_idct8_add_mmx;
  3089. if (mm_flags & MM_MMXEXT) {
  3090. c->prefetch = prefetch_mmx2;
  3091. c->put_pixels_tab[0][1] = put_pixels16_x2_mmx2;
  3092. c->put_pixels_tab[0][2] = put_pixels16_y2_mmx2;
  3093. c->avg_pixels_tab[0][0] = avg_pixels16_mmx2;
  3094. c->avg_pixels_tab[0][1] = avg_pixels16_x2_mmx2;
  3095. c->avg_pixels_tab[0][2] = avg_pixels16_y2_mmx2;
  3096. c->put_pixels_tab[1][1] = put_pixels8_x2_mmx2;
  3097. c->put_pixels_tab[1][2] = put_pixels8_y2_mmx2;
  3098. c->avg_pixels_tab[1][0] = avg_pixels8_mmx2;
  3099. c->avg_pixels_tab[1][1] = avg_pixels8_x2_mmx2;
  3100. c->avg_pixels_tab[1][2] = avg_pixels8_y2_mmx2;
  3101. #ifdef CONFIG_ENCODERS
  3102. c->sum_abs_dctelem= sum_abs_dctelem_mmx2;
  3103. c->hadamard8_diff[0]= hadamard8_diff16_mmx2;
  3104. c->hadamard8_diff[1]= hadamard8_diff_mmx2;
  3105. c->vsad[4]= vsad_intra16_mmx2;
  3106. #endif //CONFIG_ENCODERS
  3107. c->h264_idct_dc_add= ff_h264_idct_dc_add_mmx2;
  3108. c->h264_idct8_dc_add= ff_h264_idct8_dc_add_mmx2;
  3109. if(!(avctx->flags & CODEC_FLAG_BITEXACT)){
  3110. c->put_no_rnd_pixels_tab[0][1] = put_no_rnd_pixels16_x2_mmx2;
  3111. c->put_no_rnd_pixels_tab[0][2] = put_no_rnd_pixels16_y2_mmx2;
  3112. c->put_no_rnd_pixels_tab[1][1] = put_no_rnd_pixels8_x2_mmx2;
  3113. c->put_no_rnd_pixels_tab[1][2] = put_no_rnd_pixels8_y2_mmx2;
  3114. c->avg_pixels_tab[0][3] = avg_pixels16_xy2_mmx2;
  3115. c->avg_pixels_tab[1][3] = avg_pixels8_xy2_mmx2;
  3116. #ifdef CONFIG_ENCODERS
  3117. c->vsad[0] = vsad16_mmx2;
  3118. #endif //CONFIG_ENCODERS
  3119. }
  3120. #if 1
  3121. SET_QPEL_FUNC(qpel_pixels_tab[0][ 0], qpel16_mc00_mmx2)
  3122. SET_QPEL_FUNC(qpel_pixels_tab[0][ 1], qpel16_mc10_mmx2)
  3123. SET_QPEL_FUNC(qpel_pixels_tab[0][ 2], qpel16_mc20_mmx2)
  3124. SET_QPEL_FUNC(qpel_pixels_tab[0][ 3], qpel16_mc30_mmx2)
  3125. SET_QPEL_FUNC(qpel_pixels_tab[0][ 4], qpel16_mc01_mmx2)
  3126. SET_QPEL_FUNC(qpel_pixels_tab[0][ 5], qpel16_mc11_mmx2)
  3127. SET_QPEL_FUNC(qpel_pixels_tab[0][ 6], qpel16_mc21_mmx2)
  3128. SET_QPEL_FUNC(qpel_pixels_tab[0][ 7], qpel16_mc31_mmx2)
  3129. SET_QPEL_FUNC(qpel_pixels_tab[0][ 8], qpel16_mc02_mmx2)
  3130. SET_QPEL_FUNC(qpel_pixels_tab[0][ 9], qpel16_mc12_mmx2)
  3131. SET_QPEL_FUNC(qpel_pixels_tab[0][10], qpel16_mc22_mmx2)
  3132. SET_QPEL_FUNC(qpel_pixels_tab[0][11], qpel16_mc32_mmx2)
  3133. SET_QPEL_FUNC(qpel_pixels_tab[0][12], qpel16_mc03_mmx2)
  3134. SET_QPEL_FUNC(qpel_pixels_tab[0][13], qpel16_mc13_mmx2)
  3135. SET_QPEL_FUNC(qpel_pixels_tab[0][14], qpel16_mc23_mmx2)
  3136. SET_QPEL_FUNC(qpel_pixels_tab[0][15], qpel16_mc33_mmx2)
  3137. SET_QPEL_FUNC(qpel_pixels_tab[1][ 0], qpel8_mc00_mmx2)
  3138. SET_QPEL_FUNC(qpel_pixels_tab[1][ 1], qpel8_mc10_mmx2)
  3139. SET_QPEL_FUNC(qpel_pixels_tab[1][ 2], qpel8_mc20_mmx2)
  3140. SET_QPEL_FUNC(qpel_pixels_tab[1][ 3], qpel8_mc30_mmx2)
  3141. SET_QPEL_FUNC(qpel_pixels_tab[1][ 4], qpel8_mc01_mmx2)
  3142. SET_QPEL_FUNC(qpel_pixels_tab[1][ 5], qpel8_mc11_mmx2)
  3143. SET_QPEL_FUNC(qpel_pixels_tab[1][ 6], qpel8_mc21_mmx2)
  3144. SET_QPEL_FUNC(qpel_pixels_tab[1][ 7], qpel8_mc31_mmx2)
  3145. SET_QPEL_FUNC(qpel_pixels_tab[1][ 8], qpel8_mc02_mmx2)
  3146. SET_QPEL_FUNC(qpel_pixels_tab[1][ 9], qpel8_mc12_mmx2)
  3147. SET_QPEL_FUNC(qpel_pixels_tab[1][10], qpel8_mc22_mmx2)
  3148. SET_QPEL_FUNC(qpel_pixels_tab[1][11], qpel8_mc32_mmx2)
  3149. SET_QPEL_FUNC(qpel_pixels_tab[1][12], qpel8_mc03_mmx2)
  3150. SET_QPEL_FUNC(qpel_pixels_tab[1][13], qpel8_mc13_mmx2)
  3151. SET_QPEL_FUNC(qpel_pixels_tab[1][14], qpel8_mc23_mmx2)
  3152. SET_QPEL_FUNC(qpel_pixels_tab[1][15], qpel8_mc33_mmx2)
  3153. #endif
  3154. //FIXME 3dnow too
  3155. #define dspfunc(PFX, IDX, NUM) \
  3156. c->PFX ## _pixels_tab[IDX][ 0] = PFX ## NUM ## _mc00_mmx2; \
  3157. c->PFX ## _pixels_tab[IDX][ 1] = PFX ## NUM ## _mc10_mmx2; \
  3158. c->PFX ## _pixels_tab[IDX][ 2] = PFX ## NUM ## _mc20_mmx2; \
  3159. c->PFX ## _pixels_tab[IDX][ 3] = PFX ## NUM ## _mc30_mmx2; \
  3160. c->PFX ## _pixels_tab[IDX][ 4] = PFX ## NUM ## _mc01_mmx2; \
  3161. c->PFX ## _pixels_tab[IDX][ 5] = PFX ## NUM ## _mc11_mmx2; \
  3162. c->PFX ## _pixels_tab[IDX][ 6] = PFX ## NUM ## _mc21_mmx2; \
  3163. c->PFX ## _pixels_tab[IDX][ 7] = PFX ## NUM ## _mc31_mmx2; \
  3164. c->PFX ## _pixels_tab[IDX][ 8] = PFX ## NUM ## _mc02_mmx2; \
  3165. c->PFX ## _pixels_tab[IDX][ 9] = PFX ## NUM ## _mc12_mmx2; \
  3166. c->PFX ## _pixels_tab[IDX][10] = PFX ## NUM ## _mc22_mmx2; \
  3167. c->PFX ## _pixels_tab[IDX][11] = PFX ## NUM ## _mc32_mmx2; \
  3168. c->PFX ## _pixels_tab[IDX][12] = PFX ## NUM ## _mc03_mmx2; \
  3169. c->PFX ## _pixels_tab[IDX][13] = PFX ## NUM ## _mc13_mmx2; \
  3170. c->PFX ## _pixels_tab[IDX][14] = PFX ## NUM ## _mc23_mmx2; \
  3171. c->PFX ## _pixels_tab[IDX][15] = PFX ## NUM ## _mc33_mmx2
  3172. dspfunc(put_h264_qpel, 0, 16);
  3173. dspfunc(put_h264_qpel, 1, 8);
  3174. dspfunc(put_h264_qpel, 2, 4);
  3175. dspfunc(avg_h264_qpel, 0, 16);
  3176. dspfunc(avg_h264_qpel, 1, 8);
  3177. dspfunc(avg_h264_qpel, 2, 4);
  3178. dspfunc(put_2tap_qpel, 0, 16);
  3179. dspfunc(put_2tap_qpel, 1, 8);
  3180. dspfunc(avg_2tap_qpel, 0, 16);
  3181. dspfunc(avg_2tap_qpel, 1, 8);
  3182. #undef dspfunc
  3183. c->avg_h264_chroma_pixels_tab[0]= avg_h264_chroma_mc8_mmx2;
  3184. c->avg_h264_chroma_pixels_tab[1]= avg_h264_chroma_mc4_mmx2;
  3185. c->avg_h264_chroma_pixels_tab[2]= avg_h264_chroma_mc2_mmx2;
  3186. c->put_h264_chroma_pixels_tab[2]= put_h264_chroma_mc2_mmx2;
  3187. c->h264_v_loop_filter_luma= h264_v_loop_filter_luma_mmx2;
  3188. c->h264_h_loop_filter_luma= h264_h_loop_filter_luma_mmx2;
  3189. c->h264_v_loop_filter_chroma= h264_v_loop_filter_chroma_mmx2;
  3190. c->h264_h_loop_filter_chroma= h264_h_loop_filter_chroma_mmx2;
  3191. c->h264_v_loop_filter_chroma_intra= h264_v_loop_filter_chroma_intra_mmx2;
  3192. c->h264_h_loop_filter_chroma_intra= h264_h_loop_filter_chroma_intra_mmx2;
  3193. c->h264_loop_filter_strength= h264_loop_filter_strength_mmx2;
  3194. c->weight_h264_pixels_tab[0]= ff_h264_weight_16x16_mmx2;
  3195. c->weight_h264_pixels_tab[1]= ff_h264_weight_16x8_mmx2;
  3196. c->weight_h264_pixels_tab[2]= ff_h264_weight_8x16_mmx2;
  3197. c->weight_h264_pixels_tab[3]= ff_h264_weight_8x8_mmx2;
  3198. c->weight_h264_pixels_tab[4]= ff_h264_weight_8x4_mmx2;
  3199. c->weight_h264_pixels_tab[5]= ff_h264_weight_4x8_mmx2;
  3200. c->weight_h264_pixels_tab[6]= ff_h264_weight_4x4_mmx2;
  3201. c->weight_h264_pixels_tab[7]= ff_h264_weight_4x2_mmx2;
  3202. c->biweight_h264_pixels_tab[0]= ff_h264_biweight_16x16_mmx2;
  3203. c->biweight_h264_pixels_tab[1]= ff_h264_biweight_16x8_mmx2;
  3204. c->biweight_h264_pixels_tab[2]= ff_h264_biweight_8x16_mmx2;
  3205. c->biweight_h264_pixels_tab[3]= ff_h264_biweight_8x8_mmx2;
  3206. c->biweight_h264_pixels_tab[4]= ff_h264_biweight_8x4_mmx2;
  3207. c->biweight_h264_pixels_tab[5]= ff_h264_biweight_4x8_mmx2;
  3208. c->biweight_h264_pixels_tab[6]= ff_h264_biweight_4x4_mmx2;
  3209. c->biweight_h264_pixels_tab[7]= ff_h264_biweight_4x2_mmx2;
  3210. #ifdef CONFIG_CAVS_DECODER
  3211. ff_cavsdsp_init_mmx2(c, avctx);
  3212. #endif
  3213. #ifdef CONFIG_ENCODERS
  3214. c->sub_hfyu_median_prediction= sub_hfyu_median_prediction_mmx2;
  3215. #endif //CONFIG_ENCODERS
  3216. } else if (mm_flags & MM_3DNOW) {
  3217. c->prefetch = prefetch_3dnow;
  3218. c->put_pixels_tab[0][1] = put_pixels16_x2_3dnow;
  3219. c->put_pixels_tab[0][2] = put_pixels16_y2_3dnow;
  3220. c->avg_pixels_tab[0][0] = avg_pixels16_3dnow;
  3221. c->avg_pixels_tab[0][1] = avg_pixels16_x2_3dnow;
  3222. c->avg_pixels_tab[0][2] = avg_pixels16_y2_3dnow;
  3223. c->put_pixels_tab[1][1] = put_pixels8_x2_3dnow;
  3224. c->put_pixels_tab[1][2] = put_pixels8_y2_3dnow;
  3225. c->avg_pixels_tab[1][0] = avg_pixels8_3dnow;
  3226. c->avg_pixels_tab[1][1] = avg_pixels8_x2_3dnow;
  3227. c->avg_pixels_tab[1][2] = avg_pixels8_y2_3dnow;
  3228. if(!(avctx->flags & CODEC_FLAG_BITEXACT)){
  3229. c->put_no_rnd_pixels_tab[0][1] = put_no_rnd_pixels16_x2_3dnow;
  3230. c->put_no_rnd_pixels_tab[0][2] = put_no_rnd_pixels16_y2_3dnow;
  3231. c->put_no_rnd_pixels_tab[1][1] = put_no_rnd_pixels8_x2_3dnow;
  3232. c->put_no_rnd_pixels_tab[1][2] = put_no_rnd_pixels8_y2_3dnow;
  3233. c->avg_pixels_tab[0][3] = avg_pixels16_xy2_3dnow;
  3234. c->avg_pixels_tab[1][3] = avg_pixels8_xy2_3dnow;
  3235. }
  3236. SET_QPEL_FUNC(qpel_pixels_tab[0][ 0], qpel16_mc00_3dnow)
  3237. SET_QPEL_FUNC(qpel_pixels_tab[0][ 1], qpel16_mc10_3dnow)
  3238. SET_QPEL_FUNC(qpel_pixels_tab[0][ 2], qpel16_mc20_3dnow)
  3239. SET_QPEL_FUNC(qpel_pixels_tab[0][ 3], qpel16_mc30_3dnow)
  3240. SET_QPEL_FUNC(qpel_pixels_tab[0][ 4], qpel16_mc01_3dnow)
  3241. SET_QPEL_FUNC(qpel_pixels_tab[0][ 5], qpel16_mc11_3dnow)
  3242. SET_QPEL_FUNC(qpel_pixels_tab[0][ 6], qpel16_mc21_3dnow)
  3243. SET_QPEL_FUNC(qpel_pixels_tab[0][ 7], qpel16_mc31_3dnow)
  3244. SET_QPEL_FUNC(qpel_pixels_tab[0][ 8], qpel16_mc02_3dnow)
  3245. SET_QPEL_FUNC(qpel_pixels_tab[0][ 9], qpel16_mc12_3dnow)
  3246. SET_QPEL_FUNC(qpel_pixels_tab[0][10], qpel16_mc22_3dnow)
  3247. SET_QPEL_FUNC(qpel_pixels_tab[0][11], qpel16_mc32_3dnow)
  3248. SET_QPEL_FUNC(qpel_pixels_tab[0][12], qpel16_mc03_3dnow)
  3249. SET_QPEL_FUNC(qpel_pixels_tab[0][13], qpel16_mc13_3dnow)
  3250. SET_QPEL_FUNC(qpel_pixels_tab[0][14], qpel16_mc23_3dnow)
  3251. SET_QPEL_FUNC(qpel_pixels_tab[0][15], qpel16_mc33_3dnow)
  3252. SET_QPEL_FUNC(qpel_pixels_tab[1][ 0], qpel8_mc00_3dnow)
  3253. SET_QPEL_FUNC(qpel_pixels_tab[1][ 1], qpel8_mc10_3dnow)
  3254. SET_QPEL_FUNC(qpel_pixels_tab[1][ 2], qpel8_mc20_3dnow)
  3255. SET_QPEL_FUNC(qpel_pixels_tab[1][ 3], qpel8_mc30_3dnow)
  3256. SET_QPEL_FUNC(qpel_pixels_tab[1][ 4], qpel8_mc01_3dnow)
  3257. SET_QPEL_FUNC(qpel_pixels_tab[1][ 5], qpel8_mc11_3dnow)
  3258. SET_QPEL_FUNC(qpel_pixels_tab[1][ 6], qpel8_mc21_3dnow)
  3259. SET_QPEL_FUNC(qpel_pixels_tab[1][ 7], qpel8_mc31_3dnow)
  3260. SET_QPEL_FUNC(qpel_pixels_tab[1][ 8], qpel8_mc02_3dnow)
  3261. SET_QPEL_FUNC(qpel_pixels_tab[1][ 9], qpel8_mc12_3dnow)
  3262. SET_QPEL_FUNC(qpel_pixels_tab[1][10], qpel8_mc22_3dnow)
  3263. SET_QPEL_FUNC(qpel_pixels_tab[1][11], qpel8_mc32_3dnow)
  3264. SET_QPEL_FUNC(qpel_pixels_tab[1][12], qpel8_mc03_3dnow)
  3265. SET_QPEL_FUNC(qpel_pixels_tab[1][13], qpel8_mc13_3dnow)
  3266. SET_QPEL_FUNC(qpel_pixels_tab[1][14], qpel8_mc23_3dnow)
  3267. SET_QPEL_FUNC(qpel_pixels_tab[1][15], qpel8_mc33_3dnow)
  3268. #define dspfunc(PFX, IDX, NUM) \
  3269. c->PFX ## _pixels_tab[IDX][ 0] = PFX ## NUM ## _mc00_3dnow; \
  3270. c->PFX ## _pixels_tab[IDX][ 1] = PFX ## NUM ## _mc10_3dnow; \
  3271. c->PFX ## _pixels_tab[IDX][ 2] = PFX ## NUM ## _mc20_3dnow; \
  3272. c->PFX ## _pixels_tab[IDX][ 3] = PFX ## NUM ## _mc30_3dnow; \
  3273. c->PFX ## _pixels_tab[IDX][ 4] = PFX ## NUM ## _mc01_3dnow; \
  3274. c->PFX ## _pixels_tab[IDX][ 5] = PFX ## NUM ## _mc11_3dnow; \
  3275. c->PFX ## _pixels_tab[IDX][ 6] = PFX ## NUM ## _mc21_3dnow; \
  3276. c->PFX ## _pixels_tab[IDX][ 7] = PFX ## NUM ## _mc31_3dnow; \
  3277. c->PFX ## _pixels_tab[IDX][ 8] = PFX ## NUM ## _mc02_3dnow; \
  3278. c->PFX ## _pixels_tab[IDX][ 9] = PFX ## NUM ## _mc12_3dnow; \
  3279. c->PFX ## _pixels_tab[IDX][10] = PFX ## NUM ## _mc22_3dnow; \
  3280. c->PFX ## _pixels_tab[IDX][11] = PFX ## NUM ## _mc32_3dnow; \
  3281. c->PFX ## _pixels_tab[IDX][12] = PFX ## NUM ## _mc03_3dnow; \
  3282. c->PFX ## _pixels_tab[IDX][13] = PFX ## NUM ## _mc13_3dnow; \
  3283. c->PFX ## _pixels_tab[IDX][14] = PFX ## NUM ## _mc23_3dnow; \
  3284. c->PFX ## _pixels_tab[IDX][15] = PFX ## NUM ## _mc33_3dnow
  3285. dspfunc(put_h264_qpel, 0, 16);
  3286. dspfunc(put_h264_qpel, 1, 8);
  3287. dspfunc(put_h264_qpel, 2, 4);
  3288. dspfunc(avg_h264_qpel, 0, 16);
  3289. dspfunc(avg_h264_qpel, 1, 8);
  3290. dspfunc(avg_h264_qpel, 2, 4);
  3291. dspfunc(put_2tap_qpel, 0, 16);
  3292. dspfunc(put_2tap_qpel, 1, 8);
  3293. dspfunc(avg_2tap_qpel, 0, 16);
  3294. dspfunc(avg_2tap_qpel, 1, 8);
  3295. c->avg_h264_chroma_pixels_tab[0]= avg_h264_chroma_mc8_3dnow;
  3296. c->avg_h264_chroma_pixels_tab[1]= avg_h264_chroma_mc4_3dnow;
  3297. }
  3298. #ifdef CONFIG_ENCODERS
  3299. if(mm_flags & MM_SSE2){
  3300. c->sum_abs_dctelem= sum_abs_dctelem_sse2;
  3301. c->hadamard8_diff[0]= hadamard8_diff16_sse2;
  3302. c->hadamard8_diff[1]= hadamard8_diff_sse2;
  3303. }
  3304. #ifdef HAVE_SSSE3
  3305. if(mm_flags & MM_SSSE3){
  3306. if(!(avctx->flags & CODEC_FLAG_BITEXACT)){
  3307. c->try_8x8basis= try_8x8basis_ssse3;
  3308. }
  3309. c->add_8x8basis= add_8x8basis_ssse3;
  3310. c->sum_abs_dctelem= sum_abs_dctelem_ssse3;
  3311. c->hadamard8_diff[0]= hadamard8_diff16_ssse3;
  3312. c->hadamard8_diff[1]= hadamard8_diff_ssse3;
  3313. }
  3314. #endif
  3315. #endif
  3316. #ifdef CONFIG_SNOW_DECODER
  3317. if(mm_flags & MM_SSE2){
  3318. c->horizontal_compose97i = ff_snow_horizontal_compose97i_sse2;
  3319. c->vertical_compose97i = ff_snow_vertical_compose97i_sse2;
  3320. c->inner_add_yblock = ff_snow_inner_add_yblock_sse2;
  3321. }
  3322. else{
  3323. c->horizontal_compose97i = ff_snow_horizontal_compose97i_mmx;
  3324. c->vertical_compose97i = ff_snow_vertical_compose97i_mmx;
  3325. c->inner_add_yblock = ff_snow_inner_add_yblock_mmx;
  3326. }
  3327. #endif
  3328. if(mm_flags & MM_3DNOW){
  3329. #ifdef CONFIG_ENCODERS
  3330. if(!(avctx->flags & CODEC_FLAG_BITEXACT)){
  3331. c->try_8x8basis= try_8x8basis_3dnow;
  3332. }
  3333. c->add_8x8basis= add_8x8basis_3dnow;
  3334. #endif //CONFIG_ENCODERS
  3335. c->vorbis_inverse_coupling = vorbis_inverse_coupling_3dnow;
  3336. c->vector_fmul = vector_fmul_3dnow;
  3337. if(!(avctx->flags & CODEC_FLAG_BITEXACT))
  3338. c->float_to_int16 = float_to_int16_3dnow;
  3339. }
  3340. if(mm_flags & MM_3DNOWEXT)
  3341. c->vector_fmul_reverse = vector_fmul_reverse_3dnow2;
  3342. if(mm_flags & MM_SSE){
  3343. c->vorbis_inverse_coupling = vorbis_inverse_coupling_sse;
  3344. c->vector_fmul = vector_fmul_sse;
  3345. c->float_to_int16 = float_to_int16_sse;
  3346. c->vector_fmul_reverse = vector_fmul_reverse_sse;
  3347. c->vector_fmul_add_add = vector_fmul_add_add_sse;
  3348. }
  3349. if(mm_flags & MM_3DNOW)
  3350. c->vector_fmul_add_add = vector_fmul_add_add_3dnow; // faster than sse
  3351. }
  3352. #ifdef CONFIG_ENCODERS
  3353. dsputil_init_pix_mmx(c, avctx);
  3354. #endif //CONFIG_ENCODERS
  3355. #if 0
  3356. // for speed testing
  3357. get_pixels = just_return;
  3358. put_pixels_clamped = just_return;
  3359. add_pixels_clamped = just_return;
  3360. pix_abs16x16 = just_return;
  3361. pix_abs16x16_x2 = just_return;
  3362. pix_abs16x16_y2 = just_return;
  3363. pix_abs16x16_xy2 = just_return;
  3364. put_pixels_tab[0] = just_return;
  3365. put_pixels_tab[1] = just_return;
  3366. put_pixels_tab[2] = just_return;
  3367. put_pixels_tab[3] = just_return;
  3368. put_no_rnd_pixels_tab[0] = just_return;
  3369. put_no_rnd_pixels_tab[1] = just_return;
  3370. put_no_rnd_pixels_tab[2] = just_return;
  3371. put_no_rnd_pixels_tab[3] = just_return;
  3372. avg_pixels_tab[0] = just_return;
  3373. avg_pixels_tab[1] = just_return;
  3374. avg_pixels_tab[2] = just_return;
  3375. avg_pixels_tab[3] = just_return;
  3376. avg_no_rnd_pixels_tab[0] = just_return;
  3377. avg_no_rnd_pixels_tab[1] = just_return;
  3378. avg_no_rnd_pixels_tab[2] = just_return;
  3379. avg_no_rnd_pixels_tab[3] = just_return;
  3380. //av_fdct = just_return;
  3381. //ff_idct = just_return;
  3382. #endif
  3383. }