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.

3204 lines
133KB

  1. /*
  2. * Copyright (C) 2001-2003 Michael Niedermayer <michaelni@gmx.at>
  3. *
  4. * This file is part of FFmpeg.
  5. *
  6. * FFmpeg is free software; you can redistribute it and/or modify
  7. * it under the terms of the GNU General Public License as published by
  8. * the Free Software Foundation; either version 2 of the License, or
  9. * (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
  14. * GNU General Public License for more details.
  15. *
  16. * You should have received a copy of the GNU General Public License
  17. * 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. * The C code (not assembly, MMX, ...) of this file can be used
  21. * under the LGPL license.
  22. */
  23. #undef REAL_MOVNTQ
  24. #undef MOVNTQ
  25. #undef PAVGB
  26. #undef PREFETCH
  27. #undef PREFETCHW
  28. #undef EMMS
  29. #undef SFENCE
  30. #ifdef HAVE_3DNOW
  31. /* On K6 femms is faster than emms. On K7 femms is directly mapped on emms. */
  32. #define EMMS "femms"
  33. #else
  34. #define EMMS "emms"
  35. #endif
  36. #ifdef HAVE_3DNOW
  37. #define PREFETCH "prefetch"
  38. #define PREFETCHW "prefetchw"
  39. #elif defined (HAVE_MMX2)
  40. #define PREFETCH "prefetchnta"
  41. #define PREFETCHW "prefetcht0"
  42. #else
  43. #define PREFETCH " # nop"
  44. #define PREFETCHW " # nop"
  45. #endif
  46. #ifdef HAVE_MMX2
  47. #define SFENCE "sfence"
  48. #else
  49. #define SFENCE " # nop"
  50. #endif
  51. #ifdef HAVE_MMX2
  52. #define PAVGB(a,b) "pavgb " #a ", " #b " \n\t"
  53. #elif defined (HAVE_3DNOW)
  54. #define PAVGB(a,b) "pavgusb " #a ", " #b " \n\t"
  55. #endif
  56. #ifdef HAVE_MMX2
  57. #define REAL_MOVNTQ(a,b) "movntq " #a ", " #b " \n\t"
  58. #else
  59. #define REAL_MOVNTQ(a,b) "movq " #a ", " #b " \n\t"
  60. #endif
  61. #define MOVNTQ(a,b) REAL_MOVNTQ(a,b)
  62. #ifdef HAVE_ALTIVEC
  63. #include "swscale_altivec_template.c"
  64. #endif
  65. #define YSCALEYUV2YV12X(x, offset, dest, width) \
  66. asm volatile(\
  67. "xor %%"REG_a", %%"REG_a" \n\t"\
  68. "movq "VROUNDER_OFFSET"(%0), %%mm3 \n\t"\
  69. "movq %%mm3, %%mm4 \n\t"\
  70. "lea " offset "(%0), %%"REG_d" \n\t"\
  71. "mov (%%"REG_d"), %%"REG_S" \n\t"\
  72. ASMALIGN(4) /* FIXME Unroll? */\
  73. "1: \n\t"\
  74. "movq 8(%%"REG_d"), %%mm0 \n\t" /* filterCoeff */\
  75. "movq " x "(%%"REG_S", %%"REG_a", 2), %%mm2 \n\t" /* srcData */\
  76. "movq 8+" x "(%%"REG_S", %%"REG_a", 2), %%mm5 \n\t" /* srcData */\
  77. "add $16, %%"REG_d" \n\t"\
  78. "mov (%%"REG_d"), %%"REG_S" \n\t"\
  79. "test %%"REG_S", %%"REG_S" \n\t"\
  80. "pmulhw %%mm0, %%mm2 \n\t"\
  81. "pmulhw %%mm0, %%mm5 \n\t"\
  82. "paddw %%mm2, %%mm3 \n\t"\
  83. "paddw %%mm5, %%mm4 \n\t"\
  84. " jnz 1b \n\t"\
  85. "psraw $3, %%mm3 \n\t"\
  86. "psraw $3, %%mm4 \n\t"\
  87. "packuswb %%mm4, %%mm3 \n\t"\
  88. MOVNTQ(%%mm3, (%1, %%REGa))\
  89. "add $8, %%"REG_a" \n\t"\
  90. "cmp %2, %%"REG_a" \n\t"\
  91. "movq "VROUNDER_OFFSET"(%0), %%mm3 \n\t"\
  92. "movq %%mm3, %%mm4 \n\t"\
  93. "lea " offset "(%0), %%"REG_d" \n\t"\
  94. "mov (%%"REG_d"), %%"REG_S" \n\t"\
  95. "jb 1b \n\t"\
  96. :: "r" (&c->redDither),\
  97. "r" (dest), "g" (width)\
  98. : "%"REG_a, "%"REG_d, "%"REG_S\
  99. );
  100. #define YSCALEYUV2YV12X_ACCURATE(x, offset, dest, width) \
  101. asm volatile(\
  102. "lea " offset "(%0), %%"REG_d" \n\t"\
  103. "xor %%"REG_a", %%"REG_a" \n\t"\
  104. "pxor %%mm4, %%mm4 \n\t"\
  105. "pxor %%mm5, %%mm5 \n\t"\
  106. "pxor %%mm6, %%mm6 \n\t"\
  107. "pxor %%mm7, %%mm7 \n\t"\
  108. "mov (%%"REG_d"), %%"REG_S" \n\t"\
  109. ASMALIGN(4) \
  110. "1: \n\t"\
  111. "movq " x "(%%"REG_S", %%"REG_a", 2), %%mm0 \n\t" /* srcData */\
  112. "movq 8+" x "(%%"REG_S", %%"REG_a", 2), %%mm2 \n\t" /* srcData */\
  113. "mov "STR(APCK_PTR2)"(%%"REG_d"), %%"REG_S" \n\t"\
  114. "movq " x "(%%"REG_S", %%"REG_a", 2), %%mm1 \n\t" /* srcData */\
  115. "movq %%mm0, %%mm3 \n\t"\
  116. "punpcklwd %%mm1, %%mm0 \n\t"\
  117. "punpckhwd %%mm1, %%mm3 \n\t"\
  118. "movq "STR(APCK_COEF)"(%%"REG_d"), %%mm1 \n\t" /* filterCoeff */\
  119. "pmaddwd %%mm1, %%mm0 \n\t"\
  120. "pmaddwd %%mm1, %%mm3 \n\t"\
  121. "paddd %%mm0, %%mm4 \n\t"\
  122. "paddd %%mm3, %%mm5 \n\t"\
  123. "movq 8+" x "(%%"REG_S", %%"REG_a", 2), %%mm3 \n\t" /* srcData */\
  124. "mov "STR(APCK_SIZE)"(%%"REG_d"), %%"REG_S" \n\t"\
  125. "add $"STR(APCK_SIZE)", %%"REG_d" \n\t"\
  126. "test %%"REG_S", %%"REG_S" \n\t"\
  127. "movq %%mm2, %%mm0 \n\t"\
  128. "punpcklwd %%mm3, %%mm2 \n\t"\
  129. "punpckhwd %%mm3, %%mm0 \n\t"\
  130. "pmaddwd %%mm1, %%mm2 \n\t"\
  131. "pmaddwd %%mm1, %%mm0 \n\t"\
  132. "paddd %%mm2, %%mm6 \n\t"\
  133. "paddd %%mm0, %%mm7 \n\t"\
  134. " jnz 1b \n\t"\
  135. "psrad $16, %%mm4 \n\t"\
  136. "psrad $16, %%mm5 \n\t"\
  137. "psrad $16, %%mm6 \n\t"\
  138. "psrad $16, %%mm7 \n\t"\
  139. "movq "VROUNDER_OFFSET"(%0), %%mm0 \n\t"\
  140. "packssdw %%mm5, %%mm4 \n\t"\
  141. "packssdw %%mm7, %%mm6 \n\t"\
  142. "paddw %%mm0, %%mm4 \n\t"\
  143. "paddw %%mm0, %%mm6 \n\t"\
  144. "psraw $3, %%mm4 \n\t"\
  145. "psraw $3, %%mm6 \n\t"\
  146. "packuswb %%mm6, %%mm4 \n\t"\
  147. MOVNTQ(%%mm4, (%1, %%REGa))\
  148. "add $8, %%"REG_a" \n\t"\
  149. "cmp %2, %%"REG_a" \n\t"\
  150. "lea " offset "(%0), %%"REG_d" \n\t"\
  151. "pxor %%mm4, %%mm4 \n\t"\
  152. "pxor %%mm5, %%mm5 \n\t"\
  153. "pxor %%mm6, %%mm6 \n\t"\
  154. "pxor %%mm7, %%mm7 \n\t"\
  155. "mov (%%"REG_d"), %%"REG_S" \n\t"\
  156. "jb 1b \n\t"\
  157. :: "r" (&c->redDither),\
  158. "r" (dest), "g" (width)\
  159. : "%"REG_a, "%"REG_d, "%"REG_S\
  160. );
  161. #define YSCALEYUV2YV121 \
  162. "mov %2, %%"REG_a" \n\t"\
  163. ASMALIGN(4) /* FIXME Unroll? */\
  164. "1: \n\t"\
  165. "movq (%0, %%"REG_a", 2), %%mm0 \n\t"\
  166. "movq 8(%0, %%"REG_a", 2), %%mm1 \n\t"\
  167. "psraw $7, %%mm0 \n\t"\
  168. "psraw $7, %%mm1 \n\t"\
  169. "packuswb %%mm1, %%mm0 \n\t"\
  170. MOVNTQ(%%mm0, (%1, %%REGa))\
  171. "add $8, %%"REG_a" \n\t"\
  172. "jnc 1b \n\t"
  173. #define YSCALEYUV2YV121_ACCURATE \
  174. "mov %2, %%"REG_a" \n\t"\
  175. "pcmpeqw %%mm7, %%mm7 \n\t"\
  176. "psrlw $15, %%mm7 \n\t"\
  177. "psllw $6, %%mm7 \n\t"\
  178. ASMALIGN(4) /* FIXME Unroll? */\
  179. "1: \n\t"\
  180. "movq (%0, %%"REG_a", 2), %%mm0 \n\t"\
  181. "movq 8(%0, %%"REG_a", 2), %%mm1 \n\t"\
  182. "paddsw %%mm7, %%mm0 \n\t"\
  183. "paddsw %%mm7, %%mm1 \n\t"\
  184. "psraw $7, %%mm0 \n\t"\
  185. "psraw $7, %%mm1 \n\t"\
  186. "packuswb %%mm1, %%mm0 \n\t"\
  187. MOVNTQ(%%mm0, (%1, %%REGa))\
  188. "add $8, %%"REG_a" \n\t"\
  189. "jnc 1b \n\t"
  190. /*
  191. :: "m" (-lumFilterSize), "m" (-chrFilterSize),
  192. "m" (lumMmxFilter+lumFilterSize*4), "m" (chrMmxFilter+chrFilterSize*4),
  193. "r" (dest), "m" (dstW),
  194. "m" (lumSrc+lumFilterSize), "m" (chrSrc+chrFilterSize)
  195. : "%eax", "%ebx", "%ecx", "%edx", "%esi"
  196. */
  197. #define YSCALEYUV2PACKEDX \
  198. asm volatile(\
  199. "xor %%"REG_a", %%"REG_a" \n\t"\
  200. ASMALIGN(4)\
  201. "nop \n\t"\
  202. "1: \n\t"\
  203. "lea "CHR_MMX_FILTER_OFFSET"(%0), %%"REG_d" \n\t"\
  204. "mov (%%"REG_d"), %%"REG_S" \n\t"\
  205. "movq "VROUNDER_OFFSET"(%0), %%mm3 \n\t"\
  206. "movq %%mm3, %%mm4 \n\t"\
  207. ASMALIGN(4)\
  208. "2: \n\t"\
  209. "movq 8(%%"REG_d"), %%mm0 \n\t" /* filterCoeff */\
  210. "movq (%%"REG_S", %%"REG_a"), %%mm2 \n\t" /* UsrcData */\
  211. "movq "AV_STRINGIFY(VOF)"(%%"REG_S", %%"REG_a"), %%mm5 \n\t" /* VsrcData */\
  212. "add $16, %%"REG_d" \n\t"\
  213. "mov (%%"REG_d"), %%"REG_S" \n\t"\
  214. "pmulhw %%mm0, %%mm2 \n\t"\
  215. "pmulhw %%mm0, %%mm5 \n\t"\
  216. "paddw %%mm2, %%mm3 \n\t"\
  217. "paddw %%mm5, %%mm4 \n\t"\
  218. "test %%"REG_S", %%"REG_S" \n\t"\
  219. " jnz 2b \n\t"\
  220. \
  221. "lea "LUM_MMX_FILTER_OFFSET"(%0), %%"REG_d" \n\t"\
  222. "mov (%%"REG_d"), %%"REG_S" \n\t"\
  223. "movq "VROUNDER_OFFSET"(%0), %%mm1 \n\t"\
  224. "movq %%mm1, %%mm7 \n\t"\
  225. ASMALIGN(4)\
  226. "2: \n\t"\
  227. "movq 8(%%"REG_d"), %%mm0 \n\t" /* filterCoeff */\
  228. "movq (%%"REG_S", %%"REG_a", 2), %%mm2 \n\t" /* Y1srcData */\
  229. "movq 8(%%"REG_S", %%"REG_a", 2), %%mm5 \n\t" /* Y2srcData */\
  230. "add $16, %%"REG_d" \n\t"\
  231. "mov (%%"REG_d"), %%"REG_S" \n\t"\
  232. "pmulhw %%mm0, %%mm2 \n\t"\
  233. "pmulhw %%mm0, %%mm5 \n\t"\
  234. "paddw %%mm2, %%mm1 \n\t"\
  235. "paddw %%mm5, %%mm7 \n\t"\
  236. "test %%"REG_S", %%"REG_S" \n\t"\
  237. " jnz 2b \n\t"\
  238. #define YSCALEYUV2PACKEDX_END \
  239. :: "r" (&c->redDither), \
  240. "m" (dummy), "m" (dummy), "m" (dummy),\
  241. "r" (dest), "m" (dstW) \
  242. : "%"REG_a, "%"REG_d, "%"REG_S \
  243. );
  244. #define YSCALEYUV2PACKEDX_ACCURATE \
  245. asm volatile(\
  246. "xor %%"REG_a", %%"REG_a" \n\t"\
  247. ASMALIGN(4)\
  248. "nop \n\t"\
  249. "1: \n\t"\
  250. "lea "CHR_MMX_FILTER_OFFSET"(%0), %%"REG_d" \n\t"\
  251. "mov (%%"REG_d"), %%"REG_S" \n\t"\
  252. "pxor %%mm4, %%mm4 \n\t"\
  253. "pxor %%mm5, %%mm5 \n\t"\
  254. "pxor %%mm6, %%mm6 \n\t"\
  255. "pxor %%mm7, %%mm7 \n\t"\
  256. ASMALIGN(4)\
  257. "2: \n\t"\
  258. "movq (%%"REG_S", %%"REG_a"), %%mm0 \n\t" /* UsrcData */\
  259. "movq "AV_STRINGIFY(VOF)"(%%"REG_S", %%"REG_a"), %%mm2 \n\t" /* VsrcData */\
  260. "mov "STR(APCK_PTR2)"(%%"REG_d"), %%"REG_S" \n\t"\
  261. "movq (%%"REG_S", %%"REG_a"), %%mm1 \n\t" /* UsrcData */\
  262. "movq %%mm0, %%mm3 \n\t"\
  263. "punpcklwd %%mm1, %%mm0 \n\t"\
  264. "punpckhwd %%mm1, %%mm3 \n\t"\
  265. "movq "STR(APCK_COEF)"(%%"REG_d"),%%mm1 \n\t" /* filterCoeff */\
  266. "pmaddwd %%mm1, %%mm0 \n\t"\
  267. "pmaddwd %%mm1, %%mm3 \n\t"\
  268. "paddd %%mm0, %%mm4 \n\t"\
  269. "paddd %%mm3, %%mm5 \n\t"\
  270. "movq "AV_STRINGIFY(VOF)"(%%"REG_S", %%"REG_a"), %%mm3 \n\t" /* VsrcData */\
  271. "mov "STR(APCK_SIZE)"(%%"REG_d"), %%"REG_S" \n\t"\
  272. "add $"STR(APCK_SIZE)", %%"REG_d" \n\t"\
  273. "test %%"REG_S", %%"REG_S" \n\t"\
  274. "movq %%mm2, %%mm0 \n\t"\
  275. "punpcklwd %%mm3, %%mm2 \n\t"\
  276. "punpckhwd %%mm3, %%mm0 \n\t"\
  277. "pmaddwd %%mm1, %%mm2 \n\t"\
  278. "pmaddwd %%mm1, %%mm0 \n\t"\
  279. "paddd %%mm2, %%mm6 \n\t"\
  280. "paddd %%mm0, %%mm7 \n\t"\
  281. " jnz 2b \n\t"\
  282. "psrad $16, %%mm4 \n\t"\
  283. "psrad $16, %%mm5 \n\t"\
  284. "psrad $16, %%mm6 \n\t"\
  285. "psrad $16, %%mm7 \n\t"\
  286. "movq "VROUNDER_OFFSET"(%0), %%mm0 \n\t"\
  287. "packssdw %%mm5, %%mm4 \n\t"\
  288. "packssdw %%mm7, %%mm6 \n\t"\
  289. "paddw %%mm0, %%mm4 \n\t"\
  290. "paddw %%mm0, %%mm6 \n\t"\
  291. "movq %%mm4, "U_TEMP"(%0) \n\t"\
  292. "movq %%mm6, "V_TEMP"(%0) \n\t"\
  293. \
  294. "lea "LUM_MMX_FILTER_OFFSET"(%0), %%"REG_d" \n\t"\
  295. "mov (%%"REG_d"), %%"REG_S" \n\t"\
  296. "pxor %%mm1, %%mm1 \n\t"\
  297. "pxor %%mm5, %%mm5 \n\t"\
  298. "pxor %%mm7, %%mm7 \n\t"\
  299. "pxor %%mm6, %%mm6 \n\t"\
  300. ASMALIGN(4)\
  301. "2: \n\t"\
  302. "movq (%%"REG_S", %%"REG_a", 2), %%mm0 \n\t" /* Y1srcData */\
  303. "movq 8(%%"REG_S", %%"REG_a", 2), %%mm2 \n\t" /* Y2srcData */\
  304. "mov "STR(APCK_PTR2)"(%%"REG_d"), %%"REG_S" \n\t"\
  305. "movq (%%"REG_S", %%"REG_a", 2), %%mm4 \n\t" /* Y1srcData */\
  306. "movq %%mm0, %%mm3 \n\t"\
  307. "punpcklwd %%mm4, %%mm0 \n\t"\
  308. "punpckhwd %%mm4, %%mm3 \n\t"\
  309. "movq "STR(APCK_COEF)"(%%"REG_d"), %%mm4 \n\t" /* filterCoeff */\
  310. "pmaddwd %%mm4, %%mm0 \n\t"\
  311. "pmaddwd %%mm4, %%mm3 \n\t"\
  312. "paddd %%mm0, %%mm1 \n\t"\
  313. "paddd %%mm3, %%mm5 \n\t"\
  314. "movq 8(%%"REG_S", %%"REG_a", 2), %%mm3 \n\t" /* Y2srcData */\
  315. "mov "STR(APCK_SIZE)"(%%"REG_d"), %%"REG_S" \n\t"\
  316. "add $"STR(APCK_SIZE)", %%"REG_d" \n\t"\
  317. "test %%"REG_S", %%"REG_S" \n\t"\
  318. "movq %%mm2, %%mm0 \n\t"\
  319. "punpcklwd %%mm3, %%mm2 \n\t"\
  320. "punpckhwd %%mm3, %%mm0 \n\t"\
  321. "pmaddwd %%mm4, %%mm2 \n\t"\
  322. "pmaddwd %%mm4, %%mm0 \n\t"\
  323. "paddd %%mm2, %%mm7 \n\t"\
  324. "paddd %%mm0, %%mm6 \n\t"\
  325. " jnz 2b \n\t"\
  326. "psrad $16, %%mm1 \n\t"\
  327. "psrad $16, %%mm5 \n\t"\
  328. "psrad $16, %%mm7 \n\t"\
  329. "psrad $16, %%mm6 \n\t"\
  330. "movq "VROUNDER_OFFSET"(%0), %%mm0 \n\t"\
  331. "packssdw %%mm5, %%mm1 \n\t"\
  332. "packssdw %%mm6, %%mm7 \n\t"\
  333. "paddw %%mm0, %%mm1 \n\t"\
  334. "paddw %%mm0, %%mm7 \n\t"\
  335. "movq "U_TEMP"(%0), %%mm3 \n\t"\
  336. "movq "V_TEMP"(%0), %%mm4 \n\t"\
  337. #define YSCALEYUV2RGBX \
  338. "psubw "U_OFFSET"(%0), %%mm3 \n\t" /* (U-128)8*/\
  339. "psubw "V_OFFSET"(%0), %%mm4 \n\t" /* (V-128)8*/\
  340. "movq %%mm3, %%mm2 \n\t" /* (U-128)8*/\
  341. "movq %%mm4, %%mm5 \n\t" /* (V-128)8*/\
  342. "pmulhw "UG_COEFF"(%0), %%mm3 \n\t"\
  343. "pmulhw "VG_COEFF"(%0), %%mm4 \n\t"\
  344. /* mm2=(U-128)8, mm3=ug, mm4=vg mm5=(V-128)8 */\
  345. "pmulhw "UB_COEFF"(%0), %%mm2 \n\t"\
  346. "pmulhw "VR_COEFF"(%0), %%mm5 \n\t"\
  347. "psubw "Y_OFFSET"(%0), %%mm1 \n\t" /* 8(Y-16)*/\
  348. "psubw "Y_OFFSET"(%0), %%mm7 \n\t" /* 8(Y-16)*/\
  349. "pmulhw "Y_COEFF"(%0), %%mm1 \n\t"\
  350. "pmulhw "Y_COEFF"(%0), %%mm7 \n\t"\
  351. /* mm1= Y1, mm2=ub, mm3=ug, mm4=vg mm5=vr, mm7=Y2 */\
  352. "paddw %%mm3, %%mm4 \n\t"\
  353. "movq %%mm2, %%mm0 \n\t"\
  354. "movq %%mm5, %%mm6 \n\t"\
  355. "movq %%mm4, %%mm3 \n\t"\
  356. "punpcklwd %%mm2, %%mm2 \n\t"\
  357. "punpcklwd %%mm5, %%mm5 \n\t"\
  358. "punpcklwd %%mm4, %%mm4 \n\t"\
  359. "paddw %%mm1, %%mm2 \n\t"\
  360. "paddw %%mm1, %%mm5 \n\t"\
  361. "paddw %%mm1, %%mm4 \n\t"\
  362. "punpckhwd %%mm0, %%mm0 \n\t"\
  363. "punpckhwd %%mm6, %%mm6 \n\t"\
  364. "punpckhwd %%mm3, %%mm3 \n\t"\
  365. "paddw %%mm7, %%mm0 \n\t"\
  366. "paddw %%mm7, %%mm6 \n\t"\
  367. "paddw %%mm7, %%mm3 \n\t"\
  368. /* mm0=B1, mm2=B2, mm3=G2, mm4=G1, mm5=R1, mm6=R2 */\
  369. "packuswb %%mm0, %%mm2 \n\t"\
  370. "packuswb %%mm6, %%mm5 \n\t"\
  371. "packuswb %%mm3, %%mm4 \n\t"\
  372. "pxor %%mm7, %%mm7 \n\t"
  373. #if 0
  374. #define FULL_YSCALEYUV2RGB \
  375. "pxor %%mm7, %%mm7 \n\t"\
  376. "movd %6, %%mm6 \n\t" /*yalpha1*/\
  377. "punpcklwd %%mm6, %%mm6 \n\t"\
  378. "punpcklwd %%mm6, %%mm6 \n\t"\
  379. "movd %7, %%mm5 \n\t" /*uvalpha1*/\
  380. "punpcklwd %%mm5, %%mm5 \n\t"\
  381. "punpcklwd %%mm5, %%mm5 \n\t"\
  382. "xor %%"REG_a", %%"REG_a" \n\t"\
  383. ASMALIGN(4)\
  384. "1: \n\t"\
  385. "movq (%0, %%"REG_a",2), %%mm0 \n\t" /*buf0[eax]*/\
  386. "movq (%1, %%"REG_a",2), %%mm1 \n\t" /*buf1[eax]*/\
  387. "movq (%2, %%"REG_a",2), %%mm2 \n\t" /* uvbuf0[eax]*/\
  388. "movq (%3, %%"REG_a",2), %%mm3 \n\t" /* uvbuf1[eax]*/\
  389. "psubw %%mm1, %%mm0 \n\t" /* buf0[eax] - buf1[eax]*/\
  390. "psubw %%mm3, %%mm2 \n\t" /* uvbuf0[eax] - uvbuf1[eax]*/\
  391. "pmulhw %%mm6, %%mm0 \n\t" /* (buf0[eax] - buf1[eax])yalpha1>>16*/\
  392. "pmulhw %%mm5, %%mm2 \n\t" /* (uvbuf0[eax] - uvbuf1[eax])uvalpha1>>16*/\
  393. "psraw $4, %%mm1 \n\t" /* buf0[eax] - buf1[eax] >>4*/\
  394. "movq "AV_STRINGIFY(VOF)"(%2, %%"REG_a",2), %%mm4 \n\t" /* uvbuf0[eax+2048]*/\
  395. "psraw $4, %%mm3 \n\t" /* uvbuf0[eax] - uvbuf1[eax] >>4*/\
  396. "paddw %%mm0, %%mm1 \n\t" /* buf0[eax]yalpha1 + buf1[eax](1-yalpha1) >>16*/\
  397. "movq "AV_STRINGIFY(VOF)"(%3, %%"REG_a",2), %%mm0 \n\t" /* uvbuf1[eax+2048]*/\
  398. "paddw %%mm2, %%mm3 \n\t" /* uvbuf0[eax]uvalpha1 - uvbuf1[eax](1-uvalpha1)*/\
  399. "psubw %%mm0, %%mm4 \n\t" /* uvbuf0[eax+2048] - uvbuf1[eax+2048]*/\
  400. "psubw "MANGLE(w80)", %%mm1 \n\t" /* 8(Y-16)*/\
  401. "psubw "MANGLE(w400)", %%mm3 \n\t" /* 8(U-128)*/\
  402. "pmulhw "MANGLE(yCoeff)", %%mm1 \n\t"\
  403. \
  404. \
  405. "pmulhw %%mm5, %%mm4 \n\t" /* (uvbuf0[eax+2048] - uvbuf1[eax+2048])uvalpha1>>16*/\
  406. "movq %%mm3, %%mm2 \n\t" /* (U-128)8*/\
  407. "pmulhw "MANGLE(ubCoeff)", %%mm3 \n\t"\
  408. "psraw $4, %%mm0 \n\t" /* uvbuf0[eax+2048] - uvbuf1[eax+2048] >>4*/\
  409. "pmulhw "MANGLE(ugCoeff)", %%mm2 \n\t"\
  410. "paddw %%mm4, %%mm0 \n\t" /* uvbuf0[eax+2048]uvalpha1 - uvbuf1[eax+2048](1-uvalpha1)*/\
  411. "psubw "MANGLE(w400)", %%mm0 \n\t" /* (V-128)8*/\
  412. \
  413. \
  414. "movq %%mm0, %%mm4 \n\t" /* (V-128)8*/\
  415. "pmulhw "MANGLE(vrCoeff)", %%mm0 \n\t"\
  416. "pmulhw "MANGLE(vgCoeff)", %%mm4 \n\t"\
  417. "paddw %%mm1, %%mm3 \n\t" /* B*/\
  418. "paddw %%mm1, %%mm0 \n\t" /* R*/\
  419. "packuswb %%mm3, %%mm3 \n\t"\
  420. \
  421. "packuswb %%mm0, %%mm0 \n\t"\
  422. "paddw %%mm4, %%mm2 \n\t"\
  423. "paddw %%mm2, %%mm1 \n\t" /* G*/\
  424. \
  425. "packuswb %%mm1, %%mm1 \n\t"
  426. #endif
  427. #define REAL_YSCALEYUV2PACKED(index, c) \
  428. "movq "CHR_MMX_FILTER_OFFSET"+8("#c"), %%mm0 \n\t"\
  429. "movq "LUM_MMX_FILTER_OFFSET"+8("#c"), %%mm1 \n\t"\
  430. "psraw $3, %%mm0 \n\t"\
  431. "psraw $3, %%mm1 \n\t"\
  432. "movq %%mm0, "CHR_MMX_FILTER_OFFSET"+8("#c") \n\t"\
  433. "movq %%mm1, "LUM_MMX_FILTER_OFFSET"+8("#c") \n\t"\
  434. "xor "#index", "#index" \n\t"\
  435. ASMALIGN(4)\
  436. "1: \n\t"\
  437. "movq (%2, "#index"), %%mm2 \n\t" /* uvbuf0[eax]*/\
  438. "movq (%3, "#index"), %%mm3 \n\t" /* uvbuf1[eax]*/\
  439. "movq "AV_STRINGIFY(VOF)"(%2, "#index"), %%mm5 \n\t" /* uvbuf0[eax+2048]*/\
  440. "movq "AV_STRINGIFY(VOF)"(%3, "#index"), %%mm4 \n\t" /* uvbuf1[eax+2048]*/\
  441. "psubw %%mm3, %%mm2 \n\t" /* uvbuf0[eax] - uvbuf1[eax]*/\
  442. "psubw %%mm4, %%mm5 \n\t" /* uvbuf0[eax+2048] - uvbuf1[eax+2048]*/\
  443. "movq "CHR_MMX_FILTER_OFFSET"+8("#c"), %%mm0 \n\t"\
  444. "pmulhw %%mm0, %%mm2 \n\t" /* (uvbuf0[eax] - uvbuf1[eax])uvalpha1>>16*/\
  445. "pmulhw %%mm0, %%mm5 \n\t" /* (uvbuf0[eax+2048] - uvbuf1[eax+2048])uvalpha1>>16*/\
  446. "psraw $7, %%mm3 \n\t" /* uvbuf0[eax] - uvbuf1[eax] >>4*/\
  447. "psraw $7, %%mm4 \n\t" /* uvbuf0[eax+2048] - uvbuf1[eax+2048] >>4*/\
  448. "paddw %%mm2, %%mm3 \n\t" /* uvbuf0[eax]uvalpha1 - uvbuf1[eax](1-uvalpha1)*/\
  449. "paddw %%mm5, %%mm4 \n\t" /* uvbuf0[eax+2048]uvalpha1 - uvbuf1[eax+2048](1-uvalpha1)*/\
  450. "movq (%0, "#index", 2), %%mm0 \n\t" /*buf0[eax]*/\
  451. "movq (%1, "#index", 2), %%mm1 \n\t" /*buf1[eax]*/\
  452. "movq 8(%0, "#index", 2), %%mm6 \n\t" /*buf0[eax]*/\
  453. "movq 8(%1, "#index", 2), %%mm7 \n\t" /*buf1[eax]*/\
  454. "psubw %%mm1, %%mm0 \n\t" /* buf0[eax] - buf1[eax]*/\
  455. "psubw %%mm7, %%mm6 \n\t" /* buf0[eax] - buf1[eax]*/\
  456. "pmulhw "LUM_MMX_FILTER_OFFSET"+8("#c"), %%mm0 \n\t" /* (buf0[eax] - buf1[eax])yalpha1>>16*/\
  457. "pmulhw "LUM_MMX_FILTER_OFFSET"+8("#c"), %%mm6 \n\t" /* (buf0[eax] - buf1[eax])yalpha1>>16*/\
  458. "psraw $7, %%mm1 \n\t" /* buf0[eax] - buf1[eax] >>4*/\
  459. "psraw $7, %%mm7 \n\t" /* buf0[eax] - buf1[eax] >>4*/\
  460. "paddw %%mm0, %%mm1 \n\t" /* buf0[eax]yalpha1 + buf1[eax](1-yalpha1) >>16*/\
  461. "paddw %%mm6, %%mm7 \n\t" /* buf0[eax]yalpha1 + buf1[eax](1-yalpha1) >>16*/\
  462. #define YSCALEYUV2PACKED(index, c) REAL_YSCALEYUV2PACKED(index, c)
  463. #define REAL_YSCALEYUV2RGB(index, c) \
  464. "xor "#index", "#index" \n\t"\
  465. ASMALIGN(4)\
  466. "1: \n\t"\
  467. "movq (%2, "#index"), %%mm2 \n\t" /* uvbuf0[eax]*/\
  468. "movq (%3, "#index"), %%mm3 \n\t" /* uvbuf1[eax]*/\
  469. "movq "AV_STRINGIFY(VOF)"(%2, "#index"), %%mm5 \n\t" /* uvbuf0[eax+2048]*/\
  470. "movq "AV_STRINGIFY(VOF)"(%3, "#index"), %%mm4 \n\t" /* uvbuf1[eax+2048]*/\
  471. "psubw %%mm3, %%mm2 \n\t" /* uvbuf0[eax] - uvbuf1[eax]*/\
  472. "psubw %%mm4, %%mm5 \n\t" /* uvbuf0[eax+2048] - uvbuf1[eax+2048]*/\
  473. "movq "CHR_MMX_FILTER_OFFSET"+8("#c"), %%mm0 \n\t"\
  474. "pmulhw %%mm0, %%mm2 \n\t" /* (uvbuf0[eax] - uvbuf1[eax])uvalpha1>>16*/\
  475. "pmulhw %%mm0, %%mm5 \n\t" /* (uvbuf0[eax+2048] - uvbuf1[eax+2048])uvalpha1>>16*/\
  476. "psraw $4, %%mm3 \n\t" /* uvbuf0[eax] - uvbuf1[eax] >>4*/\
  477. "psraw $4, %%mm4 \n\t" /* uvbuf0[eax+2048] - uvbuf1[eax+2048] >>4*/\
  478. "paddw %%mm2, %%mm3 \n\t" /* uvbuf0[eax]uvalpha1 - uvbuf1[eax](1-uvalpha1)*/\
  479. "paddw %%mm5, %%mm4 \n\t" /* uvbuf0[eax+2048]uvalpha1 - uvbuf1[eax+2048](1-uvalpha1)*/\
  480. "psubw "U_OFFSET"("#c"), %%mm3 \n\t" /* (U-128)8*/\
  481. "psubw "V_OFFSET"("#c"), %%mm4 \n\t" /* (V-128)8*/\
  482. "movq %%mm3, %%mm2 \n\t" /* (U-128)8*/\
  483. "movq %%mm4, %%mm5 \n\t" /* (V-128)8*/\
  484. "pmulhw "UG_COEFF"("#c"), %%mm3 \n\t"\
  485. "pmulhw "VG_COEFF"("#c"), %%mm4 \n\t"\
  486. /* mm2=(U-128)8, mm3=ug, mm4=vg mm5=(V-128)8 */\
  487. "movq (%0, "#index", 2), %%mm0 \n\t" /*buf0[eax]*/\
  488. "movq (%1, "#index", 2), %%mm1 \n\t" /*buf1[eax]*/\
  489. "movq 8(%0, "#index", 2), %%mm6 \n\t" /*buf0[eax]*/\
  490. "movq 8(%1, "#index", 2), %%mm7 \n\t" /*buf1[eax]*/\
  491. "psubw %%mm1, %%mm0 \n\t" /* buf0[eax] - buf1[eax]*/\
  492. "psubw %%mm7, %%mm6 \n\t" /* buf0[eax] - buf1[eax]*/\
  493. "pmulhw "LUM_MMX_FILTER_OFFSET"+8("#c"), %%mm0 \n\t" /* (buf0[eax] - buf1[eax])yalpha1>>16*/\
  494. "pmulhw "LUM_MMX_FILTER_OFFSET"+8("#c"), %%mm6 \n\t" /* (buf0[eax] - buf1[eax])yalpha1>>16*/\
  495. "psraw $4, %%mm1 \n\t" /* buf0[eax] - buf1[eax] >>4*/\
  496. "psraw $4, %%mm7 \n\t" /* buf0[eax] - buf1[eax] >>4*/\
  497. "paddw %%mm0, %%mm1 \n\t" /* buf0[eax]yalpha1 + buf1[eax](1-yalpha1) >>16*/\
  498. "paddw %%mm6, %%mm7 \n\t" /* buf0[eax]yalpha1 + buf1[eax](1-yalpha1) >>16*/\
  499. "pmulhw "UB_COEFF"("#c"), %%mm2 \n\t"\
  500. "pmulhw "VR_COEFF"("#c"), %%mm5 \n\t"\
  501. "psubw "Y_OFFSET"("#c"), %%mm1 \n\t" /* 8(Y-16)*/\
  502. "psubw "Y_OFFSET"("#c"), %%mm7 \n\t" /* 8(Y-16)*/\
  503. "pmulhw "Y_COEFF"("#c"), %%mm1 \n\t"\
  504. "pmulhw "Y_COEFF"("#c"), %%mm7 \n\t"\
  505. /* mm1= Y1, mm2=ub, mm3=ug, mm4=vg mm5=vr, mm7=Y2 */\
  506. "paddw %%mm3, %%mm4 \n\t"\
  507. "movq %%mm2, %%mm0 \n\t"\
  508. "movq %%mm5, %%mm6 \n\t"\
  509. "movq %%mm4, %%mm3 \n\t"\
  510. "punpcklwd %%mm2, %%mm2 \n\t"\
  511. "punpcklwd %%mm5, %%mm5 \n\t"\
  512. "punpcklwd %%mm4, %%mm4 \n\t"\
  513. "paddw %%mm1, %%mm2 \n\t"\
  514. "paddw %%mm1, %%mm5 \n\t"\
  515. "paddw %%mm1, %%mm4 \n\t"\
  516. "punpckhwd %%mm0, %%mm0 \n\t"\
  517. "punpckhwd %%mm6, %%mm6 \n\t"\
  518. "punpckhwd %%mm3, %%mm3 \n\t"\
  519. "paddw %%mm7, %%mm0 \n\t"\
  520. "paddw %%mm7, %%mm6 \n\t"\
  521. "paddw %%mm7, %%mm3 \n\t"\
  522. /* mm0=B1, mm2=B2, mm3=G2, mm4=G1, mm5=R1, mm6=R2 */\
  523. "packuswb %%mm0, %%mm2 \n\t"\
  524. "packuswb %%mm6, %%mm5 \n\t"\
  525. "packuswb %%mm3, %%mm4 \n\t"\
  526. "pxor %%mm7, %%mm7 \n\t"
  527. #define YSCALEYUV2RGB(index, c) REAL_YSCALEYUV2RGB(index, c)
  528. #define REAL_YSCALEYUV2PACKED1(index, c) \
  529. "xor "#index", "#index" \n\t"\
  530. ASMALIGN(4)\
  531. "1: \n\t"\
  532. "movq (%2, "#index"), %%mm3 \n\t" /* uvbuf0[eax]*/\
  533. "movq "AV_STRINGIFY(VOF)"(%2, "#index"), %%mm4 \n\t" /* uvbuf0[eax+2048]*/\
  534. "psraw $7, %%mm3 \n\t" \
  535. "psraw $7, %%mm4 \n\t" \
  536. "movq (%0, "#index", 2), %%mm1 \n\t" /*buf0[eax]*/\
  537. "movq 8(%0, "#index", 2), %%mm7 \n\t" /*buf0[eax]*/\
  538. "psraw $7, %%mm1 \n\t" \
  539. "psraw $7, %%mm7 \n\t" \
  540. #define YSCALEYUV2PACKED1(index, c) REAL_YSCALEYUV2PACKED1(index, c)
  541. #define REAL_YSCALEYUV2RGB1(index, c) \
  542. "xor "#index", "#index" \n\t"\
  543. ASMALIGN(4)\
  544. "1: \n\t"\
  545. "movq (%2, "#index"), %%mm3 \n\t" /* uvbuf0[eax]*/\
  546. "movq "AV_STRINGIFY(VOF)"(%2, "#index"), %%mm4 \n\t" /* uvbuf0[eax+2048]*/\
  547. "psraw $4, %%mm3 \n\t" /* uvbuf0[eax] - uvbuf1[eax] >>4*/\
  548. "psraw $4, %%mm4 \n\t" /* uvbuf0[eax+2048] - uvbuf1[eax+2048] >>4*/\
  549. "psubw "U_OFFSET"("#c"), %%mm3 \n\t" /* (U-128)8*/\
  550. "psubw "V_OFFSET"("#c"), %%mm4 \n\t" /* (V-128)8*/\
  551. "movq %%mm3, %%mm2 \n\t" /* (U-128)8*/\
  552. "movq %%mm4, %%mm5 \n\t" /* (V-128)8*/\
  553. "pmulhw "UG_COEFF"("#c"), %%mm3 \n\t"\
  554. "pmulhw "VG_COEFF"("#c"), %%mm4 \n\t"\
  555. /* mm2=(U-128)8, mm3=ug, mm4=vg mm5=(V-128)8 */\
  556. "movq (%0, "#index", 2), %%mm1 \n\t" /*buf0[eax]*/\
  557. "movq 8(%0, "#index", 2), %%mm7 \n\t" /*buf0[eax]*/\
  558. "psraw $4, %%mm1 \n\t" /* buf0[eax] - buf1[eax] >>4*/\
  559. "psraw $4, %%mm7 \n\t" /* buf0[eax] - buf1[eax] >>4*/\
  560. "pmulhw "UB_COEFF"("#c"), %%mm2 \n\t"\
  561. "pmulhw "VR_COEFF"("#c"), %%mm5 \n\t"\
  562. "psubw "Y_OFFSET"("#c"), %%mm1 \n\t" /* 8(Y-16)*/\
  563. "psubw "Y_OFFSET"("#c"), %%mm7 \n\t" /* 8(Y-16)*/\
  564. "pmulhw "Y_COEFF"("#c"), %%mm1 \n\t"\
  565. "pmulhw "Y_COEFF"("#c"), %%mm7 \n\t"\
  566. /* mm1= Y1, mm2=ub, mm3=ug, mm4=vg mm5=vr, mm7=Y2 */\
  567. "paddw %%mm3, %%mm4 \n\t"\
  568. "movq %%mm2, %%mm0 \n\t"\
  569. "movq %%mm5, %%mm6 \n\t"\
  570. "movq %%mm4, %%mm3 \n\t"\
  571. "punpcklwd %%mm2, %%mm2 \n\t"\
  572. "punpcklwd %%mm5, %%mm5 \n\t"\
  573. "punpcklwd %%mm4, %%mm4 \n\t"\
  574. "paddw %%mm1, %%mm2 \n\t"\
  575. "paddw %%mm1, %%mm5 \n\t"\
  576. "paddw %%mm1, %%mm4 \n\t"\
  577. "punpckhwd %%mm0, %%mm0 \n\t"\
  578. "punpckhwd %%mm6, %%mm6 \n\t"\
  579. "punpckhwd %%mm3, %%mm3 \n\t"\
  580. "paddw %%mm7, %%mm0 \n\t"\
  581. "paddw %%mm7, %%mm6 \n\t"\
  582. "paddw %%mm7, %%mm3 \n\t"\
  583. /* mm0=B1, mm2=B2, mm3=G2, mm4=G1, mm5=R1, mm6=R2 */\
  584. "packuswb %%mm0, %%mm2 \n\t"\
  585. "packuswb %%mm6, %%mm5 \n\t"\
  586. "packuswb %%mm3, %%mm4 \n\t"\
  587. "pxor %%mm7, %%mm7 \n\t"
  588. #define YSCALEYUV2RGB1(index, c) REAL_YSCALEYUV2RGB1(index, c)
  589. #define REAL_YSCALEYUV2PACKED1b(index, c) \
  590. "xor "#index", "#index" \n\t"\
  591. ASMALIGN(4)\
  592. "1: \n\t"\
  593. "movq (%2, "#index"), %%mm2 \n\t" /* uvbuf0[eax]*/\
  594. "movq (%3, "#index"), %%mm3 \n\t" /* uvbuf1[eax]*/\
  595. "movq "AV_STRINGIFY(VOF)"(%2, "#index"), %%mm5 \n\t" /* uvbuf0[eax+2048]*/\
  596. "movq "AV_STRINGIFY(VOF)"(%3, "#index"), %%mm4 \n\t" /* uvbuf1[eax+2048]*/\
  597. "paddw %%mm2, %%mm3 \n\t" /* uvbuf0[eax] + uvbuf1[eax]*/\
  598. "paddw %%mm5, %%mm4 \n\t" /* uvbuf0[eax+2048] + uvbuf1[eax+2048]*/\
  599. "psrlw $8, %%mm3 \n\t" \
  600. "psrlw $8, %%mm4 \n\t" \
  601. "movq (%0, "#index", 2), %%mm1 \n\t" /*buf0[eax]*/\
  602. "movq 8(%0, "#index", 2), %%mm7 \n\t" /*buf0[eax]*/\
  603. "psraw $7, %%mm1 \n\t" \
  604. "psraw $7, %%mm7 \n\t"
  605. #define YSCALEYUV2PACKED1b(index, c) REAL_YSCALEYUV2PACKED1b(index, c)
  606. // do vertical chrominance interpolation
  607. #define REAL_YSCALEYUV2RGB1b(index, c) \
  608. "xor "#index", "#index" \n\t"\
  609. ASMALIGN(4)\
  610. "1: \n\t"\
  611. "movq (%2, "#index"), %%mm2 \n\t" /* uvbuf0[eax]*/\
  612. "movq (%3, "#index"), %%mm3 \n\t" /* uvbuf1[eax]*/\
  613. "movq "AV_STRINGIFY(VOF)"(%2, "#index"), %%mm5 \n\t" /* uvbuf0[eax+2048]*/\
  614. "movq "AV_STRINGIFY(VOF)"(%3, "#index"), %%mm4 \n\t" /* uvbuf1[eax+2048]*/\
  615. "paddw %%mm2, %%mm3 \n\t" /* uvbuf0[eax] + uvbuf1[eax]*/\
  616. "paddw %%mm5, %%mm4 \n\t" /* uvbuf0[eax+2048] + uvbuf1[eax+2048]*/\
  617. "psrlw $5, %%mm3 \n\t" /*FIXME might overflow*/\
  618. "psrlw $5, %%mm4 \n\t" /*FIXME might overflow*/\
  619. "psubw "U_OFFSET"("#c"), %%mm3 \n\t" /* (U-128)8*/\
  620. "psubw "V_OFFSET"("#c"), %%mm4 \n\t" /* (V-128)8*/\
  621. "movq %%mm3, %%mm2 \n\t" /* (U-128)8*/\
  622. "movq %%mm4, %%mm5 \n\t" /* (V-128)8*/\
  623. "pmulhw "UG_COEFF"("#c"), %%mm3 \n\t"\
  624. "pmulhw "VG_COEFF"("#c"), %%mm4 \n\t"\
  625. /* mm2=(U-128)8, mm3=ug, mm4=vg mm5=(V-128)8 */\
  626. "movq (%0, "#index", 2), %%mm1 \n\t" /*buf0[eax]*/\
  627. "movq 8(%0, "#index", 2), %%mm7 \n\t" /*buf0[eax]*/\
  628. "psraw $4, %%mm1 \n\t" /* buf0[eax] - buf1[eax] >>4*/\
  629. "psraw $4, %%mm7 \n\t" /* buf0[eax] - buf1[eax] >>4*/\
  630. "pmulhw "UB_COEFF"("#c"), %%mm2 \n\t"\
  631. "pmulhw "VR_COEFF"("#c"), %%mm5 \n\t"\
  632. "psubw "Y_OFFSET"("#c"), %%mm1 \n\t" /* 8(Y-16)*/\
  633. "psubw "Y_OFFSET"("#c"), %%mm7 \n\t" /* 8(Y-16)*/\
  634. "pmulhw "Y_COEFF"("#c"), %%mm1 \n\t"\
  635. "pmulhw "Y_COEFF"("#c"), %%mm7 \n\t"\
  636. /* mm1= Y1, mm2=ub, mm3=ug, mm4=vg mm5=vr, mm7=Y2 */\
  637. "paddw %%mm3, %%mm4 \n\t"\
  638. "movq %%mm2, %%mm0 \n\t"\
  639. "movq %%mm5, %%mm6 \n\t"\
  640. "movq %%mm4, %%mm3 \n\t"\
  641. "punpcklwd %%mm2, %%mm2 \n\t"\
  642. "punpcklwd %%mm5, %%mm5 \n\t"\
  643. "punpcklwd %%mm4, %%mm4 \n\t"\
  644. "paddw %%mm1, %%mm2 \n\t"\
  645. "paddw %%mm1, %%mm5 \n\t"\
  646. "paddw %%mm1, %%mm4 \n\t"\
  647. "punpckhwd %%mm0, %%mm0 \n\t"\
  648. "punpckhwd %%mm6, %%mm6 \n\t"\
  649. "punpckhwd %%mm3, %%mm3 \n\t"\
  650. "paddw %%mm7, %%mm0 \n\t"\
  651. "paddw %%mm7, %%mm6 \n\t"\
  652. "paddw %%mm7, %%mm3 \n\t"\
  653. /* mm0=B1, mm2=B2, mm3=G2, mm4=G1, mm5=R1, mm6=R2 */\
  654. "packuswb %%mm0, %%mm2 \n\t"\
  655. "packuswb %%mm6, %%mm5 \n\t"\
  656. "packuswb %%mm3, %%mm4 \n\t"\
  657. "pxor %%mm7, %%mm7 \n\t"
  658. #define YSCALEYUV2RGB1b(index, c) REAL_YSCALEYUV2RGB1b(index, c)
  659. #define REAL_WRITEBGR32(dst, dstw, index) \
  660. /* mm2=B, %%mm4=G, %%mm5=R, %%mm7=0 */\
  661. "movq %%mm2, %%mm1 \n\t" /* B */\
  662. "movq %%mm5, %%mm6 \n\t" /* R */\
  663. "punpcklbw %%mm4, %%mm2 \n\t" /* GBGBGBGB 0 */\
  664. "punpcklbw %%mm7, %%mm5 \n\t" /* 0R0R0R0R 0 */\
  665. "punpckhbw %%mm4, %%mm1 \n\t" /* GBGBGBGB 2 */\
  666. "punpckhbw %%mm7, %%mm6 \n\t" /* 0R0R0R0R 2 */\
  667. "movq %%mm2, %%mm0 \n\t" /* GBGBGBGB 0 */\
  668. "movq %%mm1, %%mm3 \n\t" /* GBGBGBGB 2 */\
  669. "punpcklwd %%mm5, %%mm0 \n\t" /* 0RGB0RGB 0 */\
  670. "punpckhwd %%mm5, %%mm2 \n\t" /* 0RGB0RGB 1 */\
  671. "punpcklwd %%mm6, %%mm1 \n\t" /* 0RGB0RGB 2 */\
  672. "punpckhwd %%mm6, %%mm3 \n\t" /* 0RGB0RGB 3 */\
  673. \
  674. MOVNTQ(%%mm0, (dst, index, 4))\
  675. MOVNTQ(%%mm2, 8(dst, index, 4))\
  676. MOVNTQ(%%mm1, 16(dst, index, 4))\
  677. MOVNTQ(%%mm3, 24(dst, index, 4))\
  678. \
  679. "add $8, "#index" \n\t"\
  680. "cmp "#dstw", "#index" \n\t"\
  681. " jb 1b \n\t"
  682. #define WRITEBGR32(dst, dstw, index) REAL_WRITEBGR32(dst, dstw, index)
  683. #define REAL_WRITERGB16(dst, dstw, index) \
  684. "pand "MANGLE(bF8)", %%mm2 \n\t" /* B */\
  685. "pand "MANGLE(bFC)", %%mm4 \n\t" /* G */\
  686. "pand "MANGLE(bF8)", %%mm5 \n\t" /* R */\
  687. "psrlq $3, %%mm2 \n\t"\
  688. \
  689. "movq %%mm2, %%mm1 \n\t"\
  690. "movq %%mm4, %%mm3 \n\t"\
  691. \
  692. "punpcklbw %%mm7, %%mm3 \n\t"\
  693. "punpcklbw %%mm5, %%mm2 \n\t"\
  694. "punpckhbw %%mm7, %%mm4 \n\t"\
  695. "punpckhbw %%mm5, %%mm1 \n\t"\
  696. \
  697. "psllq $3, %%mm3 \n\t"\
  698. "psllq $3, %%mm4 \n\t"\
  699. \
  700. "por %%mm3, %%mm2 \n\t"\
  701. "por %%mm4, %%mm1 \n\t"\
  702. \
  703. MOVNTQ(%%mm2, (dst, index, 2))\
  704. MOVNTQ(%%mm1, 8(dst, index, 2))\
  705. \
  706. "add $8, "#index" \n\t"\
  707. "cmp "#dstw", "#index" \n\t"\
  708. " jb 1b \n\t"
  709. #define WRITERGB16(dst, dstw, index) REAL_WRITERGB16(dst, dstw, index)
  710. #define REAL_WRITERGB15(dst, dstw, index) \
  711. "pand "MANGLE(bF8)", %%mm2 \n\t" /* B */\
  712. "pand "MANGLE(bF8)", %%mm4 \n\t" /* G */\
  713. "pand "MANGLE(bF8)", %%mm5 \n\t" /* R */\
  714. "psrlq $3, %%mm2 \n\t"\
  715. "psrlq $1, %%mm5 \n\t"\
  716. \
  717. "movq %%mm2, %%mm1 \n\t"\
  718. "movq %%mm4, %%mm3 \n\t"\
  719. \
  720. "punpcklbw %%mm7, %%mm3 \n\t"\
  721. "punpcklbw %%mm5, %%mm2 \n\t"\
  722. "punpckhbw %%mm7, %%mm4 \n\t"\
  723. "punpckhbw %%mm5, %%mm1 \n\t"\
  724. \
  725. "psllq $2, %%mm3 \n\t"\
  726. "psllq $2, %%mm4 \n\t"\
  727. \
  728. "por %%mm3, %%mm2 \n\t"\
  729. "por %%mm4, %%mm1 \n\t"\
  730. \
  731. MOVNTQ(%%mm2, (dst, index, 2))\
  732. MOVNTQ(%%mm1, 8(dst, index, 2))\
  733. \
  734. "add $8, "#index" \n\t"\
  735. "cmp "#dstw", "#index" \n\t"\
  736. " jb 1b \n\t"
  737. #define WRITERGB15(dst, dstw, index) REAL_WRITERGB15(dst, dstw, index)
  738. #define WRITEBGR24OLD(dst, dstw, index) \
  739. /* mm2=B, %%mm4=G, %%mm5=R, %%mm7=0 */\
  740. "movq %%mm2, %%mm1 \n\t" /* B */\
  741. "movq %%mm5, %%mm6 \n\t" /* R */\
  742. "punpcklbw %%mm4, %%mm2 \n\t" /* GBGBGBGB 0 */\
  743. "punpcklbw %%mm7, %%mm5 \n\t" /* 0R0R0R0R 0 */\
  744. "punpckhbw %%mm4, %%mm1 \n\t" /* GBGBGBGB 2 */\
  745. "punpckhbw %%mm7, %%mm6 \n\t" /* 0R0R0R0R 2 */\
  746. "movq %%mm2, %%mm0 \n\t" /* GBGBGBGB 0 */\
  747. "movq %%mm1, %%mm3 \n\t" /* GBGBGBGB 2 */\
  748. "punpcklwd %%mm5, %%mm0 \n\t" /* 0RGB0RGB 0 */\
  749. "punpckhwd %%mm5, %%mm2 \n\t" /* 0RGB0RGB 1 */\
  750. "punpcklwd %%mm6, %%mm1 \n\t" /* 0RGB0RGB 2 */\
  751. "punpckhwd %%mm6, %%mm3 \n\t" /* 0RGB0RGB 3 */\
  752. \
  753. "movq %%mm0, %%mm4 \n\t" /* 0RGB0RGB 0 */\
  754. "psrlq $8, %%mm0 \n\t" /* 00RGB0RG 0 */\
  755. "pand "MANGLE(bm00000111)", %%mm4 \n\t" /* 00000RGB 0 */\
  756. "pand "MANGLE(bm11111000)", %%mm0 \n\t" /* 00RGB000 0.5 */\
  757. "por %%mm4, %%mm0 \n\t" /* 00RGBRGB 0 */\
  758. "movq %%mm2, %%mm4 \n\t" /* 0RGB0RGB 1 */\
  759. "psllq $48, %%mm2 \n\t" /* GB000000 1 */\
  760. "por %%mm2, %%mm0 \n\t" /* GBRGBRGB 0 */\
  761. \
  762. "movq %%mm4, %%mm2 \n\t" /* 0RGB0RGB 1 */\
  763. "psrld $16, %%mm4 \n\t" /* 000R000R 1 */\
  764. "psrlq $24, %%mm2 \n\t" /* 0000RGB0 1.5 */\
  765. "por %%mm4, %%mm2 \n\t" /* 000RRGBR 1 */\
  766. "pand "MANGLE(bm00001111)", %%mm2 \n\t" /* 0000RGBR 1 */\
  767. "movq %%mm1, %%mm4 \n\t" /* 0RGB0RGB 2 */\
  768. "psrlq $8, %%mm1 \n\t" /* 00RGB0RG 2 */\
  769. "pand "MANGLE(bm00000111)", %%mm4 \n\t" /* 00000RGB 2 */\
  770. "pand "MANGLE(bm11111000)", %%mm1 \n\t" /* 00RGB000 2.5 */\
  771. "por %%mm4, %%mm1 \n\t" /* 00RGBRGB 2 */\
  772. "movq %%mm1, %%mm4 \n\t" /* 00RGBRGB 2 */\
  773. "psllq $32, %%mm1 \n\t" /* BRGB0000 2 */\
  774. "por %%mm1, %%mm2 \n\t" /* BRGBRGBR 1 */\
  775. \
  776. "psrlq $32, %%mm4 \n\t" /* 000000RG 2.5 */\
  777. "movq %%mm3, %%mm5 \n\t" /* 0RGB0RGB 3 */\
  778. "psrlq $8, %%mm3 \n\t" /* 00RGB0RG 3 */\
  779. "pand "MANGLE(bm00000111)", %%mm5 \n\t" /* 00000RGB 3 */\
  780. "pand "MANGLE(bm11111000)", %%mm3 \n\t" /* 00RGB000 3.5 */\
  781. "por %%mm5, %%mm3 \n\t" /* 00RGBRGB 3 */\
  782. "psllq $16, %%mm3 \n\t" /* RGBRGB00 3 */\
  783. "por %%mm4, %%mm3 \n\t" /* RGBRGBRG 2.5 */\
  784. \
  785. MOVNTQ(%%mm0, (dst))\
  786. MOVNTQ(%%mm2, 8(dst))\
  787. MOVNTQ(%%mm3, 16(dst))\
  788. "add $24, "#dst" \n\t"\
  789. \
  790. "add $8, "#index" \n\t"\
  791. "cmp "#dstw", "#index" \n\t"\
  792. " jb 1b \n\t"
  793. #define WRITEBGR24MMX(dst, dstw, index) \
  794. /* mm2=B, %%mm4=G, %%mm5=R, %%mm7=0 */\
  795. "movq %%mm2, %%mm1 \n\t" /* B */\
  796. "movq %%mm5, %%mm6 \n\t" /* R */\
  797. "punpcklbw %%mm4, %%mm2 \n\t" /* GBGBGBGB 0 */\
  798. "punpcklbw %%mm7, %%mm5 \n\t" /* 0R0R0R0R 0 */\
  799. "punpckhbw %%mm4, %%mm1 \n\t" /* GBGBGBGB 2 */\
  800. "punpckhbw %%mm7, %%mm6 \n\t" /* 0R0R0R0R 2 */\
  801. "movq %%mm2, %%mm0 \n\t" /* GBGBGBGB 0 */\
  802. "movq %%mm1, %%mm3 \n\t" /* GBGBGBGB 2 */\
  803. "punpcklwd %%mm5, %%mm0 \n\t" /* 0RGB0RGB 0 */\
  804. "punpckhwd %%mm5, %%mm2 \n\t" /* 0RGB0RGB 1 */\
  805. "punpcklwd %%mm6, %%mm1 \n\t" /* 0RGB0RGB 2 */\
  806. "punpckhwd %%mm6, %%mm3 \n\t" /* 0RGB0RGB 3 */\
  807. \
  808. "movq %%mm0, %%mm4 \n\t" /* 0RGB0RGB 0 */\
  809. "movq %%mm2, %%mm6 \n\t" /* 0RGB0RGB 1 */\
  810. "movq %%mm1, %%mm5 \n\t" /* 0RGB0RGB 2 */\
  811. "movq %%mm3, %%mm7 \n\t" /* 0RGB0RGB 3 */\
  812. \
  813. "psllq $40, %%mm0 \n\t" /* RGB00000 0 */\
  814. "psllq $40, %%mm2 \n\t" /* RGB00000 1 */\
  815. "psllq $40, %%mm1 \n\t" /* RGB00000 2 */\
  816. "psllq $40, %%mm3 \n\t" /* RGB00000 3 */\
  817. \
  818. "punpckhdq %%mm4, %%mm0 \n\t" /* 0RGBRGB0 0 */\
  819. "punpckhdq %%mm6, %%mm2 \n\t" /* 0RGBRGB0 1 */\
  820. "punpckhdq %%mm5, %%mm1 \n\t" /* 0RGBRGB0 2 */\
  821. "punpckhdq %%mm7, %%mm3 \n\t" /* 0RGBRGB0 3 */\
  822. \
  823. "psrlq $8, %%mm0 \n\t" /* 00RGBRGB 0 */\
  824. "movq %%mm2, %%mm6 \n\t" /* 0RGBRGB0 1 */\
  825. "psllq $40, %%mm2 \n\t" /* GB000000 1 */\
  826. "por %%mm2, %%mm0 \n\t" /* GBRGBRGB 0 */\
  827. MOVNTQ(%%mm0, (dst))\
  828. \
  829. "psrlq $24, %%mm6 \n\t" /* 0000RGBR 1 */\
  830. "movq %%mm1, %%mm5 \n\t" /* 0RGBRGB0 2 */\
  831. "psllq $24, %%mm1 \n\t" /* BRGB0000 2 */\
  832. "por %%mm1, %%mm6 \n\t" /* BRGBRGBR 1 */\
  833. MOVNTQ(%%mm6, 8(dst))\
  834. \
  835. "psrlq $40, %%mm5 \n\t" /* 000000RG 2 */\
  836. "psllq $8, %%mm3 \n\t" /* RGBRGB00 3 */\
  837. "por %%mm3, %%mm5 \n\t" /* RGBRGBRG 2 */\
  838. MOVNTQ(%%mm5, 16(dst))\
  839. \
  840. "add $24, "#dst" \n\t"\
  841. \
  842. "add $8, "#index" \n\t"\
  843. "cmp "#dstw", "#index" \n\t"\
  844. " jb 1b \n\t"
  845. #define WRITEBGR24MMX2(dst, dstw, index) \
  846. /* mm2=B, %%mm4=G, %%mm5=R, %%mm7=0 */\
  847. "movq "MANGLE(ff_M24A)", %%mm0 \n\t"\
  848. "movq "MANGLE(ff_M24C)", %%mm7 \n\t"\
  849. "pshufw $0x50, %%mm2, %%mm1 \n\t" /* B3 B2 B3 B2 B1 B0 B1 B0 */\
  850. "pshufw $0x50, %%mm4, %%mm3 \n\t" /* G3 G2 G3 G2 G1 G0 G1 G0 */\
  851. "pshufw $0x00, %%mm5, %%mm6 \n\t" /* R1 R0 R1 R0 R1 R0 R1 R0 */\
  852. \
  853. "pand %%mm0, %%mm1 \n\t" /* B2 B1 B0 */\
  854. "pand %%mm0, %%mm3 \n\t" /* G2 G1 G0 */\
  855. "pand %%mm7, %%mm6 \n\t" /* R1 R0 */\
  856. \
  857. "psllq $8, %%mm3 \n\t" /* G2 G1 G0 */\
  858. "por %%mm1, %%mm6 \n\t"\
  859. "por %%mm3, %%mm6 \n\t"\
  860. MOVNTQ(%%mm6, (dst))\
  861. \
  862. "psrlq $8, %%mm4 \n\t" /* 00 G7 G6 G5 G4 G3 G2 G1 */\
  863. "pshufw $0xA5, %%mm2, %%mm1 \n\t" /* B5 B4 B5 B4 B3 B2 B3 B2 */\
  864. "pshufw $0x55, %%mm4, %%mm3 \n\t" /* G4 G3 G4 G3 G4 G3 G4 G3 */\
  865. "pshufw $0xA5, %%mm5, %%mm6 \n\t" /* R5 R4 R5 R4 R3 R2 R3 R2 */\
  866. \
  867. "pand "MANGLE(ff_M24B)", %%mm1 \n\t" /* B5 B4 B3 */\
  868. "pand %%mm7, %%mm3 \n\t" /* G4 G3 */\
  869. "pand %%mm0, %%mm6 \n\t" /* R4 R3 R2 */\
  870. \
  871. "por %%mm1, %%mm3 \n\t" /* B5 G4 B4 G3 B3 */\
  872. "por %%mm3, %%mm6 \n\t"\
  873. MOVNTQ(%%mm6, 8(dst))\
  874. \
  875. "pshufw $0xFF, %%mm2, %%mm1 \n\t" /* B7 B6 B7 B6 B7 B6 B6 B7 */\
  876. "pshufw $0xFA, %%mm4, %%mm3 \n\t" /* 00 G7 00 G7 G6 G5 G6 G5 */\
  877. "pshufw $0xFA, %%mm5, %%mm6 \n\t" /* R7 R6 R7 R6 R5 R4 R5 R4 */\
  878. \
  879. "pand %%mm7, %%mm1 \n\t" /* B7 B6 */\
  880. "pand %%mm0, %%mm3 \n\t" /* G7 G6 G5 */\
  881. "pand "MANGLE(ff_M24B)", %%mm6 \n\t" /* R7 R6 R5 */\
  882. \
  883. "por %%mm1, %%mm3 \n\t"\
  884. "por %%mm3, %%mm6 \n\t"\
  885. MOVNTQ(%%mm6, 16(dst))\
  886. \
  887. "add $24, "#dst" \n\t"\
  888. \
  889. "add $8, "#index" \n\t"\
  890. "cmp "#dstw", "#index" \n\t"\
  891. " jb 1b \n\t"
  892. #ifdef HAVE_MMX2
  893. #undef WRITEBGR24
  894. #define WRITEBGR24(dst, dstw, index) WRITEBGR24MMX2(dst, dstw, index)
  895. #else
  896. #undef WRITEBGR24
  897. #define WRITEBGR24(dst, dstw, index) WRITEBGR24MMX(dst, dstw, index)
  898. #endif
  899. #define REAL_WRITEYUY2(dst, dstw, index) \
  900. "packuswb %%mm3, %%mm3 \n\t"\
  901. "packuswb %%mm4, %%mm4 \n\t"\
  902. "packuswb %%mm7, %%mm1 \n\t"\
  903. "punpcklbw %%mm4, %%mm3 \n\t"\
  904. "movq %%mm1, %%mm7 \n\t"\
  905. "punpcklbw %%mm3, %%mm1 \n\t"\
  906. "punpckhbw %%mm3, %%mm7 \n\t"\
  907. \
  908. MOVNTQ(%%mm1, (dst, index, 2))\
  909. MOVNTQ(%%mm7, 8(dst, index, 2))\
  910. \
  911. "add $8, "#index" \n\t"\
  912. "cmp "#dstw", "#index" \n\t"\
  913. " jb 1b \n\t"
  914. #define WRITEYUY2(dst, dstw, index) REAL_WRITEYUY2(dst, dstw, index)
  915. static inline void RENAME(yuv2yuvX)(SwsContext *c, int16_t *lumFilter, int16_t **lumSrc, int lumFilterSize,
  916. int16_t *chrFilter, int16_t **chrSrc, int chrFilterSize,
  917. uint8_t *dest, uint8_t *uDest, uint8_t *vDest, long dstW, long chrDstW)
  918. {
  919. #ifdef HAVE_MMX
  920. if (c->flags & SWS_ACCURATE_RND){
  921. if (uDest){
  922. YSCALEYUV2YV12X_ACCURATE( "0", CHR_MMX_FILTER_OFFSET, uDest, chrDstW)
  923. YSCALEYUV2YV12X_ACCURATE(AV_STRINGIFY(VOF), CHR_MMX_FILTER_OFFSET, vDest, chrDstW)
  924. }
  925. YSCALEYUV2YV12X_ACCURATE("0", LUM_MMX_FILTER_OFFSET, dest, dstW)
  926. }else{
  927. if (uDest){
  928. YSCALEYUV2YV12X( "0", CHR_MMX_FILTER_OFFSET, uDest, chrDstW)
  929. YSCALEYUV2YV12X(AV_STRINGIFY(VOF), CHR_MMX_FILTER_OFFSET, vDest, chrDstW)
  930. }
  931. YSCALEYUV2YV12X("0", LUM_MMX_FILTER_OFFSET, dest, dstW)
  932. }
  933. #else
  934. #ifdef HAVE_ALTIVEC
  935. yuv2yuvX_altivec_real(lumFilter, lumSrc, lumFilterSize,
  936. chrFilter, chrSrc, chrFilterSize,
  937. dest, uDest, vDest, dstW, chrDstW);
  938. #else //HAVE_ALTIVEC
  939. yuv2yuvXinC(lumFilter, lumSrc, lumFilterSize,
  940. chrFilter, chrSrc, chrFilterSize,
  941. dest, uDest, vDest, dstW, chrDstW);
  942. #endif //!HAVE_ALTIVEC
  943. #endif /* HAVE_MMX */
  944. }
  945. static inline void RENAME(yuv2nv12X)(SwsContext *c, int16_t *lumFilter, int16_t **lumSrc, int lumFilterSize,
  946. int16_t *chrFilter, int16_t **chrSrc, int chrFilterSize,
  947. uint8_t *dest, uint8_t *uDest, int dstW, int chrDstW, int dstFormat)
  948. {
  949. yuv2nv12XinC(lumFilter, lumSrc, lumFilterSize,
  950. chrFilter, chrSrc, chrFilterSize,
  951. dest, uDest, dstW, chrDstW, dstFormat);
  952. }
  953. static inline void RENAME(yuv2yuv1)(SwsContext *c, int16_t *lumSrc, int16_t *chrSrc,
  954. uint8_t *dest, uint8_t *uDest, uint8_t *vDest, long dstW, long chrDstW)
  955. {
  956. #ifdef HAVE_MMX
  957. long p= uDest ? 3 : 1;
  958. uint8_t *src[3]= {lumSrc + dstW, chrSrc + chrDstW, chrSrc + VOFW + chrDstW};
  959. uint8_t *dst[3]= {dest, uDest, vDest};
  960. long counter[3] = {dstW, chrDstW, chrDstW};
  961. if (c->flags & SWS_ACCURATE_RND){
  962. while(p--){
  963. asm volatile(
  964. YSCALEYUV2YV121_ACCURATE
  965. :: "r" (src[p]), "r" (dst[p] + counter[p]),
  966. "g" (-counter[p])
  967. : "%"REG_a
  968. );
  969. }
  970. }else{
  971. while(p--){
  972. asm volatile(
  973. YSCALEYUV2YV121
  974. :: "r" (src[p]), "r" (dst[p] + counter[p]),
  975. "g" (-counter[p])
  976. : "%"REG_a
  977. );
  978. }
  979. }
  980. #else
  981. int i;
  982. for (i=0; i<dstW; i++)
  983. {
  984. int val= (lumSrc[i]+64)>>7;
  985. if (val&256){
  986. if (val<0) val=0;
  987. else val=255;
  988. }
  989. dest[i]= val;
  990. }
  991. if (uDest)
  992. for (i=0; i<chrDstW; i++)
  993. {
  994. int u=(chrSrc[i ]+64)>>7;
  995. int v=(chrSrc[i + VOFW]+64)>>7;
  996. if ((u|v)&256){
  997. if (u<0) u=0;
  998. else if (u>255) u=255;
  999. if (v<0) v=0;
  1000. else if (v>255) v=255;
  1001. }
  1002. uDest[i]= u;
  1003. vDest[i]= v;
  1004. }
  1005. #endif
  1006. }
  1007. /**
  1008. * vertical scale YV12 to RGB
  1009. */
  1010. static inline void RENAME(yuv2packedX)(SwsContext *c, int16_t *lumFilter, int16_t **lumSrc, int lumFilterSize,
  1011. int16_t *chrFilter, int16_t **chrSrc, int chrFilterSize,
  1012. uint8_t *dest, long dstW, long dstY)
  1013. {
  1014. #ifdef HAVE_MMX
  1015. long dummy=0;
  1016. if (c->flags & SWS_ACCURATE_RND){
  1017. switch(c->dstFormat){
  1018. case PIX_FMT_RGB32:
  1019. YSCALEYUV2PACKEDX_ACCURATE
  1020. YSCALEYUV2RGBX
  1021. WRITEBGR32(%4, %5, %%REGa)
  1022. YSCALEYUV2PACKEDX_END
  1023. return;
  1024. case PIX_FMT_BGR24:
  1025. YSCALEYUV2PACKEDX_ACCURATE
  1026. YSCALEYUV2RGBX
  1027. "lea (%%"REG_a", %%"REG_a", 2), %%"REG_c"\n\t" //FIXME optimize
  1028. "add %4, %%"REG_c" \n\t"
  1029. WRITEBGR24(%%REGc, %5, %%REGa)
  1030. :: "r" (&c->redDither),
  1031. "m" (dummy), "m" (dummy), "m" (dummy),
  1032. "r" (dest), "m" (dstW)
  1033. : "%"REG_a, "%"REG_c, "%"REG_d, "%"REG_S
  1034. );
  1035. return;
  1036. case PIX_FMT_RGB555:
  1037. YSCALEYUV2PACKEDX_ACCURATE
  1038. YSCALEYUV2RGBX
  1039. /* mm2=B, %%mm4=G, %%mm5=R, %%mm7=0 */
  1040. #ifdef DITHER1XBPP
  1041. "paddusb "MANGLE(b5Dither)", %%mm2\n\t"
  1042. "paddusb "MANGLE(g5Dither)", %%mm4\n\t"
  1043. "paddusb "MANGLE(r5Dither)", %%mm5\n\t"
  1044. #endif
  1045. WRITERGB15(%4, %5, %%REGa)
  1046. YSCALEYUV2PACKEDX_END
  1047. return;
  1048. case PIX_FMT_RGB565:
  1049. YSCALEYUV2PACKEDX_ACCURATE
  1050. YSCALEYUV2RGBX
  1051. /* mm2=B, %%mm4=G, %%mm5=R, %%mm7=0 */
  1052. #ifdef DITHER1XBPP
  1053. "paddusb "MANGLE(b5Dither)", %%mm2\n\t"
  1054. "paddusb "MANGLE(g6Dither)", %%mm4\n\t"
  1055. "paddusb "MANGLE(r5Dither)", %%mm5\n\t"
  1056. #endif
  1057. WRITERGB16(%4, %5, %%REGa)
  1058. YSCALEYUV2PACKEDX_END
  1059. return;
  1060. case PIX_FMT_YUYV422:
  1061. YSCALEYUV2PACKEDX_ACCURATE
  1062. /* mm2=B, %%mm4=G, %%mm5=R, %%mm7=0 */
  1063. "psraw $3, %%mm3 \n\t"
  1064. "psraw $3, %%mm4 \n\t"
  1065. "psraw $3, %%mm1 \n\t"
  1066. "psraw $3, %%mm7 \n\t"
  1067. WRITEYUY2(%4, %5, %%REGa)
  1068. YSCALEYUV2PACKEDX_END
  1069. return;
  1070. }
  1071. }else{
  1072. switch(c->dstFormat)
  1073. {
  1074. case PIX_FMT_RGB32:
  1075. YSCALEYUV2PACKEDX
  1076. YSCALEYUV2RGBX
  1077. WRITEBGR32(%4, %5, %%REGa)
  1078. YSCALEYUV2PACKEDX_END
  1079. return;
  1080. case PIX_FMT_BGR24:
  1081. YSCALEYUV2PACKEDX
  1082. YSCALEYUV2RGBX
  1083. "lea (%%"REG_a", %%"REG_a", 2), %%"REG_c" \n\t" //FIXME optimize
  1084. "add %4, %%"REG_c" \n\t"
  1085. WRITEBGR24(%%REGc, %5, %%REGa)
  1086. :: "r" (&c->redDither),
  1087. "m" (dummy), "m" (dummy), "m" (dummy),
  1088. "r" (dest), "m" (dstW)
  1089. : "%"REG_a, "%"REG_c, "%"REG_d, "%"REG_S
  1090. );
  1091. return;
  1092. case PIX_FMT_RGB555:
  1093. YSCALEYUV2PACKEDX
  1094. YSCALEYUV2RGBX
  1095. /* mm2=B, %%mm4=G, %%mm5=R, %%mm7=0 */
  1096. #ifdef DITHER1XBPP
  1097. "paddusb "MANGLE(b5Dither)", %%mm2 \n\t"
  1098. "paddusb "MANGLE(g5Dither)", %%mm4 \n\t"
  1099. "paddusb "MANGLE(r5Dither)", %%mm5 \n\t"
  1100. #endif
  1101. WRITERGB15(%4, %5, %%REGa)
  1102. YSCALEYUV2PACKEDX_END
  1103. return;
  1104. case PIX_FMT_RGB565:
  1105. YSCALEYUV2PACKEDX
  1106. YSCALEYUV2RGBX
  1107. /* mm2=B, %%mm4=G, %%mm5=R, %%mm7=0 */
  1108. #ifdef DITHER1XBPP
  1109. "paddusb "MANGLE(b5Dither)", %%mm2 \n\t"
  1110. "paddusb "MANGLE(g6Dither)", %%mm4 \n\t"
  1111. "paddusb "MANGLE(r5Dither)", %%mm5 \n\t"
  1112. #endif
  1113. WRITERGB16(%4, %5, %%REGa)
  1114. YSCALEYUV2PACKEDX_END
  1115. return;
  1116. case PIX_FMT_YUYV422:
  1117. YSCALEYUV2PACKEDX
  1118. /* mm2=B, %%mm4=G, %%mm5=R, %%mm7=0 */
  1119. "psraw $3, %%mm3 \n\t"
  1120. "psraw $3, %%mm4 \n\t"
  1121. "psraw $3, %%mm1 \n\t"
  1122. "psraw $3, %%mm7 \n\t"
  1123. WRITEYUY2(%4, %5, %%REGa)
  1124. YSCALEYUV2PACKEDX_END
  1125. return;
  1126. }
  1127. }
  1128. #endif /* HAVE_MMX */
  1129. #ifdef HAVE_ALTIVEC
  1130. /* The following list of supported dstFormat values should
  1131. match what's found in the body of altivec_yuv2packedX() */
  1132. if (c->dstFormat==PIX_FMT_ABGR || c->dstFormat==PIX_FMT_BGRA ||
  1133. c->dstFormat==PIX_FMT_BGR24 || c->dstFormat==PIX_FMT_RGB24 ||
  1134. c->dstFormat==PIX_FMT_RGBA || c->dstFormat==PIX_FMT_ARGB)
  1135. altivec_yuv2packedX (c, lumFilter, lumSrc, lumFilterSize,
  1136. chrFilter, chrSrc, chrFilterSize,
  1137. dest, dstW, dstY);
  1138. else
  1139. #endif
  1140. yuv2packedXinC(c, lumFilter, lumSrc, lumFilterSize,
  1141. chrFilter, chrSrc, chrFilterSize,
  1142. dest, dstW, dstY);
  1143. }
  1144. /**
  1145. * vertical bilinear scale YV12 to RGB
  1146. */
  1147. static inline void RENAME(yuv2packed2)(SwsContext *c, uint16_t *buf0, uint16_t *buf1, uint16_t *uvbuf0, uint16_t *uvbuf1,
  1148. uint8_t *dest, int dstW, int yalpha, int uvalpha, int y)
  1149. {
  1150. int yalpha1=4095- yalpha;
  1151. int uvalpha1=4095-uvalpha;
  1152. int i;
  1153. #if 0 //isn't used
  1154. if (flags&SWS_FULL_CHR_H_INT)
  1155. {
  1156. switch(dstFormat)
  1157. {
  1158. #ifdef HAVE_MMX
  1159. case PIX_FMT_RGB32:
  1160. asm volatile(
  1161. FULL_YSCALEYUV2RGB
  1162. "punpcklbw %%mm1, %%mm3 \n\t" // BGBGBGBG
  1163. "punpcklbw %%mm7, %%mm0 \n\t" // R0R0R0R0
  1164. "movq %%mm3, %%mm1 \n\t"
  1165. "punpcklwd %%mm0, %%mm3 \n\t" // BGR0BGR0
  1166. "punpckhwd %%mm0, %%mm1 \n\t" // BGR0BGR0
  1167. MOVNTQ(%%mm3, (%4, %%REGa, 4))
  1168. MOVNTQ(%%mm1, 8(%4, %%REGa, 4))
  1169. "add $4, %%"REG_a" \n\t"
  1170. "cmp %5, %%"REG_a" \n\t"
  1171. " jb 1b \n\t"
  1172. :: "r" (buf0), "r" (buf1), "r" (uvbuf0), "r" (uvbuf1), "r" (dest), "m" ((long)dstW),
  1173. "m" (yalpha1), "m" (uvalpha1)
  1174. : "%"REG_a
  1175. );
  1176. break;
  1177. case PIX_FMT_BGR24:
  1178. asm volatile(
  1179. FULL_YSCALEYUV2RGB
  1180. // lsb ... msb
  1181. "punpcklbw %%mm1, %%mm3 \n\t" // BGBGBGBG
  1182. "punpcklbw %%mm7, %%mm0 \n\t" // R0R0R0R0
  1183. "movq %%mm3, %%mm1 \n\t"
  1184. "punpcklwd %%mm0, %%mm3 \n\t" // BGR0BGR0
  1185. "punpckhwd %%mm0, %%mm1 \n\t" // BGR0BGR0
  1186. "movq %%mm3, %%mm2 \n\t" // BGR0BGR0
  1187. "psrlq $8, %%mm3 \n\t" // GR0BGR00
  1188. "pand "MANGLE(bm00000111)", %%mm2 \n\t" // BGR00000
  1189. "pand "MANGLE(bm11111000)", %%mm3 \n\t" // 000BGR00
  1190. "por %%mm2, %%mm3 \n\t" // BGRBGR00
  1191. "movq %%mm1, %%mm2 \n\t"
  1192. "psllq $48, %%mm1 \n\t" // 000000BG
  1193. "por %%mm1, %%mm3 \n\t" // BGRBGRBG
  1194. "movq %%mm2, %%mm1 \n\t" // BGR0BGR0
  1195. "psrld $16, %%mm2 \n\t" // R000R000
  1196. "psrlq $24, %%mm1 \n\t" // 0BGR0000
  1197. "por %%mm2, %%mm1 \n\t" // RBGRR000
  1198. "mov %4, %%"REG_b" \n\t"
  1199. "add %%"REG_a", %%"REG_b" \n\t"
  1200. #ifdef HAVE_MMX2
  1201. //FIXME Alignment
  1202. "movntq %%mm3, (%%"REG_b", %%"REG_a", 2) \n\t"
  1203. "movntq %%mm1, 8(%%"REG_b", %%"REG_a", 2) \n\t"
  1204. #else
  1205. "movd %%mm3, (%%"REG_b", %%"REG_a", 2) \n\t"
  1206. "psrlq $32, %%mm3 \n\t"
  1207. "movd %%mm3, 4(%%"REG_b", %%"REG_a", 2) \n\t"
  1208. "movd %%mm1, 8(%%"REG_b", %%"REG_a", 2) \n\t"
  1209. #endif
  1210. "add $4, %%"REG_a" \n\t"
  1211. "cmp %5, %%"REG_a" \n\t"
  1212. " jb 1b \n\t"
  1213. :: "r" (buf0), "r" (buf1), "r" (uvbuf0), "r" (uvbuf1), "m" (dest), "m" (dstW),
  1214. "m" (yalpha1), "m" (uvalpha1)
  1215. : "%"REG_a, "%"REG_b
  1216. );
  1217. break;
  1218. case PIX_FMT_BGR555:
  1219. asm volatile(
  1220. FULL_YSCALEYUV2RGB
  1221. #ifdef DITHER1XBPP
  1222. "paddusb "MANGLE(g5Dither)", %%mm1 \n\t"
  1223. "paddusb "MANGLE(r5Dither)", %%mm0 \n\t"
  1224. "paddusb "MANGLE(b5Dither)", %%mm3 \n\t"
  1225. #endif
  1226. "punpcklbw %%mm7, %%mm1 \n\t" // 0G0G0G0G
  1227. "punpcklbw %%mm7, %%mm3 \n\t" // 0B0B0B0B
  1228. "punpcklbw %%mm7, %%mm0 \n\t" // 0R0R0R0R
  1229. "psrlw $3, %%mm3 \n\t"
  1230. "psllw $2, %%mm1 \n\t"
  1231. "psllw $7, %%mm0 \n\t"
  1232. "pand "MANGLE(g15Mask)", %%mm1 \n\t"
  1233. "pand "MANGLE(r15Mask)", %%mm0 \n\t"
  1234. "por %%mm3, %%mm1 \n\t"
  1235. "por %%mm1, %%mm0 \n\t"
  1236. MOVNTQ(%%mm0, (%4, %%REGa, 2))
  1237. "add $4, %%"REG_a" \n\t"
  1238. "cmp %5, %%"REG_a" \n\t"
  1239. " jb 1b \n\t"
  1240. :: "r" (buf0), "r" (buf1), "r" (uvbuf0), "r" (uvbuf1), "r" (dest), "m" (dstW),
  1241. "m" (yalpha1), "m" (uvalpha1)
  1242. : "%"REG_a
  1243. );
  1244. break;
  1245. case PIX_FMT_BGR565:
  1246. asm volatile(
  1247. FULL_YSCALEYUV2RGB
  1248. #ifdef DITHER1XBPP
  1249. "paddusb "MANGLE(g6Dither)", %%mm1 \n\t"
  1250. "paddusb "MANGLE(r5Dither)", %%mm0 \n\t"
  1251. "paddusb "MANGLE(b5Dither)", %%mm3 \n\t"
  1252. #endif
  1253. "punpcklbw %%mm7, %%mm1 \n\t" // 0G0G0G0G
  1254. "punpcklbw %%mm7, %%mm3 \n\t" // 0B0B0B0B
  1255. "punpcklbw %%mm7, %%mm0 \n\t" // 0R0R0R0R
  1256. "psrlw $3, %%mm3 \n\t"
  1257. "psllw $3, %%mm1 \n\t"
  1258. "psllw $8, %%mm0 \n\t"
  1259. "pand "MANGLE(g16Mask)", %%mm1 \n\t"
  1260. "pand "MANGLE(r16Mask)", %%mm0 \n\t"
  1261. "por %%mm3, %%mm1 \n\t"
  1262. "por %%mm1, %%mm0 \n\t"
  1263. MOVNTQ(%%mm0, (%4, %%REGa, 2))
  1264. "add $4, %%"REG_a" \n\t"
  1265. "cmp %5, %%"REG_a" \n\t"
  1266. " jb 1b \n\t"
  1267. :: "r" (buf0), "r" (buf1), "r" (uvbuf0), "r" (uvbuf1), "r" (dest), "m" (dstW),
  1268. "m" (yalpha1), "m" (uvalpha1)
  1269. : "%"REG_a
  1270. );
  1271. break;
  1272. #endif /* HAVE_MMX */
  1273. case PIX_FMT_BGR32:
  1274. #ifndef HAVE_MMX
  1275. case PIX_FMT_RGB32:
  1276. #endif
  1277. if (dstFormat==PIX_FMT_RGB32)
  1278. {
  1279. int i;
  1280. #ifdef WORDS_BIGENDIAN
  1281. dest++;
  1282. #endif
  1283. for (i=0;i<dstW;i++){
  1284. // vertical linear interpolation && yuv2rgb in a single step:
  1285. int Y=yuvtab_2568[((buf0[i]*yalpha1+buf1[i]*yalpha)>>19)];
  1286. int U=((uvbuf0[i]*uvalpha1+uvbuf1[i]*uvalpha)>>19);
  1287. int V=((uvbuf0[i+VOFW]*uvalpha1+uvbuf1[i+VOFW]*uvalpha)>>19);
  1288. dest[0]=clip_table[((Y + yuvtab_40cf[U]) >>13)];
  1289. dest[1]=clip_table[((Y + yuvtab_1a1e[V] + yuvtab_0c92[U]) >>13)];
  1290. dest[2]=clip_table[((Y + yuvtab_3343[V]) >>13)];
  1291. dest+= 4;
  1292. }
  1293. }
  1294. else if (dstFormat==PIX_FMT_BGR24)
  1295. {
  1296. int i;
  1297. for (i=0;i<dstW;i++){
  1298. // vertical linear interpolation && yuv2rgb in a single step:
  1299. int Y=yuvtab_2568[((buf0[i]*yalpha1+buf1[i]*yalpha)>>19)];
  1300. int U=((uvbuf0[i]*uvalpha1+uvbuf1[i]*uvalpha)>>19);
  1301. int V=((uvbuf0[i+VOFW]*uvalpha1+uvbuf1[i+VOFW]*uvalpha)>>19);
  1302. dest[0]=clip_table[((Y + yuvtab_40cf[U]) >>13)];
  1303. dest[1]=clip_table[((Y + yuvtab_1a1e[V] + yuvtab_0c92[U]) >>13)];
  1304. dest[2]=clip_table[((Y + yuvtab_3343[V]) >>13)];
  1305. dest+= 3;
  1306. }
  1307. }
  1308. else if (dstFormat==PIX_FMT_BGR565)
  1309. {
  1310. int i;
  1311. for (i=0;i<dstW;i++){
  1312. // vertical linear interpolation && yuv2rgb in a single step:
  1313. int Y=yuvtab_2568[((buf0[i]*yalpha1+buf1[i]*yalpha)>>19)];
  1314. int U=((uvbuf0[i]*uvalpha1+uvbuf1[i]*uvalpha)>>19);
  1315. int V=((uvbuf0[i+VOFW]*uvalpha1+uvbuf1[i+VOFW]*uvalpha)>>19);
  1316. ((uint16_t*)dest)[i] =
  1317. clip_table16b[(Y + yuvtab_40cf[U]) >>13] |
  1318. clip_table16g[(Y + yuvtab_1a1e[V] + yuvtab_0c92[U]) >>13] |
  1319. clip_table16r[(Y + yuvtab_3343[V]) >>13];
  1320. }
  1321. }
  1322. else if (dstFormat==PIX_FMT_BGR555)
  1323. {
  1324. int i;
  1325. for (i=0;i<dstW;i++){
  1326. // vertical linear interpolation && yuv2rgb in a single step:
  1327. int Y=yuvtab_2568[((buf0[i]*yalpha1+buf1[i]*yalpha)>>19)];
  1328. int U=((uvbuf0[i]*uvalpha1+uvbuf1[i]*uvalpha)>>19);
  1329. int V=((uvbuf0[i+VOFW]*uvalpha1+uvbuf1[i+VOFW]*uvalpha)>>19);
  1330. ((uint16_t*)dest)[i] =
  1331. clip_table15b[(Y + yuvtab_40cf[U]) >>13] |
  1332. clip_table15g[(Y + yuvtab_1a1e[V] + yuvtab_0c92[U]) >>13] |
  1333. clip_table15r[(Y + yuvtab_3343[V]) >>13];
  1334. }
  1335. }
  1336. }//FULL_UV_IPOL
  1337. else
  1338. {
  1339. #endif // if 0
  1340. #ifdef HAVE_MMX
  1341. switch(c->dstFormat)
  1342. {
  1343. //Note 8280 == DSTW_OFFSET but the preprocessor can't handle that there :(
  1344. case PIX_FMT_RGB32:
  1345. asm volatile(
  1346. "mov %%"REG_b", "ESP_OFFSET"(%5) \n\t"
  1347. "mov %4, %%"REG_b" \n\t"
  1348. "push %%"REG_BP" \n\t"
  1349. YSCALEYUV2RGB(%%REGBP, %5)
  1350. WRITEBGR32(%%REGb, 8280(%5), %%REGBP)
  1351. "pop %%"REG_BP" \n\t"
  1352. "mov "ESP_OFFSET"(%5), %%"REG_b" \n\t"
  1353. :: "c" (buf0), "d" (buf1), "S" (uvbuf0), "D" (uvbuf1), "m" (dest),
  1354. "a" (&c->redDither)
  1355. );
  1356. return;
  1357. case PIX_FMT_BGR24:
  1358. asm volatile(
  1359. "mov %%"REG_b", "ESP_OFFSET"(%5) \n\t"
  1360. "mov %4, %%"REG_b" \n\t"
  1361. "push %%"REG_BP" \n\t"
  1362. YSCALEYUV2RGB(%%REGBP, %5)
  1363. WRITEBGR24(%%REGb, 8280(%5), %%REGBP)
  1364. "pop %%"REG_BP" \n\t"
  1365. "mov "ESP_OFFSET"(%5), %%"REG_b" \n\t"
  1366. :: "c" (buf0), "d" (buf1), "S" (uvbuf0), "D" (uvbuf1), "m" (dest),
  1367. "a" (&c->redDither)
  1368. );
  1369. return;
  1370. case PIX_FMT_RGB555:
  1371. asm volatile(
  1372. "mov %%"REG_b", "ESP_OFFSET"(%5) \n\t"
  1373. "mov %4, %%"REG_b" \n\t"
  1374. "push %%"REG_BP" \n\t"
  1375. YSCALEYUV2RGB(%%REGBP, %5)
  1376. /* mm2=B, %%mm4=G, %%mm5=R, %%mm7=0 */
  1377. #ifdef DITHER1XBPP
  1378. "paddusb "MANGLE(b5Dither)", %%mm2 \n\t"
  1379. "paddusb "MANGLE(g5Dither)", %%mm4 \n\t"
  1380. "paddusb "MANGLE(r5Dither)", %%mm5 \n\t"
  1381. #endif
  1382. WRITERGB15(%%REGb, 8280(%5), %%REGBP)
  1383. "pop %%"REG_BP" \n\t"
  1384. "mov "ESP_OFFSET"(%5), %%"REG_b" \n\t"
  1385. :: "c" (buf0), "d" (buf1), "S" (uvbuf0), "D" (uvbuf1), "m" (dest),
  1386. "a" (&c->redDither)
  1387. );
  1388. return;
  1389. case PIX_FMT_RGB565:
  1390. asm volatile(
  1391. "mov %%"REG_b", "ESP_OFFSET"(%5) \n\t"
  1392. "mov %4, %%"REG_b" \n\t"
  1393. "push %%"REG_BP" \n\t"
  1394. YSCALEYUV2RGB(%%REGBP, %5)
  1395. /* mm2=B, %%mm4=G, %%mm5=R, %%mm7=0 */
  1396. #ifdef DITHER1XBPP
  1397. "paddusb "MANGLE(b5Dither)", %%mm2 \n\t"
  1398. "paddusb "MANGLE(g6Dither)", %%mm4 \n\t"
  1399. "paddusb "MANGLE(r5Dither)", %%mm5 \n\t"
  1400. #endif
  1401. WRITERGB16(%%REGb, 8280(%5), %%REGBP)
  1402. "pop %%"REG_BP" \n\t"
  1403. "mov "ESP_OFFSET"(%5), %%"REG_b" \n\t"
  1404. :: "c" (buf0), "d" (buf1), "S" (uvbuf0), "D" (uvbuf1), "m" (dest),
  1405. "a" (&c->redDither)
  1406. );
  1407. return;
  1408. case PIX_FMT_YUYV422:
  1409. asm volatile(
  1410. "mov %%"REG_b", "ESP_OFFSET"(%5) \n\t"
  1411. "mov %4, %%"REG_b" \n\t"
  1412. "push %%"REG_BP" \n\t"
  1413. YSCALEYUV2PACKED(%%REGBP, %5)
  1414. WRITEYUY2(%%REGb, 8280(%5), %%REGBP)
  1415. "pop %%"REG_BP" \n\t"
  1416. "mov "ESP_OFFSET"(%5), %%"REG_b" \n\t"
  1417. :: "c" (buf0), "d" (buf1), "S" (uvbuf0), "D" (uvbuf1), "m" (dest),
  1418. "a" (&c->redDither)
  1419. );
  1420. return;
  1421. default: break;
  1422. }
  1423. #endif //HAVE_MMX
  1424. YSCALE_YUV_2_ANYRGB_C(YSCALE_YUV_2_RGB2_C, YSCALE_YUV_2_PACKED2_C, YSCALE_YUV_2_GRAY16_2_C)
  1425. }
  1426. /**
  1427. * YV12 to RGB without scaling or interpolating
  1428. */
  1429. static inline void RENAME(yuv2packed1)(SwsContext *c, uint16_t *buf0, uint16_t *uvbuf0, uint16_t *uvbuf1,
  1430. uint8_t *dest, int dstW, int uvalpha, int dstFormat, int flags, int y)
  1431. {
  1432. const int yalpha1=0;
  1433. int i;
  1434. uint16_t *buf1= buf0; //FIXME needed for RGB1/BGR1
  1435. const int yalpha= 4096; //FIXME ...
  1436. if (flags&SWS_FULL_CHR_H_INT)
  1437. {
  1438. RENAME(yuv2packed2)(c, buf0, buf0, uvbuf0, uvbuf1, dest, dstW, 0, uvalpha, y);
  1439. return;
  1440. }
  1441. #ifdef HAVE_MMX
  1442. if (uvalpha < 2048) // note this is not correct (shifts chrominance by 0.5 pixels) but it is a bit faster
  1443. {
  1444. switch(dstFormat)
  1445. {
  1446. case PIX_FMT_RGB32:
  1447. asm volatile(
  1448. "mov %%"REG_b", "ESP_OFFSET"(%5) \n\t"
  1449. "mov %4, %%"REG_b" \n\t"
  1450. "push %%"REG_BP" \n\t"
  1451. YSCALEYUV2RGB1(%%REGBP, %5)
  1452. WRITEBGR32(%%REGb, 8280(%5), %%REGBP)
  1453. "pop %%"REG_BP" \n\t"
  1454. "mov "ESP_OFFSET"(%5), %%"REG_b" \n\t"
  1455. :: "c" (buf0), "d" (buf1), "S" (uvbuf0), "D" (uvbuf1), "m" (dest),
  1456. "a" (&c->redDither)
  1457. );
  1458. return;
  1459. case PIX_FMT_BGR24:
  1460. asm volatile(
  1461. "mov %%"REG_b", "ESP_OFFSET"(%5) \n\t"
  1462. "mov %4, %%"REG_b" \n\t"
  1463. "push %%"REG_BP" \n\t"
  1464. YSCALEYUV2RGB1(%%REGBP, %5)
  1465. WRITEBGR24(%%REGb, 8280(%5), %%REGBP)
  1466. "pop %%"REG_BP" \n\t"
  1467. "mov "ESP_OFFSET"(%5), %%"REG_b" \n\t"
  1468. :: "c" (buf0), "d" (buf1), "S" (uvbuf0), "D" (uvbuf1), "m" (dest),
  1469. "a" (&c->redDither)
  1470. );
  1471. return;
  1472. case PIX_FMT_RGB555:
  1473. asm volatile(
  1474. "mov %%"REG_b", "ESP_OFFSET"(%5) \n\t"
  1475. "mov %4, %%"REG_b" \n\t"
  1476. "push %%"REG_BP" \n\t"
  1477. YSCALEYUV2RGB1(%%REGBP, %5)
  1478. /* mm2=B, %%mm4=G, %%mm5=R, %%mm7=0 */
  1479. #ifdef DITHER1XBPP
  1480. "paddusb "MANGLE(b5Dither)", %%mm2 \n\t"
  1481. "paddusb "MANGLE(g5Dither)", %%mm4 \n\t"
  1482. "paddusb "MANGLE(r5Dither)", %%mm5 \n\t"
  1483. #endif
  1484. WRITERGB15(%%REGb, 8280(%5), %%REGBP)
  1485. "pop %%"REG_BP" \n\t"
  1486. "mov "ESP_OFFSET"(%5), %%"REG_b" \n\t"
  1487. :: "c" (buf0), "d" (buf1), "S" (uvbuf0), "D" (uvbuf1), "m" (dest),
  1488. "a" (&c->redDither)
  1489. );
  1490. return;
  1491. case PIX_FMT_RGB565:
  1492. asm volatile(
  1493. "mov %%"REG_b", "ESP_OFFSET"(%5) \n\t"
  1494. "mov %4, %%"REG_b" \n\t"
  1495. "push %%"REG_BP" \n\t"
  1496. YSCALEYUV2RGB1(%%REGBP, %5)
  1497. /* mm2=B, %%mm4=G, %%mm5=R, %%mm7=0 */
  1498. #ifdef DITHER1XBPP
  1499. "paddusb "MANGLE(b5Dither)", %%mm2 \n\t"
  1500. "paddusb "MANGLE(g6Dither)", %%mm4 \n\t"
  1501. "paddusb "MANGLE(r5Dither)", %%mm5 \n\t"
  1502. #endif
  1503. WRITERGB16(%%REGb, 8280(%5), %%REGBP)
  1504. "pop %%"REG_BP" \n\t"
  1505. "mov "ESP_OFFSET"(%5), %%"REG_b" \n\t"
  1506. :: "c" (buf0), "d" (buf1), "S" (uvbuf0), "D" (uvbuf1), "m" (dest),
  1507. "a" (&c->redDither)
  1508. );
  1509. return;
  1510. case PIX_FMT_YUYV422:
  1511. asm volatile(
  1512. "mov %%"REG_b", "ESP_OFFSET"(%5) \n\t"
  1513. "mov %4, %%"REG_b" \n\t"
  1514. "push %%"REG_BP" \n\t"
  1515. YSCALEYUV2PACKED1(%%REGBP, %5)
  1516. WRITEYUY2(%%REGb, 8280(%5), %%REGBP)
  1517. "pop %%"REG_BP" \n\t"
  1518. "mov "ESP_OFFSET"(%5), %%"REG_b" \n\t"
  1519. :: "c" (buf0), "d" (buf1), "S" (uvbuf0), "D" (uvbuf1), "m" (dest),
  1520. "a" (&c->redDither)
  1521. );
  1522. return;
  1523. }
  1524. }
  1525. else
  1526. {
  1527. switch(dstFormat)
  1528. {
  1529. case PIX_FMT_RGB32:
  1530. asm volatile(
  1531. "mov %%"REG_b", "ESP_OFFSET"(%5) \n\t"
  1532. "mov %4, %%"REG_b" \n\t"
  1533. "push %%"REG_BP" \n\t"
  1534. YSCALEYUV2RGB1b(%%REGBP, %5)
  1535. WRITEBGR32(%%REGb, 8280(%5), %%REGBP)
  1536. "pop %%"REG_BP" \n\t"
  1537. "mov "ESP_OFFSET"(%5), %%"REG_b" \n\t"
  1538. :: "c" (buf0), "d" (buf1), "S" (uvbuf0), "D" (uvbuf1), "m" (dest),
  1539. "a" (&c->redDither)
  1540. );
  1541. return;
  1542. case PIX_FMT_BGR24:
  1543. asm volatile(
  1544. "mov %%"REG_b", "ESP_OFFSET"(%5) \n\t"
  1545. "mov %4, %%"REG_b" \n\t"
  1546. "push %%"REG_BP" \n\t"
  1547. YSCALEYUV2RGB1b(%%REGBP, %5)
  1548. WRITEBGR24(%%REGb, 8280(%5), %%REGBP)
  1549. "pop %%"REG_BP" \n\t"
  1550. "mov "ESP_OFFSET"(%5), %%"REG_b" \n\t"
  1551. :: "c" (buf0), "d" (buf1), "S" (uvbuf0), "D" (uvbuf1), "m" (dest),
  1552. "a" (&c->redDither)
  1553. );
  1554. return;
  1555. case PIX_FMT_RGB555:
  1556. asm volatile(
  1557. "mov %%"REG_b", "ESP_OFFSET"(%5) \n\t"
  1558. "mov %4, %%"REG_b" \n\t"
  1559. "push %%"REG_BP" \n\t"
  1560. YSCALEYUV2RGB1b(%%REGBP, %5)
  1561. /* mm2=B, %%mm4=G, %%mm5=R, %%mm7=0 */
  1562. #ifdef DITHER1XBPP
  1563. "paddusb "MANGLE(b5Dither)", %%mm2 \n\t"
  1564. "paddusb "MANGLE(g5Dither)", %%mm4 \n\t"
  1565. "paddusb "MANGLE(r5Dither)", %%mm5 \n\t"
  1566. #endif
  1567. WRITERGB15(%%REGb, 8280(%5), %%REGBP)
  1568. "pop %%"REG_BP" \n\t"
  1569. "mov "ESP_OFFSET"(%5), %%"REG_b" \n\t"
  1570. :: "c" (buf0), "d" (buf1), "S" (uvbuf0), "D" (uvbuf1), "m" (dest),
  1571. "a" (&c->redDither)
  1572. );
  1573. return;
  1574. case PIX_FMT_RGB565:
  1575. asm volatile(
  1576. "mov %%"REG_b", "ESP_OFFSET"(%5) \n\t"
  1577. "mov %4, %%"REG_b" \n\t"
  1578. "push %%"REG_BP" \n\t"
  1579. YSCALEYUV2RGB1b(%%REGBP, %5)
  1580. /* mm2=B, %%mm4=G, %%mm5=R, %%mm7=0 */
  1581. #ifdef DITHER1XBPP
  1582. "paddusb "MANGLE(b5Dither)", %%mm2 \n\t"
  1583. "paddusb "MANGLE(g6Dither)", %%mm4 \n\t"
  1584. "paddusb "MANGLE(r5Dither)", %%mm5 \n\t"
  1585. #endif
  1586. WRITERGB16(%%REGb, 8280(%5), %%REGBP)
  1587. "pop %%"REG_BP" \n\t"
  1588. "mov "ESP_OFFSET"(%5), %%"REG_b" \n\t"
  1589. :: "c" (buf0), "d" (buf1), "S" (uvbuf0), "D" (uvbuf1), "m" (dest),
  1590. "a" (&c->redDither)
  1591. );
  1592. return;
  1593. case PIX_FMT_YUYV422:
  1594. asm volatile(
  1595. "mov %%"REG_b", "ESP_OFFSET"(%5) \n\t"
  1596. "mov %4, %%"REG_b" \n\t"
  1597. "push %%"REG_BP" \n\t"
  1598. YSCALEYUV2PACKED1b(%%REGBP, %5)
  1599. WRITEYUY2(%%REGb, 8280(%5), %%REGBP)
  1600. "pop %%"REG_BP" \n\t"
  1601. "mov "ESP_OFFSET"(%5), %%"REG_b" \n\t"
  1602. :: "c" (buf0), "d" (buf1), "S" (uvbuf0), "D" (uvbuf1), "m" (dest),
  1603. "a" (&c->redDither)
  1604. );
  1605. return;
  1606. }
  1607. }
  1608. #endif /* HAVE_MMX */
  1609. if (uvalpha < 2048)
  1610. {
  1611. YSCALE_YUV_2_ANYRGB_C(YSCALE_YUV_2_RGB1_C, YSCALE_YUV_2_PACKED1_C, YSCALE_YUV_2_GRAY16_1_C)
  1612. }else{
  1613. YSCALE_YUV_2_ANYRGB_C(YSCALE_YUV_2_RGB1B_C, YSCALE_YUV_2_PACKED1B_C, YSCALE_YUV_2_GRAY16_1_C)
  1614. }
  1615. }
  1616. //FIXME yuy2* can read up to 7 samples too much
  1617. static inline void RENAME(yuy2ToY)(uint8_t *dst, uint8_t *src, long width)
  1618. {
  1619. #ifdef HAVE_MMX
  1620. asm volatile(
  1621. "movq "MANGLE(bm01010101)", %%mm2 \n\t"
  1622. "mov %0, %%"REG_a" \n\t"
  1623. "1: \n\t"
  1624. "movq (%1, %%"REG_a",2), %%mm0 \n\t"
  1625. "movq 8(%1, %%"REG_a",2), %%mm1 \n\t"
  1626. "pand %%mm2, %%mm0 \n\t"
  1627. "pand %%mm2, %%mm1 \n\t"
  1628. "packuswb %%mm1, %%mm0 \n\t"
  1629. "movq %%mm0, (%2, %%"REG_a") \n\t"
  1630. "add $8, %%"REG_a" \n\t"
  1631. " js 1b \n\t"
  1632. : : "g" (-width), "r" (src+width*2), "r" (dst+width)
  1633. : "%"REG_a
  1634. );
  1635. #else
  1636. int i;
  1637. for (i=0; i<width; i++)
  1638. dst[i]= src[2*i];
  1639. #endif
  1640. }
  1641. static inline void RENAME(yuy2ToUV)(uint8_t *dstU, uint8_t *dstV, uint8_t *src1, uint8_t *src2, long width)
  1642. {
  1643. #ifdef HAVE_MMX
  1644. asm volatile(
  1645. "movq "MANGLE(bm01010101)", %%mm4 \n\t"
  1646. "mov %0, %%"REG_a" \n\t"
  1647. "1: \n\t"
  1648. "movq (%1, %%"REG_a",4), %%mm0 \n\t"
  1649. "movq 8(%1, %%"REG_a",4), %%mm1 \n\t"
  1650. "psrlw $8, %%mm0 \n\t"
  1651. "psrlw $8, %%mm1 \n\t"
  1652. "packuswb %%mm1, %%mm0 \n\t"
  1653. "movq %%mm0, %%mm1 \n\t"
  1654. "psrlw $8, %%mm0 \n\t"
  1655. "pand %%mm4, %%mm1 \n\t"
  1656. "packuswb %%mm0, %%mm0 \n\t"
  1657. "packuswb %%mm1, %%mm1 \n\t"
  1658. "movd %%mm0, (%3, %%"REG_a") \n\t"
  1659. "movd %%mm1, (%2, %%"REG_a") \n\t"
  1660. "add $4, %%"REG_a" \n\t"
  1661. " js 1b \n\t"
  1662. : : "g" (-width), "r" (src1+width*4), "r" (dstU+width), "r" (dstV+width)
  1663. : "%"REG_a
  1664. );
  1665. #else
  1666. int i;
  1667. for (i=0; i<width; i++)
  1668. {
  1669. dstU[i]= src1[4*i + 1];
  1670. dstV[i]= src1[4*i + 3];
  1671. }
  1672. #endif
  1673. assert(src1 == src2);
  1674. }
  1675. /* This is almost identical to the previous, end exists only because
  1676. * yuy2ToY/UV)(dst, src+1, ...) would have 100% unaligned accesses. */
  1677. static inline void RENAME(uyvyToY)(uint8_t *dst, uint8_t *src, long width)
  1678. {
  1679. #ifdef HAVE_MMX
  1680. asm volatile(
  1681. "mov %0, %%"REG_a" \n\t"
  1682. "1: \n\t"
  1683. "movq (%1, %%"REG_a",2), %%mm0 \n\t"
  1684. "movq 8(%1, %%"REG_a",2), %%mm1 \n\t"
  1685. "psrlw $8, %%mm0 \n\t"
  1686. "psrlw $8, %%mm1 \n\t"
  1687. "packuswb %%mm1, %%mm0 \n\t"
  1688. "movq %%mm0, (%2, %%"REG_a") \n\t"
  1689. "add $8, %%"REG_a" \n\t"
  1690. " js 1b \n\t"
  1691. : : "g" (-width), "r" (src+width*2), "r" (dst+width)
  1692. : "%"REG_a
  1693. );
  1694. #else
  1695. int i;
  1696. for (i=0; i<width; i++)
  1697. dst[i]= src[2*i+1];
  1698. #endif
  1699. }
  1700. static inline void RENAME(uyvyToUV)(uint8_t *dstU, uint8_t *dstV, uint8_t *src1, uint8_t *src2, long width)
  1701. {
  1702. #ifdef HAVE_MMX
  1703. asm volatile(
  1704. "movq "MANGLE(bm01010101)", %%mm4 \n\t"
  1705. "mov %0, %%"REG_a" \n\t"
  1706. "1: \n\t"
  1707. "movq (%1, %%"REG_a",4), %%mm0 \n\t"
  1708. "movq 8(%1, %%"REG_a",4), %%mm1 \n\t"
  1709. "pand %%mm4, %%mm0 \n\t"
  1710. "pand %%mm4, %%mm1 \n\t"
  1711. "packuswb %%mm1, %%mm0 \n\t"
  1712. "movq %%mm0, %%mm1 \n\t"
  1713. "psrlw $8, %%mm0 \n\t"
  1714. "pand %%mm4, %%mm1 \n\t"
  1715. "packuswb %%mm0, %%mm0 \n\t"
  1716. "packuswb %%mm1, %%mm1 \n\t"
  1717. "movd %%mm0, (%3, %%"REG_a") \n\t"
  1718. "movd %%mm1, (%2, %%"REG_a") \n\t"
  1719. "add $4, %%"REG_a" \n\t"
  1720. " js 1b \n\t"
  1721. : : "g" (-width), "r" (src1+width*4), "r" (dstU+width), "r" (dstV+width)
  1722. : "%"REG_a
  1723. );
  1724. #else
  1725. int i;
  1726. for (i=0; i<width; i++)
  1727. {
  1728. dstU[i]= src1[4*i + 0];
  1729. dstV[i]= src1[4*i + 2];
  1730. }
  1731. #endif
  1732. assert(src1 == src2);
  1733. }
  1734. #define BGR2Y(type, name, shr, shg, shb, maskr, maskg, maskb, RY, GY, BY, S)\
  1735. static inline void RENAME(name)(uint8_t *dst, uint8_t *src, long width)\
  1736. {\
  1737. int i;\
  1738. for (i=0; i<width; i++)\
  1739. {\
  1740. int b= (((type*)src)[i]>>shb)&maskb;\
  1741. int g= (((type*)src)[i]>>shg)&maskg;\
  1742. int r= (((type*)src)[i]>>shr)&maskr;\
  1743. \
  1744. dst[i]= (((RY)*r + (GY)*g + (BY)*b + (33<<((S)-1)))>>(S));\
  1745. }\
  1746. }
  1747. BGR2Y(uint32_t, bgr32ToY,16, 0, 0, 0x00FF, 0xFF00, 0x00FF, RY<< 8, GY , BY<< 8, RGB2YUV_SHIFT+8)
  1748. BGR2Y(uint32_t, rgb32ToY, 0, 0,16, 0x00FF, 0xFF00, 0x00FF, RY<< 8, GY , BY<< 8, RGB2YUV_SHIFT+8)
  1749. BGR2Y(uint16_t, bgr16ToY, 0, 0, 0, 0x001F, 0x07E0, 0xF800, RY<<11, GY<<5, BY , RGB2YUV_SHIFT+8)
  1750. BGR2Y(uint16_t, bgr15ToY, 0, 0, 0, 0x001F, 0x03E0, 0x7C00, RY<<10, GY<<5, BY , RGB2YUV_SHIFT+7)
  1751. BGR2Y(uint16_t, rgb16ToY, 0, 0, 0, 0xF800, 0x07E0, 0x001F, RY , GY<<5, BY<<11, RGB2YUV_SHIFT+8)
  1752. BGR2Y(uint16_t, rgb15ToY, 0, 0, 0, 0x7C00, 0x03E0, 0x001F, RY , GY<<5, BY<<10, RGB2YUV_SHIFT+7)
  1753. #define BGR2UV(type, name, shr, shg, shb, maskr, maskg, maskb, RU, GU, BU, RV, GV, BV, S)\
  1754. static inline void RENAME(name)(uint8_t *dstU, uint8_t *dstV, uint8_t *src, uint8_t *dummy, long width)\
  1755. {\
  1756. int i;\
  1757. for (i=0; i<width; i++)\
  1758. {\
  1759. int b= (((type*)src)[i]&maskb)>>shb;\
  1760. int g= (((type*)src)[i]&maskg)>>shg;\
  1761. int r= (((type*)src)[i]&maskr)>>shr;\
  1762. \
  1763. dstU[i]= ((RU)*r + (GU)*g + (BU)*b + (257<<((S)-1)))>>(S);\
  1764. dstV[i]= ((RV)*r + (GV)*g + (BV)*b + (257<<((S)-1)))>>(S);\
  1765. }\
  1766. }\
  1767. static inline void RENAME(name ## _half)(uint8_t *dstU, uint8_t *dstV, uint8_t *src, uint8_t *dummy, long width)\
  1768. {\
  1769. int i;\
  1770. for (i=0; i<width; i++)\
  1771. {\
  1772. int pix0= ((type*)src)[2*i+0];\
  1773. int pix1= ((type*)src)[2*i+1];\
  1774. int g= (pix0&maskg)+(pix1&maskg);\
  1775. int b= ((pix0+pix1-g)&(maskb|(2*maskb)))>>shb;\
  1776. int r= ((pix0+pix1-g)&(maskr|(2*maskr)))>>shr;\
  1777. \
  1778. g>>=shg;\
  1779. \
  1780. dstU[i]= ((RU)*r + (GU)*g + (BU)*b + (257<<(S)))>>((S)+1);\
  1781. dstV[i]= ((RV)*r + (GV)*g + (BV)*b + (257<<(S)))>>((S)+1);\
  1782. }\
  1783. }
  1784. BGR2UV(uint32_t, bgr32ToUV,16, 0, 0, 0xFF0000, 0xFF00, 0x00FF, RU<< 8, GU , BU<< 8, RV<< 8, GV , BV<< 8, RGB2YUV_SHIFT+8)
  1785. BGR2UV(uint32_t, rgb32ToUV, 0, 0,16, 0x00FF, 0xFF00, 0xFF0000, RU<< 8, GU , BU<< 8, RV<< 8, GV , BV<< 8, RGB2YUV_SHIFT+8)
  1786. BGR2UV(uint16_t, bgr16ToUV, 0, 0, 0, 0x001F, 0x07E0, 0xF800, RU<<11, GU<<5, BU , RV<<11, GV<<5, BV , RGB2YUV_SHIFT+8)
  1787. BGR2UV(uint16_t, bgr15ToUV, 0, 0, 0, 0x001F, 0x03E0, 0x7C00, RU<<10, GU<<5, BU , RV<<10, GV<<5, BV , RGB2YUV_SHIFT+7)
  1788. BGR2UV(uint16_t, rgb16ToUV, 0, 0, 0, 0xF800, 0x07E0, 0x001F, RU , GU<<5, BU<<11, RV , GV<<5, BV<<11, RGB2YUV_SHIFT+8)
  1789. BGR2UV(uint16_t, rgb15ToUV, 0, 0, 0, 0x7C00, 0x03E0, 0x001F, RU , GU<<5, BU<<10, RV , GV<<5, BV<<10, RGB2YUV_SHIFT+7)
  1790. #ifdef HAVE_MMX
  1791. static inline void bgr24ToY_mmx(uint8_t *dst, uint8_t *src, long width, int srcFormat)
  1792. {
  1793. if(srcFormat == PIX_FMT_BGR24){
  1794. asm volatile(
  1795. "movq "MANGLE(ff_bgr24toY1Coeff)", %%mm5 \n\t"
  1796. "movq "MANGLE(ff_bgr24toY2Coeff)", %%mm6 \n\t"
  1797. :
  1798. );
  1799. }else{
  1800. asm volatile(
  1801. "movq "MANGLE(ff_rgb24toY1Coeff)", %%mm5 \n\t"
  1802. "movq "MANGLE(ff_rgb24toY2Coeff)", %%mm6 \n\t"
  1803. :
  1804. );
  1805. }
  1806. asm volatile(
  1807. "movq "MANGLE(ff_bgr24toYOffset)", %%mm4 \n\t"
  1808. "mov %2, %%"REG_a" \n\t"
  1809. "pxor %%mm7, %%mm7 \n\t"
  1810. "1: \n\t"
  1811. PREFETCH" 64(%0) \n\t"
  1812. "movd (%0), %%mm0 \n\t"
  1813. "movd 2(%0), %%mm1 \n\t"
  1814. "movd 6(%0), %%mm2 \n\t"
  1815. "movd 8(%0), %%mm3 \n\t"
  1816. "add $12, %0 \n\t"
  1817. "punpcklbw %%mm7, %%mm0 \n\t"
  1818. "punpcklbw %%mm7, %%mm1 \n\t"
  1819. "punpcklbw %%mm7, %%mm2 \n\t"
  1820. "punpcklbw %%mm7, %%mm3 \n\t"
  1821. "pmaddwd %%mm5, %%mm0 \n\t"
  1822. "pmaddwd %%mm6, %%mm1 \n\t"
  1823. "pmaddwd %%mm5, %%mm2 \n\t"
  1824. "pmaddwd %%mm6, %%mm3 \n\t"
  1825. "paddd %%mm1, %%mm0 \n\t"
  1826. "paddd %%mm3, %%mm2 \n\t"
  1827. "paddd %%mm4, %%mm0 \n\t"
  1828. "paddd %%mm4, %%mm2 \n\t"
  1829. "psrad $15, %%mm0 \n\t"
  1830. "psrad $15, %%mm2 \n\t"
  1831. "packssdw %%mm2, %%mm0 \n\t"
  1832. "packuswb %%mm0, %%mm0 \n\t"
  1833. "movd %%mm0, (%1, %%"REG_a") \n\t"
  1834. "add $4, %%"REG_a" \n\t"
  1835. " js 1b \n\t"
  1836. : "+r" (src)
  1837. : "r" (dst+width), "g" (-width)
  1838. : "%"REG_a
  1839. );
  1840. }
  1841. static inline void bgr24ToUV_mmx(uint8_t *dstU, uint8_t *dstV, uint8_t *src, long width, int srcFormat)
  1842. {
  1843. asm volatile(
  1844. "movq 24+%4, %%mm6 \n\t"
  1845. "mov %3, %%"REG_a" \n\t"
  1846. "pxor %%mm7, %%mm7 \n\t"
  1847. "1: \n\t"
  1848. PREFETCH" 64(%0) \n\t"
  1849. "movd (%0), %%mm0 \n\t"
  1850. "movd 2(%0), %%mm1 \n\t"
  1851. "punpcklbw %%mm7, %%mm0 \n\t"
  1852. "punpcklbw %%mm7, %%mm1 \n\t"
  1853. "movq %%mm0, %%mm2 \n\t"
  1854. "movq %%mm1, %%mm3 \n\t"
  1855. "pmaddwd %4, %%mm0 \n\t"
  1856. "pmaddwd 8+%4, %%mm1 \n\t"
  1857. "pmaddwd 16+%4, %%mm2 \n\t"
  1858. "pmaddwd %%mm6, %%mm3 \n\t"
  1859. "paddd %%mm1, %%mm0 \n\t"
  1860. "paddd %%mm3, %%mm2 \n\t"
  1861. "movd 6(%0), %%mm1 \n\t"
  1862. "movd 8(%0), %%mm3 \n\t"
  1863. "add $12, %0 \n\t"
  1864. "punpcklbw %%mm7, %%mm1 \n\t"
  1865. "punpcklbw %%mm7, %%mm3 \n\t"
  1866. "movq %%mm1, %%mm4 \n\t"
  1867. "movq %%mm3, %%mm5 \n\t"
  1868. "pmaddwd %4, %%mm1 \n\t"
  1869. "pmaddwd 8+%4, %%mm3 \n\t"
  1870. "pmaddwd 16+%4, %%mm4 \n\t"
  1871. "pmaddwd %%mm6, %%mm5 \n\t"
  1872. "paddd %%mm3, %%mm1 \n\t"
  1873. "paddd %%mm5, %%mm4 \n\t"
  1874. "movq "MANGLE(ff_bgr24toUVOffset)", %%mm3 \n\t"
  1875. "paddd %%mm3, %%mm0 \n\t"
  1876. "paddd %%mm3, %%mm2 \n\t"
  1877. "paddd %%mm3, %%mm1 \n\t"
  1878. "paddd %%mm3, %%mm4 \n\t"
  1879. "psrad $15, %%mm0 \n\t"
  1880. "psrad $15, %%mm2 \n\t"
  1881. "psrad $15, %%mm1 \n\t"
  1882. "psrad $15, %%mm4 \n\t"
  1883. "packssdw %%mm1, %%mm0 \n\t"
  1884. "packssdw %%mm4, %%mm2 \n\t"
  1885. "packuswb %%mm0, %%mm0 \n\t"
  1886. "packuswb %%mm2, %%mm2 \n\t"
  1887. "movd %%mm0, (%1, %%"REG_a") \n\t"
  1888. "movd %%mm2, (%2, %%"REG_a") \n\t"
  1889. "add $4, %%"REG_a" \n\t"
  1890. " js 1b \n\t"
  1891. : "+r" (src)
  1892. : "r" (dstU+width), "r" (dstV+width), "g" (-width), "m"(ff_bgr24toUV[srcFormat == PIX_FMT_RGB24][0])
  1893. : "%"REG_a
  1894. );
  1895. }
  1896. #endif
  1897. static inline void RENAME(bgr24ToY)(uint8_t *dst, uint8_t *src, long width)
  1898. {
  1899. #ifdef HAVE_MMX
  1900. bgr24ToY_mmx(dst, src, width, PIX_FMT_BGR24);
  1901. #else
  1902. int i;
  1903. for (i=0; i<width; i++)
  1904. {
  1905. int b= src[i*3+0];
  1906. int g= src[i*3+1];
  1907. int r= src[i*3+2];
  1908. dst[i]= ((RY*r + GY*g + BY*b + (33<<(RGB2YUV_SHIFT-1)))>>RGB2YUV_SHIFT);
  1909. }
  1910. #endif /* HAVE_MMX */
  1911. }
  1912. static inline void RENAME(bgr24ToUV)(uint8_t *dstU, uint8_t *dstV, uint8_t *src1, uint8_t *src2, long width)
  1913. {
  1914. #ifdef HAVE_MMX
  1915. bgr24ToUV_mmx(dstU, dstV, src1, width, PIX_FMT_BGR24);
  1916. #else
  1917. int i;
  1918. for (i=0; i<width; i++)
  1919. {
  1920. int b= src1[3*i + 0];
  1921. int g= src1[3*i + 1];
  1922. int r= src1[3*i + 2];
  1923. dstU[i]= (RU*r + GU*g + BU*b + (257<<(RGB2YUV_SHIFT-1)))>>RGB2YUV_SHIFT;
  1924. dstV[i]= (RV*r + GV*g + BV*b + (257<<(RGB2YUV_SHIFT-1)))>>RGB2YUV_SHIFT;
  1925. }
  1926. #endif /* HAVE_MMX */
  1927. assert(src1 == src2);
  1928. }
  1929. static inline void RENAME(bgr24ToUV_half)(uint8_t *dstU, uint8_t *dstV, uint8_t *src1, uint8_t *src2, long width)
  1930. {
  1931. int i;
  1932. for (i=0; i<width; i++)
  1933. {
  1934. int b= src1[6*i + 0] + src1[6*i + 3];
  1935. int g= src1[6*i + 1] + src1[6*i + 4];
  1936. int r= src1[6*i + 2] + src1[6*i + 5];
  1937. dstU[i]= (RU*r + GU*g + BU*b + (257<<RGB2YUV_SHIFT))>>(RGB2YUV_SHIFT+1);
  1938. dstV[i]= (RV*r + GV*g + BV*b + (257<<RGB2YUV_SHIFT))>>(RGB2YUV_SHIFT+1);
  1939. }
  1940. assert(src1 == src2);
  1941. }
  1942. static inline void RENAME(rgb24ToY)(uint8_t *dst, uint8_t *src, long width)
  1943. {
  1944. #ifdef HAVE_MMX
  1945. bgr24ToY_mmx(dst, src, width, PIX_FMT_RGB24);
  1946. #else
  1947. int i;
  1948. for (i=0; i<width; i++)
  1949. {
  1950. int r= src[i*3+0];
  1951. int g= src[i*3+1];
  1952. int b= src[i*3+2];
  1953. dst[i]= ((RY*r + GY*g + BY*b + (33<<(RGB2YUV_SHIFT-1)))>>RGB2YUV_SHIFT);
  1954. }
  1955. #endif
  1956. }
  1957. static inline void RENAME(rgb24ToUV)(uint8_t *dstU, uint8_t *dstV, uint8_t *src1, uint8_t *src2, long width)
  1958. {
  1959. int i;
  1960. assert(src1==src2);
  1961. #ifdef HAVE_MMX
  1962. bgr24ToUV_mmx(dstU, dstV, src1, width, PIX_FMT_RGB24);
  1963. #else
  1964. for (i=0; i<width; i++)
  1965. {
  1966. int r= src1[3*i + 0];
  1967. int g= src1[3*i + 1];
  1968. int b= src1[3*i + 2];
  1969. dstU[i]= (RU*r + GU*g + BU*b + (257<<(RGB2YUV_SHIFT-1)))>>RGB2YUV_SHIFT;
  1970. dstV[i]= (RV*r + GV*g + BV*b + (257<<(RGB2YUV_SHIFT-1)))>>RGB2YUV_SHIFT;
  1971. }
  1972. #endif
  1973. }
  1974. static inline void RENAME(rgb24ToUV_half)(uint8_t *dstU, uint8_t *dstV, uint8_t *src1, uint8_t *src2, long width)
  1975. {
  1976. int i;
  1977. assert(src1==src2);
  1978. for (i=0; i<width; i++)
  1979. {
  1980. int r= src1[6*i + 0] + src1[6*i + 0];
  1981. int g= src1[6*i + 1] + src1[6*i + 1];
  1982. int b= src1[6*i + 2] + src1[6*i + 2];
  1983. dstU[i]= (RU*r + GU*g + BU*b + (257<<RGB2YUV_SHIFT))>>(RGB2YUV_SHIFT+1);
  1984. dstV[i]= (RV*r + GV*g + BV*b + (257<<RGB2YUV_SHIFT))>>(RGB2YUV_SHIFT+1);
  1985. }
  1986. }
  1987. static inline void RENAME(palToY)(uint8_t *dst, uint8_t *src, long width, uint32_t *pal)
  1988. {
  1989. int i;
  1990. for (i=0; i<width; i++)
  1991. {
  1992. int d= src[i];
  1993. dst[i]= pal[d] & 0xFF;
  1994. }
  1995. }
  1996. static inline void RENAME(palToUV)(uint8_t *dstU, uint8_t *dstV, uint8_t *src1, uint8_t *src2, long width, uint32_t *pal)
  1997. {
  1998. int i;
  1999. assert(src1 == src2);
  2000. for (i=0; i<width; i++)
  2001. {
  2002. int p= pal[src1[i]];
  2003. dstU[i]= p>>8;
  2004. dstV[i]= p>>16;
  2005. }
  2006. }
  2007. // bilinear / bicubic scaling
  2008. static inline void RENAME(hScale)(int16_t *dst, int dstW, uint8_t *src, int srcW, int xInc,
  2009. int16_t *filter, int16_t *filterPos, long filterSize)
  2010. {
  2011. #ifdef HAVE_MMX
  2012. assert(filterSize % 4 == 0 && filterSize>0);
  2013. if (filterSize==4) // Always true for upscaling, sometimes for down, too.
  2014. {
  2015. long counter= -2*dstW;
  2016. filter-= counter*2;
  2017. filterPos-= counter/2;
  2018. dst-= counter/2;
  2019. asm volatile(
  2020. #if defined(PIC)
  2021. "push %%"REG_b" \n\t"
  2022. #endif
  2023. "pxor %%mm7, %%mm7 \n\t"
  2024. "movq "MANGLE(w02)", %%mm6 \n\t"
  2025. "push %%"REG_BP" \n\t" // we use 7 regs here ...
  2026. "mov %%"REG_a", %%"REG_BP" \n\t"
  2027. ASMALIGN(4)
  2028. "1: \n\t"
  2029. "movzwl (%2, %%"REG_BP"), %%eax \n\t"
  2030. "movzwl 2(%2, %%"REG_BP"), %%ebx \n\t"
  2031. "movq (%1, %%"REG_BP", 4), %%mm1 \n\t"
  2032. "movq 8(%1, %%"REG_BP", 4), %%mm3 \n\t"
  2033. "movd (%3, %%"REG_a"), %%mm0 \n\t"
  2034. "movd (%3, %%"REG_b"), %%mm2 \n\t"
  2035. "punpcklbw %%mm7, %%mm0 \n\t"
  2036. "punpcklbw %%mm7, %%mm2 \n\t"
  2037. "pmaddwd %%mm1, %%mm0 \n\t"
  2038. "pmaddwd %%mm2, %%mm3 \n\t"
  2039. "psrad $8, %%mm0 \n\t"
  2040. "psrad $8, %%mm3 \n\t"
  2041. "packssdw %%mm3, %%mm0 \n\t"
  2042. "pmaddwd %%mm6, %%mm0 \n\t"
  2043. "packssdw %%mm0, %%mm0 \n\t"
  2044. "movd %%mm0, (%4, %%"REG_BP") \n\t"
  2045. "add $4, %%"REG_BP" \n\t"
  2046. " jnc 1b \n\t"
  2047. "pop %%"REG_BP" \n\t"
  2048. #if defined(PIC)
  2049. "pop %%"REG_b" \n\t"
  2050. #endif
  2051. : "+a" (counter)
  2052. : "c" (filter), "d" (filterPos), "S" (src), "D" (dst)
  2053. #if !defined(PIC)
  2054. : "%"REG_b
  2055. #endif
  2056. );
  2057. }
  2058. else if (filterSize==8)
  2059. {
  2060. long counter= -2*dstW;
  2061. filter-= counter*4;
  2062. filterPos-= counter/2;
  2063. dst-= counter/2;
  2064. asm volatile(
  2065. #if defined(PIC)
  2066. "push %%"REG_b" \n\t"
  2067. #endif
  2068. "pxor %%mm7, %%mm7 \n\t"
  2069. "movq "MANGLE(w02)", %%mm6 \n\t"
  2070. "push %%"REG_BP" \n\t" // we use 7 regs here ...
  2071. "mov %%"REG_a", %%"REG_BP" \n\t"
  2072. ASMALIGN(4)
  2073. "1: \n\t"
  2074. "movzwl (%2, %%"REG_BP"), %%eax \n\t"
  2075. "movzwl 2(%2, %%"REG_BP"), %%ebx \n\t"
  2076. "movq (%1, %%"REG_BP", 8), %%mm1 \n\t"
  2077. "movq 16(%1, %%"REG_BP", 8), %%mm3 \n\t"
  2078. "movd (%3, %%"REG_a"), %%mm0 \n\t"
  2079. "movd (%3, %%"REG_b"), %%mm2 \n\t"
  2080. "punpcklbw %%mm7, %%mm0 \n\t"
  2081. "punpcklbw %%mm7, %%mm2 \n\t"
  2082. "pmaddwd %%mm1, %%mm0 \n\t"
  2083. "pmaddwd %%mm2, %%mm3 \n\t"
  2084. "movq 8(%1, %%"REG_BP", 8), %%mm1 \n\t"
  2085. "movq 24(%1, %%"REG_BP", 8), %%mm5 \n\t"
  2086. "movd 4(%3, %%"REG_a"), %%mm4 \n\t"
  2087. "movd 4(%3, %%"REG_b"), %%mm2 \n\t"
  2088. "punpcklbw %%mm7, %%mm4 \n\t"
  2089. "punpcklbw %%mm7, %%mm2 \n\t"
  2090. "pmaddwd %%mm1, %%mm4 \n\t"
  2091. "pmaddwd %%mm2, %%mm5 \n\t"
  2092. "paddd %%mm4, %%mm0 \n\t"
  2093. "paddd %%mm5, %%mm3 \n\t"
  2094. "psrad $8, %%mm0 \n\t"
  2095. "psrad $8, %%mm3 \n\t"
  2096. "packssdw %%mm3, %%mm0 \n\t"
  2097. "pmaddwd %%mm6, %%mm0 \n\t"
  2098. "packssdw %%mm0, %%mm0 \n\t"
  2099. "movd %%mm0, (%4, %%"REG_BP") \n\t"
  2100. "add $4, %%"REG_BP" \n\t"
  2101. " jnc 1b \n\t"
  2102. "pop %%"REG_BP" \n\t"
  2103. #if defined(PIC)
  2104. "pop %%"REG_b" \n\t"
  2105. #endif
  2106. : "+a" (counter)
  2107. : "c" (filter), "d" (filterPos), "S" (src), "D" (dst)
  2108. #if !defined(PIC)
  2109. : "%"REG_b
  2110. #endif
  2111. );
  2112. }
  2113. else
  2114. {
  2115. uint8_t *offset = src+filterSize;
  2116. long counter= -2*dstW;
  2117. //filter-= counter*filterSize/2;
  2118. filterPos-= counter/2;
  2119. dst-= counter/2;
  2120. asm volatile(
  2121. "pxor %%mm7, %%mm7 \n\t"
  2122. "movq "MANGLE(w02)", %%mm6 \n\t"
  2123. ASMALIGN(4)
  2124. "1: \n\t"
  2125. "mov %2, %%"REG_c" \n\t"
  2126. "movzwl (%%"REG_c", %0), %%eax \n\t"
  2127. "movzwl 2(%%"REG_c", %0), %%edx \n\t"
  2128. "mov %5, %%"REG_c" \n\t"
  2129. "pxor %%mm4, %%mm4 \n\t"
  2130. "pxor %%mm5, %%mm5 \n\t"
  2131. "2: \n\t"
  2132. "movq (%1), %%mm1 \n\t"
  2133. "movq (%1, %6), %%mm3 \n\t"
  2134. "movd (%%"REG_c", %%"REG_a"), %%mm0 \n\t"
  2135. "movd (%%"REG_c", %%"REG_d"), %%mm2 \n\t"
  2136. "punpcklbw %%mm7, %%mm0 \n\t"
  2137. "punpcklbw %%mm7, %%mm2 \n\t"
  2138. "pmaddwd %%mm1, %%mm0 \n\t"
  2139. "pmaddwd %%mm2, %%mm3 \n\t"
  2140. "paddd %%mm3, %%mm5 \n\t"
  2141. "paddd %%mm0, %%mm4 \n\t"
  2142. "add $8, %1 \n\t"
  2143. "add $4, %%"REG_c" \n\t"
  2144. "cmp %4, %%"REG_c" \n\t"
  2145. " jb 2b \n\t"
  2146. "add %6, %1 \n\t"
  2147. "psrad $8, %%mm4 \n\t"
  2148. "psrad $8, %%mm5 \n\t"
  2149. "packssdw %%mm5, %%mm4 \n\t"
  2150. "pmaddwd %%mm6, %%mm4 \n\t"
  2151. "packssdw %%mm4, %%mm4 \n\t"
  2152. "mov %3, %%"REG_a" \n\t"
  2153. "movd %%mm4, (%%"REG_a", %0) \n\t"
  2154. "add $4, %0 \n\t"
  2155. " jnc 1b \n\t"
  2156. : "+r" (counter), "+r" (filter)
  2157. : "m" (filterPos), "m" (dst), "m"(offset),
  2158. "m" (src), "r" (filterSize*2)
  2159. : "%"REG_a, "%"REG_c, "%"REG_d
  2160. );
  2161. }
  2162. #else
  2163. #ifdef HAVE_ALTIVEC
  2164. hScale_altivec_real(dst, dstW, src, srcW, xInc, filter, filterPos, filterSize);
  2165. #else
  2166. int i;
  2167. for (i=0; i<dstW; i++)
  2168. {
  2169. int j;
  2170. int srcPos= filterPos[i];
  2171. int val=0;
  2172. //printf("filterPos: %d\n", filterPos[i]);
  2173. for (j=0; j<filterSize; j++)
  2174. {
  2175. //printf("filter: %d, src: %d\n", filter[i], src[srcPos + j]);
  2176. val += ((int)src[srcPos + j])*filter[filterSize*i + j];
  2177. }
  2178. //filter += hFilterSize;
  2179. dst[i] = av_clip(val>>7, 0, (1<<15)-1); // the cubic equation does overflow ...
  2180. //dst[i] = val>>7;
  2181. }
  2182. #endif /* HAVE_ALTIVEC */
  2183. #endif /* HAVE_MMX */
  2184. }
  2185. // *** horizontal scale Y line to temp buffer
  2186. static inline void RENAME(hyscale)(SwsContext *c, uint16_t *dst, long dstWidth, uint8_t *src, int srcW, int xInc,
  2187. int flags, int canMMX2BeUsed, int16_t *hLumFilter,
  2188. int16_t *hLumFilterPos, int hLumFilterSize, void *funnyYCode,
  2189. int srcFormat, uint8_t *formatConvBuffer, int16_t *mmx2Filter,
  2190. int32_t *mmx2FilterPos, uint8_t *pal)
  2191. {
  2192. if (srcFormat==PIX_FMT_YUYV422 || srcFormat==PIX_FMT_GRAY16BE)
  2193. {
  2194. RENAME(yuy2ToY)(formatConvBuffer, src, srcW);
  2195. src= formatConvBuffer;
  2196. }
  2197. else if (srcFormat==PIX_FMT_UYVY422 || srcFormat==PIX_FMT_GRAY16LE)
  2198. {
  2199. RENAME(uyvyToY)(formatConvBuffer, src, srcW);
  2200. src= formatConvBuffer;
  2201. }
  2202. else if (srcFormat==PIX_FMT_RGB32)
  2203. {
  2204. RENAME(bgr32ToY)(formatConvBuffer, src, srcW);
  2205. src= formatConvBuffer;
  2206. }
  2207. else if (srcFormat==PIX_FMT_RGB32_1)
  2208. {
  2209. RENAME(bgr32ToY)(formatConvBuffer, src+ALT32_CORR, srcW);
  2210. src= formatConvBuffer;
  2211. }
  2212. else if (srcFormat==PIX_FMT_BGR24)
  2213. {
  2214. RENAME(bgr24ToY)(formatConvBuffer, src, srcW);
  2215. src= formatConvBuffer;
  2216. }
  2217. else if (srcFormat==PIX_FMT_BGR565)
  2218. {
  2219. RENAME(bgr16ToY)(formatConvBuffer, src, srcW);
  2220. src= formatConvBuffer;
  2221. }
  2222. else if (srcFormat==PIX_FMT_BGR555)
  2223. {
  2224. RENAME(bgr15ToY)(formatConvBuffer, src, srcW);
  2225. src= formatConvBuffer;
  2226. }
  2227. else if (srcFormat==PIX_FMT_BGR32)
  2228. {
  2229. RENAME(rgb32ToY)(formatConvBuffer, src, srcW);
  2230. src= formatConvBuffer;
  2231. }
  2232. else if (srcFormat==PIX_FMT_BGR32_1)
  2233. {
  2234. RENAME(rgb32ToY)(formatConvBuffer, src+ALT32_CORR, srcW);
  2235. src= formatConvBuffer;
  2236. }
  2237. else if (srcFormat==PIX_FMT_RGB24)
  2238. {
  2239. RENAME(rgb24ToY)(formatConvBuffer, src, srcW);
  2240. src= formatConvBuffer;
  2241. }
  2242. else if (srcFormat==PIX_FMT_RGB565)
  2243. {
  2244. RENAME(rgb16ToY)(formatConvBuffer, src, srcW);
  2245. src= formatConvBuffer;
  2246. }
  2247. else if (srcFormat==PIX_FMT_RGB555)
  2248. {
  2249. RENAME(rgb15ToY)(formatConvBuffer, src, srcW);
  2250. src= formatConvBuffer;
  2251. }
  2252. else if (srcFormat==PIX_FMT_RGB8 || srcFormat==PIX_FMT_BGR8 || srcFormat==PIX_FMT_PAL8 || srcFormat==PIX_FMT_BGR4_BYTE || srcFormat==PIX_FMT_RGB4_BYTE)
  2253. {
  2254. RENAME(palToY)(formatConvBuffer, src, srcW, (uint32_t*)pal);
  2255. src= formatConvBuffer;
  2256. }
  2257. #ifdef HAVE_MMX
  2258. // Use the new MMX scaler if the MMX2 one can't be used (it is faster than the x86 ASM one).
  2259. if (!(flags&SWS_FAST_BILINEAR) || (!canMMX2BeUsed))
  2260. #else
  2261. if (!(flags&SWS_FAST_BILINEAR))
  2262. #endif
  2263. {
  2264. RENAME(hScale)(dst, dstWidth, src, srcW, xInc, hLumFilter, hLumFilterPos, hLumFilterSize);
  2265. }
  2266. else // fast bilinear upscale / crap downscale
  2267. {
  2268. #if defined(ARCH_X86)
  2269. #ifdef HAVE_MMX2
  2270. int i;
  2271. #if defined(PIC)
  2272. uint64_t ebxsave __attribute__((aligned(8)));
  2273. #endif
  2274. if (canMMX2BeUsed)
  2275. {
  2276. asm volatile(
  2277. #if defined(PIC)
  2278. "mov %%"REG_b", %5 \n\t"
  2279. #endif
  2280. "pxor %%mm7, %%mm7 \n\t"
  2281. "mov %0, %%"REG_c" \n\t"
  2282. "mov %1, %%"REG_D" \n\t"
  2283. "mov %2, %%"REG_d" \n\t"
  2284. "mov %3, %%"REG_b" \n\t"
  2285. "xor %%"REG_a", %%"REG_a" \n\t" // i
  2286. PREFETCH" (%%"REG_c") \n\t"
  2287. PREFETCH" 32(%%"REG_c") \n\t"
  2288. PREFETCH" 64(%%"REG_c") \n\t"
  2289. #ifdef ARCH_X86_64
  2290. #define FUNNY_Y_CODE \
  2291. "movl (%%"REG_b"), %%esi \n\t"\
  2292. "call *%4 \n\t"\
  2293. "movl (%%"REG_b", %%"REG_a"), %%esi \n\t"\
  2294. "add %%"REG_S", %%"REG_c" \n\t"\
  2295. "add %%"REG_a", %%"REG_D" \n\t"\
  2296. "xor %%"REG_a", %%"REG_a" \n\t"\
  2297. #else
  2298. #define FUNNY_Y_CODE \
  2299. "movl (%%"REG_b"), %%esi \n\t"\
  2300. "call *%4 \n\t"\
  2301. "addl (%%"REG_b", %%"REG_a"), %%"REG_c" \n\t"\
  2302. "add %%"REG_a", %%"REG_D" \n\t"\
  2303. "xor %%"REG_a", %%"REG_a" \n\t"\
  2304. #endif /* ARCH_X86_64 */
  2305. FUNNY_Y_CODE
  2306. FUNNY_Y_CODE
  2307. FUNNY_Y_CODE
  2308. FUNNY_Y_CODE
  2309. FUNNY_Y_CODE
  2310. FUNNY_Y_CODE
  2311. FUNNY_Y_CODE
  2312. FUNNY_Y_CODE
  2313. #if defined(PIC)
  2314. "mov %5, %%"REG_b" \n\t"
  2315. #endif
  2316. :: "m" (src), "m" (dst), "m" (mmx2Filter), "m" (mmx2FilterPos),
  2317. "m" (funnyYCode)
  2318. #if defined(PIC)
  2319. ,"m" (ebxsave)
  2320. #endif
  2321. : "%"REG_a, "%"REG_c, "%"REG_d, "%"REG_S, "%"REG_D
  2322. #if !defined(PIC)
  2323. ,"%"REG_b
  2324. #endif
  2325. );
  2326. for (i=dstWidth-1; (i*xInc)>>16 >=srcW-1; i--) dst[i] = src[srcW-1]*128;
  2327. }
  2328. else
  2329. {
  2330. #endif /* HAVE_MMX2 */
  2331. long xInc_shr16 = xInc >> 16;
  2332. uint16_t xInc_mask = xInc & 0xffff;
  2333. //NO MMX just normal asm ...
  2334. asm volatile(
  2335. "xor %%"REG_a", %%"REG_a" \n\t" // i
  2336. "xor %%"REG_d", %%"REG_d" \n\t" // xx
  2337. "xorl %%ecx, %%ecx \n\t" // 2*xalpha
  2338. ASMALIGN(4)
  2339. "1: \n\t"
  2340. "movzbl (%0, %%"REG_d"), %%edi \n\t" //src[xx]
  2341. "movzbl 1(%0, %%"REG_d"), %%esi \n\t" //src[xx+1]
  2342. "subl %%edi, %%esi \n\t" //src[xx+1] - src[xx]
  2343. "imull %%ecx, %%esi \n\t" //(src[xx+1] - src[xx])*2*xalpha
  2344. "shll $16, %%edi \n\t"
  2345. "addl %%edi, %%esi \n\t" //src[xx+1]*2*xalpha + src[xx]*(1-2*xalpha)
  2346. "mov %1, %%"REG_D" \n\t"
  2347. "shrl $9, %%esi \n\t"
  2348. "movw %%si, (%%"REG_D", %%"REG_a", 2) \n\t"
  2349. "addw %4, %%cx \n\t" //2*xalpha += xInc&0xFF
  2350. "adc %3, %%"REG_d" \n\t" //xx+= xInc>>8 + carry
  2351. "movzbl (%0, %%"REG_d"), %%edi \n\t" //src[xx]
  2352. "movzbl 1(%0, %%"REG_d"), %%esi \n\t" //src[xx+1]
  2353. "subl %%edi, %%esi \n\t" //src[xx+1] - src[xx]
  2354. "imull %%ecx, %%esi \n\t" //(src[xx+1] - src[xx])*2*xalpha
  2355. "shll $16, %%edi \n\t"
  2356. "addl %%edi, %%esi \n\t" //src[xx+1]*2*xalpha + src[xx]*(1-2*xalpha)
  2357. "mov %1, %%"REG_D" \n\t"
  2358. "shrl $9, %%esi \n\t"
  2359. "movw %%si, 2(%%"REG_D", %%"REG_a", 2) \n\t"
  2360. "addw %4, %%cx \n\t" //2*xalpha += xInc&0xFF
  2361. "adc %3, %%"REG_d" \n\t" //xx+= xInc>>8 + carry
  2362. "add $2, %%"REG_a" \n\t"
  2363. "cmp %2, %%"REG_a" \n\t"
  2364. " jb 1b \n\t"
  2365. :: "r" (src), "m" (dst), "m" (dstWidth), "m" (xInc_shr16), "m" (xInc_mask)
  2366. : "%"REG_a, "%"REG_d, "%ecx", "%"REG_D, "%esi"
  2367. );
  2368. #ifdef HAVE_MMX2
  2369. } //if MMX2 can't be used
  2370. #endif
  2371. #else
  2372. int i;
  2373. unsigned int xpos=0;
  2374. for (i=0;i<dstWidth;i++)
  2375. {
  2376. register unsigned int xx=xpos>>16;
  2377. register unsigned int xalpha=(xpos&0xFFFF)>>9;
  2378. dst[i]= (src[xx]<<7) + (src[xx+1] - src[xx])*xalpha;
  2379. xpos+=xInc;
  2380. }
  2381. #endif /* defined(ARCH_X86) */
  2382. }
  2383. if(c->srcRange != c->dstRange && !(isRGB(c->dstFormat) || isBGR(c->dstFormat))){
  2384. int i;
  2385. //FIXME all pal and rgb srcFormats could do this convertion as well
  2386. //FIXME all scalers more complex than bilinear could do half of this transform
  2387. if(c->srcRange){
  2388. for (i=0; i<dstWidth; i++)
  2389. dst[i]= (dst[i]*14071 + 33561947)>>14;
  2390. }else{
  2391. for (i=0; i<dstWidth; i++)
  2392. dst[i]= (FFMIN(dst[i],30189)*19077 - 39057361)>>14;
  2393. }
  2394. }
  2395. }
  2396. inline static void RENAME(hcscale)(SwsContext *c, uint16_t *dst, long dstWidth, uint8_t *src1, uint8_t *src2,
  2397. int srcW, int xInc, int flags, int canMMX2BeUsed, int16_t *hChrFilter,
  2398. int16_t *hChrFilterPos, int hChrFilterSize, void *funnyUVCode,
  2399. int srcFormat, uint8_t *formatConvBuffer, int16_t *mmx2Filter,
  2400. int32_t *mmx2FilterPos, uint8_t *pal)
  2401. {
  2402. if (srcFormat==PIX_FMT_YUYV422)
  2403. {
  2404. RENAME(yuy2ToUV)(formatConvBuffer, formatConvBuffer+VOFW, src1, src2, srcW);
  2405. src1= formatConvBuffer;
  2406. src2= formatConvBuffer+VOFW;
  2407. }
  2408. else if (srcFormat==PIX_FMT_UYVY422)
  2409. {
  2410. RENAME(uyvyToUV)(formatConvBuffer, formatConvBuffer+VOFW, src1, src2, srcW);
  2411. src1= formatConvBuffer;
  2412. src2= formatConvBuffer+VOFW;
  2413. }
  2414. else if (srcFormat==PIX_FMT_RGB32)
  2415. {
  2416. if(c->chrSrcHSubSample)
  2417. RENAME(bgr32ToUV_half)(formatConvBuffer, formatConvBuffer+VOFW, src1, src2, srcW);
  2418. else
  2419. RENAME(bgr32ToUV)(formatConvBuffer, formatConvBuffer+VOFW, src1, src2, srcW);
  2420. src1= formatConvBuffer;
  2421. src2= formatConvBuffer+VOFW;
  2422. }
  2423. else if (srcFormat==PIX_FMT_RGB32_1)
  2424. {
  2425. if(c->chrSrcHSubSample)
  2426. RENAME(bgr32ToUV_half)(formatConvBuffer, formatConvBuffer+VOFW, src1+ALT32_CORR, src2+ALT32_CORR, srcW);
  2427. else
  2428. RENAME(bgr32ToUV)(formatConvBuffer, formatConvBuffer+VOFW, src1+ALT32_CORR, src2+ALT32_CORR, srcW);
  2429. src1= formatConvBuffer;
  2430. src2= formatConvBuffer+VOFW;
  2431. }
  2432. else if (srcFormat==PIX_FMT_BGR24)
  2433. {
  2434. if(c->chrSrcHSubSample)
  2435. RENAME(bgr24ToUV_half)(formatConvBuffer, formatConvBuffer+VOFW, src1, src2, srcW);
  2436. else
  2437. RENAME(bgr24ToUV)(formatConvBuffer, formatConvBuffer+VOFW, src1, src2, srcW);
  2438. src1= formatConvBuffer;
  2439. src2= formatConvBuffer+VOFW;
  2440. }
  2441. else if (srcFormat==PIX_FMT_BGR565)
  2442. {
  2443. if(c->chrSrcHSubSample)
  2444. RENAME(bgr16ToUV_half)(formatConvBuffer, formatConvBuffer+VOFW, src1, src2, srcW);
  2445. else
  2446. RENAME(bgr16ToUV)(formatConvBuffer, formatConvBuffer+VOFW, src1, src2, srcW);
  2447. src1= formatConvBuffer;
  2448. src2= formatConvBuffer+VOFW;
  2449. }
  2450. else if (srcFormat==PIX_FMT_BGR555)
  2451. {
  2452. if(c->chrSrcHSubSample)
  2453. RENAME(bgr15ToUV_half)(formatConvBuffer, formatConvBuffer+VOFW, src1, src2, srcW);
  2454. else
  2455. RENAME(bgr15ToUV)(formatConvBuffer, formatConvBuffer+VOFW, src1, src2, srcW);
  2456. src1= formatConvBuffer;
  2457. src2= formatConvBuffer+VOFW;
  2458. }
  2459. else if (srcFormat==PIX_FMT_BGR32)
  2460. {
  2461. if(c->chrSrcHSubSample)
  2462. RENAME(rgb32ToUV_half)(formatConvBuffer, formatConvBuffer+VOFW, src1, src2, srcW);
  2463. else
  2464. RENAME(rgb32ToUV)(formatConvBuffer, formatConvBuffer+VOFW, src1, src2, srcW);
  2465. src1= formatConvBuffer;
  2466. src2= formatConvBuffer+VOFW;
  2467. }
  2468. else if (srcFormat==PIX_FMT_BGR32_1)
  2469. {
  2470. if(c->chrSrcHSubSample)
  2471. RENAME(rgb32ToUV_half)(formatConvBuffer, formatConvBuffer+VOFW, src1+ALT32_CORR, src2+ALT32_CORR, srcW);
  2472. else
  2473. RENAME(rgb32ToUV)(formatConvBuffer, formatConvBuffer+VOFW, src1+ALT32_CORR, src2+ALT32_CORR, srcW);
  2474. src1= formatConvBuffer;
  2475. src2= formatConvBuffer+VOFW;
  2476. }
  2477. else if (srcFormat==PIX_FMT_RGB24)
  2478. {
  2479. if(c->chrSrcHSubSample)
  2480. RENAME(rgb24ToUV_half)(formatConvBuffer, formatConvBuffer+VOFW, src1, src2, srcW);
  2481. else
  2482. RENAME(rgb24ToUV)(formatConvBuffer, formatConvBuffer+VOFW, src1, src2, srcW);
  2483. src1= formatConvBuffer;
  2484. src2= formatConvBuffer+VOFW;
  2485. }
  2486. else if (srcFormat==PIX_FMT_RGB565)
  2487. {
  2488. if(c->chrSrcHSubSample)
  2489. RENAME(rgb16ToUV_half)(formatConvBuffer, formatConvBuffer+VOFW, src1, src2, srcW);
  2490. else
  2491. RENAME(rgb16ToUV)(formatConvBuffer, formatConvBuffer+VOFW, src1, src2, srcW);
  2492. src1= formatConvBuffer;
  2493. src2= formatConvBuffer+VOFW;
  2494. }
  2495. else if (srcFormat==PIX_FMT_RGB555)
  2496. {
  2497. if(c->chrSrcHSubSample)
  2498. RENAME(rgb15ToUV_half)(formatConvBuffer, formatConvBuffer+VOFW, src1, src2, srcW);
  2499. else
  2500. RENAME(rgb15ToUV)(formatConvBuffer, formatConvBuffer+VOFW, src1, src2, srcW);
  2501. src1= formatConvBuffer;
  2502. src2= formatConvBuffer+VOFW;
  2503. }
  2504. else if (isGray(srcFormat))
  2505. {
  2506. return;
  2507. }
  2508. else if (srcFormat==PIX_FMT_RGB8 || srcFormat==PIX_FMT_BGR8 || srcFormat==PIX_FMT_PAL8 || srcFormat==PIX_FMT_BGR4_BYTE || srcFormat==PIX_FMT_RGB4_BYTE)
  2509. {
  2510. RENAME(palToUV)(formatConvBuffer, formatConvBuffer+VOFW, src1, src2, srcW, (uint32_t*)pal);
  2511. src1= formatConvBuffer;
  2512. src2= formatConvBuffer+VOFW;
  2513. }
  2514. #ifdef HAVE_MMX
  2515. // Use the new MMX scaler if the MMX2 one can't be used (it is faster than the x86 ASM one).
  2516. if (!(flags&SWS_FAST_BILINEAR) || (!canMMX2BeUsed))
  2517. #else
  2518. if (!(flags&SWS_FAST_BILINEAR))
  2519. #endif
  2520. {
  2521. RENAME(hScale)(dst , dstWidth, src1, srcW, xInc, hChrFilter, hChrFilterPos, hChrFilterSize);
  2522. RENAME(hScale)(dst+VOFW, dstWidth, src2, srcW, xInc, hChrFilter, hChrFilterPos, hChrFilterSize);
  2523. }
  2524. else // fast bilinear upscale / crap downscale
  2525. {
  2526. #if defined(ARCH_X86)
  2527. #ifdef HAVE_MMX2
  2528. int i;
  2529. #if defined(PIC)
  2530. uint64_t ebxsave __attribute__((aligned(8)));
  2531. #endif
  2532. if (canMMX2BeUsed)
  2533. {
  2534. asm volatile(
  2535. #if defined(PIC)
  2536. "mov %%"REG_b", %6 \n\t"
  2537. #endif
  2538. "pxor %%mm7, %%mm7 \n\t"
  2539. "mov %0, %%"REG_c" \n\t"
  2540. "mov %1, %%"REG_D" \n\t"
  2541. "mov %2, %%"REG_d" \n\t"
  2542. "mov %3, %%"REG_b" \n\t"
  2543. "xor %%"REG_a", %%"REG_a" \n\t" // i
  2544. PREFETCH" (%%"REG_c") \n\t"
  2545. PREFETCH" 32(%%"REG_c") \n\t"
  2546. PREFETCH" 64(%%"REG_c") \n\t"
  2547. #ifdef ARCH_X86_64
  2548. #define FUNNY_UV_CODE \
  2549. "movl (%%"REG_b"), %%esi \n\t"\
  2550. "call *%4 \n\t"\
  2551. "movl (%%"REG_b", %%"REG_a"), %%esi \n\t"\
  2552. "add %%"REG_S", %%"REG_c" \n\t"\
  2553. "add %%"REG_a", %%"REG_D" \n\t"\
  2554. "xor %%"REG_a", %%"REG_a" \n\t"\
  2555. #else
  2556. #define FUNNY_UV_CODE \
  2557. "movl (%%"REG_b"), %%esi \n\t"\
  2558. "call *%4 \n\t"\
  2559. "addl (%%"REG_b", %%"REG_a"), %%"REG_c" \n\t"\
  2560. "add %%"REG_a", %%"REG_D" \n\t"\
  2561. "xor %%"REG_a", %%"REG_a" \n\t"\
  2562. #endif /* ARCH_X86_64 */
  2563. FUNNY_UV_CODE
  2564. FUNNY_UV_CODE
  2565. FUNNY_UV_CODE
  2566. FUNNY_UV_CODE
  2567. "xor %%"REG_a", %%"REG_a" \n\t" // i
  2568. "mov %5, %%"REG_c" \n\t" // src
  2569. "mov %1, %%"REG_D" \n\t" // buf1
  2570. "add $"AV_STRINGIFY(VOF)", %%"REG_D" \n\t"
  2571. PREFETCH" (%%"REG_c") \n\t"
  2572. PREFETCH" 32(%%"REG_c") \n\t"
  2573. PREFETCH" 64(%%"REG_c") \n\t"
  2574. FUNNY_UV_CODE
  2575. FUNNY_UV_CODE
  2576. FUNNY_UV_CODE
  2577. FUNNY_UV_CODE
  2578. #if defined(PIC)
  2579. "mov %6, %%"REG_b" \n\t"
  2580. #endif
  2581. :: "m" (src1), "m" (dst), "m" (mmx2Filter), "m" (mmx2FilterPos),
  2582. "m" (funnyUVCode), "m" (src2)
  2583. #if defined(PIC)
  2584. ,"m" (ebxsave)
  2585. #endif
  2586. : "%"REG_a, "%"REG_c, "%"REG_d, "%"REG_S, "%"REG_D
  2587. #if !defined(PIC)
  2588. ,"%"REG_b
  2589. #endif
  2590. );
  2591. for (i=dstWidth-1; (i*xInc)>>16 >=srcW-1; i--)
  2592. {
  2593. //printf("%d %d %d\n", dstWidth, i, srcW);
  2594. dst[i] = src1[srcW-1]*128;
  2595. dst[i+VOFW] = src2[srcW-1]*128;
  2596. }
  2597. }
  2598. else
  2599. {
  2600. #endif /* HAVE_MMX2 */
  2601. long xInc_shr16 = (long) (xInc >> 16);
  2602. uint16_t xInc_mask = xInc & 0xffff;
  2603. asm volatile(
  2604. "xor %%"REG_a", %%"REG_a" \n\t" // i
  2605. "xor %%"REG_d", %%"REG_d" \n\t" // xx
  2606. "xorl %%ecx, %%ecx \n\t" // 2*xalpha
  2607. ASMALIGN(4)
  2608. "1: \n\t"
  2609. "mov %0, %%"REG_S" \n\t"
  2610. "movzbl (%%"REG_S", %%"REG_d"), %%edi \n\t" //src[xx]
  2611. "movzbl 1(%%"REG_S", %%"REG_d"), %%esi \n\t" //src[xx+1]
  2612. "subl %%edi, %%esi \n\t" //src[xx+1] - src[xx]
  2613. "imull %%ecx, %%esi \n\t" //(src[xx+1] - src[xx])*2*xalpha
  2614. "shll $16, %%edi \n\t"
  2615. "addl %%edi, %%esi \n\t" //src[xx+1]*2*xalpha + src[xx]*(1-2*xalpha)
  2616. "mov %1, %%"REG_D" \n\t"
  2617. "shrl $9, %%esi \n\t"
  2618. "movw %%si, (%%"REG_D", %%"REG_a", 2) \n\t"
  2619. "movzbl (%5, %%"REG_d"), %%edi \n\t" //src[xx]
  2620. "movzbl 1(%5, %%"REG_d"), %%esi \n\t" //src[xx+1]
  2621. "subl %%edi, %%esi \n\t" //src[xx+1] - src[xx]
  2622. "imull %%ecx, %%esi \n\t" //(src[xx+1] - src[xx])*2*xalpha
  2623. "shll $16, %%edi \n\t"
  2624. "addl %%edi, %%esi \n\t" //src[xx+1]*2*xalpha + src[xx]*(1-2*xalpha)
  2625. "mov %1, %%"REG_D" \n\t"
  2626. "shrl $9, %%esi \n\t"
  2627. "movw %%si, "AV_STRINGIFY(VOF)"(%%"REG_D", %%"REG_a", 2) \n\t"
  2628. "addw %4, %%cx \n\t" //2*xalpha += xInc&0xFF
  2629. "adc %3, %%"REG_d" \n\t" //xx+= xInc>>8 + carry
  2630. "add $1, %%"REG_a" \n\t"
  2631. "cmp %2, %%"REG_a" \n\t"
  2632. " jb 1b \n\t"
  2633. /* GCC 3.3 makes MPlayer crash on IA-32 machines when using "g" operand here,
  2634. which is needed to support GCC 4.0. */
  2635. #if defined(ARCH_X86_64) && ((__GNUC__ > 3) || (__GNUC__ == 3 && __GNUC_MINOR__ >= 4))
  2636. :: "m" (src1), "m" (dst), "g" ((long)dstWidth), "m" (xInc_shr16), "m" (xInc_mask),
  2637. #else
  2638. :: "m" (src1), "m" (dst), "m" ((long)dstWidth), "m" (xInc_shr16), "m" (xInc_mask),
  2639. #endif
  2640. "r" (src2)
  2641. : "%"REG_a, "%"REG_d, "%ecx", "%"REG_D, "%esi"
  2642. );
  2643. #ifdef HAVE_MMX2
  2644. } //if MMX2 can't be used
  2645. #endif
  2646. #else
  2647. int i;
  2648. unsigned int xpos=0;
  2649. for (i=0;i<dstWidth;i++)
  2650. {
  2651. register unsigned int xx=xpos>>16;
  2652. register unsigned int xalpha=(xpos&0xFFFF)>>9;
  2653. dst[i]=(src1[xx]*(xalpha^127)+src1[xx+1]*xalpha);
  2654. dst[i+VOFW]=(src2[xx]*(xalpha^127)+src2[xx+1]*xalpha);
  2655. /* slower
  2656. dst[i]= (src1[xx]<<7) + (src1[xx+1] - src1[xx])*xalpha;
  2657. dst[i+VOFW]=(src2[xx]<<7) + (src2[xx+1] - src2[xx])*xalpha;
  2658. */
  2659. xpos+=xInc;
  2660. }
  2661. #endif /* defined(ARCH_X86) */
  2662. }
  2663. if(c->srcRange != c->dstRange && !(isRGB(c->dstFormat) || isBGR(c->dstFormat))){
  2664. int i;
  2665. //FIXME all pal and rgb srcFormats could do this convertion as well
  2666. //FIXME all scalers more complex than bilinear could do half of this transform
  2667. if(c->srcRange){
  2668. for (i=0; i<dstWidth; i++){
  2669. dst[i ]= (dst[i ]*1799 + 4081085)>>11; //1469
  2670. dst[i+VOFW]= (dst[i+VOFW]*1799 + 4081085)>>11; //1469
  2671. }
  2672. }else{
  2673. for (i=0; i<dstWidth; i++){
  2674. dst[i ]= (FFMIN(dst[i ],30775)*4663 - 9289992)>>12; //-264
  2675. dst[i+VOFW]= (FFMIN(dst[i+VOFW],30775)*4663 - 9289992)>>12; //-264
  2676. }
  2677. }
  2678. }
  2679. }
  2680. static int RENAME(swScale)(SwsContext *c, uint8_t* src[], int srcStride[], int srcSliceY,
  2681. int srcSliceH, uint8_t* dst[], int dstStride[]){
  2682. /* load a few things into local vars to make the code more readable? and faster */
  2683. const int srcW= c->srcW;
  2684. const int dstW= c->dstW;
  2685. const int dstH= c->dstH;
  2686. const int chrDstW= c->chrDstW;
  2687. const int chrSrcW= c->chrSrcW;
  2688. const int lumXInc= c->lumXInc;
  2689. const int chrXInc= c->chrXInc;
  2690. const int dstFormat= c->dstFormat;
  2691. const int srcFormat= c->srcFormat;
  2692. const int flags= c->flags;
  2693. const int canMMX2BeUsed= c->canMMX2BeUsed;
  2694. int16_t *vLumFilterPos= c->vLumFilterPos;
  2695. int16_t *vChrFilterPos= c->vChrFilterPos;
  2696. int16_t *hLumFilterPos= c->hLumFilterPos;
  2697. int16_t *hChrFilterPos= c->hChrFilterPos;
  2698. int16_t *vLumFilter= c->vLumFilter;
  2699. int16_t *vChrFilter= c->vChrFilter;
  2700. int16_t *hLumFilter= c->hLumFilter;
  2701. int16_t *hChrFilter= c->hChrFilter;
  2702. int32_t *lumMmxFilter= c->lumMmxFilter;
  2703. int32_t *chrMmxFilter= c->chrMmxFilter;
  2704. const int vLumFilterSize= c->vLumFilterSize;
  2705. const int vChrFilterSize= c->vChrFilterSize;
  2706. const int hLumFilterSize= c->hLumFilterSize;
  2707. const int hChrFilterSize= c->hChrFilterSize;
  2708. int16_t **lumPixBuf= c->lumPixBuf;
  2709. int16_t **chrPixBuf= c->chrPixBuf;
  2710. const int vLumBufSize= c->vLumBufSize;
  2711. const int vChrBufSize= c->vChrBufSize;
  2712. uint8_t *funnyYCode= c->funnyYCode;
  2713. uint8_t *funnyUVCode= c->funnyUVCode;
  2714. uint8_t *formatConvBuffer= c->formatConvBuffer;
  2715. const int chrSrcSliceY= srcSliceY >> c->chrSrcVSubSample;
  2716. const int chrSrcSliceH= -((-srcSliceH) >> c->chrSrcVSubSample);
  2717. int lastDstY;
  2718. uint8_t *pal=NULL;
  2719. /* vars which will change and which we need to store back in the context */
  2720. int dstY= c->dstY;
  2721. int lumBufIndex= c->lumBufIndex;
  2722. int chrBufIndex= c->chrBufIndex;
  2723. int lastInLumBuf= c->lastInLumBuf;
  2724. int lastInChrBuf= c->lastInChrBuf;
  2725. if (isPacked(c->srcFormat)){
  2726. pal= src[1];
  2727. src[0]=
  2728. src[1]=
  2729. src[2]= src[0];
  2730. srcStride[0]=
  2731. srcStride[1]=
  2732. srcStride[2]= srcStride[0];
  2733. }
  2734. srcStride[1]<<= c->vChrDrop;
  2735. srcStride[2]<<= c->vChrDrop;
  2736. //printf("swscale %X %X %X -> %X %X %X\n", (int)src[0], (int)src[1], (int)src[2],
  2737. // (int)dst[0], (int)dst[1], (int)dst[2]);
  2738. #if 0 //self test FIXME move to a vfilter or something
  2739. {
  2740. static volatile int i=0;
  2741. i++;
  2742. if (srcFormat==PIX_FMT_YUV420P && i==1 && srcSliceH>= c->srcH)
  2743. selfTest(src, srcStride, c->srcW, c->srcH);
  2744. i--;
  2745. }
  2746. #endif
  2747. //printf("sws Strides:%d %d %d -> %d %d %d\n", srcStride[0],srcStride[1],srcStride[2],
  2748. //dstStride[0],dstStride[1],dstStride[2]);
  2749. if (dstStride[0]%8 !=0 || dstStride[1]%8 !=0 || dstStride[2]%8 !=0)
  2750. {
  2751. static int firstTime=1; //FIXME move this into the context perhaps
  2752. if (flags & SWS_PRINT_INFO && firstTime)
  2753. {
  2754. av_log(c, AV_LOG_WARNING, "Warning: dstStride is not aligned!\n"
  2755. " ->cannot do aligned memory accesses anymore\n");
  2756. firstTime=0;
  2757. }
  2758. }
  2759. /* Note the user might start scaling the picture in the middle so this
  2760. will not get executed. This is not really intended but works
  2761. currently, so people might do it. */
  2762. if (srcSliceY ==0){
  2763. lumBufIndex=0;
  2764. chrBufIndex=0;
  2765. dstY=0;
  2766. lastInLumBuf= -1;
  2767. lastInChrBuf= -1;
  2768. }
  2769. lastDstY= dstY;
  2770. for (;dstY < dstH; dstY++){
  2771. unsigned char *dest =dst[0]+dstStride[0]*dstY;
  2772. const int chrDstY= dstY>>c->chrDstVSubSample;
  2773. unsigned char *uDest=dst[1]+dstStride[1]*chrDstY;
  2774. unsigned char *vDest=dst[2]+dstStride[2]*chrDstY;
  2775. const int firstLumSrcY= vLumFilterPos[dstY]; //First line needed as input
  2776. const int firstChrSrcY= vChrFilterPos[chrDstY]; //First line needed as input
  2777. const int lastLumSrcY= firstLumSrcY + vLumFilterSize -1; // Last line needed as input
  2778. const int lastChrSrcY= firstChrSrcY + vChrFilterSize -1; // Last line needed as input
  2779. //printf("dstY:%d dstH:%d firstLumSrcY:%d lastInLumBuf:%d vLumBufSize: %d vChrBufSize: %d slice: %d %d vLumFilterSize: %d firstChrSrcY: %d vChrFilterSize: %d c->chrSrcVSubSample: %d\n",
  2780. // dstY, dstH, firstLumSrcY, lastInLumBuf, vLumBufSize, vChrBufSize, srcSliceY, srcSliceH, vLumFilterSize, firstChrSrcY, vChrFilterSize, c->chrSrcVSubSample);
  2781. //handle holes (FAST_BILINEAR & weird filters)
  2782. if (firstLumSrcY > lastInLumBuf) lastInLumBuf= firstLumSrcY-1;
  2783. if (firstChrSrcY > lastInChrBuf) lastInChrBuf= firstChrSrcY-1;
  2784. //printf("%d %d %d\n", firstChrSrcY, lastInChrBuf, vChrBufSize);
  2785. assert(firstLumSrcY >= lastInLumBuf - vLumBufSize + 1);
  2786. assert(firstChrSrcY >= lastInChrBuf - vChrBufSize + 1);
  2787. // Do we have enough lines in this slice to output the dstY line
  2788. if (lastLumSrcY < srcSliceY + srcSliceH && lastChrSrcY < -((-srcSliceY - srcSliceH)>>c->chrSrcVSubSample))
  2789. {
  2790. //Do horizontal scaling
  2791. while(lastInLumBuf < lastLumSrcY)
  2792. {
  2793. uint8_t *s= src[0]+(lastInLumBuf + 1 - srcSliceY)*srcStride[0];
  2794. lumBufIndex++;
  2795. //printf("%d %d %d %d\n", lumBufIndex, vLumBufSize, lastInLumBuf, lastLumSrcY);
  2796. assert(lumBufIndex < 2*vLumBufSize);
  2797. assert(lastInLumBuf + 1 - srcSliceY < srcSliceH);
  2798. assert(lastInLumBuf + 1 - srcSliceY >= 0);
  2799. //printf("%d %d\n", lumBufIndex, vLumBufSize);
  2800. RENAME(hyscale)(c, lumPixBuf[ lumBufIndex ], dstW, s, srcW, lumXInc,
  2801. flags, canMMX2BeUsed, hLumFilter, hLumFilterPos, hLumFilterSize,
  2802. funnyYCode, c->srcFormat, formatConvBuffer,
  2803. c->lumMmx2Filter, c->lumMmx2FilterPos, pal);
  2804. lastInLumBuf++;
  2805. }
  2806. while(lastInChrBuf < lastChrSrcY)
  2807. {
  2808. uint8_t *src1= src[1]+(lastInChrBuf + 1 - chrSrcSliceY)*srcStride[1];
  2809. uint8_t *src2= src[2]+(lastInChrBuf + 1 - chrSrcSliceY)*srcStride[2];
  2810. chrBufIndex++;
  2811. assert(chrBufIndex < 2*vChrBufSize);
  2812. assert(lastInChrBuf + 1 - chrSrcSliceY < (chrSrcSliceH));
  2813. assert(lastInChrBuf + 1 - chrSrcSliceY >= 0);
  2814. //FIXME replace parameters through context struct (some at least)
  2815. if (!(isGray(srcFormat) || isGray(dstFormat)))
  2816. RENAME(hcscale)(c, chrPixBuf[ chrBufIndex ], chrDstW, src1, src2, chrSrcW, chrXInc,
  2817. flags, canMMX2BeUsed, hChrFilter, hChrFilterPos, hChrFilterSize,
  2818. funnyUVCode, c->srcFormat, formatConvBuffer,
  2819. c->chrMmx2Filter, c->chrMmx2FilterPos, pal);
  2820. lastInChrBuf++;
  2821. }
  2822. //wrap buf index around to stay inside the ring buffer
  2823. if (lumBufIndex >= vLumBufSize) lumBufIndex-= vLumBufSize;
  2824. if (chrBufIndex >= vChrBufSize) chrBufIndex-= vChrBufSize;
  2825. }
  2826. else // not enough lines left in this slice -> load the rest in the buffer
  2827. {
  2828. /* printf("%d %d Last:%d %d LastInBuf:%d %d Index:%d %d Y:%d FSize: %d %d BSize: %d %d\n",
  2829. firstChrSrcY,firstLumSrcY,lastChrSrcY,lastLumSrcY,
  2830. lastInChrBuf,lastInLumBuf,chrBufIndex,lumBufIndex,dstY,vChrFilterSize,vLumFilterSize,
  2831. vChrBufSize, vLumBufSize);*/
  2832. //Do horizontal scaling
  2833. while(lastInLumBuf+1 < srcSliceY + srcSliceH)
  2834. {
  2835. uint8_t *s= src[0]+(lastInLumBuf + 1 - srcSliceY)*srcStride[0];
  2836. lumBufIndex++;
  2837. assert(lumBufIndex < 2*vLumBufSize);
  2838. assert(lastInLumBuf + 1 - srcSliceY < srcSliceH);
  2839. assert(lastInLumBuf + 1 - srcSliceY >= 0);
  2840. RENAME(hyscale)(c, lumPixBuf[ lumBufIndex ], dstW, s, srcW, lumXInc,
  2841. flags, canMMX2BeUsed, hLumFilter, hLumFilterPos, hLumFilterSize,
  2842. funnyYCode, c->srcFormat, formatConvBuffer,
  2843. c->lumMmx2Filter, c->lumMmx2FilterPos, pal);
  2844. lastInLumBuf++;
  2845. }
  2846. while(lastInChrBuf+1 < (chrSrcSliceY + chrSrcSliceH))
  2847. {
  2848. uint8_t *src1= src[1]+(lastInChrBuf + 1 - chrSrcSliceY)*srcStride[1];
  2849. uint8_t *src2= src[2]+(lastInChrBuf + 1 - chrSrcSliceY)*srcStride[2];
  2850. chrBufIndex++;
  2851. assert(chrBufIndex < 2*vChrBufSize);
  2852. assert(lastInChrBuf + 1 - chrSrcSliceY < chrSrcSliceH);
  2853. assert(lastInChrBuf + 1 - chrSrcSliceY >= 0);
  2854. if (!(isGray(srcFormat) || isGray(dstFormat)))
  2855. RENAME(hcscale)(c, chrPixBuf[ chrBufIndex ], chrDstW, src1, src2, chrSrcW, chrXInc,
  2856. flags, canMMX2BeUsed, hChrFilter, hChrFilterPos, hChrFilterSize,
  2857. funnyUVCode, c->srcFormat, formatConvBuffer,
  2858. c->chrMmx2Filter, c->chrMmx2FilterPos, pal);
  2859. lastInChrBuf++;
  2860. }
  2861. //wrap buf index around to stay inside the ring buffer
  2862. if (lumBufIndex >= vLumBufSize) lumBufIndex-= vLumBufSize;
  2863. if (chrBufIndex >= vChrBufSize) chrBufIndex-= vChrBufSize;
  2864. break; //we can't output a dstY line so let's try with the next slice
  2865. }
  2866. #ifdef HAVE_MMX
  2867. b5Dither= ff_dither8[dstY&1];
  2868. g6Dither= ff_dither4[dstY&1];
  2869. g5Dither= ff_dither8[dstY&1];
  2870. r5Dither= ff_dither8[(dstY+1)&1];
  2871. #endif
  2872. if (dstY < dstH-2)
  2873. {
  2874. int16_t **lumSrcPtr= lumPixBuf + lumBufIndex + firstLumSrcY - lastInLumBuf + vLumBufSize;
  2875. int16_t **chrSrcPtr= chrPixBuf + chrBufIndex + firstChrSrcY - lastInChrBuf + vChrBufSize;
  2876. #ifdef HAVE_MMX
  2877. int i;
  2878. if (flags & SWS_ACCURATE_RND){
  2879. int s= APCK_SIZE / 8;
  2880. for (i=0; i<vLumFilterSize; i+=2){
  2881. *(void**)&lumMmxFilter[s*i ]= lumSrcPtr[i ];
  2882. *(void**)&lumMmxFilter[s*i+APCK_PTR2/4 ]= lumSrcPtr[i+(vLumFilterSize>1)];
  2883. lumMmxFilter[s*i+APCK_COEF/4 ]=
  2884. lumMmxFilter[s*i+APCK_COEF/4+1]= vLumFilter[dstY*vLumFilterSize + i ]
  2885. + (vLumFilterSize>1 ? vLumFilter[dstY*vLumFilterSize + i + 1]<<16 : 0);
  2886. }
  2887. for (i=0; i<vChrFilterSize; i+=2){
  2888. *(void**)&chrMmxFilter[s*i ]= chrSrcPtr[i ];
  2889. *(void**)&chrMmxFilter[s*i+APCK_PTR2/4 ]= chrSrcPtr[i+(vChrFilterSize>1)];
  2890. chrMmxFilter[s*i+APCK_COEF/4 ]=
  2891. chrMmxFilter[s*i+APCK_COEF/4+1]= vChrFilter[chrDstY*vChrFilterSize + i ]
  2892. + (vChrFilterSize>1 ? vChrFilter[chrDstY*vChrFilterSize + i + 1]<<16 : 0);
  2893. }
  2894. }else{
  2895. for (i=0; i<vLumFilterSize; i++)
  2896. {
  2897. lumMmxFilter[4*i+0]= (int32_t)lumSrcPtr[i];
  2898. lumMmxFilter[4*i+1]= (uint64_t)lumSrcPtr[i] >> 32;
  2899. lumMmxFilter[4*i+2]=
  2900. lumMmxFilter[4*i+3]=
  2901. ((uint16_t)vLumFilter[dstY*vLumFilterSize + i])*0x10001;
  2902. }
  2903. for (i=0; i<vChrFilterSize; i++)
  2904. {
  2905. chrMmxFilter[4*i+0]= (int32_t)chrSrcPtr[i];
  2906. chrMmxFilter[4*i+1]= (uint64_t)chrSrcPtr[i] >> 32;
  2907. chrMmxFilter[4*i+2]=
  2908. chrMmxFilter[4*i+3]=
  2909. ((uint16_t)vChrFilter[chrDstY*vChrFilterSize + i])*0x10001;
  2910. }
  2911. }
  2912. #endif
  2913. if (dstFormat == PIX_FMT_NV12 || dstFormat == PIX_FMT_NV21){
  2914. const int chrSkipMask= (1<<c->chrDstVSubSample)-1;
  2915. if (dstY&chrSkipMask) uDest= NULL; //FIXME split functions in lumi / chromi
  2916. RENAME(yuv2nv12X)(c,
  2917. vLumFilter+dstY*vLumFilterSize , lumSrcPtr, vLumFilterSize,
  2918. vChrFilter+chrDstY*vChrFilterSize, chrSrcPtr, vChrFilterSize,
  2919. dest, uDest, dstW, chrDstW, dstFormat);
  2920. }
  2921. else if (isPlanarYUV(dstFormat) || dstFormat==PIX_FMT_GRAY8) //YV12 like
  2922. {
  2923. const int chrSkipMask= (1<<c->chrDstVSubSample)-1;
  2924. if ((dstY&chrSkipMask) || isGray(dstFormat)) uDest=vDest= NULL; //FIXME split functions in lumi / chromi
  2925. if (vLumFilterSize == 1 && vChrFilterSize == 1) // unscaled YV12
  2926. {
  2927. int16_t *lumBuf = lumPixBuf[0];
  2928. int16_t *chrBuf= chrPixBuf[0];
  2929. RENAME(yuv2yuv1)(c, lumBuf, chrBuf, dest, uDest, vDest, dstW, chrDstW);
  2930. }
  2931. else //General YV12
  2932. {
  2933. RENAME(yuv2yuvX)(c,
  2934. vLumFilter+dstY*vLumFilterSize , lumSrcPtr, vLumFilterSize,
  2935. vChrFilter+chrDstY*vChrFilterSize, chrSrcPtr, vChrFilterSize,
  2936. dest, uDest, vDest, dstW, chrDstW);
  2937. }
  2938. }
  2939. else
  2940. {
  2941. assert(lumSrcPtr + vLumFilterSize - 1 < lumPixBuf + vLumBufSize*2);
  2942. assert(chrSrcPtr + vChrFilterSize - 1 < chrPixBuf + vChrBufSize*2);
  2943. if (vLumFilterSize == 1 && vChrFilterSize == 2) //unscaled RGB
  2944. {
  2945. int chrAlpha= vChrFilter[2*dstY+1];
  2946. RENAME(yuv2packed1)(c, *lumSrcPtr, *chrSrcPtr, *(chrSrcPtr+1),
  2947. dest, dstW, chrAlpha, dstFormat, flags, dstY);
  2948. }
  2949. else if (vLumFilterSize == 2 && vChrFilterSize == 2) //bilinear upscale RGB
  2950. {
  2951. int lumAlpha= vLumFilter[2*dstY+1];
  2952. int chrAlpha= vChrFilter[2*dstY+1];
  2953. lumMmxFilter[2]=
  2954. lumMmxFilter[3]= vLumFilter[2*dstY ]*0x10001;
  2955. chrMmxFilter[2]=
  2956. chrMmxFilter[3]= vChrFilter[2*chrDstY]*0x10001;
  2957. RENAME(yuv2packed2)(c, *lumSrcPtr, *(lumSrcPtr+1), *chrSrcPtr, *(chrSrcPtr+1),
  2958. dest, dstW, lumAlpha, chrAlpha, dstY);
  2959. }
  2960. else //general RGB
  2961. {
  2962. RENAME(yuv2packedX)(c,
  2963. vLumFilter+dstY*vLumFilterSize, lumSrcPtr, vLumFilterSize,
  2964. vChrFilter+dstY*vChrFilterSize, chrSrcPtr, vChrFilterSize,
  2965. dest, dstW, dstY);
  2966. }
  2967. }
  2968. }
  2969. else // hmm looks like we can't use MMX here without overwriting this array's tail
  2970. {
  2971. int16_t **lumSrcPtr= lumPixBuf + lumBufIndex + firstLumSrcY - lastInLumBuf + vLumBufSize;
  2972. int16_t **chrSrcPtr= chrPixBuf + chrBufIndex + firstChrSrcY - lastInChrBuf + vChrBufSize;
  2973. if (dstFormat == PIX_FMT_NV12 || dstFormat == PIX_FMT_NV21){
  2974. const int chrSkipMask= (1<<c->chrDstVSubSample)-1;
  2975. if (dstY&chrSkipMask) uDest= NULL; //FIXME split functions in lumi / chromi
  2976. yuv2nv12XinC(
  2977. vLumFilter+dstY*vLumFilterSize , lumSrcPtr, vLumFilterSize,
  2978. vChrFilter+chrDstY*vChrFilterSize, chrSrcPtr, vChrFilterSize,
  2979. dest, uDest, dstW, chrDstW, dstFormat);
  2980. }
  2981. else if (isPlanarYUV(dstFormat) || dstFormat==PIX_FMT_GRAY8) //YV12
  2982. {
  2983. const int chrSkipMask= (1<<c->chrDstVSubSample)-1;
  2984. if ((dstY&chrSkipMask) || isGray(dstFormat)) uDest=vDest= NULL; //FIXME split functions in lumi / chromi
  2985. yuv2yuvXinC(
  2986. vLumFilter+dstY*vLumFilterSize , lumSrcPtr, vLumFilterSize,
  2987. vChrFilter+chrDstY*vChrFilterSize, chrSrcPtr, vChrFilterSize,
  2988. dest, uDest, vDest, dstW, chrDstW);
  2989. }
  2990. else
  2991. {
  2992. assert(lumSrcPtr + vLumFilterSize - 1 < lumPixBuf + vLumBufSize*2);
  2993. assert(chrSrcPtr + vChrFilterSize - 1 < chrPixBuf + vChrBufSize*2);
  2994. yuv2packedXinC(c,
  2995. vLumFilter+dstY*vLumFilterSize, lumSrcPtr, vLumFilterSize,
  2996. vChrFilter+dstY*vChrFilterSize, chrSrcPtr, vChrFilterSize,
  2997. dest, dstW, dstY);
  2998. }
  2999. }
  3000. }
  3001. #ifdef HAVE_MMX
  3002. asm volatile(SFENCE:::"memory");
  3003. asm volatile(EMMS:::"memory");
  3004. #endif
  3005. /* store changed local vars back in the context */
  3006. c->dstY= dstY;
  3007. c->lumBufIndex= lumBufIndex;
  3008. c->chrBufIndex= chrBufIndex;
  3009. c->lastInLumBuf= lastInLumBuf;
  3010. c->lastInChrBuf= lastInChrBuf;
  3011. return dstY - lastDstY;
  3012. }