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.

3726 lines
140KB

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