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.

1606 lines
62KB

  1. /*
  2. * Copyright (c) 2004-2005 Michael Niedermayer, Loren Merritt
  3. *
  4. * This file is part of FFmpeg.
  5. *
  6. * FFmpeg is free software; you can redistribute it and/or
  7. * modify it under the terms of the GNU Lesser General Public
  8. * License as published by the Free Software Foundation; either
  9. * version 2.1 of the License, or (at your option) any later version.
  10. *
  11. * FFmpeg is distributed in the hope that it will be useful,
  12. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  14. * Lesser General Public License for more details.
  15. *
  16. * You should have received a copy of the GNU Lesser General Public
  17. * License along with FFmpeg; if not, write to the Free Software
  18. * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
  19. */
  20. #include "dsputil_mmx.h"
  21. /***********************************/
  22. /* IDCT */
  23. #define SUMSUB_BADC( a, b, c, d ) \
  24. "paddw "#b", "#a" \n\t"\
  25. "paddw "#d", "#c" \n\t"\
  26. "paddw "#b", "#b" \n\t"\
  27. "paddw "#d", "#d" \n\t"\
  28. "psubw "#a", "#b" \n\t"\
  29. "psubw "#c", "#d" \n\t"
  30. #define SUMSUBD2_AB( a, b, t ) \
  31. "movq "#b", "#t" \n\t"\
  32. "psraw $1 , "#b" \n\t"\
  33. "paddw "#a", "#b" \n\t"\
  34. "psraw $1 , "#a" \n\t"\
  35. "psubw "#t", "#a" \n\t"
  36. #define IDCT4_1D( s02, s13, d02, d13, t ) \
  37. SUMSUB_BA ( s02, d02 )\
  38. SUMSUBD2_AB( s13, d13, t )\
  39. SUMSUB_BADC( d13, s02, s13, d02 )
  40. #define STORE_DIFF_4P( p, t, z ) \
  41. "psraw $6, "#p" \n\t"\
  42. "movd (%0), "#t" \n\t"\
  43. "punpcklbw "#z", "#t" \n\t"\
  44. "paddsw "#t", "#p" \n\t"\
  45. "packuswb "#z", "#p" \n\t"\
  46. "movd "#p", (%0) \n\t"
  47. static void ff_h264_idct_add_mmx(uint8_t *dst, int16_t *block, int stride)
  48. {
  49. /* Load dct coeffs */
  50. asm volatile(
  51. "movq (%0), %%mm0 \n\t"
  52. "movq 8(%0), %%mm1 \n\t"
  53. "movq 16(%0), %%mm2 \n\t"
  54. "movq 24(%0), %%mm3 \n\t"
  55. :: "r"(block) );
  56. asm volatile(
  57. /* mm1=s02+s13 mm2=s02-s13 mm4=d02+d13 mm0=d02-d13 */
  58. IDCT4_1D( %%mm2, %%mm1, %%mm0, %%mm3, %%mm4 )
  59. "movq %0, %%mm6 \n\t"
  60. /* in: 1,4,0,2 out: 1,2,3,0 */
  61. TRANSPOSE4( %%mm3, %%mm1, %%mm0, %%mm2, %%mm4 )
  62. "paddw %%mm6, %%mm3 \n\t"
  63. /* mm2=s02+s13 mm3=s02-s13 mm4=d02+d13 mm1=d02-d13 */
  64. IDCT4_1D( %%mm4, %%mm2, %%mm3, %%mm0, %%mm1 )
  65. "pxor %%mm7, %%mm7 \n\t"
  66. :: "m"(*ff_pw_32));
  67. asm volatile(
  68. STORE_DIFF_4P( %%mm0, %%mm1, %%mm7)
  69. "add %1, %0 \n\t"
  70. STORE_DIFF_4P( %%mm2, %%mm1, %%mm7)
  71. "add %1, %0 \n\t"
  72. STORE_DIFF_4P( %%mm3, %%mm1, %%mm7)
  73. "add %1, %0 \n\t"
  74. STORE_DIFF_4P( %%mm4, %%mm1, %%mm7)
  75. : "+r"(dst)
  76. : "r" ((long)stride)
  77. );
  78. }
  79. static inline void h264_idct8_1d(int16_t *block)
  80. {
  81. asm volatile(
  82. "movq 112(%0), %%mm7 \n\t"
  83. "movq 80(%0), %%mm0 \n\t"
  84. "movq 48(%0), %%mm3 \n\t"
  85. "movq 16(%0), %%mm5 \n\t"
  86. "movq %%mm0, %%mm4 \n\t"
  87. "movq %%mm5, %%mm1 \n\t"
  88. "psraw $1, %%mm4 \n\t"
  89. "psraw $1, %%mm1 \n\t"
  90. "paddw %%mm0, %%mm4 \n\t"
  91. "paddw %%mm5, %%mm1 \n\t"
  92. "paddw %%mm7, %%mm4 \n\t"
  93. "paddw %%mm0, %%mm1 \n\t"
  94. "psubw %%mm5, %%mm4 \n\t"
  95. "paddw %%mm3, %%mm1 \n\t"
  96. "psubw %%mm3, %%mm5 \n\t"
  97. "psubw %%mm3, %%mm0 \n\t"
  98. "paddw %%mm7, %%mm5 \n\t"
  99. "psubw %%mm7, %%mm0 \n\t"
  100. "psraw $1, %%mm3 \n\t"
  101. "psraw $1, %%mm7 \n\t"
  102. "psubw %%mm3, %%mm5 \n\t"
  103. "psubw %%mm7, %%mm0 \n\t"
  104. "movq %%mm4, %%mm3 \n\t"
  105. "movq %%mm1, %%mm7 \n\t"
  106. "psraw $2, %%mm1 \n\t"
  107. "psraw $2, %%mm3 \n\t"
  108. "paddw %%mm5, %%mm3 \n\t"
  109. "psraw $2, %%mm5 \n\t"
  110. "paddw %%mm0, %%mm1 \n\t"
  111. "psraw $2, %%mm0 \n\t"
  112. "psubw %%mm4, %%mm5 \n\t"
  113. "psubw %%mm0, %%mm7 \n\t"
  114. "movq 32(%0), %%mm2 \n\t"
  115. "movq 96(%0), %%mm6 \n\t"
  116. "movq %%mm2, %%mm4 \n\t"
  117. "movq %%mm6, %%mm0 \n\t"
  118. "psraw $1, %%mm4 \n\t"
  119. "psraw $1, %%mm6 \n\t"
  120. "psubw %%mm0, %%mm4 \n\t"
  121. "paddw %%mm2, %%mm6 \n\t"
  122. "movq (%0), %%mm2 \n\t"
  123. "movq 64(%0), %%mm0 \n\t"
  124. SUMSUB_BA( %%mm0, %%mm2 )
  125. SUMSUB_BA( %%mm6, %%mm0 )
  126. SUMSUB_BA( %%mm4, %%mm2 )
  127. SUMSUB_BA( %%mm7, %%mm6 )
  128. SUMSUB_BA( %%mm5, %%mm4 )
  129. SUMSUB_BA( %%mm3, %%mm2 )
  130. SUMSUB_BA( %%mm1, %%mm0 )
  131. :: "r"(block)
  132. );
  133. }
  134. static void ff_h264_idct8_add_mmx(uint8_t *dst, int16_t *block, int stride)
  135. {
  136. int i;
  137. int16_t __attribute__ ((aligned(8))) b2[64];
  138. block[0] += 32;
  139. for(i=0; i<2; i++){
  140. DECLARE_ALIGNED_8(uint64_t, tmp);
  141. h264_idct8_1d(block+4*i);
  142. asm volatile(
  143. "movq %%mm7, %0 \n\t"
  144. TRANSPOSE4( %%mm0, %%mm2, %%mm4, %%mm6, %%mm7 )
  145. "movq %%mm0, 8(%1) \n\t"
  146. "movq %%mm6, 24(%1) \n\t"
  147. "movq %%mm7, 40(%1) \n\t"
  148. "movq %%mm4, 56(%1) \n\t"
  149. "movq %0, %%mm7 \n\t"
  150. TRANSPOSE4( %%mm7, %%mm5, %%mm3, %%mm1, %%mm0 )
  151. "movq %%mm7, (%1) \n\t"
  152. "movq %%mm1, 16(%1) \n\t"
  153. "movq %%mm0, 32(%1) \n\t"
  154. "movq %%mm3, 48(%1) \n\t"
  155. : "=m"(tmp)
  156. : "r"(b2+32*i)
  157. : "memory"
  158. );
  159. }
  160. for(i=0; i<2; i++){
  161. h264_idct8_1d(b2+4*i);
  162. asm volatile(
  163. "psraw $6, %%mm7 \n\t"
  164. "psraw $6, %%mm6 \n\t"
  165. "psraw $6, %%mm5 \n\t"
  166. "psraw $6, %%mm4 \n\t"
  167. "psraw $6, %%mm3 \n\t"
  168. "psraw $6, %%mm2 \n\t"
  169. "psraw $6, %%mm1 \n\t"
  170. "psraw $6, %%mm0 \n\t"
  171. "movq %%mm7, (%0) \n\t"
  172. "movq %%mm5, 16(%0) \n\t"
  173. "movq %%mm3, 32(%0) \n\t"
  174. "movq %%mm1, 48(%0) \n\t"
  175. "movq %%mm0, 64(%0) \n\t"
  176. "movq %%mm2, 80(%0) \n\t"
  177. "movq %%mm4, 96(%0) \n\t"
  178. "movq %%mm6, 112(%0) \n\t"
  179. :: "r"(b2+4*i)
  180. : "memory"
  181. );
  182. }
  183. add_pixels_clamped_mmx(b2, dst, stride);
  184. }
  185. #define STORE_DIFF_8P( p, d, t, z )\
  186. "movq "#d", "#t" \n"\
  187. "psraw $6, "#p" \n"\
  188. "punpcklbw "#z", "#t" \n"\
  189. "paddsw "#t", "#p" \n"\
  190. "packuswb "#p", "#p" \n"\
  191. "movq "#p", "#d" \n"
  192. #define H264_IDCT8_1D_SSE2(a,b,c,d,e,f,g,h)\
  193. "movdqa "#c", "#a" \n"\
  194. "movdqa "#g", "#e" \n"\
  195. "psraw $1, "#c" \n"\
  196. "psraw $1, "#g" \n"\
  197. "psubw "#e", "#c" \n"\
  198. "paddw "#a", "#g" \n"\
  199. "movdqa "#b", "#e" \n"\
  200. "psraw $1, "#e" \n"\
  201. "paddw "#b", "#e" \n"\
  202. "paddw "#d", "#e" \n"\
  203. "paddw "#f", "#e" \n"\
  204. "movdqa "#f", "#a" \n"\
  205. "psraw $1, "#a" \n"\
  206. "paddw "#f", "#a" \n"\
  207. "paddw "#h", "#a" \n"\
  208. "psubw "#b", "#a" \n"\
  209. "psubw "#d", "#b" \n"\
  210. "psubw "#d", "#f" \n"\
  211. "paddw "#h", "#b" \n"\
  212. "psubw "#h", "#f" \n"\
  213. "psraw $1, "#d" \n"\
  214. "psraw $1, "#h" \n"\
  215. "psubw "#d", "#b" \n"\
  216. "psubw "#h", "#f" \n"\
  217. "movdqa "#e", "#d" \n"\
  218. "movdqa "#a", "#h" \n"\
  219. "psraw $2, "#d" \n"\
  220. "psraw $2, "#h" \n"\
  221. "paddw "#f", "#d" \n"\
  222. "paddw "#b", "#h" \n"\
  223. "psraw $2, "#f" \n"\
  224. "psraw $2, "#b" \n"\
  225. "psubw "#f", "#e" \n"\
  226. "psubw "#a", "#b" \n"\
  227. "movdqa 0x00(%1), "#a" \n"\
  228. "movdqa 0x40(%1), "#f" \n"\
  229. SUMSUB_BA(f, a)\
  230. SUMSUB_BA(g, f)\
  231. SUMSUB_BA(c, a)\
  232. SUMSUB_BA(e, g)\
  233. SUMSUB_BA(b, c)\
  234. SUMSUB_BA(h, a)\
  235. SUMSUB_BA(d, f)
  236. static void ff_h264_idct8_add_sse2(uint8_t *dst, int16_t *block, int stride)
  237. {
  238. asm volatile(
  239. "movdqa 0x10(%1), %%xmm1 \n"
  240. "movdqa 0x20(%1), %%xmm2 \n"
  241. "movdqa 0x30(%1), %%xmm3 \n"
  242. "movdqa 0x50(%1), %%xmm5 \n"
  243. "movdqa 0x60(%1), %%xmm6 \n"
  244. "movdqa 0x70(%1), %%xmm7 \n"
  245. H264_IDCT8_1D_SSE2(%%xmm0, %%xmm1, %%xmm2, %%xmm3, %%xmm4, %%xmm5, %%xmm6, %%xmm7)
  246. TRANSPOSE8(%%xmm4, %%xmm1, %%xmm7, %%xmm3, %%xmm5, %%xmm0, %%xmm2, %%xmm6, (%1))
  247. "paddw %4, %%xmm4 \n"
  248. "movdqa %%xmm4, 0x00(%1) \n"
  249. "movdqa %%xmm2, 0x40(%1) \n"
  250. H264_IDCT8_1D_SSE2(%%xmm4, %%xmm0, %%xmm6, %%xmm3, %%xmm2, %%xmm5, %%xmm7, %%xmm1)
  251. "movdqa %%xmm6, 0x60(%1) \n"
  252. "movdqa %%xmm7, 0x70(%1) \n"
  253. "pxor %%xmm7, %%xmm7 \n"
  254. STORE_DIFF_8P(%%xmm2, (%0), %%xmm6, %%xmm7)
  255. STORE_DIFF_8P(%%xmm0, (%0,%2), %%xmm6, %%xmm7)
  256. STORE_DIFF_8P(%%xmm1, (%0,%2,2), %%xmm6, %%xmm7)
  257. STORE_DIFF_8P(%%xmm3, (%0,%3), %%xmm6, %%xmm7)
  258. "lea (%0,%2,4), %0 \n"
  259. STORE_DIFF_8P(%%xmm5, (%0), %%xmm6, %%xmm7)
  260. STORE_DIFF_8P(%%xmm4, (%0,%2), %%xmm6, %%xmm7)
  261. "movdqa 0x60(%1), %%xmm0 \n"
  262. "movdqa 0x70(%1), %%xmm1 \n"
  263. STORE_DIFF_8P(%%xmm0, (%0,%2,2), %%xmm6, %%xmm7)
  264. STORE_DIFF_8P(%%xmm1, (%0,%3), %%xmm6, %%xmm7)
  265. :"+r"(dst)
  266. :"r"(block), "r"((long)stride), "r"(3L*stride), "m"(*ff_pw_32)
  267. );
  268. }
  269. static void ff_h264_idct_dc_add_mmx2(uint8_t *dst, int16_t *block, int stride)
  270. {
  271. int dc = (block[0] + 32) >> 6;
  272. asm volatile(
  273. "movd %0, %%mm0 \n\t"
  274. "pshufw $0, %%mm0, %%mm0 \n\t"
  275. "pxor %%mm1, %%mm1 \n\t"
  276. "psubw %%mm0, %%mm1 \n\t"
  277. "packuswb %%mm0, %%mm0 \n\t"
  278. "packuswb %%mm1, %%mm1 \n\t"
  279. ::"r"(dc)
  280. );
  281. asm volatile(
  282. "movd %0, %%mm2 \n\t"
  283. "movd %1, %%mm3 \n\t"
  284. "movd %2, %%mm4 \n\t"
  285. "movd %3, %%mm5 \n\t"
  286. "paddusb %%mm0, %%mm2 \n\t"
  287. "paddusb %%mm0, %%mm3 \n\t"
  288. "paddusb %%mm0, %%mm4 \n\t"
  289. "paddusb %%mm0, %%mm5 \n\t"
  290. "psubusb %%mm1, %%mm2 \n\t"
  291. "psubusb %%mm1, %%mm3 \n\t"
  292. "psubusb %%mm1, %%mm4 \n\t"
  293. "psubusb %%mm1, %%mm5 \n\t"
  294. "movd %%mm2, %0 \n\t"
  295. "movd %%mm3, %1 \n\t"
  296. "movd %%mm4, %2 \n\t"
  297. "movd %%mm5, %3 \n\t"
  298. :"+m"(*(uint32_t*)(dst+0*stride)),
  299. "+m"(*(uint32_t*)(dst+1*stride)),
  300. "+m"(*(uint32_t*)(dst+2*stride)),
  301. "+m"(*(uint32_t*)(dst+3*stride))
  302. );
  303. }
  304. static void ff_h264_idct8_dc_add_mmx2(uint8_t *dst, int16_t *block, int stride)
  305. {
  306. int dc = (block[0] + 32) >> 6;
  307. int y;
  308. asm volatile(
  309. "movd %0, %%mm0 \n\t"
  310. "pshufw $0, %%mm0, %%mm0 \n\t"
  311. "pxor %%mm1, %%mm1 \n\t"
  312. "psubw %%mm0, %%mm1 \n\t"
  313. "packuswb %%mm0, %%mm0 \n\t"
  314. "packuswb %%mm1, %%mm1 \n\t"
  315. ::"r"(dc)
  316. );
  317. for(y=2; y--; dst += 4*stride){
  318. asm volatile(
  319. "movq %0, %%mm2 \n\t"
  320. "movq %1, %%mm3 \n\t"
  321. "movq %2, %%mm4 \n\t"
  322. "movq %3, %%mm5 \n\t"
  323. "paddusb %%mm0, %%mm2 \n\t"
  324. "paddusb %%mm0, %%mm3 \n\t"
  325. "paddusb %%mm0, %%mm4 \n\t"
  326. "paddusb %%mm0, %%mm5 \n\t"
  327. "psubusb %%mm1, %%mm2 \n\t"
  328. "psubusb %%mm1, %%mm3 \n\t"
  329. "psubusb %%mm1, %%mm4 \n\t"
  330. "psubusb %%mm1, %%mm5 \n\t"
  331. "movq %%mm2, %0 \n\t"
  332. "movq %%mm3, %1 \n\t"
  333. "movq %%mm4, %2 \n\t"
  334. "movq %%mm5, %3 \n\t"
  335. :"+m"(*(uint64_t*)(dst+0*stride)),
  336. "+m"(*(uint64_t*)(dst+1*stride)),
  337. "+m"(*(uint64_t*)(dst+2*stride)),
  338. "+m"(*(uint64_t*)(dst+3*stride))
  339. );
  340. }
  341. }
  342. /***********************************/
  343. /* deblocking */
  344. // out: o = |x-y|>a
  345. // clobbers: t
  346. #define DIFF_GT_MMX(x,y,a,o,t)\
  347. "movq "#y", "#t" \n\t"\
  348. "movq "#x", "#o" \n\t"\
  349. "psubusb "#x", "#t" \n\t"\
  350. "psubusb "#y", "#o" \n\t"\
  351. "por "#t", "#o" \n\t"\
  352. "psubusb "#a", "#o" \n\t"
  353. // out: o = |x-y|>a
  354. // clobbers: t
  355. #define DIFF_GT2_MMX(x,y,a,o,t)\
  356. "movq "#y", "#t" \n\t"\
  357. "movq "#x", "#o" \n\t"\
  358. "psubusb "#x", "#t" \n\t"\
  359. "psubusb "#y", "#o" \n\t"\
  360. "psubusb "#a", "#t" \n\t"\
  361. "psubusb "#a", "#o" \n\t"\
  362. "pcmpeqb "#t", "#o" \n\t"\
  363. // in: mm0=p1 mm1=p0 mm2=q0 mm3=q1
  364. // out: mm5=beta-1, mm7=mask
  365. // clobbers: mm4,mm6
  366. #define H264_DEBLOCK_MASK(alpha1, beta1) \
  367. "pshufw $0, "#alpha1", %%mm4 \n\t"\
  368. "pshufw $0, "#beta1 ", %%mm5 \n\t"\
  369. "packuswb %%mm4, %%mm4 \n\t"\
  370. "packuswb %%mm5, %%mm5 \n\t"\
  371. DIFF_GT_MMX(%%mm1, %%mm2, %%mm4, %%mm7, %%mm6) /* |p0-q0| > alpha-1 */\
  372. DIFF_GT_MMX(%%mm0, %%mm1, %%mm5, %%mm4, %%mm6) /* |p1-p0| > beta-1 */\
  373. "por %%mm4, %%mm7 \n\t"\
  374. DIFF_GT_MMX(%%mm3, %%mm2, %%mm5, %%mm4, %%mm6) /* |q1-q0| > beta-1 */\
  375. "por %%mm4, %%mm7 \n\t"\
  376. "pxor %%mm6, %%mm6 \n\t"\
  377. "pcmpeqb %%mm6, %%mm7 \n\t"
  378. // in: mm0=p1 mm1=p0 mm2=q0 mm3=q1 mm7=(tc&mask)
  379. // out: mm1=p0' mm2=q0'
  380. // clobbers: mm0,3-6
  381. #define H264_DEBLOCK_P0_Q0(pb_01, pb_3f)\
  382. "movq %%mm1 , %%mm5 \n\t"\
  383. "pxor %%mm2 , %%mm5 \n\t" /* p0^q0*/\
  384. "pand "#pb_01" , %%mm5 \n\t" /* (p0^q0)&1*/\
  385. "pcmpeqb %%mm4 , %%mm4 \n\t"\
  386. "pxor %%mm4 , %%mm3 \n\t"\
  387. "pavgb %%mm0 , %%mm3 \n\t" /* (p1 - q1 + 256)>>1*/\
  388. "pavgb "MANGLE(ff_pb_3)" , %%mm3 \n\t" /*(((p1 - q1 + 256)>>1)+4)>>1 = 64+2+(p1-q1)>>2*/\
  389. "pxor %%mm1 , %%mm4 \n\t"\
  390. "pavgb %%mm2 , %%mm4 \n\t" /* (q0 - p0 + 256)>>1*/\
  391. "pavgb %%mm5 , %%mm3 \n\t"\
  392. "paddusb %%mm4 , %%mm3 \n\t" /* d+128+33*/\
  393. "movq "MANGLE(ff_pb_A1)" , %%mm6 \n\t"\
  394. "psubusb %%mm3 , %%mm6 \n\t"\
  395. "psubusb "MANGLE(ff_pb_A1)" , %%mm3 \n\t"\
  396. "pminub %%mm7 , %%mm6 \n\t"\
  397. "pminub %%mm7 , %%mm3 \n\t"\
  398. "psubusb %%mm6 , %%mm1 \n\t"\
  399. "psubusb %%mm3 , %%mm2 \n\t"\
  400. "paddusb %%mm3 , %%mm1 \n\t"\
  401. "paddusb %%mm6 , %%mm2 \n\t"
  402. // in: mm0=p1 mm1=p0 mm2=q0 mm3=q1 mm7=(tc&mask) %8=ff_bone
  403. // out: (q1addr) = av_clip( (q2+((p0+q0+1)>>1))>>1, q1-tc0, q1+tc0 )
  404. // clobbers: q2, tmp, tc0
  405. #define H264_DEBLOCK_Q1(p1, q2, q2addr, q1addr, tc0, tmp)\
  406. "movq %%mm1, "#tmp" \n\t"\
  407. "pavgb %%mm2, "#tmp" \n\t"\
  408. "pavgb "#tmp", "#q2" \n\t" /* avg(p2,avg(p0,q0)) */\
  409. "pxor "q2addr", "#tmp" \n\t"\
  410. "pand %8, "#tmp" \n\t" /* (p2^avg(p0,q0))&1 */\
  411. "psubusb "#tmp", "#q2" \n\t" /* (p2+((p0+q0+1)>>1))>>1 */\
  412. "movq "#p1", "#tmp" \n\t"\
  413. "psubusb "#tc0", "#tmp" \n\t"\
  414. "paddusb "#p1", "#tc0" \n\t"\
  415. "pmaxub "#tmp", "#q2" \n\t"\
  416. "pminub "#tc0", "#q2" \n\t"\
  417. "movq "#q2", "q1addr" \n\t"
  418. static inline void h264_loop_filter_luma_mmx2(uint8_t *pix, int stride, int alpha1, int beta1, int8_t *tc0)
  419. {
  420. DECLARE_ALIGNED_8(uint64_t, tmp0[2]);
  421. asm volatile(
  422. "movq (%1,%3), %%mm0 \n\t" //p1
  423. "movq (%1,%3,2), %%mm1 \n\t" //p0
  424. "movq (%2), %%mm2 \n\t" //q0
  425. "movq (%2,%3), %%mm3 \n\t" //q1
  426. H264_DEBLOCK_MASK(%6, %7)
  427. "movd %5, %%mm4 \n\t"
  428. "punpcklbw %%mm4, %%mm4 \n\t"
  429. "punpcklwd %%mm4, %%mm4 \n\t"
  430. "pcmpeqb %%mm3, %%mm3 \n\t"
  431. "movq %%mm4, %%mm6 \n\t"
  432. "pcmpgtb %%mm3, %%mm4 \n\t"
  433. "movq %%mm6, 8+%0 \n\t"
  434. "pand %%mm4, %%mm7 \n\t"
  435. "movq %%mm7, %0 \n\t"
  436. /* filter p1 */
  437. "movq (%1), %%mm3 \n\t" //p2
  438. DIFF_GT2_MMX(%%mm1, %%mm3, %%mm5, %%mm6, %%mm4) // |p2-p0|>beta-1
  439. "pand %%mm7, %%mm6 \n\t" // mask & |p2-p0|<beta
  440. "pand 8+%0, %%mm7 \n\t" // mask & tc0
  441. "movq %%mm7, %%mm4 \n\t"
  442. "psubb %%mm6, %%mm7 \n\t"
  443. "pand %%mm4, %%mm6 \n\t" // mask & |p2-p0|<beta & tc0
  444. H264_DEBLOCK_Q1(%%mm0, %%mm3, "(%1)", "(%1,%3)", %%mm6, %%mm4)
  445. /* filter q1 */
  446. "movq (%2,%3,2), %%mm4 \n\t" //q2
  447. DIFF_GT2_MMX(%%mm2, %%mm4, %%mm5, %%mm6, %%mm3) // |q2-q0|>beta-1
  448. "pand %0, %%mm6 \n\t"
  449. "movq 8+%0, %%mm5 \n\t" // can be merged with the and below but is slower then
  450. "pand %%mm6, %%mm5 \n\t"
  451. "psubb %%mm6, %%mm7 \n\t"
  452. "movq (%2,%3), %%mm3 \n\t"
  453. H264_DEBLOCK_Q1(%%mm3, %%mm4, "(%2,%3,2)", "(%2,%3)", %%mm5, %%mm6)
  454. /* filter p0, q0 */
  455. H264_DEBLOCK_P0_Q0(%8, unused)
  456. "movq %%mm1, (%1,%3,2) \n\t"
  457. "movq %%mm2, (%2) \n\t"
  458. : "=m"(*tmp0)
  459. : "r"(pix-3*stride), "r"(pix), "r"((long)stride),
  460. "m"(*tmp0/*unused*/), "m"(*(uint32_t*)tc0), "m"(alpha1), "m"(beta1),
  461. "m"(ff_bone)
  462. );
  463. }
  464. static void h264_v_loop_filter_luma_mmx2(uint8_t *pix, int stride, int alpha, int beta, int8_t *tc0)
  465. {
  466. if((tc0[0] & tc0[1]) >= 0)
  467. h264_loop_filter_luma_mmx2(pix, stride, alpha-1, beta-1, tc0);
  468. if((tc0[2] & tc0[3]) >= 0)
  469. h264_loop_filter_luma_mmx2(pix+8, stride, alpha-1, beta-1, tc0+2);
  470. }
  471. static void h264_h_loop_filter_luma_mmx2(uint8_t *pix, int stride, int alpha, int beta, int8_t *tc0)
  472. {
  473. //FIXME: could cut some load/stores by merging transpose with filter
  474. // also, it only needs to transpose 6x8
  475. DECLARE_ALIGNED_8(uint8_t, trans[8*8]);
  476. int i;
  477. for(i=0; i<2; i++, pix+=8*stride, tc0+=2) {
  478. if((tc0[0] & tc0[1]) < 0)
  479. continue;
  480. transpose4x4(trans, pix-4, 8, stride);
  481. transpose4x4(trans +4*8, pix, 8, stride);
  482. transpose4x4(trans+4, pix-4+4*stride, 8, stride);
  483. transpose4x4(trans+4+4*8, pix +4*stride, 8, stride);
  484. h264_loop_filter_luma_mmx2(trans+4*8, 8, alpha-1, beta-1, tc0);
  485. transpose4x4(pix-2, trans +2*8, stride, 8);
  486. transpose4x4(pix-2+4*stride, trans+4+2*8, stride, 8);
  487. }
  488. }
  489. static inline void h264_loop_filter_chroma_mmx2(uint8_t *pix, int stride, int alpha1, int beta1, int8_t *tc0)
  490. {
  491. asm volatile(
  492. "movq (%0), %%mm0 \n\t" //p1
  493. "movq (%0,%2), %%mm1 \n\t" //p0
  494. "movq (%1), %%mm2 \n\t" //q0
  495. "movq (%1,%2), %%mm3 \n\t" //q1
  496. H264_DEBLOCK_MASK(%4, %5)
  497. "movd %3, %%mm6 \n\t"
  498. "punpcklbw %%mm6, %%mm6 \n\t"
  499. "pand %%mm6, %%mm7 \n\t" // mm7 = tc&mask
  500. H264_DEBLOCK_P0_Q0(%6, %7)
  501. "movq %%mm1, (%0,%2) \n\t"
  502. "movq %%mm2, (%1) \n\t"
  503. :: "r"(pix-2*stride), "r"(pix), "r"((long)stride),
  504. "r"(*(uint32_t*)tc0),
  505. "m"(alpha1), "m"(beta1), "m"(ff_bone), "m"(ff_pb_3F)
  506. );
  507. }
  508. static void h264_v_loop_filter_chroma_mmx2(uint8_t *pix, int stride, int alpha, int beta, int8_t *tc0)
  509. {
  510. h264_loop_filter_chroma_mmx2(pix, stride, alpha-1, beta-1, tc0);
  511. }
  512. static void h264_h_loop_filter_chroma_mmx2(uint8_t *pix, int stride, int alpha, int beta, int8_t *tc0)
  513. {
  514. //FIXME: could cut some load/stores by merging transpose with filter
  515. DECLARE_ALIGNED_8(uint8_t, trans[8*4]);
  516. transpose4x4(trans, pix-2, 8, stride);
  517. transpose4x4(trans+4, pix-2+4*stride, 8, stride);
  518. h264_loop_filter_chroma_mmx2(trans+2*8, 8, alpha-1, beta-1, tc0);
  519. transpose4x4(pix-2, trans, stride, 8);
  520. transpose4x4(pix-2+4*stride, trans+4, stride, 8);
  521. }
  522. // p0 = (p0 + q1 + 2*p1 + 2) >> 2
  523. #define H264_FILTER_CHROMA4(p0, p1, q1, one) \
  524. "movq "#p0", %%mm4 \n\t"\
  525. "pxor "#q1", %%mm4 \n\t"\
  526. "pand "#one", %%mm4 \n\t" /* mm4 = (p0^q1)&1 */\
  527. "pavgb "#q1", "#p0" \n\t"\
  528. "psubusb %%mm4, "#p0" \n\t"\
  529. "pavgb "#p1", "#p0" \n\t" /* dst = avg(p1, avg(p0,q1) - ((p0^q1)&1)) */\
  530. static inline void h264_loop_filter_chroma_intra_mmx2(uint8_t *pix, int stride, int alpha1, int beta1)
  531. {
  532. asm volatile(
  533. "movq (%0), %%mm0 \n\t"
  534. "movq (%0,%2), %%mm1 \n\t"
  535. "movq (%1), %%mm2 \n\t"
  536. "movq (%1,%2), %%mm3 \n\t"
  537. H264_DEBLOCK_MASK(%3, %4)
  538. "movq %%mm1, %%mm5 \n\t"
  539. "movq %%mm2, %%mm6 \n\t"
  540. H264_FILTER_CHROMA4(%%mm1, %%mm0, %%mm3, %5) //p0'
  541. H264_FILTER_CHROMA4(%%mm2, %%mm3, %%mm0, %5) //q0'
  542. "psubb %%mm5, %%mm1 \n\t"
  543. "psubb %%mm6, %%mm2 \n\t"
  544. "pand %%mm7, %%mm1 \n\t"
  545. "pand %%mm7, %%mm2 \n\t"
  546. "paddb %%mm5, %%mm1 \n\t"
  547. "paddb %%mm6, %%mm2 \n\t"
  548. "movq %%mm1, (%0,%2) \n\t"
  549. "movq %%mm2, (%1) \n\t"
  550. :: "r"(pix-2*stride), "r"(pix), "r"((long)stride),
  551. "m"(alpha1), "m"(beta1), "m"(ff_bone)
  552. );
  553. }
  554. static void h264_v_loop_filter_chroma_intra_mmx2(uint8_t *pix, int stride, int alpha, int beta)
  555. {
  556. h264_loop_filter_chroma_intra_mmx2(pix, stride, alpha-1, beta-1);
  557. }
  558. static void h264_h_loop_filter_chroma_intra_mmx2(uint8_t *pix, int stride, int alpha, int beta)
  559. {
  560. //FIXME: could cut some load/stores by merging transpose with filter
  561. DECLARE_ALIGNED_8(uint8_t, trans[8*4]);
  562. transpose4x4(trans, pix-2, 8, stride);
  563. transpose4x4(trans+4, pix-2+4*stride, 8, stride);
  564. h264_loop_filter_chroma_intra_mmx2(trans+2*8, 8, alpha-1, beta-1);
  565. transpose4x4(pix-2, trans, stride, 8);
  566. transpose4x4(pix-2+4*stride, trans+4, stride, 8);
  567. }
  568. static void h264_loop_filter_strength_mmx2( int16_t bS[2][4][4], uint8_t nnz[40], int8_t ref[2][40], int16_t mv[2][40][2],
  569. int bidir, int edges, int step, int mask_mv0, int mask_mv1 ) {
  570. int dir;
  571. asm volatile(
  572. "pxor %%mm7, %%mm7 \n\t"
  573. "movq %0, %%mm6 \n\t"
  574. "movq %1, %%mm5 \n\t"
  575. "movq %2, %%mm4 \n\t"
  576. ::"m"(ff_pb_1), "m"(ff_pb_3), "m"(ff_pb_7)
  577. );
  578. // could do a special case for dir==0 && edges==1, but it only reduces the
  579. // average filter time by 1.2%
  580. for( dir=1; dir>=0; dir-- ) {
  581. const int d_idx = dir ? -8 : -1;
  582. const int mask_mv = dir ? mask_mv1 : mask_mv0;
  583. DECLARE_ALIGNED_8(const uint64_t, mask_dir) = dir ? 0 : 0xffffffffffffffffULL;
  584. int b_idx, edge, l;
  585. for( b_idx=12, edge=0; edge<edges; edge+=step, b_idx+=8*step ) {
  586. asm volatile(
  587. "pand %0, %%mm0 \n\t"
  588. ::"m"(mask_dir)
  589. );
  590. if(!(mask_mv & edge)) {
  591. asm volatile("pxor %%mm0, %%mm0 \n\t":);
  592. for( l = bidir; l >= 0; l-- ) {
  593. asm volatile(
  594. "movd %0, %%mm1 \n\t"
  595. "punpckldq %1, %%mm1 \n\t"
  596. "movq %%mm1, %%mm2 \n\t"
  597. "psrlw $7, %%mm2 \n\t"
  598. "pand %%mm6, %%mm2 \n\t"
  599. "por %%mm2, %%mm1 \n\t" // ref_cache with -2 mapped to -1
  600. "punpckldq %%mm1, %%mm2 \n\t"
  601. "pcmpeqb %%mm2, %%mm1 \n\t"
  602. "paddb %%mm6, %%mm1 \n\t"
  603. "punpckhbw %%mm7, %%mm1 \n\t" // ref[b] != ref[bn]
  604. "por %%mm1, %%mm0 \n\t"
  605. "movq %2, %%mm1 \n\t"
  606. "movq %3, %%mm2 \n\t"
  607. "psubw %4, %%mm1 \n\t"
  608. "psubw %5, %%mm2 \n\t"
  609. "packsswb %%mm2, %%mm1 \n\t"
  610. "paddb %%mm5, %%mm1 \n\t"
  611. "pminub %%mm4, %%mm1 \n\t"
  612. "pcmpeqb %%mm4, %%mm1 \n\t" // abs(mv[b] - mv[bn]) >= limit
  613. "por %%mm1, %%mm0 \n\t"
  614. ::"m"(ref[l][b_idx]),
  615. "m"(ref[l][b_idx+d_idx]),
  616. "m"(mv[l][b_idx][0]),
  617. "m"(mv[l][b_idx+2][0]),
  618. "m"(mv[l][b_idx+d_idx][0]),
  619. "m"(mv[l][b_idx+d_idx+2][0])
  620. );
  621. }
  622. }
  623. asm volatile(
  624. "movd %0, %%mm1 \n\t"
  625. "por %1, %%mm1 \n\t"
  626. "punpcklbw %%mm7, %%mm1 \n\t"
  627. "pcmpgtw %%mm7, %%mm1 \n\t" // nnz[b] || nnz[bn]
  628. ::"m"(nnz[b_idx]),
  629. "m"(nnz[b_idx+d_idx])
  630. );
  631. asm volatile(
  632. "pcmpeqw %%mm7, %%mm0 \n\t"
  633. "pcmpeqw %%mm7, %%mm0 \n\t"
  634. "psrlw $15, %%mm0 \n\t" // nonzero -> 1
  635. "psrlw $14, %%mm1 \n\t"
  636. "movq %%mm0, %%mm2 \n\t"
  637. "por %%mm1, %%mm2 \n\t"
  638. "psrlw $1, %%mm1 \n\t"
  639. "pandn %%mm2, %%mm1 \n\t"
  640. "movq %%mm1, %0 \n\t"
  641. :"=m"(*bS[dir][edge])
  642. ::"memory"
  643. );
  644. }
  645. edges = 4;
  646. step = 1;
  647. }
  648. asm volatile(
  649. "movq (%0), %%mm0 \n\t"
  650. "movq 8(%0), %%mm1 \n\t"
  651. "movq 16(%0), %%mm2 \n\t"
  652. "movq 24(%0), %%mm3 \n\t"
  653. TRANSPOSE4(%%mm0, %%mm1, %%mm2, %%mm3, %%mm4)
  654. "movq %%mm0, (%0) \n\t"
  655. "movq %%mm3, 8(%0) \n\t"
  656. "movq %%mm4, 16(%0) \n\t"
  657. "movq %%mm2, 24(%0) \n\t"
  658. ::"r"(bS[0])
  659. :"memory"
  660. );
  661. }
  662. /***********************************/
  663. /* motion compensation */
  664. #define QPEL_H264V(A,B,C,D,E,F,OP)\
  665. "movd (%0), "#F" \n\t"\
  666. "movq "#C", %%mm6 \n\t"\
  667. "paddw "#D", %%mm6 \n\t"\
  668. "psllw $2, %%mm6 \n\t"\
  669. "psubw "#B", %%mm6 \n\t"\
  670. "psubw "#E", %%mm6 \n\t"\
  671. "pmullw %4, %%mm6 \n\t"\
  672. "add %2, %0 \n\t"\
  673. "punpcklbw %%mm7, "#F" \n\t"\
  674. "paddw %5, "#A" \n\t"\
  675. "paddw "#F", "#A" \n\t"\
  676. "paddw "#A", %%mm6 \n\t"\
  677. "psraw $5, %%mm6 \n\t"\
  678. "packuswb %%mm6, %%mm6 \n\t"\
  679. OP(%%mm6, (%1), A, d)\
  680. "add %3, %1 \n\t"
  681. #define QPEL_H264HV(A,B,C,D,E,F,OF)\
  682. "movd (%0), "#F" \n\t"\
  683. "movq "#C", %%mm6 \n\t"\
  684. "paddw "#D", %%mm6 \n\t"\
  685. "psllw $2, %%mm6 \n\t"\
  686. "psubw "#B", %%mm6 \n\t"\
  687. "psubw "#E", %%mm6 \n\t"\
  688. "pmullw %3, %%mm6 \n\t"\
  689. "add %2, %0 \n\t"\
  690. "punpcklbw %%mm7, "#F" \n\t"\
  691. "paddw "#F", "#A" \n\t"\
  692. "paddw "#A", %%mm6 \n\t"\
  693. "movq %%mm6, "#OF"(%1) \n\t"
  694. #define QPEL_H264(OPNAME, OP, MMX)\
  695. static av_noinline void OPNAME ## h264_qpel4_h_lowpass_ ## MMX(uint8_t *dst, uint8_t *src, int dstStride, int srcStride){\
  696. int h=4;\
  697. \
  698. asm volatile(\
  699. "pxor %%mm7, %%mm7 \n\t"\
  700. "movq %5, %%mm4 \n\t"\
  701. "movq %6, %%mm5 \n\t"\
  702. "1: \n\t"\
  703. "movd -1(%0), %%mm1 \n\t"\
  704. "movd (%0), %%mm2 \n\t"\
  705. "movd 1(%0), %%mm3 \n\t"\
  706. "movd 2(%0), %%mm0 \n\t"\
  707. "punpcklbw %%mm7, %%mm1 \n\t"\
  708. "punpcklbw %%mm7, %%mm2 \n\t"\
  709. "punpcklbw %%mm7, %%mm3 \n\t"\
  710. "punpcklbw %%mm7, %%mm0 \n\t"\
  711. "paddw %%mm0, %%mm1 \n\t"\
  712. "paddw %%mm3, %%mm2 \n\t"\
  713. "movd -2(%0), %%mm0 \n\t"\
  714. "movd 3(%0), %%mm3 \n\t"\
  715. "punpcklbw %%mm7, %%mm0 \n\t"\
  716. "punpcklbw %%mm7, %%mm3 \n\t"\
  717. "paddw %%mm3, %%mm0 \n\t"\
  718. "psllw $2, %%mm2 \n\t"\
  719. "psubw %%mm1, %%mm2 \n\t"\
  720. "pmullw %%mm4, %%mm2 \n\t"\
  721. "paddw %%mm5, %%mm0 \n\t"\
  722. "paddw %%mm2, %%mm0 \n\t"\
  723. "psraw $5, %%mm0 \n\t"\
  724. "packuswb %%mm0, %%mm0 \n\t"\
  725. OP(%%mm0, (%1),%%mm6, d)\
  726. "add %3, %0 \n\t"\
  727. "add %4, %1 \n\t"\
  728. "decl %2 \n\t"\
  729. " jnz 1b \n\t"\
  730. : "+a"(src), "+c"(dst), "+m"(h)\
  731. : "d"((long)srcStride), "S"((long)dstStride), "m"(ff_pw_5), "m"(ff_pw_16)\
  732. : "memory"\
  733. );\
  734. }\
  735. static av_noinline void OPNAME ## h264_qpel4_h_lowpass_l2_ ## MMX(uint8_t *dst, uint8_t *src, uint8_t *src2, int dstStride, int src2Stride){\
  736. int h=4;\
  737. asm volatile(\
  738. "pxor %%mm7, %%mm7 \n\t"\
  739. "movq %0, %%mm4 \n\t"\
  740. "movq %1, %%mm5 \n\t"\
  741. :: "m"(ff_pw_5), "m"(ff_pw_16)\
  742. );\
  743. do{\
  744. asm volatile(\
  745. "movd -1(%0), %%mm1 \n\t"\
  746. "movd (%0), %%mm2 \n\t"\
  747. "movd 1(%0), %%mm3 \n\t"\
  748. "movd 2(%0), %%mm0 \n\t"\
  749. "punpcklbw %%mm7, %%mm1 \n\t"\
  750. "punpcklbw %%mm7, %%mm2 \n\t"\
  751. "punpcklbw %%mm7, %%mm3 \n\t"\
  752. "punpcklbw %%mm7, %%mm0 \n\t"\
  753. "paddw %%mm0, %%mm1 \n\t"\
  754. "paddw %%mm3, %%mm2 \n\t"\
  755. "movd -2(%0), %%mm0 \n\t"\
  756. "movd 3(%0), %%mm3 \n\t"\
  757. "punpcklbw %%mm7, %%mm0 \n\t"\
  758. "punpcklbw %%mm7, %%mm3 \n\t"\
  759. "paddw %%mm3, %%mm0 \n\t"\
  760. "psllw $2, %%mm2 \n\t"\
  761. "psubw %%mm1, %%mm2 \n\t"\
  762. "pmullw %%mm4, %%mm2 \n\t"\
  763. "paddw %%mm5, %%mm0 \n\t"\
  764. "paddw %%mm2, %%mm0 \n\t"\
  765. "movd (%2), %%mm3 \n\t"\
  766. "psraw $5, %%mm0 \n\t"\
  767. "packuswb %%mm0, %%mm0 \n\t"\
  768. PAVGB" %%mm3, %%mm0 \n\t"\
  769. OP(%%mm0, (%1),%%mm6, d)\
  770. "add %4, %0 \n\t"\
  771. "add %4, %1 \n\t"\
  772. "add %3, %2 \n\t"\
  773. : "+a"(src), "+c"(dst), "+d"(src2)\
  774. : "D"((long)src2Stride), "S"((long)dstStride)\
  775. : "memory"\
  776. );\
  777. }while(--h);\
  778. }\
  779. static av_noinline void OPNAME ## h264_qpel4_v_lowpass_ ## MMX(uint8_t *dst, uint8_t *src, int dstStride, int srcStride){\
  780. src -= 2*srcStride;\
  781. asm volatile(\
  782. "pxor %%mm7, %%mm7 \n\t"\
  783. "movd (%0), %%mm0 \n\t"\
  784. "add %2, %0 \n\t"\
  785. "movd (%0), %%mm1 \n\t"\
  786. "add %2, %0 \n\t"\
  787. "movd (%0), %%mm2 \n\t"\
  788. "add %2, %0 \n\t"\
  789. "movd (%0), %%mm3 \n\t"\
  790. "add %2, %0 \n\t"\
  791. "movd (%0), %%mm4 \n\t"\
  792. "add %2, %0 \n\t"\
  793. "punpcklbw %%mm7, %%mm0 \n\t"\
  794. "punpcklbw %%mm7, %%mm1 \n\t"\
  795. "punpcklbw %%mm7, %%mm2 \n\t"\
  796. "punpcklbw %%mm7, %%mm3 \n\t"\
  797. "punpcklbw %%mm7, %%mm4 \n\t"\
  798. QPEL_H264V(%%mm0, %%mm1, %%mm2, %%mm3, %%mm4, %%mm5, OP)\
  799. QPEL_H264V(%%mm1, %%mm2, %%mm3, %%mm4, %%mm5, %%mm0, OP)\
  800. QPEL_H264V(%%mm2, %%mm3, %%mm4, %%mm5, %%mm0, %%mm1, OP)\
  801. QPEL_H264V(%%mm3, %%mm4, %%mm5, %%mm0, %%mm1, %%mm2, OP)\
  802. \
  803. : "+a"(src), "+c"(dst)\
  804. : "S"((long)srcStride), "D"((long)dstStride), "m"(ff_pw_5), "m"(ff_pw_16)\
  805. : "memory"\
  806. );\
  807. }\
  808. static av_noinline void OPNAME ## h264_qpel4_hv_lowpass_ ## MMX(uint8_t *dst, int16_t *tmp, uint8_t *src, int dstStride, int tmpStride, int srcStride){\
  809. int h=4;\
  810. int w=3;\
  811. src -= 2*srcStride+2;\
  812. while(w--){\
  813. asm volatile(\
  814. "pxor %%mm7, %%mm7 \n\t"\
  815. "movd (%0), %%mm0 \n\t"\
  816. "add %2, %0 \n\t"\
  817. "movd (%0), %%mm1 \n\t"\
  818. "add %2, %0 \n\t"\
  819. "movd (%0), %%mm2 \n\t"\
  820. "add %2, %0 \n\t"\
  821. "movd (%0), %%mm3 \n\t"\
  822. "add %2, %0 \n\t"\
  823. "movd (%0), %%mm4 \n\t"\
  824. "add %2, %0 \n\t"\
  825. "punpcklbw %%mm7, %%mm0 \n\t"\
  826. "punpcklbw %%mm7, %%mm1 \n\t"\
  827. "punpcklbw %%mm7, %%mm2 \n\t"\
  828. "punpcklbw %%mm7, %%mm3 \n\t"\
  829. "punpcklbw %%mm7, %%mm4 \n\t"\
  830. QPEL_H264HV(%%mm0, %%mm1, %%mm2, %%mm3, %%mm4, %%mm5, 0*8*3)\
  831. QPEL_H264HV(%%mm1, %%mm2, %%mm3, %%mm4, %%mm5, %%mm0, 1*8*3)\
  832. QPEL_H264HV(%%mm2, %%mm3, %%mm4, %%mm5, %%mm0, %%mm1, 2*8*3)\
  833. QPEL_H264HV(%%mm3, %%mm4, %%mm5, %%mm0, %%mm1, %%mm2, 3*8*3)\
  834. \
  835. : "+a"(src)\
  836. : "c"(tmp), "S"((long)srcStride), "m"(ff_pw_5)\
  837. : "memory"\
  838. );\
  839. tmp += 4;\
  840. src += 4 - 9*srcStride;\
  841. }\
  842. tmp -= 3*4;\
  843. asm volatile(\
  844. "movq %4, %%mm6 \n\t"\
  845. "1: \n\t"\
  846. "movq (%0), %%mm0 \n\t"\
  847. "paddw 10(%0), %%mm0 \n\t"\
  848. "movq 2(%0), %%mm1 \n\t"\
  849. "paddw 8(%0), %%mm1 \n\t"\
  850. "movq 4(%0), %%mm2 \n\t"\
  851. "paddw 6(%0), %%mm2 \n\t"\
  852. "psubw %%mm1, %%mm0 \n\t"/*a-b (abccba)*/\
  853. "psraw $2, %%mm0 \n\t"/*(a-b)/4 */\
  854. "psubw %%mm1, %%mm0 \n\t"/*(a-b)/4-b */\
  855. "paddsw %%mm2, %%mm0 \n\t"\
  856. "psraw $2, %%mm0 \n\t"/*((a-b)/4-b+c)/4 */\
  857. "paddw %%mm6, %%mm2 \n\t"\
  858. "paddw %%mm2, %%mm0 \n\t"/*(a-5*b+20*c)/16 +32 */\
  859. "psraw $6, %%mm0 \n\t"\
  860. "packuswb %%mm0, %%mm0 \n\t"\
  861. OP(%%mm0, (%1),%%mm7, d)\
  862. "add $24, %0 \n\t"\
  863. "add %3, %1 \n\t"\
  864. "decl %2 \n\t"\
  865. " jnz 1b \n\t"\
  866. : "+a"(tmp), "+c"(dst), "+m"(h)\
  867. : "S"((long)dstStride), "m"(*ff_pw_32)\
  868. : "memory"\
  869. );\
  870. }\
  871. \
  872. static av_noinline void OPNAME ## h264_qpel8_h_lowpass_ ## MMX(uint8_t *dst, uint8_t *src, int dstStride, int srcStride){\
  873. int h=8;\
  874. asm volatile(\
  875. "pxor %%mm7, %%mm7 \n\t"\
  876. "movq %5, %%mm6 \n\t"\
  877. "1: \n\t"\
  878. "movq (%0), %%mm0 \n\t"\
  879. "movq 1(%0), %%mm2 \n\t"\
  880. "movq %%mm0, %%mm1 \n\t"\
  881. "movq %%mm2, %%mm3 \n\t"\
  882. "punpcklbw %%mm7, %%mm0 \n\t"\
  883. "punpckhbw %%mm7, %%mm1 \n\t"\
  884. "punpcklbw %%mm7, %%mm2 \n\t"\
  885. "punpckhbw %%mm7, %%mm3 \n\t"\
  886. "paddw %%mm2, %%mm0 \n\t"\
  887. "paddw %%mm3, %%mm1 \n\t"\
  888. "psllw $2, %%mm0 \n\t"\
  889. "psllw $2, %%mm1 \n\t"\
  890. "movq -1(%0), %%mm2 \n\t"\
  891. "movq 2(%0), %%mm4 \n\t"\
  892. "movq %%mm2, %%mm3 \n\t"\
  893. "movq %%mm4, %%mm5 \n\t"\
  894. "punpcklbw %%mm7, %%mm2 \n\t"\
  895. "punpckhbw %%mm7, %%mm3 \n\t"\
  896. "punpcklbw %%mm7, %%mm4 \n\t"\
  897. "punpckhbw %%mm7, %%mm5 \n\t"\
  898. "paddw %%mm4, %%mm2 \n\t"\
  899. "paddw %%mm3, %%mm5 \n\t"\
  900. "psubw %%mm2, %%mm0 \n\t"\
  901. "psubw %%mm5, %%mm1 \n\t"\
  902. "pmullw %%mm6, %%mm0 \n\t"\
  903. "pmullw %%mm6, %%mm1 \n\t"\
  904. "movd -2(%0), %%mm2 \n\t"\
  905. "movd 7(%0), %%mm5 \n\t"\
  906. "punpcklbw %%mm7, %%mm2 \n\t"\
  907. "punpcklbw %%mm7, %%mm5 \n\t"\
  908. "paddw %%mm3, %%mm2 \n\t"\
  909. "paddw %%mm5, %%mm4 \n\t"\
  910. "movq %6, %%mm5 \n\t"\
  911. "paddw %%mm5, %%mm2 \n\t"\
  912. "paddw %%mm5, %%mm4 \n\t"\
  913. "paddw %%mm2, %%mm0 \n\t"\
  914. "paddw %%mm4, %%mm1 \n\t"\
  915. "psraw $5, %%mm0 \n\t"\
  916. "psraw $5, %%mm1 \n\t"\
  917. "packuswb %%mm1, %%mm0 \n\t"\
  918. OP(%%mm0, (%1),%%mm5, q)\
  919. "add %3, %0 \n\t"\
  920. "add %4, %1 \n\t"\
  921. "decl %2 \n\t"\
  922. " jnz 1b \n\t"\
  923. : "+a"(src), "+c"(dst), "+m"(h)\
  924. : "d"((long)srcStride), "S"((long)dstStride), "m"(ff_pw_5), "m"(ff_pw_16)\
  925. : "memory"\
  926. );\
  927. }\
  928. \
  929. static av_noinline void OPNAME ## h264_qpel8_h_lowpass_l2_ ## MMX(uint8_t *dst, uint8_t *src, uint8_t *src2, int dstStride, int src2Stride){\
  930. int h=8;\
  931. asm volatile(\
  932. "pxor %%mm7, %%mm7 \n\t"\
  933. "movq %0, %%mm6 \n\t"\
  934. :: "m"(ff_pw_5)\
  935. );\
  936. do{\
  937. asm volatile(\
  938. "movq (%0), %%mm0 \n\t"\
  939. "movq 1(%0), %%mm2 \n\t"\
  940. "movq %%mm0, %%mm1 \n\t"\
  941. "movq %%mm2, %%mm3 \n\t"\
  942. "punpcklbw %%mm7, %%mm0 \n\t"\
  943. "punpckhbw %%mm7, %%mm1 \n\t"\
  944. "punpcklbw %%mm7, %%mm2 \n\t"\
  945. "punpckhbw %%mm7, %%mm3 \n\t"\
  946. "paddw %%mm2, %%mm0 \n\t"\
  947. "paddw %%mm3, %%mm1 \n\t"\
  948. "psllw $2, %%mm0 \n\t"\
  949. "psllw $2, %%mm1 \n\t"\
  950. "movq -1(%0), %%mm2 \n\t"\
  951. "movq 2(%0), %%mm4 \n\t"\
  952. "movq %%mm2, %%mm3 \n\t"\
  953. "movq %%mm4, %%mm5 \n\t"\
  954. "punpcklbw %%mm7, %%mm2 \n\t"\
  955. "punpckhbw %%mm7, %%mm3 \n\t"\
  956. "punpcklbw %%mm7, %%mm4 \n\t"\
  957. "punpckhbw %%mm7, %%mm5 \n\t"\
  958. "paddw %%mm4, %%mm2 \n\t"\
  959. "paddw %%mm3, %%mm5 \n\t"\
  960. "psubw %%mm2, %%mm0 \n\t"\
  961. "psubw %%mm5, %%mm1 \n\t"\
  962. "pmullw %%mm6, %%mm0 \n\t"\
  963. "pmullw %%mm6, %%mm1 \n\t"\
  964. "movd -2(%0), %%mm2 \n\t"\
  965. "movd 7(%0), %%mm5 \n\t"\
  966. "punpcklbw %%mm7, %%mm2 \n\t"\
  967. "punpcklbw %%mm7, %%mm5 \n\t"\
  968. "paddw %%mm3, %%mm2 \n\t"\
  969. "paddw %%mm5, %%mm4 \n\t"\
  970. "movq %5, %%mm5 \n\t"\
  971. "paddw %%mm5, %%mm2 \n\t"\
  972. "paddw %%mm5, %%mm4 \n\t"\
  973. "paddw %%mm2, %%mm0 \n\t"\
  974. "paddw %%mm4, %%mm1 \n\t"\
  975. "psraw $5, %%mm0 \n\t"\
  976. "psraw $5, %%mm1 \n\t"\
  977. "movq (%2), %%mm4 \n\t"\
  978. "packuswb %%mm1, %%mm0 \n\t"\
  979. PAVGB" %%mm4, %%mm0 \n\t"\
  980. OP(%%mm0, (%1),%%mm5, q)\
  981. "add %4, %0 \n\t"\
  982. "add %4, %1 \n\t"\
  983. "add %3, %2 \n\t"\
  984. : "+a"(src), "+c"(dst), "+d"(src2)\
  985. : "D"((long)src2Stride), "S"((long)dstStride),\
  986. "m"(ff_pw_16)\
  987. : "memory"\
  988. );\
  989. }while(--h);\
  990. }\
  991. \
  992. static av_noinline void OPNAME ## h264_qpel8or16_v_lowpass_ ## MMX(uint8_t *dst, uint8_t *src, int dstStride, int srcStride, int h){\
  993. int w= 2;\
  994. src -= 2*srcStride;\
  995. \
  996. while(w--){\
  997. asm volatile(\
  998. "pxor %%mm7, %%mm7 \n\t"\
  999. "movd (%0), %%mm0 \n\t"\
  1000. "add %2, %0 \n\t"\
  1001. "movd (%0), %%mm1 \n\t"\
  1002. "add %2, %0 \n\t"\
  1003. "movd (%0), %%mm2 \n\t"\
  1004. "add %2, %0 \n\t"\
  1005. "movd (%0), %%mm3 \n\t"\
  1006. "add %2, %0 \n\t"\
  1007. "movd (%0), %%mm4 \n\t"\
  1008. "add %2, %0 \n\t"\
  1009. "punpcklbw %%mm7, %%mm0 \n\t"\
  1010. "punpcklbw %%mm7, %%mm1 \n\t"\
  1011. "punpcklbw %%mm7, %%mm2 \n\t"\
  1012. "punpcklbw %%mm7, %%mm3 \n\t"\
  1013. "punpcklbw %%mm7, %%mm4 \n\t"\
  1014. QPEL_H264V(%%mm0, %%mm1, %%mm2, %%mm3, %%mm4, %%mm5, OP)\
  1015. QPEL_H264V(%%mm1, %%mm2, %%mm3, %%mm4, %%mm5, %%mm0, OP)\
  1016. QPEL_H264V(%%mm2, %%mm3, %%mm4, %%mm5, %%mm0, %%mm1, OP)\
  1017. QPEL_H264V(%%mm3, %%mm4, %%mm5, %%mm0, %%mm1, %%mm2, OP)\
  1018. QPEL_H264V(%%mm4, %%mm5, %%mm0, %%mm1, %%mm2, %%mm3, OP)\
  1019. QPEL_H264V(%%mm5, %%mm0, %%mm1, %%mm2, %%mm3, %%mm4, OP)\
  1020. QPEL_H264V(%%mm0, %%mm1, %%mm2, %%mm3, %%mm4, %%mm5, OP)\
  1021. QPEL_H264V(%%mm1, %%mm2, %%mm3, %%mm4, %%mm5, %%mm0, OP)\
  1022. \
  1023. : "+a"(src), "+c"(dst)\
  1024. : "S"((long)srcStride), "D"((long)dstStride), "m"(ff_pw_5), "m"(ff_pw_16)\
  1025. : "memory"\
  1026. );\
  1027. if(h==16){\
  1028. asm volatile(\
  1029. QPEL_H264V(%%mm2, %%mm3, %%mm4, %%mm5, %%mm0, %%mm1, OP)\
  1030. QPEL_H264V(%%mm3, %%mm4, %%mm5, %%mm0, %%mm1, %%mm2, OP)\
  1031. QPEL_H264V(%%mm4, %%mm5, %%mm0, %%mm1, %%mm2, %%mm3, OP)\
  1032. QPEL_H264V(%%mm5, %%mm0, %%mm1, %%mm2, %%mm3, %%mm4, OP)\
  1033. QPEL_H264V(%%mm0, %%mm1, %%mm2, %%mm3, %%mm4, %%mm5, OP)\
  1034. QPEL_H264V(%%mm1, %%mm2, %%mm3, %%mm4, %%mm5, %%mm0, OP)\
  1035. QPEL_H264V(%%mm2, %%mm3, %%mm4, %%mm5, %%mm0, %%mm1, OP)\
  1036. QPEL_H264V(%%mm3, %%mm4, %%mm5, %%mm0, %%mm1, %%mm2, OP)\
  1037. \
  1038. : "+a"(src), "+c"(dst)\
  1039. : "S"((long)srcStride), "D"((long)dstStride), "m"(ff_pw_5), "m"(ff_pw_16)\
  1040. : "memory"\
  1041. );\
  1042. }\
  1043. src += 4-(h+5)*srcStride;\
  1044. dst += 4-h*dstStride;\
  1045. }\
  1046. }\
  1047. static av_noinline void OPNAME ## h264_qpel8or16_hv_lowpass_ ## MMX(uint8_t *dst, int16_t *tmp, uint8_t *src, int dstStride, int tmpStride, int srcStride, int size){\
  1048. int h = size;\
  1049. int w = (size+8)>>2;\
  1050. src -= 2*srcStride+2;\
  1051. while(w--){\
  1052. asm volatile(\
  1053. "pxor %%mm7, %%mm7 \n\t"\
  1054. "movd (%0), %%mm0 \n\t"\
  1055. "add %2, %0 \n\t"\
  1056. "movd (%0), %%mm1 \n\t"\
  1057. "add %2, %0 \n\t"\
  1058. "movd (%0), %%mm2 \n\t"\
  1059. "add %2, %0 \n\t"\
  1060. "movd (%0), %%mm3 \n\t"\
  1061. "add %2, %0 \n\t"\
  1062. "movd (%0), %%mm4 \n\t"\
  1063. "add %2, %0 \n\t"\
  1064. "punpcklbw %%mm7, %%mm0 \n\t"\
  1065. "punpcklbw %%mm7, %%mm1 \n\t"\
  1066. "punpcklbw %%mm7, %%mm2 \n\t"\
  1067. "punpcklbw %%mm7, %%mm3 \n\t"\
  1068. "punpcklbw %%mm7, %%mm4 \n\t"\
  1069. QPEL_H264HV(%%mm0, %%mm1, %%mm2, %%mm3, %%mm4, %%mm5, 0*48)\
  1070. QPEL_H264HV(%%mm1, %%mm2, %%mm3, %%mm4, %%mm5, %%mm0, 1*48)\
  1071. QPEL_H264HV(%%mm2, %%mm3, %%mm4, %%mm5, %%mm0, %%mm1, 2*48)\
  1072. QPEL_H264HV(%%mm3, %%mm4, %%mm5, %%mm0, %%mm1, %%mm2, 3*48)\
  1073. QPEL_H264HV(%%mm4, %%mm5, %%mm0, %%mm1, %%mm2, %%mm3, 4*48)\
  1074. QPEL_H264HV(%%mm5, %%mm0, %%mm1, %%mm2, %%mm3, %%mm4, 5*48)\
  1075. QPEL_H264HV(%%mm0, %%mm1, %%mm2, %%mm3, %%mm4, %%mm5, 6*48)\
  1076. QPEL_H264HV(%%mm1, %%mm2, %%mm3, %%mm4, %%mm5, %%mm0, 7*48)\
  1077. : "+a"(src)\
  1078. : "c"(tmp), "S"((long)srcStride), "m"(ff_pw_5)\
  1079. : "memory"\
  1080. );\
  1081. if(size==16){\
  1082. asm volatile(\
  1083. QPEL_H264HV(%%mm2, %%mm3, %%mm4, %%mm5, %%mm0, %%mm1, 8*48)\
  1084. QPEL_H264HV(%%mm3, %%mm4, %%mm5, %%mm0, %%mm1, %%mm2, 9*48)\
  1085. QPEL_H264HV(%%mm4, %%mm5, %%mm0, %%mm1, %%mm2, %%mm3, 10*48)\
  1086. QPEL_H264HV(%%mm5, %%mm0, %%mm1, %%mm2, %%mm3, %%mm4, 11*48)\
  1087. QPEL_H264HV(%%mm0, %%mm1, %%mm2, %%mm3, %%mm4, %%mm5, 12*48)\
  1088. QPEL_H264HV(%%mm1, %%mm2, %%mm3, %%mm4, %%mm5, %%mm0, 13*48)\
  1089. QPEL_H264HV(%%mm2, %%mm3, %%mm4, %%mm5, %%mm0, %%mm1, 14*48)\
  1090. QPEL_H264HV(%%mm3, %%mm4, %%mm5, %%mm0, %%mm1, %%mm2, 15*48)\
  1091. : "+a"(src)\
  1092. : "c"(tmp), "S"((long)srcStride), "m"(ff_pw_5)\
  1093. : "memory"\
  1094. );\
  1095. }\
  1096. tmp += 4;\
  1097. src += 4 - (size+5)*srcStride;\
  1098. }\
  1099. tmp -= size+8;\
  1100. w = size>>4;\
  1101. do{\
  1102. h = size;\
  1103. asm volatile(\
  1104. "movq %4, %%mm6 \n\t"\
  1105. "1: \n\t"\
  1106. "movq (%0), %%mm0 \n\t"\
  1107. "movq 8(%0), %%mm3 \n\t"\
  1108. "movq 2(%0), %%mm1 \n\t"\
  1109. "movq 10(%0), %%mm4 \n\t"\
  1110. "paddw %%mm4, %%mm0 \n\t"\
  1111. "paddw %%mm3, %%mm1 \n\t"\
  1112. "paddw 18(%0), %%mm3 \n\t"\
  1113. "paddw 16(%0), %%mm4 \n\t"\
  1114. "movq 4(%0), %%mm2 \n\t"\
  1115. "movq 12(%0), %%mm5 \n\t"\
  1116. "paddw 6(%0), %%mm2 \n\t"\
  1117. "paddw 14(%0), %%mm5 \n\t"\
  1118. "psubw %%mm1, %%mm0 \n\t"\
  1119. "psubw %%mm4, %%mm3 \n\t"\
  1120. "psraw $2, %%mm0 \n\t"\
  1121. "psraw $2, %%mm3 \n\t"\
  1122. "psubw %%mm1, %%mm0 \n\t"\
  1123. "psubw %%mm4, %%mm3 \n\t"\
  1124. "paddsw %%mm2, %%mm0 \n\t"\
  1125. "paddsw %%mm5, %%mm3 \n\t"\
  1126. "psraw $2, %%mm0 \n\t"\
  1127. "psraw $2, %%mm3 \n\t"\
  1128. "paddw %%mm6, %%mm2 \n\t"\
  1129. "paddw %%mm6, %%mm5 \n\t"\
  1130. "paddw %%mm2, %%mm0 \n\t"\
  1131. "paddw %%mm5, %%mm3 \n\t"\
  1132. "psraw $6, %%mm0 \n\t"\
  1133. "psraw $6, %%mm3 \n\t"\
  1134. "packuswb %%mm3, %%mm0 \n\t"\
  1135. OP(%%mm0, (%1),%%mm7, q)\
  1136. "add $48, %0 \n\t"\
  1137. "add %3, %1 \n\t"\
  1138. "decl %2 \n\t"\
  1139. " jnz 1b \n\t"\
  1140. : "+a"(tmp), "+c"(dst), "+m"(h)\
  1141. : "S"((long)dstStride), "m"(*ff_pw_32)\
  1142. : "memory"\
  1143. );\
  1144. tmp += 8 - size*24;\
  1145. dst += 8 - size*dstStride;\
  1146. }while(w--);\
  1147. }\
  1148. \
  1149. static void OPNAME ## h264_qpel8_v_lowpass_ ## MMX(uint8_t *dst, uint8_t *src, int dstStride, int srcStride){\
  1150. OPNAME ## h264_qpel8or16_v_lowpass_ ## MMX(dst , src , dstStride, srcStride, 8);\
  1151. }\
  1152. static av_noinline void OPNAME ## h264_qpel16_v_lowpass_ ## MMX(uint8_t *dst, uint8_t *src, int dstStride, int srcStride){\
  1153. OPNAME ## h264_qpel8or16_v_lowpass_ ## MMX(dst , src , dstStride, srcStride, 16);\
  1154. OPNAME ## h264_qpel8or16_v_lowpass_ ## MMX(dst+8, src+8, dstStride, srcStride, 16);\
  1155. }\
  1156. \
  1157. static av_noinline void OPNAME ## h264_qpel16_h_lowpass_ ## MMX(uint8_t *dst, uint8_t *src, int dstStride, int srcStride){\
  1158. OPNAME ## h264_qpel8_h_lowpass_ ## MMX(dst , src , dstStride, srcStride);\
  1159. OPNAME ## h264_qpel8_h_lowpass_ ## MMX(dst+8, src+8, dstStride, srcStride);\
  1160. src += 8*srcStride;\
  1161. dst += 8*dstStride;\
  1162. OPNAME ## h264_qpel8_h_lowpass_ ## MMX(dst , src , dstStride, srcStride);\
  1163. OPNAME ## h264_qpel8_h_lowpass_ ## MMX(dst+8, src+8, dstStride, srcStride);\
  1164. }\
  1165. \
  1166. static av_noinline void OPNAME ## h264_qpel16_h_lowpass_l2_ ## MMX(uint8_t *dst, uint8_t *src, uint8_t *src2, int dstStride, int src2Stride){\
  1167. OPNAME ## h264_qpel8_h_lowpass_l2_ ## MMX(dst , src , src2 , dstStride, src2Stride);\
  1168. OPNAME ## h264_qpel8_h_lowpass_l2_ ## MMX(dst+8, src+8, src2+8, dstStride, src2Stride);\
  1169. src += 8*dstStride;\
  1170. dst += 8*dstStride;\
  1171. src2 += 8*src2Stride;\
  1172. OPNAME ## h264_qpel8_h_lowpass_l2_ ## MMX(dst , src , src2 , dstStride, src2Stride);\
  1173. OPNAME ## h264_qpel8_h_lowpass_l2_ ## MMX(dst+8, src+8, src2+8, dstStride, src2Stride);\
  1174. }\
  1175. \
  1176. static void OPNAME ## h264_qpel8_hv_lowpass_ ## MMX(uint8_t *dst, int16_t *tmp, uint8_t *src, int dstStride, int tmpStride, int srcStride){\
  1177. OPNAME ## h264_qpel8or16_hv_lowpass_ ## MMX(dst , tmp , src , dstStride, tmpStride, srcStride, 8);\
  1178. }\
  1179. \
  1180. static void OPNAME ## h264_qpel16_hv_lowpass_ ## MMX(uint8_t *dst, int16_t *tmp, uint8_t *src, int dstStride, int tmpStride, int srcStride){\
  1181. OPNAME ## h264_qpel8or16_hv_lowpass_ ## MMX(dst , tmp , src , dstStride, tmpStride, srcStride, 16);\
  1182. }\
  1183. \
  1184. static av_noinline void OPNAME ## pixels4_l2_shift5_ ## MMX(uint8_t *dst, int16_t *src16, uint8_t *src8, int dstStride, int src8Stride, int h)\
  1185. {\
  1186. asm volatile(\
  1187. "movq %5, %%mm6 \n\t"\
  1188. "movq (%1), %%mm0 \n\t"\
  1189. "movq 24(%1), %%mm1 \n\t"\
  1190. "paddw %%mm6, %%mm0 \n\t"\
  1191. "paddw %%mm6, %%mm1 \n\t"\
  1192. "psraw $5, %%mm0 \n\t"\
  1193. "psraw $5, %%mm1 \n\t"\
  1194. "packuswb %%mm0, %%mm0 \n\t"\
  1195. "packuswb %%mm1, %%mm1 \n\t"\
  1196. PAVGB" (%0), %%mm0 \n\t"\
  1197. PAVGB" (%0,%3), %%mm1 \n\t"\
  1198. OP(%%mm0, (%2), %%mm4, d)\
  1199. OP(%%mm1, (%2,%4), %%mm5, d)\
  1200. "lea (%0,%3,2), %0 \n\t"\
  1201. "lea (%2,%4,2), %2 \n\t"\
  1202. "movq 48(%1), %%mm0 \n\t"\
  1203. "movq 72(%1), %%mm1 \n\t"\
  1204. "paddw %%mm6, %%mm0 \n\t"\
  1205. "paddw %%mm6, %%mm1 \n\t"\
  1206. "psraw $5, %%mm0 \n\t"\
  1207. "psraw $5, %%mm1 \n\t"\
  1208. "packuswb %%mm0, %%mm0 \n\t"\
  1209. "packuswb %%mm1, %%mm1 \n\t"\
  1210. PAVGB" (%0), %%mm0 \n\t"\
  1211. PAVGB" (%0,%3), %%mm1 \n\t"\
  1212. OP(%%mm0, (%2), %%mm4, d)\
  1213. OP(%%mm1, (%2,%4), %%mm5, d)\
  1214. :"+a"(src8), "+c"(src16), "+d"(dst)\
  1215. :"S"((long)src8Stride), "D"((long)dstStride), "m"(ff_pw_16)\
  1216. :"memory");\
  1217. }\
  1218. static av_noinline void OPNAME ## pixels8_l2_shift5_ ## MMX(uint8_t *dst, int16_t *src16, uint8_t *src8, int dstStride, int src8Stride, int h)\
  1219. {\
  1220. asm volatile(\
  1221. "movq %0, %%mm6 \n\t"\
  1222. ::"m"(ff_pw_16)\
  1223. );\
  1224. while(h--){\
  1225. asm volatile(\
  1226. "movq (%1), %%mm0 \n\t"\
  1227. "movq 8(%1), %%mm1 \n\t"\
  1228. "paddw %%mm6, %%mm0 \n\t"\
  1229. "paddw %%mm6, %%mm1 \n\t"\
  1230. "psraw $5, %%mm0 \n\t"\
  1231. "psraw $5, %%mm1 \n\t"\
  1232. "packuswb %%mm1, %%mm0 \n\t"\
  1233. PAVGB" (%0), %%mm0 \n\t"\
  1234. OP(%%mm0, (%2), %%mm5, q)\
  1235. ::"a"(src8), "c"(src16), "d"(dst)\
  1236. :"memory");\
  1237. src8 += src8Stride;\
  1238. src16 += 24;\
  1239. dst += dstStride;\
  1240. }\
  1241. }\
  1242. static void OPNAME ## pixels16_l2_shift5_ ## MMX(uint8_t *dst, int16_t *src16, uint8_t *src8, int dstStride, int src8Stride, int h)\
  1243. {\
  1244. OPNAME ## pixels8_l2_shift5_ ## MMX(dst , src16 , src8 , dstStride, src8Stride, h);\
  1245. OPNAME ## pixels8_l2_shift5_ ## MMX(dst+8, src16+8, src8+8, dstStride, src8Stride, h);\
  1246. }\
  1247. #define H264_MC(OPNAME, SIZE, MMX) \
  1248. static void OPNAME ## h264_qpel ## SIZE ## _mc00_ ## MMX (uint8_t *dst, uint8_t *src, int stride){\
  1249. OPNAME ## pixels ## SIZE ## _ ## MMX(dst, src, stride, SIZE);\
  1250. }\
  1251. \
  1252. static void OPNAME ## h264_qpel ## SIZE ## _mc10_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  1253. OPNAME ## h264_qpel ## SIZE ## _h_lowpass_l2_ ## MMX(dst, src, src, stride, stride);\
  1254. }\
  1255. \
  1256. static void OPNAME ## h264_qpel ## SIZE ## _mc20_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  1257. OPNAME ## h264_qpel ## SIZE ## _h_lowpass_ ## MMX(dst, src, stride, stride);\
  1258. }\
  1259. \
  1260. static void OPNAME ## h264_qpel ## SIZE ## _mc30_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  1261. OPNAME ## h264_qpel ## SIZE ## _h_lowpass_l2_ ## MMX(dst, src, src+1, stride, stride);\
  1262. }\
  1263. \
  1264. static void OPNAME ## h264_qpel ## SIZE ## _mc01_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  1265. uint64_t temp[SIZE*SIZE/8];\
  1266. uint8_t * const half= (uint8_t*)temp;\
  1267. put_h264_qpel ## SIZE ## _v_lowpass_ ## MMX(half, src, SIZE, stride);\
  1268. OPNAME ## pixels ## SIZE ## _l2_ ## MMX(dst, src, half, stride, stride, SIZE);\
  1269. }\
  1270. \
  1271. static void OPNAME ## h264_qpel ## SIZE ## _mc02_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  1272. OPNAME ## h264_qpel ## SIZE ## _v_lowpass_ ## MMX(dst, src, stride, stride);\
  1273. }\
  1274. \
  1275. static void OPNAME ## h264_qpel ## SIZE ## _mc03_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  1276. uint64_t temp[SIZE*SIZE/8];\
  1277. uint8_t * const half= (uint8_t*)temp;\
  1278. put_h264_qpel ## SIZE ## _v_lowpass_ ## MMX(half, src, SIZE, stride);\
  1279. OPNAME ## pixels ## SIZE ## _l2_ ## MMX(dst, src+stride, half, stride, stride, SIZE);\
  1280. }\
  1281. \
  1282. static void OPNAME ## h264_qpel ## SIZE ## _mc11_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  1283. uint64_t temp[SIZE*SIZE/8];\
  1284. uint8_t * const halfV= (uint8_t*)temp;\
  1285. put_h264_qpel ## SIZE ## _v_lowpass_ ## MMX(halfV, src, SIZE, stride);\
  1286. OPNAME ## h264_qpel ## SIZE ## _h_lowpass_l2_ ## MMX(dst, src, halfV, stride, SIZE);\
  1287. }\
  1288. \
  1289. static void OPNAME ## h264_qpel ## SIZE ## _mc31_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  1290. uint64_t temp[SIZE*SIZE/8];\
  1291. uint8_t * const halfV= (uint8_t*)temp;\
  1292. put_h264_qpel ## SIZE ## _v_lowpass_ ## MMX(halfV, src+1, SIZE, stride);\
  1293. OPNAME ## h264_qpel ## SIZE ## _h_lowpass_l2_ ## MMX(dst, src, halfV, stride, SIZE);\
  1294. }\
  1295. \
  1296. static void OPNAME ## h264_qpel ## SIZE ## _mc13_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  1297. uint64_t temp[SIZE*SIZE/8];\
  1298. uint8_t * const halfV= (uint8_t*)temp;\
  1299. put_h264_qpel ## SIZE ## _v_lowpass_ ## MMX(halfV, src, SIZE, stride);\
  1300. OPNAME ## h264_qpel ## SIZE ## _h_lowpass_l2_ ## MMX(dst, src+stride, halfV, stride, SIZE);\
  1301. }\
  1302. \
  1303. static void OPNAME ## h264_qpel ## SIZE ## _mc33_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  1304. uint64_t temp[SIZE*SIZE/8];\
  1305. uint8_t * const halfV= (uint8_t*)temp;\
  1306. put_h264_qpel ## SIZE ## _v_lowpass_ ## MMX(halfV, src+1, SIZE, stride);\
  1307. OPNAME ## h264_qpel ## SIZE ## _h_lowpass_l2_ ## MMX(dst, src+stride, halfV, stride, SIZE);\
  1308. }\
  1309. \
  1310. static void OPNAME ## h264_qpel ## SIZE ## _mc22_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  1311. uint64_t temp[SIZE*(SIZE<8?12:24)/4];\
  1312. int16_t * const tmp= (int16_t*)temp;\
  1313. OPNAME ## h264_qpel ## SIZE ## _hv_lowpass_ ## MMX(dst, tmp, src, stride, SIZE, stride);\
  1314. }\
  1315. \
  1316. static void OPNAME ## h264_qpel ## SIZE ## _mc21_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  1317. uint64_t temp[SIZE*(SIZE<8?12:24)/4 + SIZE*SIZE/8];\
  1318. uint8_t * const halfHV= (uint8_t*)temp;\
  1319. int16_t * const tmp= ((int16_t*)temp) + SIZE*SIZE/2;\
  1320. assert(((int)temp & 7) == 0);\
  1321. put_h264_qpel ## SIZE ## _hv_lowpass_ ## MMX(halfHV, tmp, src, SIZE, SIZE, stride);\
  1322. OPNAME ## h264_qpel ## SIZE ## _h_lowpass_l2_ ## MMX(dst, src, halfHV, stride, SIZE);\
  1323. }\
  1324. \
  1325. static void OPNAME ## h264_qpel ## SIZE ## _mc23_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  1326. uint64_t temp[SIZE*(SIZE<8?12:24)/4 + SIZE*SIZE/8];\
  1327. uint8_t * const halfHV= (uint8_t*)temp;\
  1328. int16_t * const tmp= ((int16_t*)temp) + SIZE*SIZE/2;\
  1329. assert(((int)temp & 7) == 0);\
  1330. put_h264_qpel ## SIZE ## _hv_lowpass_ ## MMX(halfHV, tmp, src, SIZE, SIZE, stride);\
  1331. OPNAME ## h264_qpel ## SIZE ## _h_lowpass_l2_ ## MMX(dst, src+stride, halfHV, stride, SIZE);\
  1332. }\
  1333. \
  1334. static void OPNAME ## h264_qpel ## SIZE ## _mc12_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  1335. uint64_t temp[SIZE*(SIZE<8?12:24)/4 + SIZE*SIZE/8];\
  1336. int16_t * const halfV= ((int16_t*)temp) + SIZE*SIZE/2;\
  1337. uint8_t * const halfHV= ((uint8_t*)temp);\
  1338. assert(((int)temp & 7) == 0);\
  1339. put_h264_qpel ## SIZE ## _hv_lowpass_ ## MMX(halfHV, halfV, src, SIZE, SIZE, stride);\
  1340. OPNAME ## pixels ## SIZE ## _l2_shift5_ ## MMX(dst, halfV+2, halfHV, stride, SIZE, SIZE);\
  1341. }\
  1342. \
  1343. static void OPNAME ## h264_qpel ## SIZE ## _mc32_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  1344. uint64_t temp[SIZE*(SIZE<8?12:24)/4 + SIZE*SIZE/8];\
  1345. int16_t * const halfV= ((int16_t*)temp) + SIZE*SIZE/2;\
  1346. uint8_t * const halfHV= ((uint8_t*)temp);\
  1347. assert(((int)temp & 7) == 0);\
  1348. put_h264_qpel ## SIZE ## _hv_lowpass_ ## MMX(halfHV, halfV, src, SIZE, SIZE, stride);\
  1349. OPNAME ## pixels ## SIZE ## _l2_shift5_ ## MMX(dst, halfV+3, halfHV, stride, SIZE, SIZE);\
  1350. }\
  1351. #define AVG_3DNOW_OP(a,b,temp, size) \
  1352. "mov" #size " " #b ", " #temp " \n\t"\
  1353. "pavgusb " #temp ", " #a " \n\t"\
  1354. "mov" #size " " #a ", " #b " \n\t"
  1355. #define AVG_MMX2_OP(a,b,temp, size) \
  1356. "mov" #size " " #b ", " #temp " \n\t"\
  1357. "pavgb " #temp ", " #a " \n\t"\
  1358. "mov" #size " " #a ", " #b " \n\t"
  1359. #define PAVGB "pavgusb"
  1360. QPEL_H264(put_, PUT_OP, 3dnow)
  1361. QPEL_H264(avg_, AVG_3DNOW_OP, 3dnow)
  1362. #undef PAVGB
  1363. #define PAVGB "pavgb"
  1364. QPEL_H264(put_, PUT_OP, mmx2)
  1365. QPEL_H264(avg_, AVG_MMX2_OP, mmx2)
  1366. #undef PAVGB
  1367. H264_MC(put_, 4, 3dnow)
  1368. H264_MC(put_, 8, 3dnow)
  1369. H264_MC(put_, 16,3dnow)
  1370. H264_MC(avg_, 4, 3dnow)
  1371. H264_MC(avg_, 8, 3dnow)
  1372. H264_MC(avg_, 16,3dnow)
  1373. H264_MC(put_, 4, mmx2)
  1374. H264_MC(put_, 8, mmx2)
  1375. H264_MC(put_, 16,mmx2)
  1376. H264_MC(avg_, 4, mmx2)
  1377. H264_MC(avg_, 8, mmx2)
  1378. H264_MC(avg_, 16,mmx2)
  1379. #define H264_CHROMA_OP(S,D)
  1380. #define H264_CHROMA_OP4(S,D,T)
  1381. #define H264_CHROMA_MC8_TMPL put_h264_chroma_mc8_mmx
  1382. #define H264_CHROMA_MC4_TMPL put_h264_chroma_mc4_mmx
  1383. #define H264_CHROMA_MC2_TMPL put_h264_chroma_mc2_mmx2
  1384. #define H264_CHROMA_MC8_MV0 put_pixels8_mmx
  1385. #include "dsputil_h264_template_mmx.c"
  1386. static void put_h264_chroma_mc8_mmx_rnd(uint8_t *dst/*align 8*/, uint8_t *src/*align 1*/, int stride, int h, int x, int y)
  1387. {
  1388. put_h264_chroma_mc8_mmx(dst, src, stride, h, x, y, 1);
  1389. }
  1390. static void put_h264_chroma_mc8_mmx_nornd(uint8_t *dst/*align 8*/, uint8_t *src/*align 1*/, int stride, int h, int x, int y)
  1391. {
  1392. put_h264_chroma_mc8_mmx(dst, src, stride, h, x, y, 0);
  1393. }
  1394. #undef H264_CHROMA_OP
  1395. #undef H264_CHROMA_OP4
  1396. #undef H264_CHROMA_MC8_TMPL
  1397. #undef H264_CHROMA_MC4_TMPL
  1398. #undef H264_CHROMA_MC2_TMPL
  1399. #undef H264_CHROMA_MC8_MV0
  1400. #define H264_CHROMA_OP(S,D) "pavgb " #S ", " #D " \n\t"
  1401. #define H264_CHROMA_OP4(S,D,T) "movd " #S ", " #T " \n\t"\
  1402. "pavgb " #T ", " #D " \n\t"
  1403. #define H264_CHROMA_MC8_TMPL avg_h264_chroma_mc8_mmx2
  1404. #define H264_CHROMA_MC4_TMPL avg_h264_chroma_mc4_mmx2
  1405. #define H264_CHROMA_MC2_TMPL avg_h264_chroma_mc2_mmx2
  1406. #define H264_CHROMA_MC8_MV0 avg_pixels8_mmx2
  1407. #include "dsputil_h264_template_mmx.c"
  1408. static void avg_h264_chroma_mc8_mmx2_rnd(uint8_t *dst/*align 8*/, uint8_t *src/*align 1*/, int stride, int h, int x, int y)
  1409. {
  1410. avg_h264_chroma_mc8_mmx2(dst, src, stride, h, x, y, 1);
  1411. }
  1412. #undef H264_CHROMA_OP
  1413. #undef H264_CHROMA_OP4
  1414. #undef H264_CHROMA_MC8_TMPL
  1415. #undef H264_CHROMA_MC4_TMPL
  1416. #undef H264_CHROMA_MC2_TMPL
  1417. #undef H264_CHROMA_MC8_MV0
  1418. #define H264_CHROMA_OP(S,D) "pavgusb " #S ", " #D " \n\t"
  1419. #define H264_CHROMA_OP4(S,D,T) "movd " #S ", " #T " \n\t"\
  1420. "pavgusb " #T ", " #D " \n\t"
  1421. #define H264_CHROMA_MC8_TMPL avg_h264_chroma_mc8_3dnow
  1422. #define H264_CHROMA_MC4_TMPL avg_h264_chroma_mc4_3dnow
  1423. #define H264_CHROMA_MC8_MV0 avg_pixels8_3dnow
  1424. #include "dsputil_h264_template_mmx.c"
  1425. static void avg_h264_chroma_mc8_3dnow_rnd(uint8_t *dst/*align 8*/, uint8_t *src/*align 1*/, int stride, int h, int x, int y)
  1426. {
  1427. avg_h264_chroma_mc8_3dnow(dst, src, stride, h, x, y, 1);
  1428. }
  1429. #undef H264_CHROMA_OP
  1430. #undef H264_CHROMA_OP4
  1431. #undef H264_CHROMA_MC8_TMPL
  1432. #undef H264_CHROMA_MC4_TMPL
  1433. #undef H264_CHROMA_MC8_MV0
  1434. /***********************************/
  1435. /* weighted prediction */
  1436. static inline void ff_h264_weight_WxH_mmx2(uint8_t *dst, int stride, int log2_denom, int weight, int offset, int w, int h)
  1437. {
  1438. int x, y;
  1439. offset <<= log2_denom;
  1440. offset += (1 << log2_denom) >> 1;
  1441. asm volatile(
  1442. "movd %0, %%mm4 \n\t"
  1443. "movd %1, %%mm5 \n\t"
  1444. "movd %2, %%mm6 \n\t"
  1445. "pshufw $0, %%mm4, %%mm4 \n\t"
  1446. "pshufw $0, %%mm5, %%mm5 \n\t"
  1447. "pxor %%mm7, %%mm7 \n\t"
  1448. :: "g"(weight), "g"(offset), "g"(log2_denom)
  1449. );
  1450. for(y=0; y<h; y+=2){
  1451. for(x=0; x<w; x+=4){
  1452. asm volatile(
  1453. "movd %0, %%mm0 \n\t"
  1454. "movd %1, %%mm1 \n\t"
  1455. "punpcklbw %%mm7, %%mm0 \n\t"
  1456. "punpcklbw %%mm7, %%mm1 \n\t"
  1457. "pmullw %%mm4, %%mm0 \n\t"
  1458. "pmullw %%mm4, %%mm1 \n\t"
  1459. "paddsw %%mm5, %%mm0 \n\t"
  1460. "paddsw %%mm5, %%mm1 \n\t"
  1461. "psraw %%mm6, %%mm0 \n\t"
  1462. "psraw %%mm6, %%mm1 \n\t"
  1463. "packuswb %%mm7, %%mm0 \n\t"
  1464. "packuswb %%mm7, %%mm1 \n\t"
  1465. "movd %%mm0, %0 \n\t"
  1466. "movd %%mm1, %1 \n\t"
  1467. : "+m"(*(uint32_t*)(dst+x)),
  1468. "+m"(*(uint32_t*)(dst+x+stride))
  1469. );
  1470. }
  1471. dst += 2*stride;
  1472. }
  1473. }
  1474. static inline void ff_h264_biweight_WxH_mmx2(uint8_t *dst, uint8_t *src, int stride, int log2_denom, int weightd, int weights, int offset, int w, int h)
  1475. {
  1476. int x, y;
  1477. offset = ((offset + 1) | 1) << log2_denom;
  1478. asm volatile(
  1479. "movd %0, %%mm3 \n\t"
  1480. "movd %1, %%mm4 \n\t"
  1481. "movd %2, %%mm5 \n\t"
  1482. "movd %3, %%mm6 \n\t"
  1483. "pshufw $0, %%mm3, %%mm3 \n\t"
  1484. "pshufw $0, %%mm4, %%mm4 \n\t"
  1485. "pshufw $0, %%mm5, %%mm5 \n\t"
  1486. "pxor %%mm7, %%mm7 \n\t"
  1487. :: "g"(weightd), "g"(weights), "g"(offset), "g"(log2_denom+1)
  1488. );
  1489. for(y=0; y<h; y++){
  1490. for(x=0; x<w; x+=4){
  1491. asm volatile(
  1492. "movd %0, %%mm0 \n\t"
  1493. "movd %1, %%mm1 \n\t"
  1494. "punpcklbw %%mm7, %%mm0 \n\t"
  1495. "punpcklbw %%mm7, %%mm1 \n\t"
  1496. "pmullw %%mm3, %%mm0 \n\t"
  1497. "pmullw %%mm4, %%mm1 \n\t"
  1498. "paddsw %%mm1, %%mm0 \n\t"
  1499. "paddsw %%mm5, %%mm0 \n\t"
  1500. "psraw %%mm6, %%mm0 \n\t"
  1501. "packuswb %%mm0, %%mm0 \n\t"
  1502. "movd %%mm0, %0 \n\t"
  1503. : "+m"(*(uint32_t*)(dst+x))
  1504. : "m"(*(uint32_t*)(src+x))
  1505. );
  1506. }
  1507. src += stride;
  1508. dst += stride;
  1509. }
  1510. }
  1511. #define H264_WEIGHT(W,H) \
  1512. static void ff_h264_biweight_ ## W ## x ## H ## _mmx2(uint8_t *dst, uint8_t *src, int stride, int log2_denom, int weightd, int weights, int offset){ \
  1513. ff_h264_biweight_WxH_mmx2(dst, src, stride, log2_denom, weightd, weights, offset, W, H); \
  1514. } \
  1515. static void ff_h264_weight_ ## W ## x ## H ## _mmx2(uint8_t *dst, int stride, int log2_denom, int weight, int offset){ \
  1516. ff_h264_weight_WxH_mmx2(dst, stride, log2_denom, weight, offset, W, H); \
  1517. }
  1518. H264_WEIGHT(16,16)
  1519. H264_WEIGHT(16, 8)
  1520. H264_WEIGHT( 8,16)
  1521. H264_WEIGHT( 8, 8)
  1522. H264_WEIGHT( 8, 4)
  1523. H264_WEIGHT( 4, 8)
  1524. H264_WEIGHT( 4, 4)
  1525. H264_WEIGHT( 4, 2)