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.

2326 lines
94KB

  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. DECLARE_ALIGNED(8, static const uint64_t, ff_pb_3_1 ) = 0x0103010301030103ULL;
  22. DECLARE_ALIGNED(8, static const uint64_t, ff_pb_7_3 ) = 0x0307030703070307ULL;
  23. /***********************************/
  24. /* IDCT */
  25. #define SUMSUB_BADC( a, b, c, d ) \
  26. "paddw "#b", "#a" \n\t"\
  27. "paddw "#d", "#c" \n\t"\
  28. "paddw "#b", "#b" \n\t"\
  29. "paddw "#d", "#d" \n\t"\
  30. "psubw "#a", "#b" \n\t"\
  31. "psubw "#c", "#d" \n\t"
  32. #define SUMSUBD2_AB( a, b, t ) \
  33. "movq "#b", "#t" \n\t"\
  34. "psraw $1 , "#b" \n\t"\
  35. "paddw "#a", "#b" \n\t"\
  36. "psraw $1 , "#a" \n\t"\
  37. "psubw "#t", "#a" \n\t"
  38. #define IDCT4_1D( s02, s13, d02, d13, t ) \
  39. SUMSUB_BA ( s02, d02 )\
  40. SUMSUBD2_AB( s13, d13, t )\
  41. SUMSUB_BADC( d13, s02, s13, d02 )
  42. #define STORE_DIFF_4P( p, t, z ) \
  43. "psraw $6, "#p" \n\t"\
  44. "movd (%0), "#t" \n\t"\
  45. "punpcklbw "#z", "#t" \n\t"\
  46. "paddsw "#t", "#p" \n\t"\
  47. "packuswb "#z", "#p" \n\t"\
  48. "movd "#p", (%0) \n\t"
  49. static void ff_h264_idct_add_mmx(uint8_t *dst, int16_t *block, int stride)
  50. {
  51. /* Load dct coeffs */
  52. __asm__ volatile(
  53. "movq (%0), %%mm0 \n\t"
  54. "movq 8(%0), %%mm1 \n\t"
  55. "movq 16(%0), %%mm2 \n\t"
  56. "movq 24(%0), %%mm3 \n\t"
  57. :: "r"(block) );
  58. __asm__ volatile(
  59. /* mm1=s02+s13 mm2=s02-s13 mm4=d02+d13 mm0=d02-d13 */
  60. IDCT4_1D( %%mm2, %%mm1, %%mm0, %%mm3, %%mm4 )
  61. "movq %0, %%mm6 \n\t"
  62. /* in: 1,4,0,2 out: 1,2,3,0 */
  63. TRANSPOSE4( %%mm3, %%mm1, %%mm0, %%mm2, %%mm4 )
  64. "paddw %%mm6, %%mm3 \n\t"
  65. /* mm2=s02+s13 mm3=s02-s13 mm4=d02+d13 mm1=d02-d13 */
  66. IDCT4_1D( %%mm4, %%mm2, %%mm3, %%mm0, %%mm1 )
  67. "pxor %%mm7, %%mm7 \n\t"
  68. :: "m"(ff_pw_32));
  69. __asm__ volatile(
  70. STORE_DIFF_4P( %%mm0, %%mm1, %%mm7)
  71. "add %1, %0 \n\t"
  72. STORE_DIFF_4P( %%mm2, %%mm1, %%mm7)
  73. "add %1, %0 \n\t"
  74. STORE_DIFF_4P( %%mm3, %%mm1, %%mm7)
  75. "add %1, %0 \n\t"
  76. STORE_DIFF_4P( %%mm4, %%mm1, %%mm7)
  77. : "+r"(dst)
  78. : "r" ((x86_reg)stride)
  79. );
  80. }
  81. static inline void h264_idct8_1d(int16_t *block)
  82. {
  83. __asm__ volatile(
  84. "movq 112(%0), %%mm7 \n\t"
  85. "movq 80(%0), %%mm0 \n\t"
  86. "movq 48(%0), %%mm3 \n\t"
  87. "movq 16(%0), %%mm5 \n\t"
  88. "movq %%mm0, %%mm4 \n\t"
  89. "movq %%mm5, %%mm1 \n\t"
  90. "psraw $1, %%mm4 \n\t"
  91. "psraw $1, %%mm1 \n\t"
  92. "paddw %%mm0, %%mm4 \n\t"
  93. "paddw %%mm5, %%mm1 \n\t"
  94. "paddw %%mm7, %%mm4 \n\t"
  95. "paddw %%mm0, %%mm1 \n\t"
  96. "psubw %%mm5, %%mm4 \n\t"
  97. "paddw %%mm3, %%mm1 \n\t"
  98. "psubw %%mm3, %%mm5 \n\t"
  99. "psubw %%mm3, %%mm0 \n\t"
  100. "paddw %%mm7, %%mm5 \n\t"
  101. "psubw %%mm7, %%mm0 \n\t"
  102. "psraw $1, %%mm3 \n\t"
  103. "psraw $1, %%mm7 \n\t"
  104. "psubw %%mm3, %%mm5 \n\t"
  105. "psubw %%mm7, %%mm0 \n\t"
  106. "movq %%mm4, %%mm3 \n\t"
  107. "movq %%mm1, %%mm7 \n\t"
  108. "psraw $2, %%mm1 \n\t"
  109. "psraw $2, %%mm3 \n\t"
  110. "paddw %%mm5, %%mm3 \n\t"
  111. "psraw $2, %%mm5 \n\t"
  112. "paddw %%mm0, %%mm1 \n\t"
  113. "psraw $2, %%mm0 \n\t"
  114. "psubw %%mm4, %%mm5 \n\t"
  115. "psubw %%mm0, %%mm7 \n\t"
  116. "movq 32(%0), %%mm2 \n\t"
  117. "movq 96(%0), %%mm6 \n\t"
  118. "movq %%mm2, %%mm4 \n\t"
  119. "movq %%mm6, %%mm0 \n\t"
  120. "psraw $1, %%mm4 \n\t"
  121. "psraw $1, %%mm6 \n\t"
  122. "psubw %%mm0, %%mm4 \n\t"
  123. "paddw %%mm2, %%mm6 \n\t"
  124. "movq (%0), %%mm2 \n\t"
  125. "movq 64(%0), %%mm0 \n\t"
  126. SUMSUB_BA( %%mm0, %%mm2 )
  127. SUMSUB_BA( %%mm6, %%mm0 )
  128. SUMSUB_BA( %%mm4, %%mm2 )
  129. SUMSUB_BA( %%mm7, %%mm6 )
  130. SUMSUB_BA( %%mm5, %%mm4 )
  131. SUMSUB_BA( %%mm3, %%mm2 )
  132. SUMSUB_BA( %%mm1, %%mm0 )
  133. :: "r"(block)
  134. );
  135. }
  136. static void ff_h264_idct8_add_mmx(uint8_t *dst, int16_t *block, int stride)
  137. {
  138. int i;
  139. DECLARE_ALIGNED(8, int16_t, b2)[64];
  140. block[0] += 32;
  141. for(i=0; i<2; i++){
  142. DECLARE_ALIGNED(8, uint64_t, tmp);
  143. h264_idct8_1d(block+4*i);
  144. __asm__ volatile(
  145. "movq %%mm7, %0 \n\t"
  146. TRANSPOSE4( %%mm0, %%mm2, %%mm4, %%mm6, %%mm7 )
  147. "movq %%mm0, 8(%1) \n\t"
  148. "movq %%mm6, 24(%1) \n\t"
  149. "movq %%mm7, 40(%1) \n\t"
  150. "movq %%mm4, 56(%1) \n\t"
  151. "movq %0, %%mm7 \n\t"
  152. TRANSPOSE4( %%mm7, %%mm5, %%mm3, %%mm1, %%mm0 )
  153. "movq %%mm7, (%1) \n\t"
  154. "movq %%mm1, 16(%1) \n\t"
  155. "movq %%mm0, 32(%1) \n\t"
  156. "movq %%mm3, 48(%1) \n\t"
  157. : "=m"(tmp)
  158. : "r"(b2+32*i)
  159. : "memory"
  160. );
  161. }
  162. for(i=0; i<2; i++){
  163. h264_idct8_1d(b2+4*i);
  164. __asm__ volatile(
  165. "psraw $6, %%mm7 \n\t"
  166. "psraw $6, %%mm6 \n\t"
  167. "psraw $6, %%mm5 \n\t"
  168. "psraw $6, %%mm4 \n\t"
  169. "psraw $6, %%mm3 \n\t"
  170. "psraw $6, %%mm2 \n\t"
  171. "psraw $6, %%mm1 \n\t"
  172. "psraw $6, %%mm0 \n\t"
  173. "movq %%mm7, (%0) \n\t"
  174. "movq %%mm5, 16(%0) \n\t"
  175. "movq %%mm3, 32(%0) \n\t"
  176. "movq %%mm1, 48(%0) \n\t"
  177. "movq %%mm0, 64(%0) \n\t"
  178. "movq %%mm2, 80(%0) \n\t"
  179. "movq %%mm4, 96(%0) \n\t"
  180. "movq %%mm6, 112(%0) \n\t"
  181. :: "r"(b2+4*i)
  182. : "memory"
  183. );
  184. }
  185. add_pixels_clamped_mmx(b2, dst, stride);
  186. }
  187. #define STORE_DIFF_8P( p, d, t, z )\
  188. "movq "#d", "#t" \n"\
  189. "psraw $6, "#p" \n"\
  190. "punpcklbw "#z", "#t" \n"\
  191. "paddsw "#t", "#p" \n"\
  192. "packuswb "#p", "#p" \n"\
  193. "movq "#p", "#d" \n"
  194. #define H264_IDCT8_1D_SSE2(a,b,c,d,e,f,g,h)\
  195. "movdqa "#c", "#a" \n"\
  196. "movdqa "#g", "#e" \n"\
  197. "psraw $1, "#c" \n"\
  198. "psraw $1, "#g" \n"\
  199. "psubw "#e", "#c" \n"\
  200. "paddw "#a", "#g" \n"\
  201. "movdqa "#b", "#e" \n"\
  202. "psraw $1, "#e" \n"\
  203. "paddw "#b", "#e" \n"\
  204. "paddw "#d", "#e" \n"\
  205. "paddw "#f", "#e" \n"\
  206. "movdqa "#f", "#a" \n"\
  207. "psraw $1, "#a" \n"\
  208. "paddw "#f", "#a" \n"\
  209. "paddw "#h", "#a" \n"\
  210. "psubw "#b", "#a" \n"\
  211. "psubw "#d", "#b" \n"\
  212. "psubw "#d", "#f" \n"\
  213. "paddw "#h", "#b" \n"\
  214. "psubw "#h", "#f" \n"\
  215. "psraw $1, "#d" \n"\
  216. "psraw $1, "#h" \n"\
  217. "psubw "#d", "#b" \n"\
  218. "psubw "#h", "#f" \n"\
  219. "movdqa "#e", "#d" \n"\
  220. "movdqa "#a", "#h" \n"\
  221. "psraw $2, "#d" \n"\
  222. "psraw $2, "#h" \n"\
  223. "paddw "#f", "#d" \n"\
  224. "paddw "#b", "#h" \n"\
  225. "psraw $2, "#f" \n"\
  226. "psraw $2, "#b" \n"\
  227. "psubw "#f", "#e" \n"\
  228. "psubw "#a", "#b" \n"\
  229. "movdqa 0x00(%1), "#a" \n"\
  230. "movdqa 0x40(%1), "#f" \n"\
  231. SUMSUB_BA(f, a)\
  232. SUMSUB_BA(g, f)\
  233. SUMSUB_BA(c, a)\
  234. SUMSUB_BA(e, g)\
  235. SUMSUB_BA(b, c)\
  236. SUMSUB_BA(h, a)\
  237. SUMSUB_BA(d, f)
  238. static void ff_h264_idct8_add_sse2(uint8_t *dst, int16_t *block, int stride)
  239. {
  240. __asm__ volatile(
  241. "movdqa 0x10(%1), %%xmm1 \n"
  242. "movdqa 0x20(%1), %%xmm2 \n"
  243. "movdqa 0x30(%1), %%xmm3 \n"
  244. "movdqa 0x50(%1), %%xmm5 \n"
  245. "movdqa 0x60(%1), %%xmm6 \n"
  246. "movdqa 0x70(%1), %%xmm7 \n"
  247. H264_IDCT8_1D_SSE2(%%xmm0, %%xmm1, %%xmm2, %%xmm3, %%xmm4, %%xmm5, %%xmm6, %%xmm7)
  248. TRANSPOSE8(%%xmm4, %%xmm1, %%xmm7, %%xmm3, %%xmm5, %%xmm0, %%xmm2, %%xmm6, (%1))
  249. "paddw %4, %%xmm4 \n"
  250. "movdqa %%xmm4, 0x00(%1) \n"
  251. "movdqa %%xmm2, 0x40(%1) \n"
  252. H264_IDCT8_1D_SSE2(%%xmm4, %%xmm0, %%xmm6, %%xmm3, %%xmm2, %%xmm5, %%xmm7, %%xmm1)
  253. "movdqa %%xmm6, 0x60(%1) \n"
  254. "movdqa %%xmm7, 0x70(%1) \n"
  255. "pxor %%xmm7, %%xmm7 \n"
  256. STORE_DIFF_8P(%%xmm2, (%0), %%xmm6, %%xmm7)
  257. STORE_DIFF_8P(%%xmm0, (%0,%2), %%xmm6, %%xmm7)
  258. STORE_DIFF_8P(%%xmm1, (%0,%2,2), %%xmm6, %%xmm7)
  259. STORE_DIFF_8P(%%xmm3, (%0,%3), %%xmm6, %%xmm7)
  260. "lea (%0,%2,4), %0 \n"
  261. STORE_DIFF_8P(%%xmm5, (%0), %%xmm6, %%xmm7)
  262. STORE_DIFF_8P(%%xmm4, (%0,%2), %%xmm6, %%xmm7)
  263. "movdqa 0x60(%1), %%xmm0 \n"
  264. "movdqa 0x70(%1), %%xmm1 \n"
  265. STORE_DIFF_8P(%%xmm0, (%0,%2,2), %%xmm6, %%xmm7)
  266. STORE_DIFF_8P(%%xmm1, (%0,%3), %%xmm6, %%xmm7)
  267. :"+r"(dst)
  268. :"r"(block), "r"((x86_reg)stride), "r"((x86_reg)3L*stride), "m"(ff_pw_32)
  269. );
  270. }
  271. static void ff_h264_idct_dc_add_mmx2(uint8_t *dst, int16_t *block, int stride)
  272. {
  273. int dc = (block[0] + 32) >> 6;
  274. __asm__ volatile(
  275. "movd %0, %%mm0 \n\t"
  276. "pshufw $0, %%mm0, %%mm0 \n\t"
  277. "pxor %%mm1, %%mm1 \n\t"
  278. "psubw %%mm0, %%mm1 \n\t"
  279. "packuswb %%mm0, %%mm0 \n\t"
  280. "packuswb %%mm1, %%mm1 \n\t"
  281. ::"r"(dc)
  282. );
  283. __asm__ volatile(
  284. "movd %0, %%mm2 \n\t"
  285. "movd %1, %%mm3 \n\t"
  286. "movd %2, %%mm4 \n\t"
  287. "movd %3, %%mm5 \n\t"
  288. "paddusb %%mm0, %%mm2 \n\t"
  289. "paddusb %%mm0, %%mm3 \n\t"
  290. "paddusb %%mm0, %%mm4 \n\t"
  291. "paddusb %%mm0, %%mm5 \n\t"
  292. "psubusb %%mm1, %%mm2 \n\t"
  293. "psubusb %%mm1, %%mm3 \n\t"
  294. "psubusb %%mm1, %%mm4 \n\t"
  295. "psubusb %%mm1, %%mm5 \n\t"
  296. "movd %%mm2, %0 \n\t"
  297. "movd %%mm3, %1 \n\t"
  298. "movd %%mm4, %2 \n\t"
  299. "movd %%mm5, %3 \n\t"
  300. :"+m"(*(uint32_t*)(dst+0*stride)),
  301. "+m"(*(uint32_t*)(dst+1*stride)),
  302. "+m"(*(uint32_t*)(dst+2*stride)),
  303. "+m"(*(uint32_t*)(dst+3*stride))
  304. );
  305. }
  306. static void ff_h264_idct8_dc_add_mmx2(uint8_t *dst, int16_t *block, int stride)
  307. {
  308. int dc = (block[0] + 32) >> 6;
  309. int y;
  310. __asm__ volatile(
  311. "movd %0, %%mm0 \n\t"
  312. "pshufw $0, %%mm0, %%mm0 \n\t"
  313. "pxor %%mm1, %%mm1 \n\t"
  314. "psubw %%mm0, %%mm1 \n\t"
  315. "packuswb %%mm0, %%mm0 \n\t"
  316. "packuswb %%mm1, %%mm1 \n\t"
  317. ::"r"(dc)
  318. );
  319. for(y=2; y--; dst += 4*stride){
  320. __asm__ volatile(
  321. "movq %0, %%mm2 \n\t"
  322. "movq %1, %%mm3 \n\t"
  323. "movq %2, %%mm4 \n\t"
  324. "movq %3, %%mm5 \n\t"
  325. "paddusb %%mm0, %%mm2 \n\t"
  326. "paddusb %%mm0, %%mm3 \n\t"
  327. "paddusb %%mm0, %%mm4 \n\t"
  328. "paddusb %%mm0, %%mm5 \n\t"
  329. "psubusb %%mm1, %%mm2 \n\t"
  330. "psubusb %%mm1, %%mm3 \n\t"
  331. "psubusb %%mm1, %%mm4 \n\t"
  332. "psubusb %%mm1, %%mm5 \n\t"
  333. "movq %%mm2, %0 \n\t"
  334. "movq %%mm3, %1 \n\t"
  335. "movq %%mm4, %2 \n\t"
  336. "movq %%mm5, %3 \n\t"
  337. :"+m"(*(uint64_t*)(dst+0*stride)),
  338. "+m"(*(uint64_t*)(dst+1*stride)),
  339. "+m"(*(uint64_t*)(dst+2*stride)),
  340. "+m"(*(uint64_t*)(dst+3*stride))
  341. );
  342. }
  343. }
  344. //FIXME this table is a duplicate from h264data.h, and will be removed once the tables from, h264 have been split
  345. static const uint8_t scan8[16 + 2*4]={
  346. 4+1*8, 5+1*8, 4+2*8, 5+2*8,
  347. 6+1*8, 7+1*8, 6+2*8, 7+2*8,
  348. 4+3*8, 5+3*8, 4+4*8, 5+4*8,
  349. 6+3*8, 7+3*8, 6+4*8, 7+4*8,
  350. 1+1*8, 2+1*8,
  351. 1+2*8, 2+2*8,
  352. 1+4*8, 2+4*8,
  353. 1+5*8, 2+5*8,
  354. };
  355. static void ff_h264_idct_add16_mmx(uint8_t *dst, const int *block_offset, DCTELEM *block, int stride, const uint8_t nnzc[6*8]){
  356. int i;
  357. for(i=0; i<16; i++){
  358. if(nnzc[ scan8[i] ])
  359. ff_h264_idct_add_mmx(dst + block_offset[i], block + i*16, stride);
  360. }
  361. }
  362. static void ff_h264_idct8_add4_mmx(uint8_t *dst, const int *block_offset, DCTELEM *block, int stride, const uint8_t nnzc[6*8]){
  363. int i;
  364. for(i=0; i<16; i+=4){
  365. if(nnzc[ scan8[i] ])
  366. ff_h264_idct8_add_mmx(dst + block_offset[i], block + i*16, stride);
  367. }
  368. }
  369. static void ff_h264_idct_add16_mmx2(uint8_t *dst, const int *block_offset, DCTELEM *block, int stride, const uint8_t nnzc[6*8]){
  370. int i;
  371. for(i=0; i<16; i++){
  372. int nnz = nnzc[ scan8[i] ];
  373. if(nnz){
  374. if(nnz==1 && block[i*16]) ff_h264_idct_dc_add_mmx2(dst + block_offset[i], block + i*16, stride);
  375. else ff_h264_idct_add_mmx (dst + block_offset[i], block + i*16, stride);
  376. }
  377. }
  378. }
  379. static void ff_h264_idct_add16intra_mmx(uint8_t *dst, const int *block_offset, DCTELEM *block, int stride, const uint8_t nnzc[6*8]){
  380. int i;
  381. for(i=0; i<16; i++){
  382. if(nnzc[ scan8[i] ] || block[i*16])
  383. ff_h264_idct_add_mmx(dst + block_offset[i], block + i*16, stride);
  384. }
  385. }
  386. static void ff_h264_idct_add16intra_mmx2(uint8_t *dst, const int *block_offset, DCTELEM *block, int stride, const uint8_t nnzc[6*8]){
  387. int i;
  388. for(i=0; i<16; i++){
  389. if(nnzc[ scan8[i] ]) ff_h264_idct_add_mmx (dst + block_offset[i], block + i*16, stride);
  390. else if(block[i*16]) ff_h264_idct_dc_add_mmx2(dst + block_offset[i], block + i*16, stride);
  391. }
  392. }
  393. static void ff_h264_idct8_add4_mmx2(uint8_t *dst, const int *block_offset, DCTELEM *block, int stride, const uint8_t nnzc[6*8]){
  394. int i;
  395. for(i=0; i<16; i+=4){
  396. int nnz = nnzc[ scan8[i] ];
  397. if(nnz){
  398. if(nnz==1 && block[i*16]) ff_h264_idct8_dc_add_mmx2(dst + block_offset[i], block + i*16, stride);
  399. else ff_h264_idct8_add_mmx (dst + block_offset[i], block + i*16, stride);
  400. }
  401. }
  402. }
  403. static void ff_h264_idct8_add4_sse2(uint8_t *dst, const int *block_offset, DCTELEM *block, int stride, const uint8_t nnzc[6*8]){
  404. int i;
  405. for(i=0; i<16; i+=4){
  406. int nnz = nnzc[ scan8[i] ];
  407. if(nnz){
  408. if(nnz==1 && block[i*16]) ff_h264_idct8_dc_add_mmx2(dst + block_offset[i], block + i*16, stride);
  409. else ff_h264_idct8_add_sse2 (dst + block_offset[i], block + i*16, stride);
  410. }
  411. }
  412. }
  413. static void ff_h264_idct_add8_mmx(uint8_t **dest, const int *block_offset, DCTELEM *block, int stride, const uint8_t nnzc[6*8]){
  414. int i;
  415. for(i=16; i<16+8; i++){
  416. if(nnzc[ scan8[i] ] || block[i*16])
  417. ff_h264_idct_add_mmx (dest[(i&4)>>2] + block_offset[i], block + i*16, stride);
  418. }
  419. }
  420. static void ff_h264_idct_add8_mmx2(uint8_t **dest, const int *block_offset, DCTELEM *block, int stride, const uint8_t nnzc[6*8]){
  421. int i;
  422. for(i=16; i<16+8; i++){
  423. if(nnzc[ scan8[i] ])
  424. ff_h264_idct_add_mmx (dest[(i&4)>>2] + block_offset[i], block + i*16, stride);
  425. else if(block[i*16])
  426. ff_h264_idct_dc_add_mmx2(dest[(i&4)>>2] + block_offset[i], block + i*16, stride);
  427. }
  428. }
  429. #if CONFIG_GPL && HAVE_YASM
  430. static void ff_h264_idct_dc_add8_mmx2(uint8_t *dst, int16_t *block, int stride)
  431. {
  432. __asm__ volatile(
  433. "movd %0, %%mm0 \n\t" // 0 0 X D
  434. "punpcklwd %1, %%mm0 \n\t" // x X d D
  435. "paddsw %2, %%mm0 \n\t"
  436. "psraw $6, %%mm0 \n\t"
  437. "punpcklwd %%mm0, %%mm0 \n\t" // d d D D
  438. "pxor %%mm1, %%mm1 \n\t" // 0 0 0 0
  439. "psubw %%mm0, %%mm1 \n\t" // -d-d-D-D
  440. "packuswb %%mm1, %%mm0 \n\t" // -d-d-D-D d d D D
  441. "pshufw $0xFA, %%mm0, %%mm1 \n\t" // -d-d-d-d-D-D-D-D
  442. "punpcklwd %%mm0, %%mm0 \n\t" // d d d d D D D D
  443. ::"m"(block[ 0]),
  444. "m"(block[16]),
  445. "m"(ff_pw_32)
  446. );
  447. __asm__ volatile(
  448. "movq %0, %%mm2 \n\t"
  449. "movq %1, %%mm3 \n\t"
  450. "movq %2, %%mm4 \n\t"
  451. "movq %3, %%mm5 \n\t"
  452. "paddusb %%mm0, %%mm2 \n\t"
  453. "paddusb %%mm0, %%mm3 \n\t"
  454. "paddusb %%mm0, %%mm4 \n\t"
  455. "paddusb %%mm0, %%mm5 \n\t"
  456. "psubusb %%mm1, %%mm2 \n\t"
  457. "psubusb %%mm1, %%mm3 \n\t"
  458. "psubusb %%mm1, %%mm4 \n\t"
  459. "psubusb %%mm1, %%mm5 \n\t"
  460. "movq %%mm2, %0 \n\t"
  461. "movq %%mm3, %1 \n\t"
  462. "movq %%mm4, %2 \n\t"
  463. "movq %%mm5, %3 \n\t"
  464. :"+m"(*(uint64_t*)(dst+0*stride)),
  465. "+m"(*(uint64_t*)(dst+1*stride)),
  466. "+m"(*(uint64_t*)(dst+2*stride)),
  467. "+m"(*(uint64_t*)(dst+3*stride))
  468. );
  469. }
  470. extern void ff_x264_add8x4_idct_sse2(uint8_t *dst, int16_t *block, int stride);
  471. static void ff_h264_idct_add16_sse2(uint8_t *dst, const int *block_offset, DCTELEM *block, int stride, const uint8_t nnzc[6*8]){
  472. int i;
  473. for(i=0; i<16; i+=2)
  474. if(nnzc[ scan8[i+0] ]|nnzc[ scan8[i+1] ])
  475. ff_x264_add8x4_idct_sse2 (dst + block_offset[i], block + i*16, stride);
  476. }
  477. static void ff_h264_idct_add16intra_sse2(uint8_t *dst, const int *block_offset, DCTELEM *block, int stride, const uint8_t nnzc[6*8]){
  478. int i;
  479. for(i=0; i<16; i+=2){
  480. if(nnzc[ scan8[i+0] ]|nnzc[ scan8[i+1] ])
  481. ff_x264_add8x4_idct_sse2 (dst + block_offset[i], block + i*16, stride);
  482. else if(block[i*16]|block[i*16+16])
  483. ff_h264_idct_dc_add8_mmx2(dst + block_offset[i], block + i*16, stride);
  484. }
  485. }
  486. static void ff_h264_idct_add8_sse2(uint8_t **dest, const int *block_offset, DCTELEM *block, int stride, const uint8_t nnzc[6*8]){
  487. int i;
  488. for(i=16; i<16+8; i+=2){
  489. if(nnzc[ scan8[i+0] ]|nnzc[ scan8[i+1] ])
  490. ff_x264_add8x4_idct_sse2 (dest[(i&4)>>2] + block_offset[i], block + i*16, stride);
  491. else if(block[i*16]|block[i*16+16])
  492. ff_h264_idct_dc_add8_mmx2(dest[(i&4)>>2] + block_offset[i], block + i*16, stride);
  493. }
  494. }
  495. #endif
  496. /***********************************/
  497. /* deblocking */
  498. // out: o = |x-y|>a
  499. // clobbers: t
  500. #define DIFF_GT_MMX(x,y,a,o,t)\
  501. "movq "#y", "#t" \n\t"\
  502. "movq "#x", "#o" \n\t"\
  503. "psubusb "#x", "#t" \n\t"\
  504. "psubusb "#y", "#o" \n\t"\
  505. "por "#t", "#o" \n\t"\
  506. "psubusb "#a", "#o" \n\t"
  507. // out: o = |x-y|>a
  508. // clobbers: t
  509. #define DIFF_GT2_MMX(x,y,a,o,t)\
  510. "movq "#y", "#t" \n\t"\
  511. "movq "#x", "#o" \n\t"\
  512. "psubusb "#x", "#t" \n\t"\
  513. "psubusb "#y", "#o" \n\t"\
  514. "psubusb "#a", "#t" \n\t"\
  515. "psubusb "#a", "#o" \n\t"\
  516. "pcmpeqb "#t", "#o" \n\t"\
  517. // in: mm0=p1 mm1=p0 mm2=q0 mm3=q1
  518. // out: mm5=beta-1, mm7=mask
  519. // clobbers: mm4,mm6
  520. #define H264_DEBLOCK_MASK(alpha1, beta1) \
  521. "pshufw $0, "#alpha1", %%mm4 \n\t"\
  522. "pshufw $0, "#beta1 ", %%mm5 \n\t"\
  523. "packuswb %%mm4, %%mm4 \n\t"\
  524. "packuswb %%mm5, %%mm5 \n\t"\
  525. DIFF_GT_MMX(%%mm1, %%mm2, %%mm4, %%mm7, %%mm6) /* |p0-q0| > alpha-1 */\
  526. DIFF_GT_MMX(%%mm0, %%mm1, %%mm5, %%mm4, %%mm6) /* |p1-p0| > beta-1 */\
  527. "por %%mm4, %%mm7 \n\t"\
  528. DIFF_GT_MMX(%%mm3, %%mm2, %%mm5, %%mm4, %%mm6) /* |q1-q0| > beta-1 */\
  529. "por %%mm4, %%mm7 \n\t"\
  530. "pxor %%mm6, %%mm6 \n\t"\
  531. "pcmpeqb %%mm6, %%mm7 \n\t"
  532. // in: mm0=p1 mm1=p0 mm2=q0 mm3=q1 mm7=(tc&mask)
  533. // out: mm1=p0' mm2=q0'
  534. // clobbers: mm0,3-6
  535. #define H264_DEBLOCK_P0_Q0(pb_01, pb_3f)\
  536. "movq %%mm1 , %%mm5 \n\t"\
  537. "pxor %%mm2 , %%mm5 \n\t" /* p0^q0*/\
  538. "pand "#pb_01" , %%mm5 \n\t" /* (p0^q0)&1*/\
  539. "pcmpeqb %%mm4 , %%mm4 \n\t"\
  540. "pxor %%mm4 , %%mm3 \n\t"\
  541. "pavgb %%mm0 , %%mm3 \n\t" /* (p1 - q1 + 256)>>1*/\
  542. "pavgb "MANGLE(ff_pb_3)" , %%mm3 \n\t" /*(((p1 - q1 + 256)>>1)+4)>>1 = 64+2+(p1-q1)>>2*/\
  543. "pxor %%mm1 , %%mm4 \n\t"\
  544. "pavgb %%mm2 , %%mm4 \n\t" /* (q0 - p0 + 256)>>1*/\
  545. "pavgb %%mm5 , %%mm3 \n\t"\
  546. "paddusb %%mm4 , %%mm3 \n\t" /* d+128+33*/\
  547. "movq "MANGLE(ff_pb_A1)" , %%mm6 \n\t"\
  548. "psubusb %%mm3 , %%mm6 \n\t"\
  549. "psubusb "MANGLE(ff_pb_A1)" , %%mm3 \n\t"\
  550. "pminub %%mm7 , %%mm6 \n\t"\
  551. "pminub %%mm7 , %%mm3 \n\t"\
  552. "psubusb %%mm6 , %%mm1 \n\t"\
  553. "psubusb %%mm3 , %%mm2 \n\t"\
  554. "paddusb %%mm3 , %%mm1 \n\t"\
  555. "paddusb %%mm6 , %%mm2 \n\t"
  556. // in: mm0=p1 mm1=p0 mm2=q0 mm3=q1 mm7=(tc&mask) %8=ff_bone
  557. // out: (q1addr) = av_clip( (q2+((p0+q0+1)>>1))>>1, q1-tc0, q1+tc0 )
  558. // clobbers: q2, tmp, tc0
  559. #define H264_DEBLOCK_Q1(p1, q2, q2addr, q1addr, tc0, tmp)\
  560. "movq %%mm1, "#tmp" \n\t"\
  561. "pavgb %%mm2, "#tmp" \n\t"\
  562. "pavgb "#tmp", "#q2" \n\t" /* avg(p2,avg(p0,q0)) */\
  563. "pxor "q2addr", "#tmp" \n\t"\
  564. "pand %9, "#tmp" \n\t" /* (p2^avg(p0,q0))&1 */\
  565. "psubusb "#tmp", "#q2" \n\t" /* (p2+((p0+q0+1)>>1))>>1 */\
  566. "movq "#p1", "#tmp" \n\t"\
  567. "psubusb "#tc0", "#tmp" \n\t"\
  568. "paddusb "#p1", "#tc0" \n\t"\
  569. "pmaxub "#tmp", "#q2" \n\t"\
  570. "pminub "#tc0", "#q2" \n\t"\
  571. "movq "#q2", "q1addr" \n\t"
  572. static inline void h264_loop_filter_luma_mmx2(uint8_t *pix, int stride, int alpha1, int beta1, int8_t *tc0)
  573. {
  574. DECLARE_ALIGNED(8, uint64_t, tmp0)[2];
  575. __asm__ volatile(
  576. "movq (%2,%4), %%mm0 \n\t" //p1
  577. "movq (%2,%4,2), %%mm1 \n\t" //p0
  578. "movq (%3), %%mm2 \n\t" //q0
  579. "movq (%3,%4), %%mm3 \n\t" //q1
  580. H264_DEBLOCK_MASK(%7, %8)
  581. "movd %6, %%mm4 \n\t"
  582. "punpcklbw %%mm4, %%mm4 \n\t"
  583. "punpcklwd %%mm4, %%mm4 \n\t"
  584. "pcmpeqb %%mm3, %%mm3 \n\t"
  585. "movq %%mm4, %%mm6 \n\t"
  586. "pcmpgtb %%mm3, %%mm4 \n\t"
  587. "movq %%mm6, %1 \n\t"
  588. "pand %%mm4, %%mm7 \n\t"
  589. "movq %%mm7, %0 \n\t"
  590. /* filter p1 */
  591. "movq (%2), %%mm3 \n\t" //p2
  592. DIFF_GT2_MMX(%%mm1, %%mm3, %%mm5, %%mm6, %%mm4) // |p2-p0|>beta-1
  593. "pand %%mm7, %%mm6 \n\t" // mask & |p2-p0|<beta
  594. "pand %1, %%mm7 \n\t" // mask & tc0
  595. "movq %%mm7, %%mm4 \n\t"
  596. "psubb %%mm6, %%mm7 \n\t"
  597. "pand %%mm4, %%mm6 \n\t" // mask & |p2-p0|<beta & tc0
  598. H264_DEBLOCK_Q1(%%mm0, %%mm3, "(%2)", "(%2,%4)", %%mm6, %%mm4)
  599. /* filter q1 */
  600. "movq (%3,%4,2), %%mm4 \n\t" //q2
  601. DIFF_GT2_MMX(%%mm2, %%mm4, %%mm5, %%mm6, %%mm3) // |q2-q0|>beta-1
  602. "pand %0, %%mm6 \n\t"
  603. "movq %1, %%mm5 \n\t" // can be merged with the and below but is slower then
  604. "pand %%mm6, %%mm5 \n\t"
  605. "psubb %%mm6, %%mm7 \n\t"
  606. "movq (%3,%4), %%mm3 \n\t"
  607. H264_DEBLOCK_Q1(%%mm3, %%mm4, "(%3,%4,2)", "(%3,%4)", %%mm5, %%mm6)
  608. /* filter p0, q0 */
  609. H264_DEBLOCK_P0_Q0(%9, unused)
  610. "movq %%mm1, (%2,%4,2) \n\t"
  611. "movq %%mm2, (%3) \n\t"
  612. : "=m"(tmp0[0]), "=m"(tmp0[1])
  613. : "r"(pix-3*stride), "r"(pix), "r"((x86_reg)stride),
  614. "m"(*tmp0/*unused*/), "m"(*(uint32_t*)tc0), "m"(alpha1), "m"(beta1),
  615. "m"(ff_bone)
  616. );
  617. }
  618. static void h264_v_loop_filter_luma_mmx2(uint8_t *pix, int stride, int alpha, int beta, int8_t *tc0)
  619. {
  620. if((tc0[0] & tc0[1]) >= 0)
  621. h264_loop_filter_luma_mmx2(pix, stride, alpha-1, beta-1, tc0);
  622. if((tc0[2] & tc0[3]) >= 0)
  623. h264_loop_filter_luma_mmx2(pix+8, stride, alpha-1, beta-1, tc0+2);
  624. }
  625. static void h264_h_loop_filter_luma_mmx2(uint8_t *pix, int stride, int alpha, int beta, int8_t *tc0)
  626. {
  627. //FIXME: could cut some load/stores by merging transpose with filter
  628. // also, it only needs to transpose 6x8
  629. DECLARE_ALIGNED(8, uint8_t, trans)[8*8];
  630. int i;
  631. for(i=0; i<2; i++, pix+=8*stride, tc0+=2) {
  632. if((tc0[0] & tc0[1]) < 0)
  633. continue;
  634. transpose4x4(trans, pix-4, 8, stride);
  635. transpose4x4(trans +4*8, pix, 8, stride);
  636. transpose4x4(trans+4, pix-4+4*stride, 8, stride);
  637. transpose4x4(trans+4+4*8, pix +4*stride, 8, stride);
  638. h264_loop_filter_luma_mmx2(trans+4*8, 8, alpha-1, beta-1, tc0);
  639. transpose4x4(pix-2, trans +2*8, stride, 8);
  640. transpose4x4(pix-2+4*stride, trans+4+2*8, stride, 8);
  641. }
  642. }
  643. static inline void h264_loop_filter_chroma_mmx2(uint8_t *pix, int stride, int alpha1, int beta1, int8_t *tc0)
  644. {
  645. __asm__ volatile(
  646. "movq (%0), %%mm0 \n\t" //p1
  647. "movq (%0,%2), %%mm1 \n\t" //p0
  648. "movq (%1), %%mm2 \n\t" //q0
  649. "movq (%1,%2), %%mm3 \n\t" //q1
  650. H264_DEBLOCK_MASK(%4, %5)
  651. "movd %3, %%mm6 \n\t"
  652. "punpcklbw %%mm6, %%mm6 \n\t"
  653. "pand %%mm6, %%mm7 \n\t" // mm7 = tc&mask
  654. H264_DEBLOCK_P0_Q0(%6, %7)
  655. "movq %%mm1, (%0,%2) \n\t"
  656. "movq %%mm2, (%1) \n\t"
  657. :: "r"(pix-2*stride), "r"(pix), "r"((x86_reg)stride),
  658. "r"(*(uint32_t*)tc0),
  659. "m"(alpha1), "m"(beta1), "m"(ff_bone), "m"(ff_pb_3F)
  660. );
  661. }
  662. static void h264_v_loop_filter_chroma_mmx2(uint8_t *pix, int stride, int alpha, int beta, int8_t *tc0)
  663. {
  664. h264_loop_filter_chroma_mmx2(pix, stride, alpha-1, beta-1, tc0);
  665. }
  666. static void h264_h_loop_filter_chroma_mmx2(uint8_t *pix, int stride, int alpha, int beta, int8_t *tc0)
  667. {
  668. //FIXME: could cut some load/stores by merging transpose with filter
  669. DECLARE_ALIGNED(8, uint8_t, trans)[8*4];
  670. transpose4x4(trans, pix-2, 8, stride);
  671. transpose4x4(trans+4, pix-2+4*stride, 8, stride);
  672. h264_loop_filter_chroma_mmx2(trans+2*8, 8, alpha-1, beta-1, tc0);
  673. transpose4x4(pix-2, trans, stride, 8);
  674. transpose4x4(pix-2+4*stride, trans+4, stride, 8);
  675. }
  676. // p0 = (p0 + q1 + 2*p1 + 2) >> 2
  677. #define H264_FILTER_CHROMA4(p0, p1, q1, one) \
  678. "movq "#p0", %%mm4 \n\t"\
  679. "pxor "#q1", %%mm4 \n\t"\
  680. "pand "#one", %%mm4 \n\t" /* mm4 = (p0^q1)&1 */\
  681. "pavgb "#q1", "#p0" \n\t"\
  682. "psubusb %%mm4, "#p0" \n\t"\
  683. "pavgb "#p1", "#p0" \n\t" /* dst = avg(p1, avg(p0,q1) - ((p0^q1)&1)) */\
  684. static inline void h264_loop_filter_chroma_intra_mmx2(uint8_t *pix, int stride, int alpha1, int beta1)
  685. {
  686. __asm__ volatile(
  687. "movq (%0), %%mm0 \n\t"
  688. "movq (%0,%2), %%mm1 \n\t"
  689. "movq (%1), %%mm2 \n\t"
  690. "movq (%1,%2), %%mm3 \n\t"
  691. H264_DEBLOCK_MASK(%3, %4)
  692. "movq %%mm1, %%mm5 \n\t"
  693. "movq %%mm2, %%mm6 \n\t"
  694. H264_FILTER_CHROMA4(%%mm1, %%mm0, %%mm3, %5) //p0'
  695. H264_FILTER_CHROMA4(%%mm2, %%mm3, %%mm0, %5) //q0'
  696. "psubb %%mm5, %%mm1 \n\t"
  697. "psubb %%mm6, %%mm2 \n\t"
  698. "pand %%mm7, %%mm1 \n\t"
  699. "pand %%mm7, %%mm2 \n\t"
  700. "paddb %%mm5, %%mm1 \n\t"
  701. "paddb %%mm6, %%mm2 \n\t"
  702. "movq %%mm1, (%0,%2) \n\t"
  703. "movq %%mm2, (%1) \n\t"
  704. :: "r"(pix-2*stride), "r"(pix), "r"((x86_reg)stride),
  705. "m"(alpha1), "m"(beta1), "m"(ff_bone)
  706. );
  707. }
  708. static void h264_v_loop_filter_chroma_intra_mmx2(uint8_t *pix, int stride, int alpha, int beta)
  709. {
  710. h264_loop_filter_chroma_intra_mmx2(pix, stride, alpha-1, beta-1);
  711. }
  712. static void h264_h_loop_filter_chroma_intra_mmx2(uint8_t *pix, int stride, int alpha, int beta)
  713. {
  714. //FIXME: could cut some load/stores by merging transpose with filter
  715. DECLARE_ALIGNED(8, uint8_t, trans)[8*4];
  716. transpose4x4(trans, pix-2, 8, stride);
  717. transpose4x4(trans+4, pix-2+4*stride, 8, stride);
  718. h264_loop_filter_chroma_intra_mmx2(trans+2*8, 8, alpha-1, beta-1);
  719. transpose4x4(pix-2, trans, stride, 8);
  720. transpose4x4(pix-2+4*stride, trans+4, stride, 8);
  721. }
  722. 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],
  723. int bidir, int edges, int step, int mask_mv0, int mask_mv1, int field ) {
  724. int dir;
  725. __asm__ volatile(
  726. "movq %0, %%mm7 \n"
  727. "movq %1, %%mm6 \n"
  728. ::"m"(ff_pb_1), "m"(ff_pb_3)
  729. );
  730. if(field)
  731. __asm__ volatile(
  732. "movq %0, %%mm6 \n"
  733. ::"m"(ff_pb_3_1)
  734. );
  735. __asm__ volatile(
  736. "movq %%mm6, %%mm5 \n"
  737. "paddb %%mm5, %%mm5 \n"
  738. :);
  739. // could do a special case for dir==0 && edges==1, but it only reduces the
  740. // average filter time by 1.2%
  741. for( dir=1; dir>=0; dir-- ) {
  742. const x86_reg d_idx = dir ? -8 : -1;
  743. const int mask_mv = dir ? mask_mv1 : mask_mv0;
  744. DECLARE_ALIGNED(8, const uint64_t, mask_dir) = dir ? 0 : 0xffffffffffffffffULL;
  745. int b_idx, edge;
  746. for( b_idx=12, edge=0; edge<edges; edge+=step, b_idx+=8*step ) {
  747. __asm__ volatile(
  748. "pand %0, %%mm0 \n\t"
  749. ::"m"(mask_dir)
  750. );
  751. if(!(mask_mv & edge)) {
  752. if(bidir) {
  753. __asm__ volatile(
  754. "movd (%1,%0), %%mm2 \n"
  755. "punpckldq 40(%1,%0), %%mm2 \n" // { ref0[bn], ref1[bn] }
  756. "pshufw $0x44, (%1), %%mm0 \n" // { ref0[b], ref0[b] }
  757. "pshufw $0x44, 40(%1), %%mm1 \n" // { ref1[b], ref1[b] }
  758. "pshufw $0x4E, %%mm2, %%mm3 \n"
  759. "psubb %%mm2, %%mm0 \n" // { ref0[b]!=ref0[bn], ref0[b]!=ref1[bn] }
  760. "psubb %%mm3, %%mm1 \n" // { ref1[b]!=ref1[bn], ref1[b]!=ref0[bn] }
  761. "1: \n"
  762. "por %%mm1, %%mm0 \n"
  763. "movq (%2,%0,4), %%mm1 \n"
  764. "movq 8(%2,%0,4), %%mm2 \n"
  765. "movq %%mm1, %%mm3 \n"
  766. "movq %%mm2, %%mm4 \n"
  767. "psubw (%2), %%mm1 \n"
  768. "psubw 8(%2), %%mm2 \n"
  769. "psubw 160(%2), %%mm3 \n"
  770. "psubw 168(%2), %%mm4 \n"
  771. "packsswb %%mm2, %%mm1 \n"
  772. "packsswb %%mm4, %%mm3 \n"
  773. "paddb %%mm6, %%mm1 \n"
  774. "paddb %%mm6, %%mm3 \n"
  775. "psubusb %%mm5, %%mm1 \n" // abs(mv[b] - mv[bn]) >= limit
  776. "psubusb %%mm5, %%mm3 \n"
  777. "packsswb %%mm3, %%mm1 \n"
  778. "add $40, %0 \n"
  779. "cmp $40, %0 \n"
  780. "jl 1b \n"
  781. "sub $80, %0 \n"
  782. "pshufw $0x4E, %%mm1, %%mm1 \n"
  783. "por %%mm1, %%mm0 \n"
  784. "pshufw $0x4E, %%mm0, %%mm1 \n"
  785. "pminub %%mm1, %%mm0 \n"
  786. ::"r"(d_idx),
  787. "r"(ref[0]+b_idx),
  788. "r"(mv[0]+b_idx)
  789. );
  790. } else {
  791. __asm__ volatile(
  792. "movd (%1), %%mm0 \n"
  793. "psubb (%1,%0), %%mm0 \n" // ref[b] != ref[bn]
  794. "movq (%2), %%mm1 \n"
  795. "movq 8(%2), %%mm2 \n"
  796. "psubw (%2,%0,4), %%mm1 \n"
  797. "psubw 8(%2,%0,4), %%mm2 \n"
  798. "packsswb %%mm2, %%mm1 \n"
  799. "paddb %%mm6, %%mm1 \n"
  800. "psubusb %%mm5, %%mm1 \n" // abs(mv[b] - mv[bn]) >= limit
  801. "packsswb %%mm1, %%mm1 \n"
  802. "por %%mm1, %%mm0 \n"
  803. ::"r"(d_idx),
  804. "r"(ref[0]+b_idx),
  805. "r"(mv[0]+b_idx)
  806. );
  807. }
  808. }
  809. __asm__ volatile(
  810. "movd %0, %%mm1 \n"
  811. "por %1, %%mm1 \n" // nnz[b] || nnz[bn]
  812. ::"m"(nnz[b_idx]),
  813. "m"(nnz[b_idx+d_idx])
  814. );
  815. __asm__ volatile(
  816. "pminub %%mm7, %%mm1 \n"
  817. "pminub %%mm7, %%mm0 \n"
  818. "psllw $1, %%mm1 \n"
  819. "pxor %%mm2, %%mm2 \n"
  820. "pmaxub %%mm0, %%mm1 \n"
  821. "punpcklbw %%mm2, %%mm1 \n"
  822. "movq %%mm1, %0 \n"
  823. :"=m"(*bS[dir][edge])
  824. ::"memory"
  825. );
  826. }
  827. edges = 4;
  828. step = 1;
  829. }
  830. __asm__ volatile(
  831. "movq (%0), %%mm0 \n\t"
  832. "movq 8(%0), %%mm1 \n\t"
  833. "movq 16(%0), %%mm2 \n\t"
  834. "movq 24(%0), %%mm3 \n\t"
  835. TRANSPOSE4(%%mm0, %%mm1, %%mm2, %%mm3, %%mm4)
  836. "movq %%mm0, (%0) \n\t"
  837. "movq %%mm3, 8(%0) \n\t"
  838. "movq %%mm4, 16(%0) \n\t"
  839. "movq %%mm2, 24(%0) \n\t"
  840. ::"r"(bS[0])
  841. :"memory"
  842. );
  843. }
  844. /***********************************/
  845. /* motion compensation */
  846. #define QPEL_H264V_MM(A,B,C,D,E,F,OP,T,Z,d,q)\
  847. "mov"#q" "#C", "#T" \n\t"\
  848. "mov"#d" (%0), "#F" \n\t"\
  849. "paddw "#D", "#T" \n\t"\
  850. "psllw $2, "#T" \n\t"\
  851. "psubw "#B", "#T" \n\t"\
  852. "psubw "#E", "#T" \n\t"\
  853. "punpcklbw "#Z", "#F" \n\t"\
  854. "pmullw %4, "#T" \n\t"\
  855. "paddw %5, "#A" \n\t"\
  856. "add %2, %0 \n\t"\
  857. "paddw "#F", "#A" \n\t"\
  858. "paddw "#A", "#T" \n\t"\
  859. "psraw $5, "#T" \n\t"\
  860. "packuswb "#T", "#T" \n\t"\
  861. OP(T, (%1), A, d)\
  862. "add %3, %1 \n\t"
  863. #define QPEL_H264HV_MM(A,B,C,D,E,F,OF,T,Z,d,q)\
  864. "mov"#q" "#C", "#T" \n\t"\
  865. "mov"#d" (%0), "#F" \n\t"\
  866. "paddw "#D", "#T" \n\t"\
  867. "psllw $2, "#T" \n\t"\
  868. "paddw %4, "#A" \n\t"\
  869. "psubw "#B", "#T" \n\t"\
  870. "psubw "#E", "#T" \n\t"\
  871. "punpcklbw "#Z", "#F" \n\t"\
  872. "pmullw %3, "#T" \n\t"\
  873. "paddw "#F", "#A" \n\t"\
  874. "add %2, %0 \n\t"\
  875. "paddw "#A", "#T" \n\t"\
  876. "mov"#q" "#T", "#OF"(%1) \n\t"
  877. #define QPEL_H264V(A,B,C,D,E,F,OP) QPEL_H264V_MM(A,B,C,D,E,F,OP,%%mm6,%%mm7,d,q)
  878. #define QPEL_H264HV(A,B,C,D,E,F,OF) QPEL_H264HV_MM(A,B,C,D,E,F,OF,%%mm6,%%mm7,d,q)
  879. #define QPEL_H264V_XMM(A,B,C,D,E,F,OP) QPEL_H264V_MM(A,B,C,D,E,F,OP,%%xmm6,%%xmm7,q,dqa)
  880. #define QPEL_H264HV_XMM(A,B,C,D,E,F,OF) QPEL_H264HV_MM(A,B,C,D,E,F,OF,%%xmm6,%%xmm7,q,dqa)
  881. #define QPEL_H264(OPNAME, OP, MMX)\
  882. static av_noinline void OPNAME ## h264_qpel4_h_lowpass_ ## MMX(uint8_t *dst, uint8_t *src, int dstStride, int srcStride){\
  883. int h=4;\
  884. \
  885. __asm__ volatile(\
  886. "pxor %%mm7, %%mm7 \n\t"\
  887. "movq %5, %%mm4 \n\t"\
  888. "movq %6, %%mm5 \n\t"\
  889. "1: \n\t"\
  890. "movd -1(%0), %%mm1 \n\t"\
  891. "movd (%0), %%mm2 \n\t"\
  892. "movd 1(%0), %%mm3 \n\t"\
  893. "movd 2(%0), %%mm0 \n\t"\
  894. "punpcklbw %%mm7, %%mm1 \n\t"\
  895. "punpcklbw %%mm7, %%mm2 \n\t"\
  896. "punpcklbw %%mm7, %%mm3 \n\t"\
  897. "punpcklbw %%mm7, %%mm0 \n\t"\
  898. "paddw %%mm0, %%mm1 \n\t"\
  899. "paddw %%mm3, %%mm2 \n\t"\
  900. "movd -2(%0), %%mm0 \n\t"\
  901. "movd 3(%0), %%mm3 \n\t"\
  902. "punpcklbw %%mm7, %%mm0 \n\t"\
  903. "punpcklbw %%mm7, %%mm3 \n\t"\
  904. "paddw %%mm3, %%mm0 \n\t"\
  905. "psllw $2, %%mm2 \n\t"\
  906. "psubw %%mm1, %%mm2 \n\t"\
  907. "pmullw %%mm4, %%mm2 \n\t"\
  908. "paddw %%mm5, %%mm0 \n\t"\
  909. "paddw %%mm2, %%mm0 \n\t"\
  910. "psraw $5, %%mm0 \n\t"\
  911. "packuswb %%mm0, %%mm0 \n\t"\
  912. OP(%%mm0, (%1),%%mm6, d)\
  913. "add %3, %0 \n\t"\
  914. "add %4, %1 \n\t"\
  915. "decl %2 \n\t"\
  916. " jnz 1b \n\t"\
  917. : "+a"(src), "+c"(dst), "+g"(h)\
  918. : "d"((x86_reg)srcStride), "S"((x86_reg)dstStride), "m"(ff_pw_5), "m"(ff_pw_16)\
  919. : "memory"\
  920. );\
  921. }\
  922. static av_noinline void OPNAME ## h264_qpel4_h_lowpass_l2_ ## MMX(uint8_t *dst, uint8_t *src, uint8_t *src2, int dstStride, int src2Stride){\
  923. int h=4;\
  924. __asm__ volatile(\
  925. "pxor %%mm7, %%mm7 \n\t"\
  926. "movq %0, %%mm4 \n\t"\
  927. "movq %1, %%mm5 \n\t"\
  928. :: "m"(ff_pw_5), "m"(ff_pw_16)\
  929. );\
  930. do{\
  931. __asm__ volatile(\
  932. "movd -1(%0), %%mm1 \n\t"\
  933. "movd (%0), %%mm2 \n\t"\
  934. "movd 1(%0), %%mm3 \n\t"\
  935. "movd 2(%0), %%mm0 \n\t"\
  936. "punpcklbw %%mm7, %%mm1 \n\t"\
  937. "punpcklbw %%mm7, %%mm2 \n\t"\
  938. "punpcklbw %%mm7, %%mm3 \n\t"\
  939. "punpcklbw %%mm7, %%mm0 \n\t"\
  940. "paddw %%mm0, %%mm1 \n\t"\
  941. "paddw %%mm3, %%mm2 \n\t"\
  942. "movd -2(%0), %%mm0 \n\t"\
  943. "movd 3(%0), %%mm3 \n\t"\
  944. "punpcklbw %%mm7, %%mm0 \n\t"\
  945. "punpcklbw %%mm7, %%mm3 \n\t"\
  946. "paddw %%mm3, %%mm0 \n\t"\
  947. "psllw $2, %%mm2 \n\t"\
  948. "psubw %%mm1, %%mm2 \n\t"\
  949. "pmullw %%mm4, %%mm2 \n\t"\
  950. "paddw %%mm5, %%mm0 \n\t"\
  951. "paddw %%mm2, %%mm0 \n\t"\
  952. "movd (%2), %%mm3 \n\t"\
  953. "psraw $5, %%mm0 \n\t"\
  954. "packuswb %%mm0, %%mm0 \n\t"\
  955. PAVGB" %%mm3, %%mm0 \n\t"\
  956. OP(%%mm0, (%1),%%mm6, d)\
  957. "add %4, %0 \n\t"\
  958. "add %4, %1 \n\t"\
  959. "add %3, %2 \n\t"\
  960. : "+a"(src), "+c"(dst), "+d"(src2)\
  961. : "D"((x86_reg)src2Stride), "S"((x86_reg)dstStride)\
  962. : "memory"\
  963. );\
  964. }while(--h);\
  965. }\
  966. static av_noinline void OPNAME ## h264_qpel4_v_lowpass_ ## MMX(uint8_t *dst, uint8_t *src, int dstStride, int srcStride){\
  967. src -= 2*srcStride;\
  968. __asm__ volatile(\
  969. "pxor %%mm7, %%mm7 \n\t"\
  970. "movd (%0), %%mm0 \n\t"\
  971. "add %2, %0 \n\t"\
  972. "movd (%0), %%mm1 \n\t"\
  973. "add %2, %0 \n\t"\
  974. "movd (%0), %%mm2 \n\t"\
  975. "add %2, %0 \n\t"\
  976. "movd (%0), %%mm3 \n\t"\
  977. "add %2, %0 \n\t"\
  978. "movd (%0), %%mm4 \n\t"\
  979. "add %2, %0 \n\t"\
  980. "punpcklbw %%mm7, %%mm0 \n\t"\
  981. "punpcklbw %%mm7, %%mm1 \n\t"\
  982. "punpcklbw %%mm7, %%mm2 \n\t"\
  983. "punpcklbw %%mm7, %%mm3 \n\t"\
  984. "punpcklbw %%mm7, %%mm4 \n\t"\
  985. QPEL_H264V(%%mm0, %%mm1, %%mm2, %%mm3, %%mm4, %%mm5, OP)\
  986. QPEL_H264V(%%mm1, %%mm2, %%mm3, %%mm4, %%mm5, %%mm0, OP)\
  987. QPEL_H264V(%%mm2, %%mm3, %%mm4, %%mm5, %%mm0, %%mm1, OP)\
  988. QPEL_H264V(%%mm3, %%mm4, %%mm5, %%mm0, %%mm1, %%mm2, OP)\
  989. \
  990. : "+a"(src), "+c"(dst)\
  991. : "S"((x86_reg)srcStride), "D"((x86_reg)dstStride), "m"(ff_pw_5), "m"(ff_pw_16)\
  992. : "memory"\
  993. );\
  994. }\
  995. 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){\
  996. int h=4;\
  997. int w=3;\
  998. src -= 2*srcStride+2;\
  999. while(w--){\
  1000. __asm__ volatile(\
  1001. "pxor %%mm7, %%mm7 \n\t"\
  1002. "movd (%0), %%mm0 \n\t"\
  1003. "add %2, %0 \n\t"\
  1004. "movd (%0), %%mm1 \n\t"\
  1005. "add %2, %0 \n\t"\
  1006. "movd (%0), %%mm2 \n\t"\
  1007. "add %2, %0 \n\t"\
  1008. "movd (%0), %%mm3 \n\t"\
  1009. "add %2, %0 \n\t"\
  1010. "movd (%0), %%mm4 \n\t"\
  1011. "add %2, %0 \n\t"\
  1012. "punpcklbw %%mm7, %%mm0 \n\t"\
  1013. "punpcklbw %%mm7, %%mm1 \n\t"\
  1014. "punpcklbw %%mm7, %%mm2 \n\t"\
  1015. "punpcklbw %%mm7, %%mm3 \n\t"\
  1016. "punpcklbw %%mm7, %%mm4 \n\t"\
  1017. QPEL_H264HV(%%mm0, %%mm1, %%mm2, %%mm3, %%mm4, %%mm5, 0*8*3)\
  1018. QPEL_H264HV(%%mm1, %%mm2, %%mm3, %%mm4, %%mm5, %%mm0, 1*8*3)\
  1019. QPEL_H264HV(%%mm2, %%mm3, %%mm4, %%mm5, %%mm0, %%mm1, 2*8*3)\
  1020. QPEL_H264HV(%%mm3, %%mm4, %%mm5, %%mm0, %%mm1, %%mm2, 3*8*3)\
  1021. \
  1022. : "+a"(src)\
  1023. : "c"(tmp), "S"((x86_reg)srcStride), "m"(ff_pw_5), "m"(ff_pw_16)\
  1024. : "memory"\
  1025. );\
  1026. tmp += 4;\
  1027. src += 4 - 9*srcStride;\
  1028. }\
  1029. tmp -= 3*4;\
  1030. __asm__ volatile(\
  1031. "1: \n\t"\
  1032. "movq (%0), %%mm0 \n\t"\
  1033. "paddw 10(%0), %%mm0 \n\t"\
  1034. "movq 2(%0), %%mm1 \n\t"\
  1035. "paddw 8(%0), %%mm1 \n\t"\
  1036. "movq 4(%0), %%mm2 \n\t"\
  1037. "paddw 6(%0), %%mm2 \n\t"\
  1038. "psubw %%mm1, %%mm0 \n\t"/*a-b (abccba)*/\
  1039. "psraw $2, %%mm0 \n\t"/*(a-b)/4 */\
  1040. "psubw %%mm1, %%mm0 \n\t"/*(a-b)/4-b */\
  1041. "paddsw %%mm2, %%mm0 \n\t"\
  1042. "psraw $2, %%mm0 \n\t"/*((a-b)/4-b+c)/4 */\
  1043. "paddw %%mm2, %%mm0 \n\t"/*(a-5*b+20*c)/16 */\
  1044. "psraw $6, %%mm0 \n\t"\
  1045. "packuswb %%mm0, %%mm0 \n\t"\
  1046. OP(%%mm0, (%1),%%mm7, d)\
  1047. "add $24, %0 \n\t"\
  1048. "add %3, %1 \n\t"\
  1049. "decl %2 \n\t"\
  1050. " jnz 1b \n\t"\
  1051. : "+a"(tmp), "+c"(dst), "+g"(h)\
  1052. : "S"((x86_reg)dstStride)\
  1053. : "memory"\
  1054. );\
  1055. }\
  1056. \
  1057. static av_noinline void OPNAME ## h264_qpel8_h_lowpass_ ## MMX(uint8_t *dst, uint8_t *src, int dstStride, int srcStride){\
  1058. int h=8;\
  1059. __asm__ volatile(\
  1060. "pxor %%mm7, %%mm7 \n\t"\
  1061. "movq %5, %%mm6 \n\t"\
  1062. "1: \n\t"\
  1063. "movq (%0), %%mm0 \n\t"\
  1064. "movq 1(%0), %%mm2 \n\t"\
  1065. "movq %%mm0, %%mm1 \n\t"\
  1066. "movq %%mm2, %%mm3 \n\t"\
  1067. "punpcklbw %%mm7, %%mm0 \n\t"\
  1068. "punpckhbw %%mm7, %%mm1 \n\t"\
  1069. "punpcklbw %%mm7, %%mm2 \n\t"\
  1070. "punpckhbw %%mm7, %%mm3 \n\t"\
  1071. "paddw %%mm2, %%mm0 \n\t"\
  1072. "paddw %%mm3, %%mm1 \n\t"\
  1073. "psllw $2, %%mm0 \n\t"\
  1074. "psllw $2, %%mm1 \n\t"\
  1075. "movq -1(%0), %%mm2 \n\t"\
  1076. "movq 2(%0), %%mm4 \n\t"\
  1077. "movq %%mm2, %%mm3 \n\t"\
  1078. "movq %%mm4, %%mm5 \n\t"\
  1079. "punpcklbw %%mm7, %%mm2 \n\t"\
  1080. "punpckhbw %%mm7, %%mm3 \n\t"\
  1081. "punpcklbw %%mm7, %%mm4 \n\t"\
  1082. "punpckhbw %%mm7, %%mm5 \n\t"\
  1083. "paddw %%mm4, %%mm2 \n\t"\
  1084. "paddw %%mm3, %%mm5 \n\t"\
  1085. "psubw %%mm2, %%mm0 \n\t"\
  1086. "psubw %%mm5, %%mm1 \n\t"\
  1087. "pmullw %%mm6, %%mm0 \n\t"\
  1088. "pmullw %%mm6, %%mm1 \n\t"\
  1089. "movd -2(%0), %%mm2 \n\t"\
  1090. "movd 7(%0), %%mm5 \n\t"\
  1091. "punpcklbw %%mm7, %%mm2 \n\t"\
  1092. "punpcklbw %%mm7, %%mm5 \n\t"\
  1093. "paddw %%mm3, %%mm2 \n\t"\
  1094. "paddw %%mm5, %%mm4 \n\t"\
  1095. "movq %6, %%mm5 \n\t"\
  1096. "paddw %%mm5, %%mm2 \n\t"\
  1097. "paddw %%mm5, %%mm4 \n\t"\
  1098. "paddw %%mm2, %%mm0 \n\t"\
  1099. "paddw %%mm4, %%mm1 \n\t"\
  1100. "psraw $5, %%mm0 \n\t"\
  1101. "psraw $5, %%mm1 \n\t"\
  1102. "packuswb %%mm1, %%mm0 \n\t"\
  1103. OP(%%mm0, (%1),%%mm5, q)\
  1104. "add %3, %0 \n\t"\
  1105. "add %4, %1 \n\t"\
  1106. "decl %2 \n\t"\
  1107. " jnz 1b \n\t"\
  1108. : "+a"(src), "+c"(dst), "+g"(h)\
  1109. : "d"((x86_reg)srcStride), "S"((x86_reg)dstStride), "m"(ff_pw_5), "m"(ff_pw_16)\
  1110. : "memory"\
  1111. );\
  1112. }\
  1113. \
  1114. static av_noinline void OPNAME ## h264_qpel8_h_lowpass_l2_ ## MMX(uint8_t *dst, uint8_t *src, uint8_t *src2, int dstStride, int src2Stride){\
  1115. int h=8;\
  1116. __asm__ volatile(\
  1117. "pxor %%mm7, %%mm7 \n\t"\
  1118. "movq %0, %%mm6 \n\t"\
  1119. :: "m"(ff_pw_5)\
  1120. );\
  1121. do{\
  1122. __asm__ volatile(\
  1123. "movq (%0), %%mm0 \n\t"\
  1124. "movq 1(%0), %%mm2 \n\t"\
  1125. "movq %%mm0, %%mm1 \n\t"\
  1126. "movq %%mm2, %%mm3 \n\t"\
  1127. "punpcklbw %%mm7, %%mm0 \n\t"\
  1128. "punpckhbw %%mm7, %%mm1 \n\t"\
  1129. "punpcklbw %%mm7, %%mm2 \n\t"\
  1130. "punpckhbw %%mm7, %%mm3 \n\t"\
  1131. "paddw %%mm2, %%mm0 \n\t"\
  1132. "paddw %%mm3, %%mm1 \n\t"\
  1133. "psllw $2, %%mm0 \n\t"\
  1134. "psllw $2, %%mm1 \n\t"\
  1135. "movq -1(%0), %%mm2 \n\t"\
  1136. "movq 2(%0), %%mm4 \n\t"\
  1137. "movq %%mm2, %%mm3 \n\t"\
  1138. "movq %%mm4, %%mm5 \n\t"\
  1139. "punpcklbw %%mm7, %%mm2 \n\t"\
  1140. "punpckhbw %%mm7, %%mm3 \n\t"\
  1141. "punpcklbw %%mm7, %%mm4 \n\t"\
  1142. "punpckhbw %%mm7, %%mm5 \n\t"\
  1143. "paddw %%mm4, %%mm2 \n\t"\
  1144. "paddw %%mm3, %%mm5 \n\t"\
  1145. "psubw %%mm2, %%mm0 \n\t"\
  1146. "psubw %%mm5, %%mm1 \n\t"\
  1147. "pmullw %%mm6, %%mm0 \n\t"\
  1148. "pmullw %%mm6, %%mm1 \n\t"\
  1149. "movd -2(%0), %%mm2 \n\t"\
  1150. "movd 7(%0), %%mm5 \n\t"\
  1151. "punpcklbw %%mm7, %%mm2 \n\t"\
  1152. "punpcklbw %%mm7, %%mm5 \n\t"\
  1153. "paddw %%mm3, %%mm2 \n\t"\
  1154. "paddw %%mm5, %%mm4 \n\t"\
  1155. "movq %5, %%mm5 \n\t"\
  1156. "paddw %%mm5, %%mm2 \n\t"\
  1157. "paddw %%mm5, %%mm4 \n\t"\
  1158. "paddw %%mm2, %%mm0 \n\t"\
  1159. "paddw %%mm4, %%mm1 \n\t"\
  1160. "psraw $5, %%mm0 \n\t"\
  1161. "psraw $5, %%mm1 \n\t"\
  1162. "movq (%2), %%mm4 \n\t"\
  1163. "packuswb %%mm1, %%mm0 \n\t"\
  1164. PAVGB" %%mm4, %%mm0 \n\t"\
  1165. OP(%%mm0, (%1),%%mm5, q)\
  1166. "add %4, %0 \n\t"\
  1167. "add %4, %1 \n\t"\
  1168. "add %3, %2 \n\t"\
  1169. : "+a"(src), "+c"(dst), "+d"(src2)\
  1170. : "D"((x86_reg)src2Stride), "S"((x86_reg)dstStride),\
  1171. "m"(ff_pw_16)\
  1172. : "memory"\
  1173. );\
  1174. }while(--h);\
  1175. }\
  1176. \
  1177. static av_noinline void OPNAME ## h264_qpel8or16_v_lowpass_ ## MMX(uint8_t *dst, uint8_t *src, int dstStride, int srcStride, int h){\
  1178. int w= 2;\
  1179. src -= 2*srcStride;\
  1180. \
  1181. while(w--){\
  1182. __asm__ volatile(\
  1183. "pxor %%mm7, %%mm7 \n\t"\
  1184. "movd (%0), %%mm0 \n\t"\
  1185. "add %2, %0 \n\t"\
  1186. "movd (%0), %%mm1 \n\t"\
  1187. "add %2, %0 \n\t"\
  1188. "movd (%0), %%mm2 \n\t"\
  1189. "add %2, %0 \n\t"\
  1190. "movd (%0), %%mm3 \n\t"\
  1191. "add %2, %0 \n\t"\
  1192. "movd (%0), %%mm4 \n\t"\
  1193. "add %2, %0 \n\t"\
  1194. "punpcklbw %%mm7, %%mm0 \n\t"\
  1195. "punpcklbw %%mm7, %%mm1 \n\t"\
  1196. "punpcklbw %%mm7, %%mm2 \n\t"\
  1197. "punpcklbw %%mm7, %%mm3 \n\t"\
  1198. "punpcklbw %%mm7, %%mm4 \n\t"\
  1199. QPEL_H264V(%%mm0, %%mm1, %%mm2, %%mm3, %%mm4, %%mm5, OP)\
  1200. QPEL_H264V(%%mm1, %%mm2, %%mm3, %%mm4, %%mm5, %%mm0, OP)\
  1201. QPEL_H264V(%%mm2, %%mm3, %%mm4, %%mm5, %%mm0, %%mm1, OP)\
  1202. QPEL_H264V(%%mm3, %%mm4, %%mm5, %%mm0, %%mm1, %%mm2, OP)\
  1203. QPEL_H264V(%%mm4, %%mm5, %%mm0, %%mm1, %%mm2, %%mm3, OP)\
  1204. QPEL_H264V(%%mm5, %%mm0, %%mm1, %%mm2, %%mm3, %%mm4, OP)\
  1205. QPEL_H264V(%%mm0, %%mm1, %%mm2, %%mm3, %%mm4, %%mm5, OP)\
  1206. QPEL_H264V(%%mm1, %%mm2, %%mm3, %%mm4, %%mm5, %%mm0, OP)\
  1207. \
  1208. : "+a"(src), "+c"(dst)\
  1209. : "S"((x86_reg)srcStride), "D"((x86_reg)dstStride), "m"(ff_pw_5), "m"(ff_pw_16)\
  1210. : "memory"\
  1211. );\
  1212. if(h==16){\
  1213. __asm__ volatile(\
  1214. QPEL_H264V(%%mm2, %%mm3, %%mm4, %%mm5, %%mm0, %%mm1, OP)\
  1215. QPEL_H264V(%%mm3, %%mm4, %%mm5, %%mm0, %%mm1, %%mm2, OP)\
  1216. QPEL_H264V(%%mm4, %%mm5, %%mm0, %%mm1, %%mm2, %%mm3, OP)\
  1217. QPEL_H264V(%%mm5, %%mm0, %%mm1, %%mm2, %%mm3, %%mm4, OP)\
  1218. QPEL_H264V(%%mm0, %%mm1, %%mm2, %%mm3, %%mm4, %%mm5, OP)\
  1219. QPEL_H264V(%%mm1, %%mm2, %%mm3, %%mm4, %%mm5, %%mm0, OP)\
  1220. QPEL_H264V(%%mm2, %%mm3, %%mm4, %%mm5, %%mm0, %%mm1, OP)\
  1221. QPEL_H264V(%%mm3, %%mm4, %%mm5, %%mm0, %%mm1, %%mm2, OP)\
  1222. \
  1223. : "+a"(src), "+c"(dst)\
  1224. : "S"((x86_reg)srcStride), "D"((x86_reg)dstStride), "m"(ff_pw_5), "m"(ff_pw_16)\
  1225. : "memory"\
  1226. );\
  1227. }\
  1228. src += 4-(h+5)*srcStride;\
  1229. dst += 4-h*dstStride;\
  1230. }\
  1231. }\
  1232. static av_always_inline void OPNAME ## h264_qpel8or16_hv1_lowpass_ ## MMX(int16_t *tmp, uint8_t *src, int tmpStride, int srcStride, int size){\
  1233. int w = (size+8)>>2;\
  1234. src -= 2*srcStride+2;\
  1235. while(w--){\
  1236. __asm__ volatile(\
  1237. "pxor %%mm7, %%mm7 \n\t"\
  1238. "movd (%0), %%mm0 \n\t"\
  1239. "add %2, %0 \n\t"\
  1240. "movd (%0), %%mm1 \n\t"\
  1241. "add %2, %0 \n\t"\
  1242. "movd (%0), %%mm2 \n\t"\
  1243. "add %2, %0 \n\t"\
  1244. "movd (%0), %%mm3 \n\t"\
  1245. "add %2, %0 \n\t"\
  1246. "movd (%0), %%mm4 \n\t"\
  1247. "add %2, %0 \n\t"\
  1248. "punpcklbw %%mm7, %%mm0 \n\t"\
  1249. "punpcklbw %%mm7, %%mm1 \n\t"\
  1250. "punpcklbw %%mm7, %%mm2 \n\t"\
  1251. "punpcklbw %%mm7, %%mm3 \n\t"\
  1252. "punpcklbw %%mm7, %%mm4 \n\t"\
  1253. QPEL_H264HV(%%mm0, %%mm1, %%mm2, %%mm3, %%mm4, %%mm5, 0*48)\
  1254. QPEL_H264HV(%%mm1, %%mm2, %%mm3, %%mm4, %%mm5, %%mm0, 1*48)\
  1255. QPEL_H264HV(%%mm2, %%mm3, %%mm4, %%mm5, %%mm0, %%mm1, 2*48)\
  1256. QPEL_H264HV(%%mm3, %%mm4, %%mm5, %%mm0, %%mm1, %%mm2, 3*48)\
  1257. QPEL_H264HV(%%mm4, %%mm5, %%mm0, %%mm1, %%mm2, %%mm3, 4*48)\
  1258. QPEL_H264HV(%%mm5, %%mm0, %%mm1, %%mm2, %%mm3, %%mm4, 5*48)\
  1259. QPEL_H264HV(%%mm0, %%mm1, %%mm2, %%mm3, %%mm4, %%mm5, 6*48)\
  1260. QPEL_H264HV(%%mm1, %%mm2, %%mm3, %%mm4, %%mm5, %%mm0, 7*48)\
  1261. : "+a"(src)\
  1262. : "c"(tmp), "S"((x86_reg)srcStride), "m"(ff_pw_5), "m"(ff_pw_16)\
  1263. : "memory"\
  1264. );\
  1265. if(size==16){\
  1266. __asm__ volatile(\
  1267. QPEL_H264HV(%%mm2, %%mm3, %%mm4, %%mm5, %%mm0, %%mm1, 8*48)\
  1268. QPEL_H264HV(%%mm3, %%mm4, %%mm5, %%mm0, %%mm1, %%mm2, 9*48)\
  1269. QPEL_H264HV(%%mm4, %%mm5, %%mm0, %%mm1, %%mm2, %%mm3, 10*48)\
  1270. QPEL_H264HV(%%mm5, %%mm0, %%mm1, %%mm2, %%mm3, %%mm4, 11*48)\
  1271. QPEL_H264HV(%%mm0, %%mm1, %%mm2, %%mm3, %%mm4, %%mm5, 12*48)\
  1272. QPEL_H264HV(%%mm1, %%mm2, %%mm3, %%mm4, %%mm5, %%mm0, 13*48)\
  1273. QPEL_H264HV(%%mm2, %%mm3, %%mm4, %%mm5, %%mm0, %%mm1, 14*48)\
  1274. QPEL_H264HV(%%mm3, %%mm4, %%mm5, %%mm0, %%mm1, %%mm2, 15*48)\
  1275. : "+a"(src)\
  1276. : "c"(tmp), "S"((x86_reg)srcStride), "m"(ff_pw_5), "m"(ff_pw_16)\
  1277. : "memory"\
  1278. );\
  1279. }\
  1280. tmp += 4;\
  1281. src += 4 - (size+5)*srcStride;\
  1282. }\
  1283. }\
  1284. static av_always_inline void OPNAME ## h264_qpel8or16_hv2_lowpass_ ## MMX(uint8_t *dst, int16_t *tmp, int dstStride, int tmpStride, int size){\
  1285. int w = size>>4;\
  1286. do{\
  1287. int h = size;\
  1288. __asm__ volatile(\
  1289. "1: \n\t"\
  1290. "movq (%0), %%mm0 \n\t"\
  1291. "movq 8(%0), %%mm3 \n\t"\
  1292. "movq 2(%0), %%mm1 \n\t"\
  1293. "movq 10(%0), %%mm4 \n\t"\
  1294. "paddw %%mm4, %%mm0 \n\t"\
  1295. "paddw %%mm3, %%mm1 \n\t"\
  1296. "paddw 18(%0), %%mm3 \n\t"\
  1297. "paddw 16(%0), %%mm4 \n\t"\
  1298. "movq 4(%0), %%mm2 \n\t"\
  1299. "movq 12(%0), %%mm5 \n\t"\
  1300. "paddw 6(%0), %%mm2 \n\t"\
  1301. "paddw 14(%0), %%mm5 \n\t"\
  1302. "psubw %%mm1, %%mm0 \n\t"\
  1303. "psubw %%mm4, %%mm3 \n\t"\
  1304. "psraw $2, %%mm0 \n\t"\
  1305. "psraw $2, %%mm3 \n\t"\
  1306. "psubw %%mm1, %%mm0 \n\t"\
  1307. "psubw %%mm4, %%mm3 \n\t"\
  1308. "paddsw %%mm2, %%mm0 \n\t"\
  1309. "paddsw %%mm5, %%mm3 \n\t"\
  1310. "psraw $2, %%mm0 \n\t"\
  1311. "psraw $2, %%mm3 \n\t"\
  1312. "paddw %%mm2, %%mm0 \n\t"\
  1313. "paddw %%mm5, %%mm3 \n\t"\
  1314. "psraw $6, %%mm0 \n\t"\
  1315. "psraw $6, %%mm3 \n\t"\
  1316. "packuswb %%mm3, %%mm0 \n\t"\
  1317. OP(%%mm0, (%1),%%mm7, q)\
  1318. "add $48, %0 \n\t"\
  1319. "add %3, %1 \n\t"\
  1320. "decl %2 \n\t"\
  1321. " jnz 1b \n\t"\
  1322. : "+a"(tmp), "+c"(dst), "+g"(h)\
  1323. : "S"((x86_reg)dstStride)\
  1324. : "memory"\
  1325. );\
  1326. tmp += 8 - size*24;\
  1327. dst += 8 - size*dstStride;\
  1328. }while(w--);\
  1329. }\
  1330. \
  1331. static void OPNAME ## h264_qpel8_v_lowpass_ ## MMX(uint8_t *dst, uint8_t *src, int dstStride, int srcStride){\
  1332. OPNAME ## h264_qpel8or16_v_lowpass_ ## MMX(dst , src , dstStride, srcStride, 8);\
  1333. }\
  1334. static av_noinline void OPNAME ## h264_qpel16_v_lowpass_ ## MMX(uint8_t *dst, uint8_t *src, int dstStride, int srcStride){\
  1335. OPNAME ## h264_qpel8or16_v_lowpass_ ## MMX(dst , src , dstStride, srcStride, 16);\
  1336. OPNAME ## h264_qpel8or16_v_lowpass_ ## MMX(dst+8, src+8, dstStride, srcStride, 16);\
  1337. }\
  1338. \
  1339. static void OPNAME ## h264_qpel16_h_lowpass_ ## MMX(uint8_t *dst, uint8_t *src, int dstStride, int srcStride){\
  1340. OPNAME ## h264_qpel8_h_lowpass_ ## MMX(dst , src , dstStride, srcStride);\
  1341. OPNAME ## h264_qpel8_h_lowpass_ ## MMX(dst+8, src+8, dstStride, srcStride);\
  1342. src += 8*srcStride;\
  1343. dst += 8*dstStride;\
  1344. OPNAME ## h264_qpel8_h_lowpass_ ## MMX(dst , src , dstStride, srcStride);\
  1345. OPNAME ## h264_qpel8_h_lowpass_ ## MMX(dst+8, src+8, dstStride, srcStride);\
  1346. }\
  1347. \
  1348. static av_noinline void OPNAME ## h264_qpel16_h_lowpass_l2_ ## MMX(uint8_t *dst, uint8_t *src, uint8_t *src2, int dstStride, int src2Stride){\
  1349. OPNAME ## h264_qpel8_h_lowpass_l2_ ## MMX(dst , src , src2 , dstStride, src2Stride);\
  1350. OPNAME ## h264_qpel8_h_lowpass_l2_ ## MMX(dst+8, src+8, src2+8, dstStride, src2Stride);\
  1351. src += 8*dstStride;\
  1352. dst += 8*dstStride;\
  1353. src2 += 8*src2Stride;\
  1354. OPNAME ## h264_qpel8_h_lowpass_l2_ ## MMX(dst , src , src2 , dstStride, src2Stride);\
  1355. OPNAME ## h264_qpel8_h_lowpass_l2_ ## MMX(dst+8, src+8, src2+8, dstStride, src2Stride);\
  1356. }\
  1357. \
  1358. 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){\
  1359. put_h264_qpel8or16_hv1_lowpass_ ## MMX(tmp, src, tmpStride, srcStride, size);\
  1360. OPNAME ## h264_qpel8or16_hv2_lowpass_ ## MMX(dst, tmp, dstStride, tmpStride, size);\
  1361. }\
  1362. static void OPNAME ## h264_qpel8_hv_lowpass_ ## MMX(uint8_t *dst, int16_t *tmp, uint8_t *src, int dstStride, int tmpStride, int srcStride){\
  1363. OPNAME ## h264_qpel8or16_hv_lowpass_ ## MMX(dst , tmp , src , dstStride, tmpStride, srcStride, 8);\
  1364. }\
  1365. \
  1366. static void OPNAME ## h264_qpel16_hv_lowpass_ ## MMX(uint8_t *dst, int16_t *tmp, uint8_t *src, int dstStride, int tmpStride, int srcStride){\
  1367. OPNAME ## h264_qpel8or16_hv_lowpass_ ## MMX(dst , tmp , src , dstStride, tmpStride, srcStride, 16);\
  1368. }\
  1369. \
  1370. static av_noinline void OPNAME ## pixels4_l2_shift5_ ## MMX(uint8_t *dst, int16_t *src16, uint8_t *src8, int dstStride, int src8Stride, int h)\
  1371. {\
  1372. __asm__ volatile(\
  1373. "movq (%1), %%mm0 \n\t"\
  1374. "movq 24(%1), %%mm1 \n\t"\
  1375. "psraw $5, %%mm0 \n\t"\
  1376. "psraw $5, %%mm1 \n\t"\
  1377. "packuswb %%mm0, %%mm0 \n\t"\
  1378. "packuswb %%mm1, %%mm1 \n\t"\
  1379. PAVGB" (%0), %%mm0 \n\t"\
  1380. PAVGB" (%0,%3), %%mm1 \n\t"\
  1381. OP(%%mm0, (%2), %%mm4, d)\
  1382. OP(%%mm1, (%2,%4), %%mm5, d)\
  1383. "lea (%0,%3,2), %0 \n\t"\
  1384. "lea (%2,%4,2), %2 \n\t"\
  1385. "movq 48(%1), %%mm0 \n\t"\
  1386. "movq 72(%1), %%mm1 \n\t"\
  1387. "psraw $5, %%mm0 \n\t"\
  1388. "psraw $5, %%mm1 \n\t"\
  1389. "packuswb %%mm0, %%mm0 \n\t"\
  1390. "packuswb %%mm1, %%mm1 \n\t"\
  1391. PAVGB" (%0), %%mm0 \n\t"\
  1392. PAVGB" (%0,%3), %%mm1 \n\t"\
  1393. OP(%%mm0, (%2), %%mm4, d)\
  1394. OP(%%mm1, (%2,%4), %%mm5, d)\
  1395. :"+a"(src8), "+c"(src16), "+d"(dst)\
  1396. :"S"((x86_reg)src8Stride), "D"((x86_reg)dstStride)\
  1397. :"memory");\
  1398. }\
  1399. static av_noinline void OPNAME ## pixels8_l2_shift5_ ## MMX(uint8_t *dst, int16_t *src16, uint8_t *src8, int dstStride, int src8Stride, int h)\
  1400. {\
  1401. do{\
  1402. __asm__ volatile(\
  1403. "movq (%1), %%mm0 \n\t"\
  1404. "movq 8(%1), %%mm1 \n\t"\
  1405. "movq 48(%1), %%mm2 \n\t"\
  1406. "movq 8+48(%1), %%mm3 \n\t"\
  1407. "psraw $5, %%mm0 \n\t"\
  1408. "psraw $5, %%mm1 \n\t"\
  1409. "psraw $5, %%mm2 \n\t"\
  1410. "psraw $5, %%mm3 \n\t"\
  1411. "packuswb %%mm1, %%mm0 \n\t"\
  1412. "packuswb %%mm3, %%mm2 \n\t"\
  1413. PAVGB" (%0), %%mm0 \n\t"\
  1414. PAVGB" (%0,%3), %%mm2 \n\t"\
  1415. OP(%%mm0, (%2), %%mm5, q)\
  1416. OP(%%mm2, (%2,%4), %%mm5, q)\
  1417. ::"a"(src8), "c"(src16), "d"(dst),\
  1418. "r"((x86_reg)src8Stride), "r"((x86_reg)dstStride)\
  1419. :"memory");\
  1420. src8 += 2L*src8Stride;\
  1421. src16 += 48;\
  1422. dst += 2L*dstStride;\
  1423. }while(h-=2);\
  1424. }\
  1425. static void OPNAME ## pixels16_l2_shift5_ ## MMX(uint8_t *dst, int16_t *src16, uint8_t *src8, int dstStride, int src8Stride, int h)\
  1426. {\
  1427. OPNAME ## pixels8_l2_shift5_ ## MMX(dst , src16 , src8 , dstStride, src8Stride, h);\
  1428. OPNAME ## pixels8_l2_shift5_ ## MMX(dst+8, src16+8, src8+8, dstStride, src8Stride, h);\
  1429. }\
  1430. #if ARCH_X86_64
  1431. #define QPEL_H264_H16_XMM(OPNAME, OP, MMX)\
  1432. static av_noinline void OPNAME ## h264_qpel16_h_lowpass_l2_ ## MMX(uint8_t *dst, uint8_t *src, uint8_t *src2, int dstStride, int src2Stride){\
  1433. int h=16;\
  1434. __asm__ volatile(\
  1435. "pxor %%xmm15, %%xmm15 \n\t"\
  1436. "movdqa %6, %%xmm14 \n\t"\
  1437. "movdqa %7, %%xmm13 \n\t"\
  1438. "1: \n\t"\
  1439. "lddqu 6(%0), %%xmm1 \n\t"\
  1440. "lddqu -2(%0), %%xmm7 \n\t"\
  1441. "movdqa %%xmm1, %%xmm0 \n\t"\
  1442. "punpckhbw %%xmm15, %%xmm1 \n\t"\
  1443. "punpcklbw %%xmm15, %%xmm0 \n\t"\
  1444. "punpcklbw %%xmm15, %%xmm7 \n\t"\
  1445. "movdqa %%xmm1, %%xmm2 \n\t"\
  1446. "movdqa %%xmm0, %%xmm6 \n\t"\
  1447. "movdqa %%xmm1, %%xmm3 \n\t"\
  1448. "movdqa %%xmm0, %%xmm8 \n\t"\
  1449. "movdqa %%xmm1, %%xmm4 \n\t"\
  1450. "movdqa %%xmm0, %%xmm9 \n\t"\
  1451. "movdqa %%xmm0, %%xmm12 \n\t"\
  1452. "movdqa %%xmm1, %%xmm11 \n\t"\
  1453. "palignr $10,%%xmm0, %%xmm11\n\t"\
  1454. "palignr $10,%%xmm7, %%xmm12\n\t"\
  1455. "palignr $2, %%xmm0, %%xmm4 \n\t"\
  1456. "palignr $2, %%xmm7, %%xmm9 \n\t"\
  1457. "palignr $4, %%xmm0, %%xmm3 \n\t"\
  1458. "palignr $4, %%xmm7, %%xmm8 \n\t"\
  1459. "palignr $6, %%xmm0, %%xmm2 \n\t"\
  1460. "palignr $6, %%xmm7, %%xmm6 \n\t"\
  1461. "paddw %%xmm0 ,%%xmm11 \n\t"\
  1462. "palignr $8, %%xmm0, %%xmm1 \n\t"\
  1463. "palignr $8, %%xmm7, %%xmm0 \n\t"\
  1464. "paddw %%xmm12,%%xmm7 \n\t"\
  1465. "paddw %%xmm3, %%xmm2 \n\t"\
  1466. "paddw %%xmm8, %%xmm6 \n\t"\
  1467. "paddw %%xmm4, %%xmm1 \n\t"\
  1468. "paddw %%xmm9, %%xmm0 \n\t"\
  1469. "psllw $2, %%xmm2 \n\t"\
  1470. "psllw $2, %%xmm6 \n\t"\
  1471. "psubw %%xmm1, %%xmm2 \n\t"\
  1472. "psubw %%xmm0, %%xmm6 \n\t"\
  1473. "paddw %%xmm13,%%xmm11 \n\t"\
  1474. "paddw %%xmm13,%%xmm7 \n\t"\
  1475. "pmullw %%xmm14,%%xmm2 \n\t"\
  1476. "pmullw %%xmm14,%%xmm6 \n\t"\
  1477. "lddqu (%2), %%xmm3 \n\t"\
  1478. "paddw %%xmm11,%%xmm2 \n\t"\
  1479. "paddw %%xmm7, %%xmm6 \n\t"\
  1480. "psraw $5, %%xmm2 \n\t"\
  1481. "psraw $5, %%xmm6 \n\t"\
  1482. "packuswb %%xmm2,%%xmm6 \n\t"\
  1483. "pavgb %%xmm3, %%xmm6 \n\t"\
  1484. OP(%%xmm6, (%1), %%xmm4, dqa)\
  1485. "add %5, %0 \n\t"\
  1486. "add %5, %1 \n\t"\
  1487. "add %4, %2 \n\t"\
  1488. "decl %3 \n\t"\
  1489. "jg 1b \n\t"\
  1490. : "+a"(src), "+c"(dst), "+d"(src2), "+g"(h)\
  1491. : "D"((x86_reg)src2Stride), "S"((x86_reg)dstStride),\
  1492. "m"(ff_pw_5), "m"(ff_pw_16)\
  1493. : "memory"\
  1494. );\
  1495. }
  1496. #else // ARCH_X86_64
  1497. #define QPEL_H264_H16_XMM(OPNAME, OP, MMX)\
  1498. static av_noinline void OPNAME ## h264_qpel16_h_lowpass_l2_ ## MMX(uint8_t *dst, uint8_t *src, uint8_t *src2, int dstStride, int src2Stride){\
  1499. OPNAME ## h264_qpel8_h_lowpass_l2_ ## MMX(dst , src , src2 , dstStride, src2Stride);\
  1500. OPNAME ## h264_qpel8_h_lowpass_l2_ ## MMX(dst+8, src+8, src2+8, dstStride, src2Stride);\
  1501. src += 8*dstStride;\
  1502. dst += 8*dstStride;\
  1503. src2 += 8*src2Stride;\
  1504. OPNAME ## h264_qpel8_h_lowpass_l2_ ## MMX(dst , src , src2 , dstStride, src2Stride);\
  1505. OPNAME ## h264_qpel8_h_lowpass_l2_ ## MMX(dst+8, src+8, src2+8, dstStride, src2Stride);\
  1506. }
  1507. #endif // ARCH_X86_64
  1508. #define QPEL_H264_H_XMM(OPNAME, OP, MMX)\
  1509. static av_noinline void OPNAME ## h264_qpel8_h_lowpass_l2_ ## MMX(uint8_t *dst, uint8_t *src, uint8_t *src2, int dstStride, int src2Stride){\
  1510. int h=8;\
  1511. __asm__ volatile(\
  1512. "pxor %%xmm7, %%xmm7 \n\t"\
  1513. "movdqa %0, %%xmm6 \n\t"\
  1514. :: "m"(ff_pw_5)\
  1515. );\
  1516. do{\
  1517. __asm__ volatile(\
  1518. "lddqu -2(%0), %%xmm1 \n\t"\
  1519. "movdqa %%xmm1, %%xmm0 \n\t"\
  1520. "punpckhbw %%xmm7, %%xmm1 \n\t"\
  1521. "punpcklbw %%xmm7, %%xmm0 \n\t"\
  1522. "movdqa %%xmm1, %%xmm2 \n\t"\
  1523. "movdqa %%xmm1, %%xmm3 \n\t"\
  1524. "movdqa %%xmm1, %%xmm4 \n\t"\
  1525. "movdqa %%xmm1, %%xmm5 \n\t"\
  1526. "palignr $2, %%xmm0, %%xmm4 \n\t"\
  1527. "palignr $4, %%xmm0, %%xmm3 \n\t"\
  1528. "palignr $6, %%xmm0, %%xmm2 \n\t"\
  1529. "palignr $8, %%xmm0, %%xmm1 \n\t"\
  1530. "palignr $10,%%xmm0, %%xmm5 \n\t"\
  1531. "paddw %%xmm5, %%xmm0 \n\t"\
  1532. "paddw %%xmm3, %%xmm2 \n\t"\
  1533. "paddw %%xmm4, %%xmm1 \n\t"\
  1534. "psllw $2, %%xmm2 \n\t"\
  1535. "movq (%2), %%xmm3 \n\t"\
  1536. "psubw %%xmm1, %%xmm2 \n\t"\
  1537. "paddw %5, %%xmm0 \n\t"\
  1538. "pmullw %%xmm6, %%xmm2 \n\t"\
  1539. "paddw %%xmm0, %%xmm2 \n\t"\
  1540. "psraw $5, %%xmm2 \n\t"\
  1541. "packuswb %%xmm2, %%xmm2 \n\t"\
  1542. "pavgb %%xmm3, %%xmm2 \n\t"\
  1543. OP(%%xmm2, (%1), %%xmm4, q)\
  1544. "add %4, %0 \n\t"\
  1545. "add %4, %1 \n\t"\
  1546. "add %3, %2 \n\t"\
  1547. : "+a"(src), "+c"(dst), "+d"(src2)\
  1548. : "D"((x86_reg)src2Stride), "S"((x86_reg)dstStride),\
  1549. "m"(ff_pw_16)\
  1550. : "memory"\
  1551. );\
  1552. }while(--h);\
  1553. }\
  1554. QPEL_H264_H16_XMM(OPNAME, OP, MMX)\
  1555. \
  1556. static av_noinline void OPNAME ## h264_qpel8_h_lowpass_ ## MMX(uint8_t *dst, uint8_t *src, int dstStride, int srcStride){\
  1557. int h=8;\
  1558. __asm__ volatile(\
  1559. "pxor %%xmm7, %%xmm7 \n\t"\
  1560. "movdqa %5, %%xmm6 \n\t"\
  1561. "1: \n\t"\
  1562. "lddqu -2(%0), %%xmm1 \n\t"\
  1563. "movdqa %%xmm1, %%xmm0 \n\t"\
  1564. "punpckhbw %%xmm7, %%xmm1 \n\t"\
  1565. "punpcklbw %%xmm7, %%xmm0 \n\t"\
  1566. "movdqa %%xmm1, %%xmm2 \n\t"\
  1567. "movdqa %%xmm1, %%xmm3 \n\t"\
  1568. "movdqa %%xmm1, %%xmm4 \n\t"\
  1569. "movdqa %%xmm1, %%xmm5 \n\t"\
  1570. "palignr $2, %%xmm0, %%xmm4 \n\t"\
  1571. "palignr $4, %%xmm0, %%xmm3 \n\t"\
  1572. "palignr $6, %%xmm0, %%xmm2 \n\t"\
  1573. "palignr $8, %%xmm0, %%xmm1 \n\t"\
  1574. "palignr $10,%%xmm0, %%xmm5 \n\t"\
  1575. "paddw %%xmm5, %%xmm0 \n\t"\
  1576. "paddw %%xmm3, %%xmm2 \n\t"\
  1577. "paddw %%xmm4, %%xmm1 \n\t"\
  1578. "psllw $2, %%xmm2 \n\t"\
  1579. "psubw %%xmm1, %%xmm2 \n\t"\
  1580. "paddw %6, %%xmm0 \n\t"\
  1581. "pmullw %%xmm6, %%xmm2 \n\t"\
  1582. "paddw %%xmm0, %%xmm2 \n\t"\
  1583. "psraw $5, %%xmm2 \n\t"\
  1584. "packuswb %%xmm2, %%xmm2 \n\t"\
  1585. OP(%%xmm2, (%1), %%xmm4, q)\
  1586. "add %3, %0 \n\t"\
  1587. "add %4, %1 \n\t"\
  1588. "decl %2 \n\t"\
  1589. " jnz 1b \n\t"\
  1590. : "+a"(src), "+c"(dst), "+g"(h)\
  1591. : "D"((x86_reg)srcStride), "S"((x86_reg)dstStride),\
  1592. "m"(ff_pw_5), "m"(ff_pw_16)\
  1593. : "memory"\
  1594. );\
  1595. }\
  1596. static void OPNAME ## h264_qpel16_h_lowpass_ ## MMX(uint8_t *dst, uint8_t *src, int dstStride, int srcStride){\
  1597. OPNAME ## h264_qpel8_h_lowpass_ ## MMX(dst , src , dstStride, srcStride);\
  1598. OPNAME ## h264_qpel8_h_lowpass_ ## MMX(dst+8, src+8, dstStride, srcStride);\
  1599. src += 8*srcStride;\
  1600. dst += 8*dstStride;\
  1601. OPNAME ## h264_qpel8_h_lowpass_ ## MMX(dst , src , dstStride, srcStride);\
  1602. OPNAME ## h264_qpel8_h_lowpass_ ## MMX(dst+8, src+8, dstStride, srcStride);\
  1603. }\
  1604. #define QPEL_H264_V_XMM(OPNAME, OP, MMX)\
  1605. static av_noinline void OPNAME ## h264_qpel8or16_v_lowpass_ ## MMX(uint8_t *dst, uint8_t *src, int dstStride, int srcStride, int h){\
  1606. src -= 2*srcStride;\
  1607. \
  1608. __asm__ volatile(\
  1609. "pxor %%xmm7, %%xmm7 \n\t"\
  1610. "movq (%0), %%xmm0 \n\t"\
  1611. "add %2, %0 \n\t"\
  1612. "movq (%0), %%xmm1 \n\t"\
  1613. "add %2, %0 \n\t"\
  1614. "movq (%0), %%xmm2 \n\t"\
  1615. "add %2, %0 \n\t"\
  1616. "movq (%0), %%xmm3 \n\t"\
  1617. "add %2, %0 \n\t"\
  1618. "movq (%0), %%xmm4 \n\t"\
  1619. "add %2, %0 \n\t"\
  1620. "punpcklbw %%xmm7, %%xmm0 \n\t"\
  1621. "punpcklbw %%xmm7, %%xmm1 \n\t"\
  1622. "punpcklbw %%xmm7, %%xmm2 \n\t"\
  1623. "punpcklbw %%xmm7, %%xmm3 \n\t"\
  1624. "punpcklbw %%xmm7, %%xmm4 \n\t"\
  1625. QPEL_H264V_XMM(%%xmm0, %%xmm1, %%xmm2, %%xmm3, %%xmm4, %%xmm5, OP)\
  1626. QPEL_H264V_XMM(%%xmm1, %%xmm2, %%xmm3, %%xmm4, %%xmm5, %%xmm0, OP)\
  1627. QPEL_H264V_XMM(%%xmm2, %%xmm3, %%xmm4, %%xmm5, %%xmm0, %%xmm1, OP)\
  1628. QPEL_H264V_XMM(%%xmm3, %%xmm4, %%xmm5, %%xmm0, %%xmm1, %%xmm2, OP)\
  1629. QPEL_H264V_XMM(%%xmm4, %%xmm5, %%xmm0, %%xmm1, %%xmm2, %%xmm3, OP)\
  1630. QPEL_H264V_XMM(%%xmm5, %%xmm0, %%xmm1, %%xmm2, %%xmm3, %%xmm4, OP)\
  1631. QPEL_H264V_XMM(%%xmm0, %%xmm1, %%xmm2, %%xmm3, %%xmm4, %%xmm5, OP)\
  1632. QPEL_H264V_XMM(%%xmm1, %%xmm2, %%xmm3, %%xmm4, %%xmm5, %%xmm0, OP)\
  1633. \
  1634. : "+a"(src), "+c"(dst)\
  1635. : "S"((x86_reg)srcStride), "D"((x86_reg)dstStride), "m"(ff_pw_5), "m"(ff_pw_16)\
  1636. : "memory"\
  1637. );\
  1638. if(h==16){\
  1639. __asm__ volatile(\
  1640. QPEL_H264V_XMM(%%xmm2, %%xmm3, %%xmm4, %%xmm5, %%xmm0, %%xmm1, OP)\
  1641. QPEL_H264V_XMM(%%xmm3, %%xmm4, %%xmm5, %%xmm0, %%xmm1, %%xmm2, OP)\
  1642. QPEL_H264V_XMM(%%xmm4, %%xmm5, %%xmm0, %%xmm1, %%xmm2, %%xmm3, OP)\
  1643. QPEL_H264V_XMM(%%xmm5, %%xmm0, %%xmm1, %%xmm2, %%xmm3, %%xmm4, OP)\
  1644. QPEL_H264V_XMM(%%xmm0, %%xmm1, %%xmm2, %%xmm3, %%xmm4, %%xmm5, OP)\
  1645. QPEL_H264V_XMM(%%xmm1, %%xmm2, %%xmm3, %%xmm4, %%xmm5, %%xmm0, OP)\
  1646. QPEL_H264V_XMM(%%xmm2, %%xmm3, %%xmm4, %%xmm5, %%xmm0, %%xmm1, OP)\
  1647. QPEL_H264V_XMM(%%xmm3, %%xmm4, %%xmm5, %%xmm0, %%xmm1, %%xmm2, OP)\
  1648. \
  1649. : "+a"(src), "+c"(dst)\
  1650. : "S"((x86_reg)srcStride), "D"((x86_reg)dstStride), "m"(ff_pw_5), "m"(ff_pw_16)\
  1651. : "memory"\
  1652. );\
  1653. }\
  1654. }\
  1655. static void OPNAME ## h264_qpel8_v_lowpass_ ## MMX(uint8_t *dst, uint8_t *src, int dstStride, int srcStride){\
  1656. OPNAME ## h264_qpel8or16_v_lowpass_ ## MMX(dst , src , dstStride, srcStride, 8);\
  1657. }\
  1658. static av_noinline void OPNAME ## h264_qpel16_v_lowpass_ ## MMX(uint8_t *dst, uint8_t *src, int dstStride, int srcStride){\
  1659. OPNAME ## h264_qpel8or16_v_lowpass_ ## MMX(dst , src , dstStride, srcStride, 16);\
  1660. OPNAME ## h264_qpel8or16_v_lowpass_ ## MMX(dst+8, src+8, dstStride, srcStride, 16);\
  1661. }
  1662. static av_always_inline void put_h264_qpel8or16_hv1_lowpass_sse2(int16_t *tmp, uint8_t *src, int tmpStride, int srcStride, int size){
  1663. int w = (size+8)>>3;
  1664. src -= 2*srcStride+2;
  1665. while(w--){
  1666. __asm__ volatile(
  1667. "pxor %%xmm7, %%xmm7 \n\t"
  1668. "movq (%0), %%xmm0 \n\t"
  1669. "add %2, %0 \n\t"
  1670. "movq (%0), %%xmm1 \n\t"
  1671. "add %2, %0 \n\t"
  1672. "movq (%0), %%xmm2 \n\t"
  1673. "add %2, %0 \n\t"
  1674. "movq (%0), %%xmm3 \n\t"
  1675. "add %2, %0 \n\t"
  1676. "movq (%0), %%xmm4 \n\t"
  1677. "add %2, %0 \n\t"
  1678. "punpcklbw %%xmm7, %%xmm0 \n\t"
  1679. "punpcklbw %%xmm7, %%xmm1 \n\t"
  1680. "punpcklbw %%xmm7, %%xmm2 \n\t"
  1681. "punpcklbw %%xmm7, %%xmm3 \n\t"
  1682. "punpcklbw %%xmm7, %%xmm4 \n\t"
  1683. QPEL_H264HV_XMM(%%xmm0, %%xmm1, %%xmm2, %%xmm3, %%xmm4, %%xmm5, 0*48)
  1684. QPEL_H264HV_XMM(%%xmm1, %%xmm2, %%xmm3, %%xmm4, %%xmm5, %%xmm0, 1*48)
  1685. QPEL_H264HV_XMM(%%xmm2, %%xmm3, %%xmm4, %%xmm5, %%xmm0, %%xmm1, 2*48)
  1686. QPEL_H264HV_XMM(%%xmm3, %%xmm4, %%xmm5, %%xmm0, %%xmm1, %%xmm2, 3*48)
  1687. QPEL_H264HV_XMM(%%xmm4, %%xmm5, %%xmm0, %%xmm1, %%xmm2, %%xmm3, 4*48)
  1688. QPEL_H264HV_XMM(%%xmm5, %%xmm0, %%xmm1, %%xmm2, %%xmm3, %%xmm4, 5*48)
  1689. QPEL_H264HV_XMM(%%xmm0, %%xmm1, %%xmm2, %%xmm3, %%xmm4, %%xmm5, 6*48)
  1690. QPEL_H264HV_XMM(%%xmm1, %%xmm2, %%xmm3, %%xmm4, %%xmm5, %%xmm0, 7*48)
  1691. : "+a"(src)
  1692. : "c"(tmp), "S"((x86_reg)srcStride), "m"(ff_pw_5), "m"(ff_pw_16)
  1693. : "memory"
  1694. );
  1695. if(size==16){
  1696. __asm__ volatile(
  1697. QPEL_H264HV_XMM(%%xmm2, %%xmm3, %%xmm4, %%xmm5, %%xmm0, %%xmm1, 8*48)
  1698. QPEL_H264HV_XMM(%%xmm3, %%xmm4, %%xmm5, %%xmm0, %%xmm1, %%xmm2, 9*48)
  1699. QPEL_H264HV_XMM(%%xmm4, %%xmm5, %%xmm0, %%xmm1, %%xmm2, %%xmm3, 10*48)
  1700. QPEL_H264HV_XMM(%%xmm5, %%xmm0, %%xmm1, %%xmm2, %%xmm3, %%xmm4, 11*48)
  1701. QPEL_H264HV_XMM(%%xmm0, %%xmm1, %%xmm2, %%xmm3, %%xmm4, %%xmm5, 12*48)
  1702. QPEL_H264HV_XMM(%%xmm1, %%xmm2, %%xmm3, %%xmm4, %%xmm5, %%xmm0, 13*48)
  1703. QPEL_H264HV_XMM(%%xmm2, %%xmm3, %%xmm4, %%xmm5, %%xmm0, %%xmm1, 14*48)
  1704. QPEL_H264HV_XMM(%%xmm3, %%xmm4, %%xmm5, %%xmm0, %%xmm1, %%xmm2, 15*48)
  1705. : "+a"(src)
  1706. : "c"(tmp), "S"((x86_reg)srcStride), "m"(ff_pw_5), "m"(ff_pw_16)
  1707. : "memory"
  1708. );
  1709. }
  1710. tmp += 8;
  1711. src += 8 - (size+5)*srcStride;
  1712. }
  1713. }
  1714. #define QPEL_H264_HV2_XMM(OPNAME, OP, MMX)\
  1715. static av_always_inline void OPNAME ## h264_qpel8or16_hv2_lowpass_ ## MMX(uint8_t *dst, int16_t *tmp, int dstStride, int tmpStride, int size){\
  1716. int h = size;\
  1717. if(size == 16){\
  1718. __asm__ volatile(\
  1719. "1: \n\t"\
  1720. "movdqa 32(%0), %%xmm4 \n\t"\
  1721. "movdqa 16(%0), %%xmm5 \n\t"\
  1722. "movdqa (%0), %%xmm7 \n\t"\
  1723. "movdqa %%xmm4, %%xmm3 \n\t"\
  1724. "movdqa %%xmm4, %%xmm2 \n\t"\
  1725. "movdqa %%xmm4, %%xmm1 \n\t"\
  1726. "movdqa %%xmm4, %%xmm0 \n\t"\
  1727. "palignr $10, %%xmm5, %%xmm0 \n\t"\
  1728. "palignr $8, %%xmm5, %%xmm1 \n\t"\
  1729. "palignr $6, %%xmm5, %%xmm2 \n\t"\
  1730. "palignr $4, %%xmm5, %%xmm3 \n\t"\
  1731. "palignr $2, %%xmm5, %%xmm4 \n\t"\
  1732. "paddw %%xmm5, %%xmm0 \n\t"\
  1733. "paddw %%xmm4, %%xmm1 \n\t"\
  1734. "paddw %%xmm3, %%xmm2 \n\t"\
  1735. "movdqa %%xmm5, %%xmm6 \n\t"\
  1736. "movdqa %%xmm5, %%xmm4 \n\t"\
  1737. "movdqa %%xmm5, %%xmm3 \n\t"\
  1738. "palignr $8, %%xmm7, %%xmm4 \n\t"\
  1739. "palignr $2, %%xmm7, %%xmm6 \n\t"\
  1740. "palignr $10, %%xmm7, %%xmm3 \n\t"\
  1741. "paddw %%xmm6, %%xmm4 \n\t"\
  1742. "movdqa %%xmm5, %%xmm6 \n\t"\
  1743. "palignr $6, %%xmm7, %%xmm5 \n\t"\
  1744. "palignr $4, %%xmm7, %%xmm6 \n\t"\
  1745. "paddw %%xmm7, %%xmm3 \n\t"\
  1746. "paddw %%xmm6, %%xmm5 \n\t"\
  1747. \
  1748. "psubw %%xmm1, %%xmm0 \n\t"\
  1749. "psubw %%xmm4, %%xmm3 \n\t"\
  1750. "psraw $2, %%xmm0 \n\t"\
  1751. "psraw $2, %%xmm3 \n\t"\
  1752. "psubw %%xmm1, %%xmm0 \n\t"\
  1753. "psubw %%xmm4, %%xmm3 \n\t"\
  1754. "paddw %%xmm2, %%xmm0 \n\t"\
  1755. "paddw %%xmm5, %%xmm3 \n\t"\
  1756. "psraw $2, %%xmm0 \n\t"\
  1757. "psraw $2, %%xmm3 \n\t"\
  1758. "paddw %%xmm2, %%xmm0 \n\t"\
  1759. "paddw %%xmm5, %%xmm3 \n\t"\
  1760. "psraw $6, %%xmm0 \n\t"\
  1761. "psraw $6, %%xmm3 \n\t"\
  1762. "packuswb %%xmm0, %%xmm3 \n\t"\
  1763. OP(%%xmm3, (%1), %%xmm7, dqa)\
  1764. "add $48, %0 \n\t"\
  1765. "add %3, %1 \n\t"\
  1766. "decl %2 \n\t"\
  1767. " jnz 1b \n\t"\
  1768. : "+a"(tmp), "+c"(dst), "+g"(h)\
  1769. : "S"((x86_reg)dstStride)\
  1770. : "memory"\
  1771. );\
  1772. }else{\
  1773. __asm__ volatile(\
  1774. "1: \n\t"\
  1775. "movdqa 16(%0), %%xmm1 \n\t"\
  1776. "movdqa (%0), %%xmm0 \n\t"\
  1777. "movdqa %%xmm1, %%xmm2 \n\t"\
  1778. "movdqa %%xmm1, %%xmm3 \n\t"\
  1779. "movdqa %%xmm1, %%xmm4 \n\t"\
  1780. "movdqa %%xmm1, %%xmm5 \n\t"\
  1781. "palignr $10, %%xmm0, %%xmm5 \n\t"\
  1782. "palignr $8, %%xmm0, %%xmm4 \n\t"\
  1783. "palignr $6, %%xmm0, %%xmm3 \n\t"\
  1784. "palignr $4, %%xmm0, %%xmm2 \n\t"\
  1785. "palignr $2, %%xmm0, %%xmm1 \n\t"\
  1786. "paddw %%xmm5, %%xmm0 \n\t"\
  1787. "paddw %%xmm4, %%xmm1 \n\t"\
  1788. "paddw %%xmm3, %%xmm2 \n\t"\
  1789. "psubw %%xmm1, %%xmm0 \n\t"\
  1790. "psraw $2, %%xmm0 \n\t"\
  1791. "psubw %%xmm1, %%xmm0 \n\t"\
  1792. "paddw %%xmm2, %%xmm0 \n\t"\
  1793. "psraw $2, %%xmm0 \n\t"\
  1794. "paddw %%xmm2, %%xmm0 \n\t"\
  1795. "psraw $6, %%xmm0 \n\t"\
  1796. "packuswb %%xmm0, %%xmm0 \n\t"\
  1797. OP(%%xmm0, (%1), %%xmm7, q)\
  1798. "add $48, %0 \n\t"\
  1799. "add %3, %1 \n\t"\
  1800. "decl %2 \n\t"\
  1801. " jnz 1b \n\t"\
  1802. : "+a"(tmp), "+c"(dst), "+g"(h)\
  1803. : "S"((x86_reg)dstStride)\
  1804. : "memory"\
  1805. );\
  1806. }\
  1807. }
  1808. #define QPEL_H264_HV_XMM(OPNAME, OP, MMX)\
  1809. 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){\
  1810. put_h264_qpel8or16_hv1_lowpass_sse2(tmp, src, tmpStride, srcStride, size);\
  1811. OPNAME ## h264_qpel8or16_hv2_lowpass_ ## MMX(dst, tmp, dstStride, tmpStride, size);\
  1812. }\
  1813. static void OPNAME ## h264_qpel8_hv_lowpass_ ## MMX(uint8_t *dst, int16_t *tmp, uint8_t *src, int dstStride, int tmpStride, int srcStride){\
  1814. OPNAME ## h264_qpel8or16_hv_lowpass_ ## MMX(dst, tmp, src, dstStride, tmpStride, srcStride, 8);\
  1815. }\
  1816. static void OPNAME ## h264_qpel16_hv_lowpass_ ## MMX(uint8_t *dst, int16_t *tmp, uint8_t *src, int dstStride, int tmpStride, int srcStride){\
  1817. OPNAME ## h264_qpel8or16_hv_lowpass_ ## MMX(dst, tmp, src, dstStride, tmpStride, srcStride, 16);\
  1818. }\
  1819. #define put_pixels8_l2_sse2 put_pixels8_l2_mmx2
  1820. #define avg_pixels8_l2_sse2 avg_pixels8_l2_mmx2
  1821. #define put_pixels16_l2_sse2 put_pixels16_l2_mmx2
  1822. #define avg_pixels16_l2_sse2 avg_pixels16_l2_mmx2
  1823. #define put_pixels8_l2_ssse3 put_pixels8_l2_mmx2
  1824. #define avg_pixels8_l2_ssse3 avg_pixels8_l2_mmx2
  1825. #define put_pixels16_l2_ssse3 put_pixels16_l2_mmx2
  1826. #define avg_pixels16_l2_ssse3 avg_pixels16_l2_mmx2
  1827. #define put_pixels8_l2_shift5_sse2 put_pixels8_l2_shift5_mmx2
  1828. #define avg_pixels8_l2_shift5_sse2 avg_pixels8_l2_shift5_mmx2
  1829. #define put_pixels16_l2_shift5_sse2 put_pixels16_l2_shift5_mmx2
  1830. #define avg_pixels16_l2_shift5_sse2 avg_pixels16_l2_shift5_mmx2
  1831. #define put_pixels8_l2_shift5_ssse3 put_pixels8_l2_shift5_mmx2
  1832. #define avg_pixels8_l2_shift5_ssse3 avg_pixels8_l2_shift5_mmx2
  1833. #define put_pixels16_l2_shift5_ssse3 put_pixels16_l2_shift5_mmx2
  1834. #define avg_pixels16_l2_shift5_ssse3 avg_pixels16_l2_shift5_mmx2
  1835. #define put_h264_qpel8_h_lowpass_l2_sse2 put_h264_qpel8_h_lowpass_l2_mmx2
  1836. #define avg_h264_qpel8_h_lowpass_l2_sse2 avg_h264_qpel8_h_lowpass_l2_mmx2
  1837. #define put_h264_qpel16_h_lowpass_l2_sse2 put_h264_qpel16_h_lowpass_l2_mmx2
  1838. #define avg_h264_qpel16_h_lowpass_l2_sse2 avg_h264_qpel16_h_lowpass_l2_mmx2
  1839. #define put_h264_qpel8_v_lowpass_ssse3 put_h264_qpel8_v_lowpass_sse2
  1840. #define avg_h264_qpel8_v_lowpass_ssse3 avg_h264_qpel8_v_lowpass_sse2
  1841. #define put_h264_qpel16_v_lowpass_ssse3 put_h264_qpel16_v_lowpass_sse2
  1842. #define avg_h264_qpel16_v_lowpass_ssse3 avg_h264_qpel16_v_lowpass_sse2
  1843. #define put_h264_qpel8or16_hv2_lowpass_sse2 put_h264_qpel8or16_hv2_lowpass_mmx2
  1844. #define avg_h264_qpel8or16_hv2_lowpass_sse2 avg_h264_qpel8or16_hv2_lowpass_mmx2
  1845. #define H264_MC(OPNAME, SIZE, MMX, ALIGN) \
  1846. H264_MC_C(OPNAME, SIZE, MMX, ALIGN)\
  1847. H264_MC_V(OPNAME, SIZE, MMX, ALIGN)\
  1848. H264_MC_H(OPNAME, SIZE, MMX, ALIGN)\
  1849. H264_MC_HV(OPNAME, SIZE, MMX, ALIGN)\
  1850. static void put_h264_qpel16_mc00_sse2 (uint8_t *dst, uint8_t *src, int stride){
  1851. put_pixels16_sse2(dst, src, stride, 16);
  1852. }
  1853. static void avg_h264_qpel16_mc00_sse2 (uint8_t *dst, uint8_t *src, int stride){
  1854. avg_pixels16_sse2(dst, src, stride, 16);
  1855. }
  1856. #define put_h264_qpel8_mc00_sse2 put_h264_qpel8_mc00_mmx2
  1857. #define avg_h264_qpel8_mc00_sse2 avg_h264_qpel8_mc00_mmx2
  1858. #define H264_MC_C(OPNAME, SIZE, MMX, ALIGN) \
  1859. static void OPNAME ## h264_qpel ## SIZE ## _mc00_ ## MMX (uint8_t *dst, uint8_t *src, int stride){\
  1860. OPNAME ## pixels ## SIZE ## _ ## MMX(dst, src, stride, SIZE);\
  1861. }\
  1862. #define H264_MC_H(OPNAME, SIZE, MMX, ALIGN) \
  1863. static void OPNAME ## h264_qpel ## SIZE ## _mc10_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  1864. OPNAME ## h264_qpel ## SIZE ## _h_lowpass_l2_ ## MMX(dst, src, src, stride, stride);\
  1865. }\
  1866. \
  1867. static void OPNAME ## h264_qpel ## SIZE ## _mc20_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  1868. OPNAME ## h264_qpel ## SIZE ## _h_lowpass_ ## MMX(dst, src, stride, stride);\
  1869. }\
  1870. \
  1871. static void OPNAME ## h264_qpel ## SIZE ## _mc30_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  1872. OPNAME ## h264_qpel ## SIZE ## _h_lowpass_l2_ ## MMX(dst, src, src+1, stride, stride);\
  1873. }\
  1874. #define H264_MC_V(OPNAME, SIZE, MMX, ALIGN) \
  1875. static void OPNAME ## h264_qpel ## SIZE ## _mc01_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  1876. DECLARE_ALIGNED(ALIGN, uint8_t, temp)[SIZE*SIZE];\
  1877. put_h264_qpel ## SIZE ## _v_lowpass_ ## MMX(temp, src, SIZE, stride);\
  1878. OPNAME ## pixels ## SIZE ## _l2_ ## MMX(dst, src, temp, stride, stride, SIZE);\
  1879. }\
  1880. \
  1881. static void OPNAME ## h264_qpel ## SIZE ## _mc02_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  1882. OPNAME ## h264_qpel ## SIZE ## _v_lowpass_ ## MMX(dst, src, stride, stride);\
  1883. }\
  1884. \
  1885. static void OPNAME ## h264_qpel ## SIZE ## _mc03_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  1886. DECLARE_ALIGNED(ALIGN, uint8_t, temp)[SIZE*SIZE];\
  1887. put_h264_qpel ## SIZE ## _v_lowpass_ ## MMX(temp, src, SIZE, stride);\
  1888. OPNAME ## pixels ## SIZE ## _l2_ ## MMX(dst, src+stride, temp, stride, stride, SIZE);\
  1889. }\
  1890. #define H264_MC_HV(OPNAME, SIZE, MMX, ALIGN) \
  1891. static void OPNAME ## h264_qpel ## SIZE ## _mc11_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  1892. DECLARE_ALIGNED(ALIGN, uint8_t, temp)[SIZE*SIZE];\
  1893. put_h264_qpel ## SIZE ## _v_lowpass_ ## MMX(temp, src, SIZE, stride);\
  1894. OPNAME ## h264_qpel ## SIZE ## _h_lowpass_l2_ ## MMX(dst, src, temp, stride, SIZE);\
  1895. }\
  1896. \
  1897. static void OPNAME ## h264_qpel ## SIZE ## _mc31_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  1898. DECLARE_ALIGNED(ALIGN, uint8_t, temp)[SIZE*SIZE];\
  1899. put_h264_qpel ## SIZE ## _v_lowpass_ ## MMX(temp, src+1, SIZE, stride);\
  1900. OPNAME ## h264_qpel ## SIZE ## _h_lowpass_l2_ ## MMX(dst, src, temp, stride, SIZE);\
  1901. }\
  1902. \
  1903. static void OPNAME ## h264_qpel ## SIZE ## _mc13_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  1904. DECLARE_ALIGNED(ALIGN, uint8_t, temp)[SIZE*SIZE];\
  1905. put_h264_qpel ## SIZE ## _v_lowpass_ ## MMX(temp, src, SIZE, stride);\
  1906. OPNAME ## h264_qpel ## SIZE ## _h_lowpass_l2_ ## MMX(dst, src+stride, temp, stride, SIZE);\
  1907. }\
  1908. \
  1909. static void OPNAME ## h264_qpel ## SIZE ## _mc33_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  1910. DECLARE_ALIGNED(ALIGN, uint8_t, temp)[SIZE*SIZE];\
  1911. put_h264_qpel ## SIZE ## _v_lowpass_ ## MMX(temp, src+1, SIZE, stride);\
  1912. OPNAME ## h264_qpel ## SIZE ## _h_lowpass_l2_ ## MMX(dst, src+stride, temp, stride, SIZE);\
  1913. }\
  1914. \
  1915. static void OPNAME ## h264_qpel ## SIZE ## _mc22_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  1916. DECLARE_ALIGNED(ALIGN, uint16_t, temp)[SIZE*(SIZE<8?12:24)];\
  1917. OPNAME ## h264_qpel ## SIZE ## _hv_lowpass_ ## MMX(dst, temp, src, stride, SIZE, stride);\
  1918. }\
  1919. \
  1920. static void OPNAME ## h264_qpel ## SIZE ## _mc21_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  1921. DECLARE_ALIGNED(ALIGN, uint8_t, temp)[SIZE*(SIZE<8?12:24)*2 + SIZE*SIZE];\
  1922. uint8_t * const halfHV= temp;\
  1923. int16_t * const halfV= (int16_t*)(temp + SIZE*SIZE);\
  1924. assert(((int)temp & 7) == 0);\
  1925. put_h264_qpel ## SIZE ## _hv_lowpass_ ## MMX(halfHV, halfV, src, SIZE, SIZE, stride);\
  1926. OPNAME ## h264_qpel ## SIZE ## _h_lowpass_l2_ ## MMX(dst, src, halfHV, stride, SIZE);\
  1927. }\
  1928. \
  1929. static void OPNAME ## h264_qpel ## SIZE ## _mc23_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  1930. DECLARE_ALIGNED(ALIGN, uint8_t, temp)[SIZE*(SIZE<8?12:24)*2 + SIZE*SIZE];\
  1931. uint8_t * const halfHV= temp;\
  1932. int16_t * const halfV= (int16_t*)(temp + SIZE*SIZE);\
  1933. assert(((int)temp & 7) == 0);\
  1934. put_h264_qpel ## SIZE ## _hv_lowpass_ ## MMX(halfHV, halfV, src, SIZE, SIZE, stride);\
  1935. OPNAME ## h264_qpel ## SIZE ## _h_lowpass_l2_ ## MMX(dst, src+stride, halfHV, stride, SIZE);\
  1936. }\
  1937. \
  1938. static void OPNAME ## h264_qpel ## SIZE ## _mc12_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  1939. DECLARE_ALIGNED(ALIGN, uint8_t, temp)[SIZE*(SIZE<8?12:24)*2 + SIZE*SIZE];\
  1940. uint8_t * const halfHV= temp;\
  1941. int16_t * const halfV= (int16_t*)(temp + SIZE*SIZE);\
  1942. assert(((int)temp & 7) == 0);\
  1943. put_h264_qpel ## SIZE ## _hv_lowpass_ ## MMX(halfHV, halfV, src, SIZE, SIZE, stride);\
  1944. OPNAME ## pixels ## SIZE ## _l2_shift5_ ## MMX(dst, halfV+2, halfHV, stride, SIZE, SIZE);\
  1945. }\
  1946. \
  1947. static void OPNAME ## h264_qpel ## SIZE ## _mc32_ ## MMX(uint8_t *dst, uint8_t *src, int stride){\
  1948. DECLARE_ALIGNED(ALIGN, uint8_t, temp)[SIZE*(SIZE<8?12:24)*2 + SIZE*SIZE];\
  1949. uint8_t * const halfHV= temp;\
  1950. int16_t * const halfV= (int16_t*)(temp + SIZE*SIZE);\
  1951. assert(((int)temp & 7) == 0);\
  1952. put_h264_qpel ## SIZE ## _hv_lowpass_ ## MMX(halfHV, halfV, src, SIZE, SIZE, stride);\
  1953. OPNAME ## pixels ## SIZE ## _l2_shift5_ ## MMX(dst, halfV+3, halfHV, stride, SIZE, SIZE);\
  1954. }\
  1955. #define H264_MC_4816(MMX)\
  1956. H264_MC(put_, 4, MMX, 8)\
  1957. H264_MC(put_, 8, MMX, 8)\
  1958. H264_MC(put_, 16,MMX, 8)\
  1959. H264_MC(avg_, 4, MMX, 8)\
  1960. H264_MC(avg_, 8, MMX, 8)\
  1961. H264_MC(avg_, 16,MMX, 8)\
  1962. #define H264_MC_816(QPEL, XMM)\
  1963. QPEL(put_, 8, XMM, 16)\
  1964. QPEL(put_, 16,XMM, 16)\
  1965. QPEL(avg_, 8, XMM, 16)\
  1966. QPEL(avg_, 16,XMM, 16)\
  1967. #define AVG_3DNOW_OP(a,b,temp, size) \
  1968. "mov" #size " " #b ", " #temp " \n\t"\
  1969. "pavgusb " #temp ", " #a " \n\t"\
  1970. "mov" #size " " #a ", " #b " \n\t"
  1971. #define AVG_MMX2_OP(a,b,temp, size) \
  1972. "mov" #size " " #b ", " #temp " \n\t"\
  1973. "pavgb " #temp ", " #a " \n\t"\
  1974. "mov" #size " " #a ", " #b " \n\t"
  1975. #define PAVGB "pavgusb"
  1976. QPEL_H264(put_, PUT_OP, 3dnow)
  1977. QPEL_H264(avg_, AVG_3DNOW_OP, 3dnow)
  1978. #undef PAVGB
  1979. #define PAVGB "pavgb"
  1980. QPEL_H264(put_, PUT_OP, mmx2)
  1981. QPEL_H264(avg_, AVG_MMX2_OP, mmx2)
  1982. QPEL_H264_V_XMM(put_, PUT_OP, sse2)
  1983. QPEL_H264_V_XMM(avg_, AVG_MMX2_OP, sse2)
  1984. QPEL_H264_HV_XMM(put_, PUT_OP, sse2)
  1985. QPEL_H264_HV_XMM(avg_, AVG_MMX2_OP, sse2)
  1986. #if HAVE_SSSE3
  1987. QPEL_H264_H_XMM(put_, PUT_OP, ssse3)
  1988. QPEL_H264_H_XMM(avg_, AVG_MMX2_OP, ssse3)
  1989. QPEL_H264_HV2_XMM(put_, PUT_OP, ssse3)
  1990. QPEL_H264_HV2_XMM(avg_, AVG_MMX2_OP, ssse3)
  1991. QPEL_H264_HV_XMM(put_, PUT_OP, ssse3)
  1992. QPEL_H264_HV_XMM(avg_, AVG_MMX2_OP, ssse3)
  1993. #endif
  1994. #undef PAVGB
  1995. H264_MC_4816(3dnow)
  1996. H264_MC_4816(mmx2)
  1997. H264_MC_816(H264_MC_V, sse2)
  1998. H264_MC_816(H264_MC_HV, sse2)
  1999. #if HAVE_SSSE3
  2000. H264_MC_816(H264_MC_H, ssse3)
  2001. H264_MC_816(H264_MC_HV, ssse3)
  2002. #endif
  2003. /* rnd interleaved with rnd div 8, use p+1 to access rnd div 8 */
  2004. DECLARE_ALIGNED(8, static const uint64_t, h264_rnd_reg)[4] = {
  2005. 0x0020002000200020ULL, 0x0004000400040004ULL, 0x001C001C001C001CULL, 0x0003000300030003ULL
  2006. };
  2007. #define H264_CHROMA_OP(S,D)
  2008. #define H264_CHROMA_OP4(S,D,T)
  2009. #define H264_CHROMA_MC8_TMPL put_h264_chroma_generic_mc8_mmx
  2010. #define H264_CHROMA_MC4_TMPL put_h264_chroma_generic_mc4_mmx
  2011. #define H264_CHROMA_MC2_TMPL put_h264_chroma_mc2_mmx2
  2012. #define H264_CHROMA_MC8_MV0 put_pixels8_mmx
  2013. #include "dsputil_h264_template_mmx.c"
  2014. 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)
  2015. {
  2016. put_h264_chroma_generic_mc8_mmx(dst, src, stride, h, x, y, h264_rnd_reg);
  2017. }
  2018. static void put_vc1_chroma_mc8_mmx_nornd(uint8_t *dst/*align 8*/, uint8_t *src/*align 1*/, int stride, int h, int x, int y)
  2019. {
  2020. put_h264_chroma_generic_mc8_mmx(dst, src, stride, h, x, y, h264_rnd_reg+2);
  2021. }
  2022. static void put_h264_chroma_mc4_mmx(uint8_t *dst/*align 8*/, uint8_t *src/*align 1*/, int stride, int h, int x, int y)
  2023. {
  2024. put_h264_chroma_generic_mc4_mmx(dst, src, stride, h, x, y, h264_rnd_reg);
  2025. }
  2026. #undef H264_CHROMA_OP
  2027. #undef H264_CHROMA_OP4
  2028. #undef H264_CHROMA_MC8_TMPL
  2029. #undef H264_CHROMA_MC4_TMPL
  2030. #undef H264_CHROMA_MC2_TMPL
  2031. #undef H264_CHROMA_MC8_MV0
  2032. #define H264_CHROMA_OP(S,D) "pavgb " #S ", " #D " \n\t"
  2033. #define H264_CHROMA_OP4(S,D,T) "movd " #S ", " #T " \n\t"\
  2034. "pavgb " #T ", " #D " \n\t"
  2035. #define H264_CHROMA_MC8_TMPL avg_h264_chroma_generic_mc8_mmx2
  2036. #define H264_CHROMA_MC4_TMPL avg_h264_chroma_generic_mc4_mmx2
  2037. #define H264_CHROMA_MC2_TMPL avg_h264_chroma_mc2_mmx2
  2038. #define H264_CHROMA_MC8_MV0 avg_pixels8_mmx2
  2039. #include "dsputil_h264_template_mmx.c"
  2040. 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)
  2041. {
  2042. avg_h264_chroma_generic_mc8_mmx2(dst, src, stride, h, x, y, h264_rnd_reg);
  2043. }
  2044. static void avg_vc1_chroma_mc8_mmx2_nornd(uint8_t *dst/*align 8*/, uint8_t *src/*align 1*/, int stride, int h, int x, int y)
  2045. {
  2046. avg_h264_chroma_generic_mc8_mmx2(dst, src, stride, h, x, y, h264_rnd_reg+2);
  2047. }
  2048. static void avg_h264_chroma_mc4_mmx2(uint8_t *dst/*align 8*/, uint8_t *src/*align 1*/, int stride, int h, int x, int y)
  2049. {
  2050. avg_h264_chroma_generic_mc4_mmx2(dst, src, stride, h, x, y, h264_rnd_reg);
  2051. }
  2052. #undef H264_CHROMA_OP
  2053. #undef H264_CHROMA_OP4
  2054. #undef H264_CHROMA_MC8_TMPL
  2055. #undef H264_CHROMA_MC4_TMPL
  2056. #undef H264_CHROMA_MC2_TMPL
  2057. #undef H264_CHROMA_MC8_MV0
  2058. #define H264_CHROMA_OP(S,D) "pavgusb " #S ", " #D " \n\t"
  2059. #define H264_CHROMA_OP4(S,D,T) "movd " #S ", " #T " \n\t"\
  2060. "pavgusb " #T ", " #D " \n\t"
  2061. #define H264_CHROMA_MC8_TMPL avg_h264_chroma_generic_mc8_3dnow
  2062. #define H264_CHROMA_MC4_TMPL avg_h264_chroma_generic_mc4_3dnow
  2063. #define H264_CHROMA_MC8_MV0 avg_pixels8_3dnow
  2064. #include "dsputil_h264_template_mmx.c"
  2065. 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)
  2066. {
  2067. avg_h264_chroma_generic_mc8_3dnow(dst, src, stride, h, x, y, h264_rnd_reg);
  2068. }
  2069. static void avg_h264_chroma_mc4_3dnow(uint8_t *dst/*align 8*/, uint8_t *src/*align 1*/, int stride, int h, int x, int y)
  2070. {
  2071. avg_h264_chroma_generic_mc4_3dnow(dst, src, stride, h, x, y, h264_rnd_reg);
  2072. }
  2073. #undef H264_CHROMA_OP
  2074. #undef H264_CHROMA_OP4
  2075. #undef H264_CHROMA_MC8_TMPL
  2076. #undef H264_CHROMA_MC4_TMPL
  2077. #undef H264_CHROMA_MC8_MV0
  2078. #if HAVE_SSSE3
  2079. #define AVG_OP(X)
  2080. #undef H264_CHROMA_MC8_TMPL
  2081. #undef H264_CHROMA_MC4_TMPL
  2082. #define H264_CHROMA_MC8_TMPL put_h264_chroma_mc8_ssse3
  2083. #define H264_CHROMA_MC4_TMPL put_h264_chroma_mc4_ssse3
  2084. #define H264_CHROMA_MC8_MV0 put_pixels8_mmx
  2085. #include "dsputil_h264_template_ssse3.c"
  2086. static void put_h264_chroma_mc8_ssse3_rnd(uint8_t *dst/*align 8*/, uint8_t *src/*align 1*/, int stride, int h, int x, int y)
  2087. {
  2088. put_h264_chroma_mc8_ssse3(dst, src, stride, h, x, y, 1);
  2089. }
  2090. static void put_vc1_chroma_mc8_ssse3_nornd(uint8_t *dst/*align 8*/, uint8_t *src/*align 1*/, int stride, int h, int x, int y)
  2091. {
  2092. put_h264_chroma_mc8_ssse3(dst, src, stride, h, x, y, 0);
  2093. }
  2094. #undef AVG_OP
  2095. #undef H264_CHROMA_MC8_TMPL
  2096. #undef H264_CHROMA_MC4_TMPL
  2097. #undef H264_CHROMA_MC8_MV0
  2098. #define AVG_OP(X) X
  2099. #define H264_CHROMA_MC8_TMPL avg_h264_chroma_mc8_ssse3
  2100. #define H264_CHROMA_MC4_TMPL avg_h264_chroma_mc4_ssse3
  2101. #define H264_CHROMA_MC8_MV0 avg_pixels8_mmx2
  2102. #include "dsputil_h264_template_ssse3.c"
  2103. static void avg_h264_chroma_mc8_ssse3_rnd(uint8_t *dst/*align 8*/, uint8_t *src/*align 1*/, int stride, int h, int x, int y)
  2104. {
  2105. avg_h264_chroma_mc8_ssse3(dst, src, stride, h, x, y, 1);
  2106. }
  2107. static void avg_vc1_chroma_mc8_ssse3_nornd(uint8_t *dst/*align 8*/, uint8_t *src/*align 1*/, int stride, int h, int x, int y)
  2108. {
  2109. avg_h264_chroma_mc8_ssse3(dst, src, stride, h, x, y, 0);
  2110. }
  2111. #undef AVG_OP
  2112. #undef H264_CHROMA_MC8_TMPL
  2113. #undef H264_CHROMA_MC4_TMPL
  2114. #undef H264_CHROMA_MC8_MV0
  2115. #endif
  2116. /***********************************/
  2117. /* weighted prediction */
  2118. static inline void ff_h264_weight_WxH_mmx2(uint8_t *dst, int stride, int log2_denom, int weight, int offset, int w, int h)
  2119. {
  2120. int x, y;
  2121. offset <<= log2_denom;
  2122. offset += (1 << log2_denom) >> 1;
  2123. __asm__ volatile(
  2124. "movd %0, %%mm4 \n\t"
  2125. "movd %1, %%mm5 \n\t"
  2126. "movd %2, %%mm6 \n\t"
  2127. "pshufw $0, %%mm4, %%mm4 \n\t"
  2128. "pshufw $0, %%mm5, %%mm5 \n\t"
  2129. "pxor %%mm7, %%mm7 \n\t"
  2130. :: "g"(weight), "g"(offset), "g"(log2_denom)
  2131. );
  2132. for(y=0; y<h; y+=2){
  2133. for(x=0; x<w; x+=4){
  2134. __asm__ volatile(
  2135. "movd %0, %%mm0 \n\t"
  2136. "movd %1, %%mm1 \n\t"
  2137. "punpcklbw %%mm7, %%mm0 \n\t"
  2138. "punpcklbw %%mm7, %%mm1 \n\t"
  2139. "pmullw %%mm4, %%mm0 \n\t"
  2140. "pmullw %%mm4, %%mm1 \n\t"
  2141. "paddsw %%mm5, %%mm0 \n\t"
  2142. "paddsw %%mm5, %%mm1 \n\t"
  2143. "psraw %%mm6, %%mm0 \n\t"
  2144. "psraw %%mm6, %%mm1 \n\t"
  2145. "packuswb %%mm7, %%mm0 \n\t"
  2146. "packuswb %%mm7, %%mm1 \n\t"
  2147. "movd %%mm0, %0 \n\t"
  2148. "movd %%mm1, %1 \n\t"
  2149. : "+m"(*(uint32_t*)(dst+x)),
  2150. "+m"(*(uint32_t*)(dst+x+stride))
  2151. );
  2152. }
  2153. dst += 2*stride;
  2154. }
  2155. }
  2156. 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)
  2157. {
  2158. int x, y;
  2159. offset = ((offset + 1) | 1) << log2_denom;
  2160. __asm__ volatile(
  2161. "movd %0, %%mm3 \n\t"
  2162. "movd %1, %%mm4 \n\t"
  2163. "movd %2, %%mm5 \n\t"
  2164. "movd %3, %%mm6 \n\t"
  2165. "pshufw $0, %%mm3, %%mm3 \n\t"
  2166. "pshufw $0, %%mm4, %%mm4 \n\t"
  2167. "pshufw $0, %%mm5, %%mm5 \n\t"
  2168. "pxor %%mm7, %%mm7 \n\t"
  2169. :: "g"(weightd), "g"(weights), "g"(offset), "g"(log2_denom+1)
  2170. );
  2171. for(y=0; y<h; y++){
  2172. for(x=0; x<w; x+=4){
  2173. __asm__ volatile(
  2174. "movd %0, %%mm0 \n\t"
  2175. "movd %1, %%mm1 \n\t"
  2176. "punpcklbw %%mm7, %%mm0 \n\t"
  2177. "punpcklbw %%mm7, %%mm1 \n\t"
  2178. "pmullw %%mm3, %%mm0 \n\t"
  2179. "pmullw %%mm4, %%mm1 \n\t"
  2180. "paddsw %%mm1, %%mm0 \n\t"
  2181. "paddsw %%mm5, %%mm0 \n\t"
  2182. "psraw %%mm6, %%mm0 \n\t"
  2183. "packuswb %%mm0, %%mm0 \n\t"
  2184. "movd %%mm0, %0 \n\t"
  2185. : "+m"(*(uint32_t*)(dst+x))
  2186. : "m"(*(uint32_t*)(src+x))
  2187. );
  2188. }
  2189. src += stride;
  2190. dst += stride;
  2191. }
  2192. }
  2193. #define H264_WEIGHT(W,H) \
  2194. 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){ \
  2195. ff_h264_biweight_WxH_mmx2(dst, src, stride, log2_denom, weightd, weights, offset, W, H); \
  2196. } \
  2197. static void ff_h264_weight_ ## W ## x ## H ## _mmx2(uint8_t *dst, int stride, int log2_denom, int weight, int offset){ \
  2198. ff_h264_weight_WxH_mmx2(dst, stride, log2_denom, weight, offset, W, H); \
  2199. }
  2200. H264_WEIGHT(16,16)
  2201. H264_WEIGHT(16, 8)
  2202. H264_WEIGHT( 8,16)
  2203. H264_WEIGHT( 8, 8)
  2204. H264_WEIGHT( 8, 4)
  2205. H264_WEIGHT( 4, 8)
  2206. H264_WEIGHT( 4, 4)
  2207. H264_WEIGHT( 4, 2)