PageRenderTime 64ms CodeModel.GetById 12ms RepoModel.GetById 0ms app.codeStats 0ms

/xbmc/cores/dvdplayer/Codecs/ffmpeg/libswscale/rgb2rgb_template.c

https://github.com/gusax/plex
C | 2738 lines | 2501 code | 134 blank | 103 comment | 81 complexity | 65f5f8732d44e4eae54667d88bfb13f1 MD5 | raw file
Possible License(s): Unlicense, AGPL-1.0, GPL-2.0, LGPL-2.1, GPL-3.0
  1. /*
  2. * software RGB to RGB converter
  3. * pluralize by software PAL8 to RGB converter
  4. * software YUV to YUV converter
  5. * software YUV to RGB converter
  6. * Written by Nick Kurshev.
  7. * palette & YUV & runtime CPU stuff by Michael (michaelni@gmx.at)
  8. * lot of big-endian byte order fixes by Alex Beregszaszi
  9. *
  10. * This file is part of FFmpeg.
  11. *
  12. * FFmpeg is free software; you can redistribute it and/or modify
  13. * it under the terms of the GNU General Public License as published by
  14. * the Free Software Foundation; either version 2 of the License, or
  15. * (at your option) any later version.
  16. *
  17. * FFmpeg is distributed in the hope that it will be useful,
  18. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  19. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  20. * GNU General Public License for more details.
  21. *
  22. * You should have received a copy of the GNU General Public License
  23. * along with FFmpeg; if not, write to the Free Software
  24. * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
  25. *
  26. * The C code (not assembly, MMX, ...) of this file can be used
  27. * under the LGPL license.
  28. */
  29. #include <stddef.h>
  30. #undef PREFETCH
  31. #undef MOVNTQ
  32. #undef EMMS
  33. #undef SFENCE
  34. #undef MMREG_SIZE
  35. #undef PREFETCHW
  36. #undef PAVGB
  37. #if HAVE_SSE2
  38. #define MMREG_SIZE 16
  39. #else
  40. #define MMREG_SIZE 8
  41. #endif
  42. #if HAVE_AMD3DNOW
  43. #define PREFETCH "prefetch"
  44. #define PREFETCHW "prefetchw"
  45. #define PAVGB "pavgusb"
  46. #elif HAVE_MMX2
  47. #define PREFETCH "prefetchnta"
  48. #define PREFETCHW "prefetcht0"
  49. #define PAVGB "pavgb"
  50. #else
  51. #define PREFETCH " # nop"
  52. #define PREFETCHW " # nop"
  53. #endif
  54. #if HAVE_AMD3DNOW
  55. /* On K6 femms is faster than emms. On K7 femms is directly mapped to emms. */
  56. #define EMMS "femms"
  57. #else
  58. #define EMMS "emms"
  59. #endif
  60. #if HAVE_MMX2
  61. #define MOVNTQ "movntq"
  62. #define SFENCE "sfence"
  63. #else
  64. #define MOVNTQ "movq"
  65. #define SFENCE " # nop"
  66. #endif
  67. static inline void RENAME(rgb24tobgr32)(const uint8_t *src, uint8_t *dst, long src_size)
  68. {
  69. uint8_t *dest = dst;
  70. const uint8_t *s = src;
  71. const uint8_t *end;
  72. #if HAVE_MMX
  73. const uint8_t *mm_end;
  74. #endif
  75. end = s + src_size;
  76. #if HAVE_MMX
  77. __asm__ volatile(PREFETCH" %0"::"m"(*s):"memory");
  78. mm_end = end - 23;
  79. __asm__ volatile("movq %0, %%mm7"::"m"(mask32a):"memory");
  80. while (s < mm_end)
  81. {
  82. __asm__ volatile(
  83. PREFETCH" 32%1 \n\t"
  84. "movd %1, %%mm0 \n\t"
  85. "punpckldq 3%1, %%mm0 \n\t"
  86. "movd 6%1, %%mm1 \n\t"
  87. "punpckldq 9%1, %%mm1 \n\t"
  88. "movd 12%1, %%mm2 \n\t"
  89. "punpckldq 15%1, %%mm2 \n\t"
  90. "movd 18%1, %%mm3 \n\t"
  91. "punpckldq 21%1, %%mm3 \n\t"
  92. "por %%mm7, %%mm0 \n\t"
  93. "por %%mm7, %%mm1 \n\t"
  94. "por %%mm7, %%mm2 \n\t"
  95. "por %%mm7, %%mm3 \n\t"
  96. MOVNTQ" %%mm0, %0 \n\t"
  97. MOVNTQ" %%mm1, 8%0 \n\t"
  98. MOVNTQ" %%mm2, 16%0 \n\t"
  99. MOVNTQ" %%mm3, 24%0"
  100. :"=m"(*dest)
  101. :"m"(*s)
  102. :"memory");
  103. dest += 32;
  104. s += 24;
  105. }
  106. __asm__ volatile(SFENCE:::"memory");
  107. __asm__ volatile(EMMS:::"memory");
  108. #endif
  109. while (s < end)
  110. {
  111. #ifdef WORDS_BIGENDIAN
  112. /* RGB24 (= R,G,B) -> RGB32 (= A,B,G,R) */
  113. *dest++ = 255;
  114. *dest++ = s[2];
  115. *dest++ = s[1];
  116. *dest++ = s[0];
  117. s+=3;
  118. #else
  119. *dest++ = *s++;
  120. *dest++ = *s++;
  121. *dest++ = *s++;
  122. *dest++ = 255;
  123. #endif
  124. }
  125. }
  126. static inline void RENAME(rgb32tobgr24)(const uint8_t *src, uint8_t *dst, long src_size)
  127. {
  128. uint8_t *dest = dst;
  129. const uint8_t *s = src;
  130. const uint8_t *end;
  131. #if HAVE_MMX
  132. const uint8_t *mm_end;
  133. #endif
  134. end = s + src_size;
  135. #if HAVE_MMX
  136. __asm__ volatile(PREFETCH" %0"::"m"(*s):"memory");
  137. mm_end = end - 31;
  138. while (s < mm_end)
  139. {
  140. __asm__ volatile(
  141. PREFETCH" 32%1 \n\t"
  142. "movq %1, %%mm0 \n\t"
  143. "movq 8%1, %%mm1 \n\t"
  144. "movq 16%1, %%mm4 \n\t"
  145. "movq 24%1, %%mm5 \n\t"
  146. "movq %%mm0, %%mm2 \n\t"
  147. "movq %%mm1, %%mm3 \n\t"
  148. "movq %%mm4, %%mm6 \n\t"
  149. "movq %%mm5, %%mm7 \n\t"
  150. "psrlq $8, %%mm2 \n\t"
  151. "psrlq $8, %%mm3 \n\t"
  152. "psrlq $8, %%mm6 \n\t"
  153. "psrlq $8, %%mm7 \n\t"
  154. "pand %2, %%mm0 \n\t"
  155. "pand %2, %%mm1 \n\t"
  156. "pand %2, %%mm4 \n\t"
  157. "pand %2, %%mm5 \n\t"
  158. "pand %3, %%mm2 \n\t"
  159. "pand %3, %%mm3 \n\t"
  160. "pand %3, %%mm6 \n\t"
  161. "pand %3, %%mm7 \n\t"
  162. "por %%mm2, %%mm0 \n\t"
  163. "por %%mm3, %%mm1 \n\t"
  164. "por %%mm6, %%mm4 \n\t"
  165. "por %%mm7, %%mm5 \n\t"
  166. "movq %%mm1, %%mm2 \n\t"
  167. "movq %%mm4, %%mm3 \n\t"
  168. "psllq $48, %%mm2 \n\t"
  169. "psllq $32, %%mm3 \n\t"
  170. "pand %4, %%mm2 \n\t"
  171. "pand %5, %%mm3 \n\t"
  172. "por %%mm2, %%mm0 \n\t"
  173. "psrlq $16, %%mm1 \n\t"
  174. "psrlq $32, %%mm4 \n\t"
  175. "psllq $16, %%mm5 \n\t"
  176. "por %%mm3, %%mm1 \n\t"
  177. "pand %6, %%mm5 \n\t"
  178. "por %%mm5, %%mm4 \n\t"
  179. MOVNTQ" %%mm0, %0 \n\t"
  180. MOVNTQ" %%mm1, 8%0 \n\t"
  181. MOVNTQ" %%mm4, 16%0"
  182. :"=m"(*dest)
  183. :"m"(*s),"m"(mask24l),
  184. "m"(mask24h),"m"(mask24hh),"m"(mask24hhh),"m"(mask24hhhh)
  185. :"memory");
  186. dest += 24;
  187. s += 32;
  188. }
  189. __asm__ volatile(SFENCE:::"memory");
  190. __asm__ volatile(EMMS:::"memory");
  191. #endif
  192. while (s < end)
  193. {
  194. #ifdef WORDS_BIGENDIAN
  195. /* RGB32 (= A,B,G,R) -> RGB24 (= R,G,B) */
  196. s++;
  197. dest[2] = *s++;
  198. dest[1] = *s++;
  199. dest[0] = *s++;
  200. dest += 3;
  201. #else
  202. *dest++ = *s++;
  203. *dest++ = *s++;
  204. *dest++ = *s++;
  205. s++;
  206. #endif
  207. }
  208. }
  209. /*
  210. original by Strepto/Astral
  211. ported to gcc & bugfixed: A'rpi
  212. MMX2, 3DNOW optimization by Nick Kurshev
  213. 32-bit C version, and and&add trick by Michael Niedermayer
  214. */
  215. static inline void RENAME(rgb15to16)(const uint8_t *src, uint8_t *dst, long src_size)
  216. {
  217. register const uint8_t* s=src;
  218. register uint8_t* d=dst;
  219. register const uint8_t *end;
  220. const uint8_t *mm_end;
  221. end = s + src_size;
  222. #if HAVE_MMX
  223. __asm__ volatile(PREFETCH" %0"::"m"(*s));
  224. __asm__ volatile("movq %0, %%mm4"::"m"(mask15s));
  225. mm_end = end - 15;
  226. while (s<mm_end)
  227. {
  228. __asm__ volatile(
  229. PREFETCH" 32%1 \n\t"
  230. "movq %1, %%mm0 \n\t"
  231. "movq 8%1, %%mm2 \n\t"
  232. "movq %%mm0, %%mm1 \n\t"
  233. "movq %%mm2, %%mm3 \n\t"
  234. "pand %%mm4, %%mm0 \n\t"
  235. "pand %%mm4, %%mm2 \n\t"
  236. "paddw %%mm1, %%mm0 \n\t"
  237. "paddw %%mm3, %%mm2 \n\t"
  238. MOVNTQ" %%mm0, %0 \n\t"
  239. MOVNTQ" %%mm2, 8%0"
  240. :"=m"(*d)
  241. :"m"(*s)
  242. );
  243. d+=16;
  244. s+=16;
  245. }
  246. __asm__ volatile(SFENCE:::"memory");
  247. __asm__ volatile(EMMS:::"memory");
  248. #endif
  249. mm_end = end - 3;
  250. while (s < mm_end)
  251. {
  252. register unsigned x= *((const uint32_t *)s);
  253. *((uint32_t *)d) = (x&0x7FFF7FFF) + (x&0x7FE07FE0);
  254. d+=4;
  255. s+=4;
  256. }
  257. if (s < end)
  258. {
  259. register unsigned short x= *((const uint16_t *)s);
  260. *((uint16_t *)d) = (x&0x7FFF) + (x&0x7FE0);
  261. }
  262. }
  263. static inline void RENAME(rgb16to15)(const uint8_t *src, uint8_t *dst, long src_size)
  264. {
  265. register const uint8_t* s=src;
  266. register uint8_t* d=dst;
  267. register const uint8_t *end;
  268. const uint8_t *mm_end;
  269. end = s + src_size;
  270. #if HAVE_MMX
  271. __asm__ volatile(PREFETCH" %0"::"m"(*s));
  272. __asm__ volatile("movq %0, %%mm7"::"m"(mask15rg));
  273. __asm__ volatile("movq %0, %%mm6"::"m"(mask15b));
  274. mm_end = end - 15;
  275. while (s<mm_end)
  276. {
  277. __asm__ volatile(
  278. PREFETCH" 32%1 \n\t"
  279. "movq %1, %%mm0 \n\t"
  280. "movq 8%1, %%mm2 \n\t"
  281. "movq %%mm0, %%mm1 \n\t"
  282. "movq %%mm2, %%mm3 \n\t"
  283. "psrlq $1, %%mm0 \n\t"
  284. "psrlq $1, %%mm2 \n\t"
  285. "pand %%mm7, %%mm0 \n\t"
  286. "pand %%mm7, %%mm2 \n\t"
  287. "pand %%mm6, %%mm1 \n\t"
  288. "pand %%mm6, %%mm3 \n\t"
  289. "por %%mm1, %%mm0 \n\t"
  290. "por %%mm3, %%mm2 \n\t"
  291. MOVNTQ" %%mm0, %0 \n\t"
  292. MOVNTQ" %%mm2, 8%0"
  293. :"=m"(*d)
  294. :"m"(*s)
  295. );
  296. d+=16;
  297. s+=16;
  298. }
  299. __asm__ volatile(SFENCE:::"memory");
  300. __asm__ volatile(EMMS:::"memory");
  301. #endif
  302. mm_end = end - 3;
  303. while (s < mm_end)
  304. {
  305. register uint32_t x= *((const uint32_t*)s);
  306. *((uint32_t *)d) = ((x>>1)&0x7FE07FE0) | (x&0x001F001F);
  307. s+=4;
  308. d+=4;
  309. }
  310. if (s < end)
  311. {
  312. register uint16_t x= *((const uint16_t*)s);
  313. *((uint16_t *)d) = ((x>>1)&0x7FE0) | (x&0x001F);
  314. s+=2;
  315. d+=2;
  316. }
  317. }
  318. static inline void RENAME(rgb32to16)(const uint8_t *src, uint8_t *dst, long src_size)
  319. {
  320. const uint8_t *s = src;
  321. const uint8_t *end;
  322. #if HAVE_MMX
  323. const uint8_t *mm_end;
  324. #endif
  325. uint16_t *d = (uint16_t *)dst;
  326. end = s + src_size;
  327. #if HAVE_MMX
  328. mm_end = end - 15;
  329. #if 1 //is faster only if multiplies are reasonably fast (FIXME figure out on which CPUs this is faster, on Athlon it is slightly faster)
  330. __asm__ volatile(
  331. "movq %3, %%mm5 \n\t"
  332. "movq %4, %%mm6 \n\t"
  333. "movq %5, %%mm7 \n\t"
  334. "jmp 2f \n\t"
  335. ASMALIGN(4)
  336. "1: \n\t"
  337. PREFETCH" 32(%1) \n\t"
  338. "movd (%1), %%mm0 \n\t"
  339. "movd 4(%1), %%mm3 \n\t"
  340. "punpckldq 8(%1), %%mm0 \n\t"
  341. "punpckldq 12(%1), %%mm3 \n\t"
  342. "movq %%mm0, %%mm1 \n\t"
  343. "movq %%mm3, %%mm4 \n\t"
  344. "pand %%mm6, %%mm0 \n\t"
  345. "pand %%mm6, %%mm3 \n\t"
  346. "pmaddwd %%mm7, %%mm0 \n\t"
  347. "pmaddwd %%mm7, %%mm3 \n\t"
  348. "pand %%mm5, %%mm1 \n\t"
  349. "pand %%mm5, %%mm4 \n\t"
  350. "por %%mm1, %%mm0 \n\t"
  351. "por %%mm4, %%mm3 \n\t"
  352. "psrld $5, %%mm0 \n\t"
  353. "pslld $11, %%mm3 \n\t"
  354. "por %%mm3, %%mm0 \n\t"
  355. MOVNTQ" %%mm0, (%0) \n\t"
  356. "add $16, %1 \n\t"
  357. "add $8, %0 \n\t"
  358. "2: \n\t"
  359. "cmp %2, %1 \n\t"
  360. " jb 1b \n\t"
  361. : "+r" (d), "+r"(s)
  362. : "r" (mm_end), "m" (mask3216g), "m" (mask3216br), "m" (mul3216)
  363. );
  364. #else
  365. __asm__ volatile(PREFETCH" %0"::"m"(*src):"memory");
  366. __asm__ volatile(
  367. "movq %0, %%mm7 \n\t"
  368. "movq %1, %%mm6 \n\t"
  369. ::"m"(red_16mask),"m"(green_16mask));
  370. while (s < mm_end)
  371. {
  372. __asm__ volatile(
  373. PREFETCH" 32%1 \n\t"
  374. "movd %1, %%mm0 \n\t"
  375. "movd 4%1, %%mm3 \n\t"
  376. "punpckldq 8%1, %%mm0 \n\t"
  377. "punpckldq 12%1, %%mm3 \n\t"
  378. "movq %%mm0, %%mm1 \n\t"
  379. "movq %%mm0, %%mm2 \n\t"
  380. "movq %%mm3, %%mm4 \n\t"
  381. "movq %%mm3, %%mm5 \n\t"
  382. "psrlq $3, %%mm0 \n\t"
  383. "psrlq $3, %%mm3 \n\t"
  384. "pand %2, %%mm0 \n\t"
  385. "pand %2, %%mm3 \n\t"
  386. "psrlq $5, %%mm1 \n\t"
  387. "psrlq $5, %%mm4 \n\t"
  388. "pand %%mm6, %%mm1 \n\t"
  389. "pand %%mm6, %%mm4 \n\t"
  390. "psrlq $8, %%mm2 \n\t"
  391. "psrlq $8, %%mm5 \n\t"
  392. "pand %%mm7, %%mm2 \n\t"
  393. "pand %%mm7, %%mm5 \n\t"
  394. "por %%mm1, %%mm0 \n\t"
  395. "por %%mm4, %%mm3 \n\t"
  396. "por %%mm2, %%mm0 \n\t"
  397. "por %%mm5, %%mm3 \n\t"
  398. "psllq $16, %%mm3 \n\t"
  399. "por %%mm3, %%mm0 \n\t"
  400. MOVNTQ" %%mm0, %0 \n\t"
  401. :"=m"(*d):"m"(*s),"m"(blue_16mask):"memory");
  402. d += 4;
  403. s += 16;
  404. }
  405. #endif
  406. __asm__ volatile(SFENCE:::"memory");
  407. __asm__ volatile(EMMS:::"memory");
  408. #endif
  409. while (s < end)
  410. {
  411. register int rgb = *(const uint32_t*)s; s += 4;
  412. *d++ = ((rgb&0xFF)>>3) + ((rgb&0xFC00)>>5) + ((rgb&0xF80000)>>8);
  413. }
  414. }
  415. static inline void RENAME(rgb32tobgr16)(const uint8_t *src, uint8_t *dst, long src_size)
  416. {
  417. const uint8_t *s = src;
  418. const uint8_t *end;
  419. #if HAVE_MMX
  420. const uint8_t *mm_end;
  421. #endif
  422. uint16_t *d = (uint16_t *)dst;
  423. end = s + src_size;
  424. #if HAVE_MMX
  425. __asm__ volatile(PREFETCH" %0"::"m"(*src):"memory");
  426. __asm__ volatile(
  427. "movq %0, %%mm7 \n\t"
  428. "movq %1, %%mm6 \n\t"
  429. ::"m"(red_16mask),"m"(green_16mask));
  430. mm_end = end - 15;
  431. while (s < mm_end)
  432. {
  433. __asm__ volatile(
  434. PREFETCH" 32%1 \n\t"
  435. "movd %1, %%mm0 \n\t"
  436. "movd 4%1, %%mm3 \n\t"
  437. "punpckldq 8%1, %%mm0 \n\t"
  438. "punpckldq 12%1, %%mm3 \n\t"
  439. "movq %%mm0, %%mm1 \n\t"
  440. "movq %%mm0, %%mm2 \n\t"
  441. "movq %%mm3, %%mm4 \n\t"
  442. "movq %%mm3, %%mm5 \n\t"
  443. "psllq $8, %%mm0 \n\t"
  444. "psllq $8, %%mm3 \n\t"
  445. "pand %%mm7, %%mm0 \n\t"
  446. "pand %%mm7, %%mm3 \n\t"
  447. "psrlq $5, %%mm1 \n\t"
  448. "psrlq $5, %%mm4 \n\t"
  449. "pand %%mm6, %%mm1 \n\t"
  450. "pand %%mm6, %%mm4 \n\t"
  451. "psrlq $19, %%mm2 \n\t"
  452. "psrlq $19, %%mm5 \n\t"
  453. "pand %2, %%mm2 \n\t"
  454. "pand %2, %%mm5 \n\t"
  455. "por %%mm1, %%mm0 \n\t"
  456. "por %%mm4, %%mm3 \n\t"
  457. "por %%mm2, %%mm0 \n\t"
  458. "por %%mm5, %%mm3 \n\t"
  459. "psllq $16, %%mm3 \n\t"
  460. "por %%mm3, %%mm0 \n\t"
  461. MOVNTQ" %%mm0, %0 \n\t"
  462. :"=m"(*d):"m"(*s),"m"(blue_16mask):"memory");
  463. d += 4;
  464. s += 16;
  465. }
  466. __asm__ volatile(SFENCE:::"memory");
  467. __asm__ volatile(EMMS:::"memory");
  468. #endif
  469. while (s < end)
  470. {
  471. register int rgb = *(const uint32_t*)s; s += 4;
  472. *d++ = ((rgb&0xF8)<<8) + ((rgb&0xFC00)>>5) + ((rgb&0xF80000)>>19);
  473. }
  474. }
  475. static inline void RENAME(rgb32to15)(const uint8_t *src, uint8_t *dst, long src_size)
  476. {
  477. const uint8_t *s = src;
  478. const uint8_t *end;
  479. #if HAVE_MMX
  480. const uint8_t *mm_end;
  481. #endif
  482. uint16_t *d = (uint16_t *)dst;
  483. end = s + src_size;
  484. #if HAVE_MMX
  485. mm_end = end - 15;
  486. #if 1 //is faster only if multiplies are reasonably fast (FIXME figure out on which CPUs this is faster, on Athlon it is slightly faster)
  487. __asm__ volatile(
  488. "movq %3, %%mm5 \n\t"
  489. "movq %4, %%mm6 \n\t"
  490. "movq %5, %%mm7 \n\t"
  491. "jmp 2f \n\t"
  492. ASMALIGN(4)
  493. "1: \n\t"
  494. PREFETCH" 32(%1) \n\t"
  495. "movd (%1), %%mm0 \n\t"
  496. "movd 4(%1), %%mm3 \n\t"
  497. "punpckldq 8(%1), %%mm0 \n\t"
  498. "punpckldq 12(%1), %%mm3 \n\t"
  499. "movq %%mm0, %%mm1 \n\t"
  500. "movq %%mm3, %%mm4 \n\t"
  501. "pand %%mm6, %%mm0 \n\t"
  502. "pand %%mm6, %%mm3 \n\t"
  503. "pmaddwd %%mm7, %%mm0 \n\t"
  504. "pmaddwd %%mm7, %%mm3 \n\t"
  505. "pand %%mm5, %%mm1 \n\t"
  506. "pand %%mm5, %%mm4 \n\t"
  507. "por %%mm1, %%mm0 \n\t"
  508. "por %%mm4, %%mm3 \n\t"
  509. "psrld $6, %%mm0 \n\t"
  510. "pslld $10, %%mm3 \n\t"
  511. "por %%mm3, %%mm0 \n\t"
  512. MOVNTQ" %%mm0, (%0) \n\t"
  513. "add $16, %1 \n\t"
  514. "add $8, %0 \n\t"
  515. "2: \n\t"
  516. "cmp %2, %1 \n\t"
  517. " jb 1b \n\t"
  518. : "+r" (d), "+r"(s)
  519. : "r" (mm_end), "m" (mask3215g), "m" (mask3216br), "m" (mul3215)
  520. );
  521. #else
  522. __asm__ volatile(PREFETCH" %0"::"m"(*src):"memory");
  523. __asm__ volatile(
  524. "movq %0, %%mm7 \n\t"
  525. "movq %1, %%mm6 \n\t"
  526. ::"m"(red_15mask),"m"(green_15mask));
  527. while (s < mm_end)
  528. {
  529. __asm__ volatile(
  530. PREFETCH" 32%1 \n\t"
  531. "movd %1, %%mm0 \n\t"
  532. "movd 4%1, %%mm3 \n\t"
  533. "punpckldq 8%1, %%mm0 \n\t"
  534. "punpckldq 12%1, %%mm3 \n\t"
  535. "movq %%mm0, %%mm1 \n\t"
  536. "movq %%mm0, %%mm2 \n\t"
  537. "movq %%mm3, %%mm4 \n\t"
  538. "movq %%mm3, %%mm5 \n\t"
  539. "psrlq $3, %%mm0 \n\t"
  540. "psrlq $3, %%mm3 \n\t"
  541. "pand %2, %%mm0 \n\t"
  542. "pand %2, %%mm3 \n\t"
  543. "psrlq $6, %%mm1 \n\t"
  544. "psrlq $6, %%mm4 \n\t"
  545. "pand %%mm6, %%mm1 \n\t"
  546. "pand %%mm6, %%mm4 \n\t"
  547. "psrlq $9, %%mm2 \n\t"
  548. "psrlq $9, %%mm5 \n\t"
  549. "pand %%mm7, %%mm2 \n\t"
  550. "pand %%mm7, %%mm5 \n\t"
  551. "por %%mm1, %%mm0 \n\t"
  552. "por %%mm4, %%mm3 \n\t"
  553. "por %%mm2, %%mm0 \n\t"
  554. "por %%mm5, %%mm3 \n\t"
  555. "psllq $16, %%mm3 \n\t"
  556. "por %%mm3, %%mm0 \n\t"
  557. MOVNTQ" %%mm0, %0 \n\t"
  558. :"=m"(*d):"m"(*s),"m"(blue_15mask):"memory");
  559. d += 4;
  560. s += 16;
  561. }
  562. #endif
  563. __asm__ volatile(SFENCE:::"memory");
  564. __asm__ volatile(EMMS:::"memory");
  565. #endif
  566. while (s < end)
  567. {
  568. register int rgb = *(const uint32_t*)s; s += 4;
  569. *d++ = ((rgb&0xFF)>>3) + ((rgb&0xF800)>>6) + ((rgb&0xF80000)>>9);
  570. }
  571. }
  572. static inline void RENAME(rgb32tobgr15)(const uint8_t *src, uint8_t *dst, long src_size)
  573. {
  574. const uint8_t *s = src;
  575. const uint8_t *end;
  576. #if HAVE_MMX
  577. const uint8_t *mm_end;
  578. #endif
  579. uint16_t *d = (uint16_t *)dst;
  580. end = s + src_size;
  581. #if HAVE_MMX
  582. __asm__ volatile(PREFETCH" %0"::"m"(*src):"memory");
  583. __asm__ volatile(
  584. "movq %0, %%mm7 \n\t"
  585. "movq %1, %%mm6 \n\t"
  586. ::"m"(red_15mask),"m"(green_15mask));
  587. mm_end = end - 15;
  588. while (s < mm_end)
  589. {
  590. __asm__ volatile(
  591. PREFETCH" 32%1 \n\t"
  592. "movd %1, %%mm0 \n\t"
  593. "movd 4%1, %%mm3 \n\t"
  594. "punpckldq 8%1, %%mm0 \n\t"
  595. "punpckldq 12%1, %%mm3 \n\t"
  596. "movq %%mm0, %%mm1 \n\t"
  597. "movq %%mm0, %%mm2 \n\t"
  598. "movq %%mm3, %%mm4 \n\t"
  599. "movq %%mm3, %%mm5 \n\t"
  600. "psllq $7, %%mm0 \n\t"
  601. "psllq $7, %%mm3 \n\t"
  602. "pand %%mm7, %%mm0 \n\t"
  603. "pand %%mm7, %%mm3 \n\t"
  604. "psrlq $6, %%mm1 \n\t"
  605. "psrlq $6, %%mm4 \n\t"
  606. "pand %%mm6, %%mm1 \n\t"
  607. "pand %%mm6, %%mm4 \n\t"
  608. "psrlq $19, %%mm2 \n\t"
  609. "psrlq $19, %%mm5 \n\t"
  610. "pand %2, %%mm2 \n\t"
  611. "pand %2, %%mm5 \n\t"
  612. "por %%mm1, %%mm0 \n\t"
  613. "por %%mm4, %%mm3 \n\t"
  614. "por %%mm2, %%mm0 \n\t"
  615. "por %%mm5, %%mm3 \n\t"
  616. "psllq $16, %%mm3 \n\t"
  617. "por %%mm3, %%mm0 \n\t"
  618. MOVNTQ" %%mm0, %0 \n\t"
  619. :"=m"(*d):"m"(*s),"m"(blue_15mask):"memory");
  620. d += 4;
  621. s += 16;
  622. }
  623. __asm__ volatile(SFENCE:::"memory");
  624. __asm__ volatile(EMMS:::"memory");
  625. #endif
  626. while (s < end)
  627. {
  628. register int rgb = *(const uint32_t*)s; s += 4;
  629. *d++ = ((rgb&0xF8)<<7) + ((rgb&0xF800)>>6) + ((rgb&0xF80000)>>19);
  630. }
  631. }
  632. static inline void RENAME(rgb24tobgr16)(const uint8_t *src, uint8_t *dst, long src_size)
  633. {
  634. const uint8_t *s = src;
  635. const uint8_t *end;
  636. #if HAVE_MMX
  637. const uint8_t *mm_end;
  638. #endif
  639. uint16_t *d = (uint16_t *)dst;
  640. end = s + src_size;
  641. #if HAVE_MMX
  642. __asm__ volatile(PREFETCH" %0"::"m"(*src):"memory");
  643. __asm__ volatile(
  644. "movq %0, %%mm7 \n\t"
  645. "movq %1, %%mm6 \n\t"
  646. ::"m"(red_16mask),"m"(green_16mask));
  647. mm_end = end - 11;
  648. while (s < mm_end)
  649. {
  650. __asm__ volatile(
  651. PREFETCH" 32%1 \n\t"
  652. "movd %1, %%mm0 \n\t"
  653. "movd 3%1, %%mm3 \n\t"
  654. "punpckldq 6%1, %%mm0 \n\t"
  655. "punpckldq 9%1, %%mm3 \n\t"
  656. "movq %%mm0, %%mm1 \n\t"
  657. "movq %%mm0, %%mm2 \n\t"
  658. "movq %%mm3, %%mm4 \n\t"
  659. "movq %%mm3, %%mm5 \n\t"
  660. "psrlq $3, %%mm0 \n\t"
  661. "psrlq $3, %%mm3 \n\t"
  662. "pand %2, %%mm0 \n\t"
  663. "pand %2, %%mm3 \n\t"
  664. "psrlq $5, %%mm1 \n\t"
  665. "psrlq $5, %%mm4 \n\t"
  666. "pand %%mm6, %%mm1 \n\t"
  667. "pand %%mm6, %%mm4 \n\t"
  668. "psrlq $8, %%mm2 \n\t"
  669. "psrlq $8, %%mm5 \n\t"
  670. "pand %%mm7, %%mm2 \n\t"
  671. "pand %%mm7, %%mm5 \n\t"
  672. "por %%mm1, %%mm0 \n\t"
  673. "por %%mm4, %%mm3 \n\t"
  674. "por %%mm2, %%mm0 \n\t"
  675. "por %%mm5, %%mm3 \n\t"
  676. "psllq $16, %%mm3 \n\t"
  677. "por %%mm3, %%mm0 \n\t"
  678. MOVNTQ" %%mm0, %0 \n\t"
  679. :"=m"(*d):"m"(*s),"m"(blue_16mask):"memory");
  680. d += 4;
  681. s += 12;
  682. }
  683. __asm__ volatile(SFENCE:::"memory");
  684. __asm__ volatile(EMMS:::"memory");
  685. #endif
  686. while (s < end)
  687. {
  688. const int b = *s++;
  689. const int g = *s++;
  690. const int r = *s++;
  691. *d++ = (b>>3) | ((g&0xFC)<<3) | ((r&0xF8)<<8);
  692. }
  693. }
  694. static inline void RENAME(rgb24to16)(const uint8_t *src, uint8_t *dst, long src_size)
  695. {
  696. const uint8_t *s = src;
  697. const uint8_t *end;
  698. #if HAVE_MMX
  699. const uint8_t *mm_end;
  700. #endif
  701. uint16_t *d = (uint16_t *)dst;
  702. end = s + src_size;
  703. #if HAVE_MMX
  704. __asm__ volatile(PREFETCH" %0"::"m"(*src):"memory");
  705. __asm__ volatile(
  706. "movq %0, %%mm7 \n\t"
  707. "movq %1, %%mm6 \n\t"
  708. ::"m"(red_16mask),"m"(green_16mask));
  709. mm_end = end - 15;
  710. while (s < mm_end)
  711. {
  712. __asm__ volatile(
  713. PREFETCH" 32%1 \n\t"
  714. "movd %1, %%mm0 \n\t"
  715. "movd 3%1, %%mm3 \n\t"
  716. "punpckldq 6%1, %%mm0 \n\t"
  717. "punpckldq 9%1, %%mm3 \n\t"
  718. "movq %%mm0, %%mm1 \n\t"
  719. "movq %%mm0, %%mm2 \n\t"
  720. "movq %%mm3, %%mm4 \n\t"
  721. "movq %%mm3, %%mm5 \n\t"
  722. "psllq $8, %%mm0 \n\t"
  723. "psllq $8, %%mm3 \n\t"
  724. "pand %%mm7, %%mm0 \n\t"
  725. "pand %%mm7, %%mm3 \n\t"
  726. "psrlq $5, %%mm1 \n\t"
  727. "psrlq $5, %%mm4 \n\t"
  728. "pand %%mm6, %%mm1 \n\t"
  729. "pand %%mm6, %%mm4 \n\t"
  730. "psrlq $19, %%mm2 \n\t"
  731. "psrlq $19, %%mm5 \n\t"
  732. "pand %2, %%mm2 \n\t"
  733. "pand %2, %%mm5 \n\t"
  734. "por %%mm1, %%mm0 \n\t"
  735. "por %%mm4, %%mm3 \n\t"
  736. "por %%mm2, %%mm0 \n\t"
  737. "por %%mm5, %%mm3 \n\t"
  738. "psllq $16, %%mm3 \n\t"
  739. "por %%mm3, %%mm0 \n\t"
  740. MOVNTQ" %%mm0, %0 \n\t"
  741. :"=m"(*d):"m"(*s),"m"(blue_16mask):"memory");
  742. d += 4;
  743. s += 12;
  744. }
  745. __asm__ volatile(SFENCE:::"memory");
  746. __asm__ volatile(EMMS:::"memory");
  747. #endif
  748. while (s < end)
  749. {
  750. const int r = *s++;
  751. const int g = *s++;
  752. const int b = *s++;
  753. *d++ = (b>>3) | ((g&0xFC)<<3) | ((r&0xF8)<<8);
  754. }
  755. }
  756. static inline void RENAME(rgb24tobgr15)(const uint8_t *src, uint8_t *dst, long src_size)
  757. {
  758. const uint8_t *s = src;
  759. const uint8_t *end;
  760. #if HAVE_MMX
  761. const uint8_t *mm_end;
  762. #endif
  763. uint16_t *d = (uint16_t *)dst;
  764. end = s + src_size;
  765. #if HAVE_MMX
  766. __asm__ volatile(PREFETCH" %0"::"m"(*src):"memory");
  767. __asm__ volatile(
  768. "movq %0, %%mm7 \n\t"
  769. "movq %1, %%mm6 \n\t"
  770. ::"m"(red_15mask),"m"(green_15mask));
  771. mm_end = end - 11;
  772. while (s < mm_end)
  773. {
  774. __asm__ volatile(
  775. PREFETCH" 32%1 \n\t"
  776. "movd %1, %%mm0 \n\t"
  777. "movd 3%1, %%mm3 \n\t"
  778. "punpckldq 6%1, %%mm0 \n\t"
  779. "punpckldq 9%1, %%mm3 \n\t"
  780. "movq %%mm0, %%mm1 \n\t"
  781. "movq %%mm0, %%mm2 \n\t"
  782. "movq %%mm3, %%mm4 \n\t"
  783. "movq %%mm3, %%mm5 \n\t"
  784. "psrlq $3, %%mm0 \n\t"
  785. "psrlq $3, %%mm3 \n\t"
  786. "pand %2, %%mm0 \n\t"
  787. "pand %2, %%mm3 \n\t"
  788. "psrlq $6, %%mm1 \n\t"
  789. "psrlq $6, %%mm4 \n\t"
  790. "pand %%mm6, %%mm1 \n\t"
  791. "pand %%mm6, %%mm4 \n\t"
  792. "psrlq $9, %%mm2 \n\t"
  793. "psrlq $9, %%mm5 \n\t"
  794. "pand %%mm7, %%mm2 \n\t"
  795. "pand %%mm7, %%mm5 \n\t"
  796. "por %%mm1, %%mm0 \n\t"
  797. "por %%mm4, %%mm3 \n\t"
  798. "por %%mm2, %%mm0 \n\t"
  799. "por %%mm5, %%mm3 \n\t"
  800. "psllq $16, %%mm3 \n\t"
  801. "por %%mm3, %%mm0 \n\t"
  802. MOVNTQ" %%mm0, %0 \n\t"
  803. :"=m"(*d):"m"(*s),"m"(blue_15mask):"memory");
  804. d += 4;
  805. s += 12;
  806. }
  807. __asm__ volatile(SFENCE:::"memory");
  808. __asm__ volatile(EMMS:::"memory");
  809. #endif
  810. while (s < end)
  811. {
  812. const int b = *s++;
  813. const int g = *s++;
  814. const int r = *s++;
  815. *d++ = (b>>3) | ((g&0xF8)<<2) | ((r&0xF8)<<7);
  816. }
  817. }
  818. static inline void RENAME(rgb24to15)(const uint8_t *src, uint8_t *dst, long src_size)
  819. {
  820. const uint8_t *s = src;
  821. const uint8_t *end;
  822. #if HAVE_MMX
  823. const uint8_t *mm_end;
  824. #endif
  825. uint16_t *d = (uint16_t *)dst;
  826. end = s + src_size;
  827. #if HAVE_MMX
  828. __asm__ volatile(PREFETCH" %0"::"m"(*src):"memory");
  829. __asm__ volatile(
  830. "movq %0, %%mm7 \n\t"
  831. "movq %1, %%mm6 \n\t"
  832. ::"m"(red_15mask),"m"(green_15mask));
  833. mm_end = end - 15;
  834. while (s < mm_end)
  835. {
  836. __asm__ volatile(
  837. PREFETCH" 32%1 \n\t"
  838. "movd %1, %%mm0 \n\t"
  839. "movd 3%1, %%mm3 \n\t"
  840. "punpckldq 6%1, %%mm0 \n\t"
  841. "punpckldq 9%1, %%mm3 \n\t"
  842. "movq %%mm0, %%mm1 \n\t"
  843. "movq %%mm0, %%mm2 \n\t"
  844. "movq %%mm3, %%mm4 \n\t"
  845. "movq %%mm3, %%mm5 \n\t"
  846. "psllq $7, %%mm0 \n\t"
  847. "psllq $7, %%mm3 \n\t"
  848. "pand %%mm7, %%mm0 \n\t"
  849. "pand %%mm7, %%mm3 \n\t"
  850. "psrlq $6, %%mm1 \n\t"
  851. "psrlq $6, %%mm4 \n\t"
  852. "pand %%mm6, %%mm1 \n\t"
  853. "pand %%mm6, %%mm4 \n\t"
  854. "psrlq $19, %%mm2 \n\t"
  855. "psrlq $19, %%mm5 \n\t"
  856. "pand %2, %%mm2 \n\t"
  857. "pand %2, %%mm5 \n\t"
  858. "por %%mm1, %%mm0 \n\t"
  859. "por %%mm4, %%mm3 \n\t"
  860. "por %%mm2, %%mm0 \n\t"
  861. "por %%mm5, %%mm3 \n\t"
  862. "psllq $16, %%mm3 \n\t"
  863. "por %%mm3, %%mm0 \n\t"
  864. MOVNTQ" %%mm0, %0 \n\t"
  865. :"=m"(*d):"m"(*s),"m"(blue_15mask):"memory");
  866. d += 4;
  867. s += 12;
  868. }
  869. __asm__ volatile(SFENCE:::"memory");
  870. __asm__ volatile(EMMS:::"memory");
  871. #endif
  872. while (s < end)
  873. {
  874. const int r = *s++;
  875. const int g = *s++;
  876. const int b = *s++;
  877. *d++ = (b>>3) | ((g&0xF8)<<2) | ((r&0xF8)<<7);
  878. }
  879. }
  880. /*
  881. I use less accurate approximation here by simply left-shifting the input
  882. value and filling the low order bits with zeroes. This method improves PNG
  883. compression but this scheme cannot reproduce white exactly, since it does
  884. not generate an all-ones maximum value; the net effect is to darken the
  885. image slightly.
  886. The better method should be "left bit replication":
  887. 4 3 2 1 0
  888. ---------
  889. 1 1 0 1 1
  890. 7 6 5 4 3 2 1 0
  891. ----------------
  892. 1 1 0 1 1 1 1 0
  893. |=======| |===|
  894. | leftmost bits repeated to fill open bits
  895. |
  896. original bits
  897. */
  898. static inline void RENAME(rgb15tobgr24)(const uint8_t *src, uint8_t *dst, long src_size)
  899. {
  900. const uint16_t *end;
  901. #if HAVE_MMX
  902. const uint16_t *mm_end;
  903. #endif
  904. uint8_t *d = dst;
  905. const uint16_t *s = (const uint16_t*)src;
  906. end = s + src_size/2;
  907. #if HAVE_MMX
  908. __asm__ volatile(PREFETCH" %0"::"m"(*s):"memory");
  909. mm_end = end - 7;
  910. while (s < mm_end)
  911. {
  912. __asm__ volatile(
  913. PREFETCH" 32%1 \n\t"
  914. "movq %1, %%mm0 \n\t"
  915. "movq %1, %%mm1 \n\t"
  916. "movq %1, %%mm2 \n\t"
  917. "pand %2, %%mm0 \n\t"
  918. "pand %3, %%mm1 \n\t"
  919. "pand %4, %%mm2 \n\t"
  920. "psllq $3, %%mm0 \n\t"
  921. "psrlq $2, %%mm1 \n\t"
  922. "psrlq $7, %%mm2 \n\t"
  923. "movq %%mm0, %%mm3 \n\t"
  924. "movq %%mm1, %%mm4 \n\t"
  925. "movq %%mm2, %%mm5 \n\t"
  926. "punpcklwd %5, %%mm0 \n\t"
  927. "punpcklwd %5, %%mm1 \n\t"
  928. "punpcklwd %5, %%mm2 \n\t"
  929. "punpckhwd %5, %%mm3 \n\t"
  930. "punpckhwd %5, %%mm4 \n\t"
  931. "punpckhwd %5, %%mm5 \n\t"
  932. "psllq $8, %%mm1 \n\t"
  933. "psllq $16, %%mm2 \n\t"
  934. "por %%mm1, %%mm0 \n\t"
  935. "por %%mm2, %%mm0 \n\t"
  936. "psllq $8, %%mm4 \n\t"
  937. "psllq $16, %%mm5 \n\t"
  938. "por %%mm4, %%mm3 \n\t"
  939. "por %%mm5, %%mm3 \n\t"
  940. "movq %%mm0, %%mm6 \n\t"
  941. "movq %%mm3, %%mm7 \n\t"
  942. "movq 8%1, %%mm0 \n\t"
  943. "movq 8%1, %%mm1 \n\t"
  944. "movq 8%1, %%mm2 \n\t"
  945. "pand %2, %%mm0 \n\t"
  946. "pand %3, %%mm1 \n\t"
  947. "pand %4, %%mm2 \n\t"
  948. "psllq $3, %%mm0 \n\t"
  949. "psrlq $2, %%mm1 \n\t"
  950. "psrlq $7, %%mm2 \n\t"
  951. "movq %%mm0, %%mm3 \n\t"
  952. "movq %%mm1, %%mm4 \n\t"
  953. "movq %%mm2, %%mm5 \n\t"
  954. "punpcklwd %5, %%mm0 \n\t"
  955. "punpcklwd %5, %%mm1 \n\t"
  956. "punpcklwd %5, %%mm2 \n\t"
  957. "punpckhwd %5, %%mm3 \n\t"
  958. "punpckhwd %5, %%mm4 \n\t"
  959. "punpckhwd %5, %%mm5 \n\t"
  960. "psllq $8, %%mm1 \n\t"
  961. "psllq $16, %%mm2 \n\t"
  962. "por %%mm1, %%mm0 \n\t"
  963. "por %%mm2, %%mm0 \n\t"
  964. "psllq $8, %%mm4 \n\t"
  965. "psllq $16, %%mm5 \n\t"
  966. "por %%mm4, %%mm3 \n\t"
  967. "por %%mm5, %%mm3 \n\t"
  968. :"=m"(*d)
  969. :"m"(*s),"m"(mask15b),"m"(mask15g),"m"(mask15r), "m"(mmx_null)
  970. :"memory");
  971. /* borrowed 32 to 24 */
  972. __asm__ volatile(
  973. "movq %%mm0, %%mm4 \n\t"
  974. "movq %%mm3, %%mm5 \n\t"
  975. "movq %%mm6, %%mm0 \n\t"
  976. "movq %%mm7, %%mm1 \n\t"
  977. "movq %%mm4, %%mm6 \n\t"
  978. "movq %%mm5, %%mm7 \n\t"
  979. "movq %%mm0, %%mm2 \n\t"
  980. "movq %%mm1, %%mm3 \n\t"
  981. "psrlq $8, %%mm2 \n\t"
  982. "psrlq $8, %%mm3 \n\t"
  983. "psrlq $8, %%mm6 \n\t"
  984. "psrlq $8, %%mm7 \n\t"
  985. "pand %2, %%mm0 \n\t"
  986. "pand %2, %%mm1 \n\t"
  987. "pand %2, %%mm4 \n\t"
  988. "pand %2, %%mm5 \n\t"
  989. "pand %3, %%mm2 \n\t"
  990. "pand %3, %%mm3 \n\t"
  991. "pand %3, %%mm6 \n\t"
  992. "pand %3, %%mm7 \n\t"
  993. "por %%mm2, %%mm0 \n\t"
  994. "por %%mm3, %%mm1 \n\t"
  995. "por %%mm6, %%mm4 \n\t"
  996. "por %%mm7, %%mm5 \n\t"
  997. "movq %%mm1, %%mm2 \n\t"
  998. "movq %%mm4, %%mm3 \n\t"
  999. "psllq $48, %%mm2 \n\t"
  1000. "psllq $32, %%mm3 \n\t"
  1001. "pand %4, %%mm2 \n\t"
  1002. "pand %5, %%mm3 \n\t"
  1003. "por %%mm2, %%mm0 \n\t"
  1004. "psrlq $16, %%mm1 \n\t"
  1005. "psrlq $32, %%mm4 \n\t"
  1006. "psllq $16, %%mm5 \n\t"
  1007. "por %%mm3, %%mm1 \n\t"
  1008. "pand %6, %%mm5 \n\t"
  1009. "por %%mm5, %%mm4 \n\t"
  1010. MOVNTQ" %%mm0, %0 \n\t"
  1011. MOVNTQ" %%mm1, 8%0 \n\t"
  1012. MOVNTQ" %%mm4, 16%0"
  1013. :"=m"(*d)
  1014. :"m"(*s),"m"(mask24l),"m"(mask24h),"m"(mask24hh),"m"(mask24hhh),"m"(mask24hhhh)
  1015. :"memory");
  1016. d += 24;
  1017. s += 8;
  1018. }
  1019. __asm__ volatile(SFENCE:::"memory");
  1020. __asm__ volatile(EMMS:::"memory");
  1021. #endif
  1022. while (s < end)
  1023. {
  1024. register uint16_t bgr;
  1025. bgr = *s++;
  1026. *d++ = (bgr&0x1F)<<3;
  1027. *d++ = (bgr&0x3E0)>>2;
  1028. *d++ = (bgr&0x7C00)>>7;
  1029. }
  1030. }
  1031. static inline void RENAME(rgb16tobgr24)(const uint8_t *src, uint8_t *dst, long src_size)
  1032. {
  1033. const uint16_t *end;
  1034. #if HAVE_MMX
  1035. const uint16_t *mm_end;
  1036. #endif
  1037. uint8_t *d = (uint8_t *)dst;
  1038. const uint16_t *s = (const uint16_t *)src;
  1039. end = s + src_size/2;
  1040. #if HAVE_MMX
  1041. __asm__ volatile(PREFETCH" %0"::"m"(*s):"memory");
  1042. mm_end = end - 7;
  1043. while (s < mm_end)
  1044. {
  1045. __asm__ volatile(
  1046. PREFETCH" 32%1 \n\t"
  1047. "movq %1, %%mm0 \n\t"
  1048. "movq %1, %%mm1 \n\t"
  1049. "movq %1, %%mm2 \n\t"
  1050. "pand %2, %%mm0 \n\t"
  1051. "pand %3, %%mm1 \n\t"
  1052. "pand %4, %%mm2 \n\t"
  1053. "psllq $3, %%mm0 \n\t"
  1054. "psrlq $3, %%mm1 \n\t"
  1055. "psrlq $8, %%mm2 \n\t"
  1056. "movq %%mm0, %%mm3 \n\t"
  1057. "movq %%mm1, %%mm4 \n\t"
  1058. "movq %%mm2, %%mm5 \n\t"
  1059. "punpcklwd %5, %%mm0 \n\t"
  1060. "punpcklwd %5, %%mm1 \n\t"
  1061. "punpcklwd %5, %%mm2 \n\t"
  1062. "punpckhwd %5, %%mm3 \n\t"
  1063. "punpckhwd %5, %%mm4 \n\t"
  1064. "punpckhwd %5, %%mm5 \n\t"
  1065. "psllq $8, %%mm1 \n\t"
  1066. "psllq $16, %%mm2 \n\t"
  1067. "por %%mm1, %%mm0 \n\t"
  1068. "por %%mm2, %%mm0 \n\t"
  1069. "psllq $8, %%mm4 \n\t"
  1070. "psllq $16, %%mm5 \n\t"
  1071. "por %%mm4, %%mm3 \n\t"
  1072. "por %%mm5, %%mm3 \n\t"
  1073. "movq %%mm0, %%mm6 \n\t"
  1074. "movq %%mm3, %%mm7 \n\t"
  1075. "movq 8%1, %%mm0 \n\t"
  1076. "movq 8%1, %%mm1 \n\t"
  1077. "movq 8%1, %%mm2 \n\t"
  1078. "pand %2, %%mm0 \n\t"
  1079. "pand %3, %%mm1 \n\t"
  1080. "pand %4, %%mm2 \n\t"
  1081. "psllq $3, %%mm0 \n\t"
  1082. "psrlq $3, %%mm1 \n\t"
  1083. "psrlq $8, %%mm2 \n\t"
  1084. "movq %%mm0, %%mm3 \n\t"
  1085. "movq %%mm1, %%mm4 \n\t"
  1086. "movq %%mm2, %%mm5 \n\t"
  1087. "punpcklwd %5, %%mm0 \n\t"
  1088. "punpcklwd %5, %%mm1 \n\t"
  1089. "punpcklwd %5, %%mm2 \n\t"
  1090. "punpckhwd %5, %%mm3 \n\t"
  1091. "punpckhwd %5, %%mm4 \n\t"
  1092. "punpckhwd %5, %%mm5 \n\t"
  1093. "psllq $8, %%mm1 \n\t"
  1094. "psllq $16, %%mm2 \n\t"
  1095. "por %%mm1, %%mm0 \n\t"
  1096. "por %%mm2, %%mm0 \n\t"
  1097. "psllq $8, %%mm4 \n\t"
  1098. "psllq $16, %%mm5 \n\t"
  1099. "por %%mm4, %%mm3 \n\t"
  1100. "por %%mm5, %%mm3 \n\t"
  1101. :"=m"(*d)
  1102. :"m"(*s),"m"(mask16b),"m"(mask16g),"m"(mask16r),"m"(mmx_null)
  1103. :"memory");
  1104. /* borrowed 32 to 24 */
  1105. __asm__ volatile(
  1106. "movq %%mm0, %%mm4 \n\t"
  1107. "movq %%mm3, %%mm5 \n\t"
  1108. "movq %%mm6, %%mm0 \n\t"
  1109. "movq %%mm7, %%mm1 \n\t"
  1110. "movq %%mm4, %%mm6 \n\t"
  1111. "movq %%mm5, %%mm7 \n\t"
  1112. "movq %%mm0, %%mm2 \n\t"
  1113. "movq %%mm1, %%mm3 \n\t"
  1114. "psrlq $8, %%mm2 \n\t"
  1115. "psrlq $8, %%mm3 \n\t"
  1116. "psrlq $8, %%mm6 \n\t"
  1117. "psrlq $8, %%mm7 \n\t"
  1118. "pand %2, %%mm0 \n\t"
  1119. "pand %2, %%mm1 \n\t"
  1120. "pand %2, %%mm4 \n\t"
  1121. "pand %2, %%mm5 \n\t"
  1122. "pand %3, %%mm2 \n\t"
  1123. "pand %3, %%mm3 \n\t"
  1124. "pand %3, %%mm6 \n\t"
  1125. "pand %3, %%mm7 \n\t"
  1126. "por %%mm2, %%mm0 \n\t"
  1127. "por %%mm3, %%mm1 \n\t"
  1128. "por %%mm6, %%mm4 \n\t"
  1129. "por %%mm7, %%mm5 \n\t"
  1130. "movq %%mm1, %%mm2 \n\t"
  1131. "movq %%mm4, %%mm3 \n\t"
  1132. "psllq $48, %%mm2 \n\t"
  1133. "psllq $32, %%mm3 \n\t"
  1134. "pand %4, %%mm2 \n\t"
  1135. "pand %5, %%mm3 \n\t"
  1136. "por %%mm2, %%mm0 \n\t"
  1137. "psrlq $16, %%mm1 \n\t"
  1138. "psrlq $32, %%mm4 \n\t"
  1139. "psllq $16, %%mm5 \n\t"
  1140. "por %%mm3, %%mm1 \n\t"
  1141. "pand %6, %%mm5 \n\t"
  1142. "por %%mm5, %%mm4 \n\t"
  1143. MOVNTQ" %%mm0, %0 \n\t"
  1144. MOVNTQ" %%mm1, 8%0 \n\t"
  1145. MOVNTQ" %%mm4, 16%0"
  1146. :"=m"(*d)
  1147. :"m"(*s),"m"(mask24l),"m"(mask24h),"m"(mask24hh),"m"(mask24hhh),"m"(mask24hhhh)
  1148. :"memory");
  1149. d += 24;
  1150. s += 8;
  1151. }
  1152. __asm__ volatile(SFENCE:::"memory");
  1153. __asm__ volatile(EMMS:::"memory");
  1154. #endif
  1155. while (s < end)
  1156. {
  1157. register uint16_t bgr;
  1158. bgr = *s++;
  1159. *d++ = (bgr&0x1F)<<3;
  1160. *d++ = (bgr&0x7E0)>>3;
  1161. *d++ = (bgr&0xF800)>>8;
  1162. }
  1163. }
  1164. static inline void RENAME(rgb15to32)(const uint8_t *src, uint8_t *dst, long src_size)
  1165. {
  1166. const uint16_t *end;
  1167. #if HAVE_MMX
  1168. const uint16_t *mm_end;
  1169. #endif
  1170. uint8_t *d = dst;
  1171. const uint16_t *s = (const uint16_t *)src;
  1172. end = s + src_size/2;
  1173. #if HAVE_MMX
  1174. __asm__ volatile(PREFETCH" %0"::"m"(*s):"memory");
  1175. __asm__ volatile("pxor %%mm7,%%mm7 \n\t":::"memory");
  1176. mm_end = end - 3;
  1177. while (s < mm_end)
  1178. {
  1179. __asm__ volatile(
  1180. PREFETCH" 32%1 \n\t"
  1181. "movq %1, %%mm0 \n\t"
  1182. "movq %1, %%mm1 \n\t"
  1183. "movq %1, %%mm2 \n\t"
  1184. "pand %2, %%mm0 \n\t"
  1185. "pand %3, %%mm1 \n\t"
  1186. "pand %4, %%mm2 \n\t"
  1187. "psllq $3, %%mm0 \n\t"
  1188. "psrlq $2, %%mm1 \n\t"
  1189. "psrlq $7, %%mm2 \n\t"
  1190. "movq %%mm0, %%mm3 \n\t"
  1191. "movq %%mm1, %%mm4 \n\t"
  1192. "movq %%mm2, %%mm5 \n\t"
  1193. "punpcklwd %%mm7, %%mm0 \n\t"
  1194. "punpcklwd %%mm7, %%mm1 \n\t"
  1195. "punpcklwd %%mm7, %%mm2 \n\t"
  1196. "punpckhwd %%mm7, %%mm3 \n\t"
  1197. "punpckhwd %%mm7, %%mm4 \n\t"
  1198. "punpckhwd %%mm7, %%mm5 \n\t"
  1199. "psllq $8, %%mm1 \n\t"
  1200. "psllq $16, %%mm2 \n\t"
  1201. "por %%mm1, %%mm0 \n\t"
  1202. "por %%mm2, %%mm0 \n\t"
  1203. "psllq $8, %%mm4 \n\t"
  1204. "psllq $16, %%mm5 \n\t"
  1205. "por %%mm4, %%mm3 \n\t"
  1206. "por %%mm5, %%mm3 \n\t"
  1207. MOVNTQ" %%mm0, %0 \n\t"
  1208. MOVNTQ" %%mm3, 8%0 \n\t"
  1209. :"=m"(*d)
  1210. :"m"(*s),"m"(mask15b),"m"(mask15g),"m"(mask15r)
  1211. :"memory");
  1212. d += 16;
  1213. s += 4;
  1214. }
  1215. __asm__ volatile(SFENCE:::"memory");
  1216. __asm__ volatile(EMMS:::"memory");
  1217. #endif
  1218. while (s < end)
  1219. {
  1220. #if 0 //slightly slower on Athlon
  1221. int bgr= *s++;
  1222. *((uint32_t*)d)++ = ((bgr&0x1F)<<3) + ((bgr&0x3E0)<<6) + ((bgr&0x7C00)<<9);
  1223. #else
  1224. register uint16_t bgr;
  1225. bgr = *s++;
  1226. #ifdef WORDS_BIGENDIAN
  1227. *d++ = 255;
  1228. *d++ = (bgr&0x7C00)>>7;
  1229. *d++ = (bgr&0x3E0)>>2;
  1230. *d++ = (bgr&0x1F)<<3;
  1231. #else
  1232. *d++ = (bgr&0x1F)<<3;
  1233. *d++ = (bgr&0x3E0)>>2;
  1234. *d++ = (bgr&0x7C00)>>7;
  1235. *d++ = 255;
  1236. #endif
  1237. #endif
  1238. }
  1239. }
  1240. static inline void RENAME(rgb16to32)(const uint8_t *src, uint8_t *dst, long src_size)
  1241. {
  1242. const uint16_t *end;
  1243. #if HAVE_MMX
  1244. const uint16_t *mm_end;
  1245. #endif
  1246. uint8_t *d = dst;
  1247. const uint16_t *s = (const uint16_t*)src;
  1248. end = s + src_size/2;
  1249. #if HAVE_MMX
  1250. __asm__ volatile(PREFETCH" %0"::"m"(*s):"memory");
  1251. __asm__ volatile("pxor %%mm7,%%mm7 \n\t":::"memory");
  1252. mm_end = end - 3;
  1253. while (s < mm_end)
  1254. {
  1255. __asm__ volatile(
  1256. PREFETCH" 32%1 \n\t"
  1257. "movq %1, %%mm0 \n\t"
  1258. "movq %1, %%mm1 \n\t"
  1259. "movq %1, %%mm2 \n\t"
  1260. "pand %2, %%mm0 \n\t"
  1261. "pand %3, %%mm1 \n\t"
  1262. "pand %4, %%mm2 \n\t"
  1263. "psllq $3, %%mm0 \n\t"
  1264. "psrlq $3, %%mm1 \n\t"
  1265. "psrlq $8, %%mm2 \n\t"
  1266. "movq %%mm0, %%mm3 \n\t"
  1267. "movq %%mm1, %%mm4 \n\t"
  1268. "movq %%mm2, %%mm5 \n\t"
  1269. "punpcklwd %%mm7, %%mm0 \n\t"
  1270. "punpcklwd %%mm7, %%mm1 \n\t"
  1271. "punpcklwd %%mm7, %%mm2 \n\t"
  1272. "punpckhwd %%mm7, %%mm3 \n\t"
  1273. "punpckhwd %%mm7, %%mm4 \n\t"
  1274. "punpckhwd %%mm7, %%mm5 \n\t"
  1275. "psllq $8, %%mm1 \n\t"
  1276. "psllq $16, %%mm2 \n\t"
  1277. "por %%mm1, %%mm0 \n\t"
  1278. "por %%mm2, %%mm0 \n\t"
  1279. "psllq $8, %%mm4 \n\t"
  1280. "psllq $16, %%mm5 \n\t"
  1281. "por %%mm4, %%mm3 \n\t"
  1282. "por %%mm5, %%mm3 \n\t"
  1283. MOVNTQ" %%mm0, %0 \n\t"
  1284. MOVNTQ" %%mm3, 8%0 \n\t"
  1285. :"=m"(*d)
  1286. :"m"(*s),"m"(mask16b),"m"(mask16g),"m"(mask16r)
  1287. :"memory");
  1288. d += 16;
  1289. s += 4;
  1290. }
  1291. __asm__ volatile(SFENCE:::"memory");
  1292. __asm__ volatile(EMMS:::"memory");
  1293. #endif
  1294. while (s < end)
  1295. {
  1296. register uint16_t bgr;
  1297. bgr = *s++;
  1298. #ifdef WORDS_BIGENDIAN
  1299. *d++ = 255;
  1300. *d++ = (bgr&0xF800)>>8;
  1301. *d++ = (bgr&0x7E0)>>3;
  1302. *d++ = (bgr&0x1F)<<3;
  1303. #else
  1304. *d++ = (bgr&0x1F)<<3;
  1305. *d++ = (bgr&0x7E0)>>3;
  1306. *d++ = (bgr&0xF800)>>8;
  1307. *d++ = 255;
  1308. #endif
  1309. }
  1310. }
  1311. static inline void RENAME(rgb32tobgr32)(const uint8_t *src, uint8_t *dst, long src_size)
  1312. {
  1313. long idx = 15 - src_size;
  1314. const uint8_t *s = src-idx;
  1315. uint8_t *d = dst-idx;
  1316. #if HAVE_MMX
  1317. __asm__ volatile(
  1318. "test %0, %0 \n\t"
  1319. "jns 2f \n\t"
  1320. PREFETCH" (%1, %0) \n\t"
  1321. "movq %3, %%mm7 \n\t"
  1322. "pxor %4, %%mm7 \n\t"
  1323. "movq %%mm7, %%mm6 \n\t"
  1324. "pxor %5, %%mm7 \n\t"
  1325. ASMALIGN(4)
  1326. "1: \n\t"
  1327. PREFETCH" 32(%1, %0) \n\t"
  1328. "movq (%1, %0), %%mm0 \n\t"
  1329. "movq 8(%1, %0), %%mm1 \n\t"
  1330. # if HAVE_MMX2
  1331. "pshufw $177, %%mm0, %%mm3 \n\t"
  1332. "pshufw $177, %%mm1, %%mm5 \n\t"
  1333. "pand %%mm7, %%mm0 \n\t"
  1334. "pand %%mm6, %%mm3 \n\t"
  1335. "pand %%mm7, %%mm1 \n\t"
  1336. "pand %%mm6, %%mm5 \n\t"
  1337. "por %%mm3, %%mm0 \n\t"
  1338. "por %%mm5, %%mm1 \n\t"
  1339. # else
  1340. "movq %%mm0, %%mm2 \n\t"
  1341. "movq %%mm1, %%mm4 \n\t"
  1342. "pand %%mm7, %%mm0 \n\t"
  1343. "pand %%mm6, %%mm2 \n\t"
  1344. "pand %%mm7, %%mm1 \n\t"
  1345. "pand %%mm6, %%mm4 \n\t"
  1346. "movq %%mm2, %%mm3 \n\t"
  1347. "movq %%mm4, %%mm5 \n\t"
  1348. "pslld $16, %%mm2 \n\t"
  1349. "psrld $16, %%mm3 \n\t"
  1350. "pslld $16, %%mm4 \n\t"
  1351. "psrld $16, %%mm5 \n\t"
  1352. "por %%mm2, %%mm0 \n\t"
  1353. "por %%mm4, %%mm1 \n\t"
  1354. "por %%mm3, %%mm0 \n\t"
  1355. "por %%mm5, %%mm1 \n\t"
  1356. # endif
  1357. MOVNTQ" %%mm0, (%2, %0) \n\t"
  1358. MOVNTQ" %%mm1, 8(%2, %0) \n\t"
  1359. "add $16, %0 \n\t"
  1360. "js 1b \n\t"
  1361. SFENCE" \n\t"
  1362. EMMS" \n\t"
  1363. "2: \n\t"
  1364. : "+&r"(idx)
  1365. : "r" (s), "r" (d), "m" (mask32b), "m" (mask32r), "m" (mmx_one)
  1366. : "memory");
  1367. #endif
  1368. for (; idx<15; idx+=4) {
  1369. register int v = *(const uint32_t *)&s[idx], g = v & 0xff00ff00;
  1370. v &= 0xff00ff;
  1371. *(uint32_t *)&d[idx] = (v>>16) + g + (v<<16);
  1372. }
  1373. }
  1374. static inline void RENAME(rgb24tobgr24)(const uint8_t *src, uint8_t *dst, long src_size)
  1375. {
  1376. unsigned i;
  1377. #if HAVE_MMX
  1378. long mmx_size= 23 - src_size;
  1379. __asm__ volatile (
  1380. "test %%"REG_a", %%"REG_a" \n\t"
  1381. "jns 2f \n\t"
  1382. "movq "MANGLE(mask24r)", %%mm5 \n\t"
  1383. "movq "MANGLE(mask24g)", %%mm6 \n\t"
  1384. "movq "MANGLE(mask24b)", %%mm7 \n\t"
  1385. ASMALIGN(4)
  1386. "1: \n\t"
  1387. PREFETCH" 32(%1, %%"REG_a") \n\t"
  1388. "movq (%1, %%"REG_a"), %%mm0 \n\t" // BGR BGR BG
  1389. "movq (%1, %%"REG_a"), %%mm1 \n\t" // BGR BGR BG
  1390. "movq 2(%1, %%"REG_a"), %%mm2 \n\t" // R BGR BGR B
  1391. "psllq $16, %%mm0 \n\t" // 00 BGR BGR
  1392. "pand %%mm5, %%mm0 \n\t"
  1393. "pand %%mm6, %%mm1 \n\t"
  1394. "pand %%mm7, %%mm2 \n\t"
  1395. "por %%mm0, %%mm1 \n\t"
  1396. "por %%mm2, %%mm1 \n\t"
  1397. "movq 6(%1, %%"REG_a"), %%mm0 \n\t" // BGR BGR BG
  1398. MOVNTQ" %%mm1, (%2, %%"REG_a") \n\t" // RGB RGB RG
  1399. "movq 8(%1, %%"REG_a"), %%mm1 \n\t" // R BGR BGR B
  1400. "movq 10(%1, %%"REG_a"), %%mm2 \n\t" // GR BGR BGR
  1401. "pand %%mm7, %%mm0 \n\t"
  1402. "pand %%mm5, %%mm1 \n\t"
  1403. "pand %%mm6, %%mm2 \n\t"
  1404. "por %%mm0, %%mm1 \n\t"
  1405. "por %%mm2, %%mm1 \n\t"
  1406. "movq 14(%1, %%"REG_a"), %%mm0 \n\t" // R BGR BGR B
  1407. MOVNTQ" %%mm1, 8(%2, %%"REG_a") \n\t" // B RGB RGB R
  1408. "movq 16(%1, %%"REG_a"), %%mm1 \n\t" // GR BGR BGR
  1409. "movq 18(%1, %%"REG_a"), %%mm2 \n\t" // BGR BGR BG
  1410. "pand %%mm6, %%mm0 \n\t"
  1411. "pand %%mm7, %%mm1 \n\t"
  1412. "pand %%mm5, %%mm2 \n\t"
  1413. "por %%mm0, %%mm1 \n\t"
  1414. "por %%mm2, %%mm1 \n\t"
  1415. MOVNTQ" %%mm1, 16(%2, %%"REG_a") \n\t"
  1416. "add $24, %%"REG_a" \n\t"
  1417. " js 1b \n\t"
  1418. "2: \n\t"
  1419. : "+a" (mmx_size)
  1420. : "r" (src-mmx_size), "r"(dst-mmx_size)
  1421. );
  1422. __asm__ volatile(SFENCE:::"memory");
  1423. __asm__ volatile(EMMS:::"memory");
  1424. if (mmx_size==23) return; //finished, was multiple of 8
  1425. src+= src_size;
  1426. dst+= src_size;
  1427. src_size= 23-mmx_size;
  1428. src-= src_size;
  1429. dst-= src_size;
  1430. #endif
  1431. for (i=0; i<src_size; i+=3)
  1432. {
  1433. register uint8_t x;
  1434. x = src[i + 2];
  1435. dst[i + 1] = src[i + 1];
  1436. dst[i + 2] = src[i + 0];
  1437. dst[i + 0] = x;
  1438. }
  1439. }
  1440. static inline void RENAME(yuvPlanartoyuy2)(const uint8_t *ysrc, const uint8_t *usrc, const uint8_t *vsrc, uint8_t *dst,
  1441. long width, long height,
  1442. long lumStride, long chromStride, long dstStride, long vertLumPerChroma)
  1443. {
  1444. long y;
  1445. const long chromWidth= width>>1;
  1446. for (y=0; y<height; y++)
  1447. {
  1448. #if HAVE_MMX
  1449. //FIXME handle 2 lines at once (fewer prefetches, reuse some chroma, but very likely memory-limited anyway)
  1450. __asm__ volatile(
  1451. "xor %%"REG_a", %%"REG_a" \n\t"
  1452. ASMALIGN(4)
  1453. "1: \n\t"
  1454. PREFETCH" 32(%1, %%"REG_a", 2) \n\t"
  1455. PREFETCH" 32(%2, %%"REG_a") \n\t"
  1456. PREFETCH" 32(%3, %%"REG_a") \n\t"
  1457. "movq (%2, %%"REG_a"), %%mm0 \n\t" // U(0)
  1458. "movq %%mm0, %%mm2 \n\t" // U(0)
  1459. "movq (%3, %%"REG_a"), %%mm1 \n\t" // V(0)
  1460. "punpcklbw %%mm1, %%mm0 \n\t" // UVUV UVUV(0)
  1461. "punpckhbw %%mm1, %%mm2 \n\t" // UVUV UVUV(8)
  1462. "movq (%1, %%"REG_a",2), %%mm3 \n\t" // Y(0)
  1463. "movq 8(%1, %%"REG_a",2), %%mm5 \n\t" // Y(8)
  1464. "movq %%mm3, %%mm4 \n\t" // Y(0)
  1465. "movq %%mm5, %%mm6 \n\t" // Y(8)
  1466. "punpcklbw %%mm0, %%mm3 \n\t" // YUYV YUYV(0)
  1467. "punpckhbw %%mm0, %%mm4 \n\t" // YUYV YUYV(4)
  1468. "punpcklbw %%mm2, %%mm5 \n\t" // YUYV YUYV(8)
  1469. "punpckhbw %%mm2, %%mm6 \n\t" // YUYV YUYV(12)
  1470. MOVNTQ" %%mm3, (%0, %%"REG_a", 4) \n\t"
  1471. MOVNTQ" %%mm4, 8(%0, %%"REG_a", 4) \n\t"
  1472. MOVNTQ" %%mm5, 16(%0, %%"REG_a", 4) \n\t"
  1473. MOVNTQ" %%mm6, 24(%0, %%"REG_a", 4) \n\t"
  1474. "add $8, %%"REG_a" \n\t"
  1475. "cmp %4, %%"REG_a" \n\t"
  1476. " jb 1b \n\t"
  1477. ::"r"(dst), "r"(ysrc), "r"(usrc), "r"(vsrc), "g" (chromWidth)
  1478. : "%"REG_a
  1479. );
  1480. #else
  1481. #if ARCH_ALPHA && HAVE_MVI
  1482. #define pl2yuy2(n) \
  1483. y1 = yc[n]; \
  1484. y2 = yc2[n]; \
  1485. u = uc[n]; \
  1486. v = vc[n]; \
  1487. __asm__("unpkbw %1, %0" : "=r"(y1) : "r"(y1)); \
  1488. __asm__("unpkbw %1, %0" : "=r"(y2) : "r"(y2)); \
  1489. __asm__("unpkbl %1, %0" : "=r"(u) : "r"(u)); \
  1490. __asm__("unpkbl %1, %0" : "=r"(v) : "r"(v)); \
  1491. yuv1 = (u << 8) + (v << 24); \
  1492. yuv2 = yuv1 + y2; \
  1493. yuv1 += y1; \
  1494. qdst[n] = yuv1; \
  1495. qdst2[n] = yuv2;
  1496. int i;
  1497. uint64_t *qdst = (uint64_t *) dst;
  1498. uint64_t *qdst2 = (uint64_t *) (dst + dstStride);
  1499. const uint32_t *yc = (uint32_t *) ysrc;
  1500. const uint32_t *yc2 = (uint32_t *) (ysrc + lumStride);
  1501. const uint16_t *uc = (uint16_t*) usrc, *vc = (uint16_t*) vsrc;
  1502. for (i = 0; i < chromWidth; i += 8){
  1503. uint64_t y1, y2, yuv1, yuv2;
  1504. uint64_t u, v;
  1505. /* Prefetch */
  1506. __asm__("ldq $31,64(%0)" :: "r"(yc));
  1507. __asm__("ldq $31,64(%0)" :: "r"(yc2));
  1508. __asm__("ldq $31,64(%0)" :: "r"(uc));
  1509. __asm__("ldq $31,64(%0)" :: "r"(vc));
  1510. pl2yuy2(0);
  1511. pl2yuy2(1);
  1512. pl2yuy2(2);
  1513. pl2yuy2(3);
  1514. yc += 4;
  1515. yc2 += 4;
  1516. uc += 4;
  1517. vc += 4;
  1518. qdst += 4;
  1519. qdst2 += 4;
  1520. }
  1521. y++;
  1522. ysrc += lumStride;
  1523. dst += dstStride;
  1524. #elif HAVE_FAST_64BIT
  1525. int i;
  1526. uint64_t *ldst = (uint64_t *) dst;
  1527. const uint8_t *yc = ysrc, *uc = usrc, *vc = vsrc;
  1528. for (i = 0; i < chromWidth; i += 2){
  1529. uint64_t k, l;
  1530. k = yc[0] + (uc[0] << 8) +
  1531. (yc[1] << 16) + (vc[0] << 24);
  1532. l = yc[2] + (uc[1] << 8) +
  1533. (yc[3] << 16) + (vc[1] << 24);
  1534. *ldst++ = k + (l << 32);
  1535. yc += 4;
  1536. uc += 2;
  1537. vc += 2;
  1538. }
  1539. #else
  1540. int i, *idst = (int32_t *) dst;
  1541. const uint8_t *yc = ysrc, *uc = usrc, *vc = vsrc;
  1542. for (i = 0; i < chromWidth; i++){
  1543. #ifdef WORDS_BIGENDIAN
  1544. *idst++ = (yc[0] << 24)+ (uc[0] << 16) +
  1545. (yc[1] << 8) + (vc[0] << 0);
  1546. #else
  1547. *idst++ = yc[0] + (uc[0] << 8) +
  1548. (yc[1] << 16) + (vc[0] << 24);
  1549. #endif
  1550. yc += 2;
  1551. uc++;
  1552. vc++;
  1553. }
  1554. #endif
  1555. #endif
  1556. if ((y&(vertLumPerChroma-1)) == vertLumPerChroma-1)
  1557. {
  1558. usrc += chromStride;
  1559. vsrc += chromStride;
  1560. }
  1561. ysrc += lumStride;
  1562. dst += dstStride;
  1563. }
  1564. #if HAVE_MMX
  1565. __asm__( EMMS" \n\t"
  1566. SFENCE" \n\t"
  1567. :::"memory");
  1568. #endif
  1569. }
  1570. /**
  1571. * Height should be a multiple of 2 and width should be a multiple of 16.
  1572. * (If this is a problem for anyone then tell me, and I will fix it.)
  1573. */
  1574. static inline void RENAME(yv12toyuy2)(const uint8_t *ysrc, const uint8_t *usrc, const uint8_t *vsrc, uint8_t *dst,
  1575. long width, long height,
  1576. long lumStride, long chromStride, long dstStride)
  1577. {
  1578. //FIXME interpolate chroma
  1579. RENAME(yuvPlanartoyuy2)(ysrc, usrc, vsrc, dst, width, height, lumStride, chromStride, dstStride, 2);
  1580. }
  1581. static inline void RENAME(yuvPlanartouyvy)(const uint8_t *ysrc, const uint8_t *usrc, const uint8_t *vsrc, uint8_t *dst,
  1582. long width, long height,
  1583. long lumStride, long chromStride, long dstStride, long vertLumPerChroma)
  1584. {
  1585. long y;
  1586. const long chromWidth= width>>1;
  1587. for (y=0; y<height; y++)
  1588. {
  1589. #if HAVE_MMX
  1590. //FIXME handle 2 lines at once (fewer prefetches, reuse some chroma, but very likely memory-limited anyway)
  1591. __asm__ volatile(
  1592. "xor %%"REG_a", %%"REG_a" \n\t"
  1593. ASMALIGN(4)
  1594. "1: \n\t"
  1595. PREFETCH" 32(%1, %%"REG_a", 2) \n\t"
  1596. PREFETCH" 32(%2, %%"REG_a") \n\t"
  1597. PREFETCH" 32(%3, %%"REG_a") \n\t"
  1598. "movq (%2, %%"REG_a"), %%mm0 \n\t" // U(0)
  1599. "movq %%mm0, %%mm2 \n\t" // U(0)
  1600. "movq (%3, %%"REG_a"), %%mm1 \n\t" // V(0)
  1601. "punpcklbw %%mm1, %%mm0 \n\t" // UVUV UVUV(0)
  1602. "punpckhbw %%mm1, %%mm2 \n\t" // UVUV UVUV(8)
  1603. "movq (%1, %%"REG_a",2), %%mm3 \n\t" // Y(0)
  1604. "movq 8(%1, %%"REG_a",2), %%mm5 \n\t" // Y(8)
  1605. "movq %%mm0, %%mm4 \n\t" // Y(0)
  1606. "movq %%mm2, %%mm6 \n\t" // Y(8)
  1607. "punpcklbw %%mm3, %%mm0 \n\t" // YUYV YUYV(0)
  1608. "punpckhbw %%mm3, %%mm4 \n\t" // YUYV YUYV(4)
  1609. "punpcklbw %%mm5, %%mm2 \n\t" // YUYV YUYV(8)
  1610. "punpckhbw %%mm5, %%mm6 \n\t" // YUYV YUYV(12)
  1611. MOVNTQ" %%mm0, (%0, %%"REG_a", 4) \n\t"
  1612. MOVNTQ" %%mm4, 8(%0, %%"REG_a", 4) \n\t"
  1613. MOVNTQ" %%mm2, 16(%0, %%"REG_a", 4) \n\t"
  1614. MOVNTQ" %%mm6, 24(%0, %%"REG_a", 4) \n\t"
  1615. "add $8, %%"REG_a" \n\t"
  1616. "cmp %4, %%"REG_a" \n\t"
  1617. " jb 1b \n\t"
  1618. ::"r"(dst), "r"(ysrc), "r"(usrc), "r"(vsrc), "g" (chromWidth)
  1619. : "%"REG_a
  1620. );
  1621. #else
  1622. //FIXME adapt the Alpha ASM code from yv12->yuy2
  1623. #if HAVE_FAST_64BIT
  1624. int i;
  1625. uint64_t *ldst = (uint64_t *) dst;
  1626. const uint8_t *yc = ysrc, *uc = usrc, *vc = vsrc;
  1627. for (i = 0; i < chromWidth; i += 2){
  1628. uint64_t k, l;
  1629. k = uc[0] + (yc[0] << 8) +
  1630. (vc[0] << 16) + (yc[1] << 24);
  1631. l = uc[1] + (yc[2] << 8) +
  1632. (vc[1] << 16) + (yc[3] << 24);
  1633. *ldst++ = k + (l << 32);
  1634. yc += 4;
  1635. uc += 2;
  1636. vc += 2;
  1637. }
  1638. #else
  1639. int i, *idst = (int32_t *) dst;
  1640. const uint8_t *yc = ysrc, *uc = usrc, *vc = vsrc;
  1641. for (i = 0; i < chromWidth; i++){
  1642. #ifdef WORDS_BIGENDIAN
  1643. *idst++ = (uc[0] << 24)+ (yc[0] << 16) +
  1644. (vc[0] << 8) + (yc[1] << 0);
  1645. #else
  1646. *idst++ = uc[0] + (yc[0] << 8) +
  1647. (vc[0] << 16) + (yc[1] << 24);
  1648. #endif
  1649. yc += 2;
  1650. uc++;
  1651. vc++;
  1652. }
  1653. #endif
  1654. #endif
  1655. if ((y&(vertLumPerChroma-1)) == vertLumPerChroma-1)
  1656. {
  1657. usrc += chromStride;
  1658. vsrc += chromStride;
  1659. }
  1660. ysrc += lumStride;
  1661. dst += dstStride;
  1662. }
  1663. #if HAVE_MMX
  1664. __asm__( EMMS" \n\t"
  1665. SFENCE" \n\t"
  1666. :::"memory");
  1667. #endif
  1668. }
  1669. /**
  1670. * Height should be a multiple of 2 and width should be a multiple of 16
  1671. * (If this is a problem for anyone then tell me, and I will fix it.)
  1672. */
  1673. static inline void RENAME(yv12touyvy)(const uint8_t *ysrc, const uint8_t *usrc, const uint8_t *vsrc, uint8_t *dst,
  1674. long width, long height,
  1675. long lumStride, long chromStride, long dstStride)
  1676. {
  1677. //FIXME interpolate chroma
  1678. RENAME(yuvPlanartouyvy)(ysrc, usrc, vsrc, dst, width, height, lumStride, chromStride, dstStride, 2);
  1679. }
  1680. /**
  1681. * Width should be a multiple of 16.
  1682. */
  1683. static inline void RENAME(yuv422ptouyvy)(const uint8_t *ysrc, const uint8_t *usrc, const uint8_t *vsrc, uint8_t *dst,
  1684. long width, long height,
  1685. long lumStride, long chromStride, long dstStride)
  1686. {
  1687. RENAME(yuvPlanartouyvy)(ysrc, usrc, vsrc, dst, width, height, lumStride, chromStride, dstStride, 1);
  1688. }
  1689. /**
  1690. * Width should be a multiple of 16.
  1691. */
  1692. static inline void RENAME(yuv422ptoyuy2)(const uint8_t *ysrc, const uint8_t *usrc, const uint8_t *vsrc, uint8_t *dst,
  1693. long width, long height,
  1694. long lumStride, long chromStride, long dstStride)
  1695. {
  1696. RENAME(yuvPlanartoyuy2)(ysrc, usrc, vsrc, dst, width, height, lumStride, chromStride, dstStride, 1);
  1697. }
  1698. /**
  1699. * Height should be a multiple of 2 and width should be a multiple of 16.
  1700. * (If this is a problem for anyone then tell me, and I will fix it.)
  1701. */
  1702. static inline void RENAME(yuy2toyv12)(const uint8_t *src, uint8_t *ydst, uint8_t *udst, uint8_t *vdst,
  1703. long width, long height,
  1704. long lumStride, long chromStride, long srcStride)
  1705. {
  1706. long y;
  1707. const long chromWidth= width>>1;
  1708. for (y=0; y<height; y+=2)
  1709. {
  1710. #if HAVE_MMX
  1711. __asm__ volatile(
  1712. "xor %%"REG_a", %%"REG_a" \n\t"
  1713. "pcmpeqw %%mm7, %%mm7 \n\t"
  1714. "psrlw $8, %%mm7 \n\t" // FF,00,FF,00...
  1715. ASMALIGN(4)
  1716. "1: \n\t"
  1717. PREFETCH" 64(%0, %%"REG_a", 4) \n\t"
  1718. "movq (%0, %%"REG_a", 4), %%mm0 \n\t" // YUYV YUYV(0)
  1719. "movq 8(%0, %%"REG_a", 4), %%mm1 \n\t" // YUYV YUYV(4)
  1720. "movq %%mm0, %%mm2 \n\t" // YUYV YUYV(0)
  1721. "movq %%mm1, %%mm3 \n\t" // YUYV YUYV(4)
  1722. "psrlw $8, %%mm0 \n\t" // U0V0 U0V0(0)
  1723. "psrlw $8, %%mm1 \n\t" // U0V0 U0V0(4)
  1724. "pand %%mm7, %%mm2 \n\t" // Y0Y0 Y0Y0(0)
  1725. "pand %%mm7, %%mm3 \n\t" // Y0Y0 Y0Y0(4)
  1726. "packuswb %%mm1, %%mm0 \n\t" // UVUV UVUV(0)
  1727. "packuswb %%mm3, %%mm2 \n\t" // YYYY YYYY(0)
  1728. MOVNTQ" %%mm2, (%1, %%"REG_a", 2) \n\t"
  1729. "movq 16(%0, %%"REG_a", 4), %%mm1 \n\t" // YUYV YUYV(8)
  1730. "movq 24(%0, %%"REG_a", 4), %%mm2 \n\t" // YUYV YUYV(12)
  1731. "movq %%mm1, %%mm3 \n\t" // YUYV YUYV(8)
  1732. "movq %%mm2, %%mm4 \n\t" // YUYV YUYV(12)
  1733. "psrlw $8, %%mm1 \n\t" // U0V0 U0V0(8)
  1734. "psrlw $8, %%mm2 \n\t" // U0V0 U0V0(12)
  1735. "pand %%mm7, %%mm3 \n\t" // Y0Y0 Y0Y0(8)
  1736. "pand %%mm7, %%mm4 \n\t" // Y0Y0 Y0Y0(12)
  1737. "packuswb %%mm2, %%mm1 \n\t" // UVUV UVUV(8)
  1738. "packuswb %%mm4, %%mm3 \n\t" // YYYY YYYY(8)
  1739. MOVNTQ" %%mm3, 8(%1, %%"REG_a", 2) \n\t"
  1740. "movq %%mm0, %%mm2 \n\t" // UVUV UVUV(0)
  1741. "movq %%mm1, %%mm3 \n\t" // UVUV UVUV(8)
  1742. "psrlw $8, %%mm0 \n\t" // V0V0 V0V0(0)
  1743. "psrlw $8, %%mm1 \n\t" // V0V0 V0V0(8)
  1744. "pand %%mm7, %%mm2 \n\t" // U0U0 U0U0(0)
  1745. "pand %%mm7, %%mm3 \n\t" // U0U0 U0U0(8)
  1746. "packuswb %%mm1, %%mm0 \n\t" // VVVV VVVV(0)
  1747. "packuswb %%mm3, %%mm2 \n\t" // UUUU UUUU(0)
  1748. MOVNTQ" %%mm0, (%3, %%"REG_a") \n\t"
  1749. MOVNTQ" %%mm2, (%2, %%"REG_a") \n\t"
  1750. "add $8, %%"REG_a" \n\t"
  1751. "cmp %4, %%"REG_a" \n\t"
  1752. " jb 1b \n\t"
  1753. ::"r"(src), "r"(ydst), "r"(udst), "r"(vdst), "g" (chromWidth)
  1754. : "memory", "%"REG_a
  1755. );
  1756. ydst += lumStride;
  1757. src += srcStride;
  1758. __asm__ volatile(
  1759. "xor %%"REG_a", %%"REG_a" \n\t"
  1760. ASMALIGN(4)
  1761. "1: \n\t"
  1762. PREFETCH" 64(%0, %%"REG_a", 4) \n\t"
  1763. "movq (%0, %%"REG_a", 4), %%mm0 \n\t" // YUYV YUYV(0)
  1764. "movq 8(%0, %%"REG_a", 4), %%mm1 \n\t" // YUYV YUYV(4)
  1765. "movq 16(%0, %%"REG_a", 4), %%mm2 \n\t" // YUYV YUYV(8)
  1766. "movq 24(%0, %%"REG_a", 4), %%mm3 \n\t" // YUYV YUYV(12)
  1767. "pand %%mm7, %%mm0 \n\t" // Y0Y0 Y0Y0(0)
  1768. "pand %%mm7, %%mm1 \n\t" // Y0Y0 Y0Y0(4)
  1769. "pand %%mm7, %%mm2 \n\t" // Y0Y0 Y0Y0(8)
  1770. "pand %%mm7, %%mm3 \n\t" // Y0Y0 Y0Y0(12)
  1771. "packuswb %%mm1, %%mm0 \n\t" // YYYY YYYY(0)
  1772. "packuswb %%mm3, %%mm2 \n\t" // YYYY YYYY(8)
  1773. MOVNTQ" %%mm0, (%1, %%"REG_a", 2) \n\t"
  1774. MOVNTQ" %%mm2, 8(%1, %%"REG_a", 2) \n\t"
  1775. "add $8, %%"REG_a" \n\t"
  1776. "cmp %4, %%"REG_a" \n\t"
  1777. " jb 1b \n\t"
  1778. ::"r"(src), "r"(ydst), "r"(udst), "r"(vdst), "g" (chromWidth)
  1779. : "memory", "%"REG_a
  1780. );
  1781. #else
  1782. long i;
  1783. for (i=0; i<chromWidth; i++)
  1784. {
  1785. ydst[2*i+0] = src[4*i+0];
  1786. udst[i] = src[4*i+1];
  1787. ydst[2*i+1] = src[4*i+2];
  1788. vdst[i] = src[4*i+3];
  1789. }
  1790. ydst += lumStride;
  1791. src += srcStride;
  1792. for (i=0; i<chromWidth; i++)
  1793. {
  1794. ydst[2*i+0] = src[4*i+0];
  1795. ydst[2*i+1] = src[4*i+2];
  1796. }
  1797. #endif
  1798. udst += chromStride;
  1799. vdst += chromStride;
  1800. ydst += lumStride;
  1801. src += srcStride;
  1802. }
  1803. #if HAVE_MMX
  1804. __asm__ volatile( EMMS" \n\t"
  1805. SFENCE" \n\t"
  1806. :::"memory");
  1807. #endif
  1808. }
  1809. static inline void RENAME(yvu9toyv12)(const uint8_t *ysrc, const uint8_t *usrc, const uint8_t *vsrc,
  1810. uint8_t *ydst, uint8_t *udst, uint8_t *vdst,
  1811. long width, long height, long lumStride, long chromStride)
  1812. {
  1813. /* Y Plane */
  1814. memcpy(ydst, ysrc, width*height);
  1815. /* XXX: implement upscaling for U,V */
  1816. }
  1817. static inline void RENAME(planar2x)(const uint8_t *src, uint8_t *dst, long srcWidth, long srcHeight, long srcStride, long dstStride)
  1818. {
  1819. long x,y;
  1820. dst[0]= src[0];
  1821. // first line
  1822. for (x=0; x<srcWidth-1; x++){
  1823. dst[2*x+1]= (3*src[x] + src[x+1])>>2;
  1824. dst[2*x+2]= ( src[x] + 3*src[x+1])>>2;
  1825. }
  1826. dst[2*srcWidth-1]= src[srcWidth-1];
  1827. dst+= dstStride;
  1828. for (y=1; y<srcHeight; y++){
  1829. #if HAVE_MMX2 || HAVE_AMD3DNOW
  1830. const long mmxSize= srcWidth&~15;
  1831. __asm__ volatile(
  1832. "mov %4, %%"REG_a" \n\t"
  1833. "1: \n\t"
  1834. "movq (%0, %%"REG_a"), %%mm0 \n\t"
  1835. "movq (%1, %%"REG_a"), %%mm1 \n\t"
  1836. "movq 1(%0, %%"REG_a"), %%mm2 \n\t"
  1837. "movq 1(%1, %%"REG_a"), %%mm3 \n\t"
  1838. "movq -1(%0, %%"REG_a"), %%mm4 \n\t"
  1839. "movq -1(%1, %%"REG_a"), %%mm5 \n\t"
  1840. PAVGB" %%mm0, %%mm5 \n\t"
  1841. PAVGB" %%mm0, %%mm3 \n\t"
  1842. PAVGB" %%mm0, %%mm5 \n\t"
  1843. PAVGB" %%mm0, %%mm3 \n\t"
  1844. PAVGB" %%mm1, %%mm4 \n\t"
  1845. PAVGB" %%mm1, %%mm2 \n\t"
  1846. PAVGB" %%mm1, %%mm4 \n\t"
  1847. PAVGB" %%mm1, %%mm2 \n\t"
  1848. "movq %%mm5, %%mm7 \n\t"
  1849. "movq %%mm4, %%mm6 \n\t"
  1850. "punpcklbw %%mm3, %%mm5 \n\t"
  1851. "punpckhbw %%mm3, %%mm7 \n\t"
  1852. "punpcklbw %%mm2, %%mm4 \n\t"
  1853. "punpckhbw %%mm2, %%mm6 \n\t"
  1854. #if 1
  1855. MOVNTQ" %%mm5, (%2, %%"REG_a", 2) \n\t"
  1856. MOVNTQ" %%mm7, 8(%2, %%"REG_a", 2) \n\t"
  1857. MOVNTQ" %%mm4, (%3, %%"REG_a", 2) \n\t"
  1858. MOVNTQ" %%mm6, 8(%3, %%"REG_a", 2) \n\t"
  1859. #else
  1860. "movq %%mm5, (%2, %%"REG_a", 2) \n\t"
  1861. "movq %%mm7, 8(%2, %%"REG_a", 2) \n\t"
  1862. "movq %%mm4, (%3, %%"REG_a", 2) \n\t"
  1863. "movq %%mm6, 8(%3, %%"REG_a", 2) \n\t"
  1864. #endif
  1865. "add $8, %%"REG_a" \n\t"
  1866. " js 1b \n\t"
  1867. :: "r" (src + mmxSize ), "r" (src + srcStride + mmxSize ),
  1868. "r" (dst + mmxSize*2), "r" (dst + dstStride + mmxSize*2),
  1869. "g" (-mmxSize)
  1870. : "%"REG_a
  1871. );
  1872. #else
  1873. const long mmxSize=1;
  1874. #endif
  1875. dst[0 ]= (3*src[0] + src[srcStride])>>2;
  1876. dst[dstStride]= ( src[0] + 3*src[srcStride])>>2;
  1877. for (x=mmxSize-1; x<srcWidth-1; x++){
  1878. dst[2*x +1]= (3*src[x+0] + src[x+srcStride+1])>>2;
  1879. dst[2*x+dstStride+2]= ( src[x+0] + 3*src[x+srcStride+1])>>2;
  1880. dst[2*x+dstStride+1]= ( src[x+1] + 3*src[x+srcStride ])>>2;
  1881. dst[2*x +2]= (3*src[x+1] + src[x+srcStride ])>>2;
  1882. }
  1883. dst[srcWidth*2 -1 ]= (3*src[srcWidth-1] + src[srcWidth-1 + srcStride])>>2;
  1884. dst[srcWidth*2 -1 + dstStride]= ( src[srcWidth-1] + 3*src[srcWidth-1 + srcStride])>>2;
  1885. dst+=dstStride*2;
  1886. src+=srcStride;
  1887. }
  1888. // last line
  1889. #if 1
  1890. dst[0]= src[0];
  1891. for (x=0; x<srcWidth-1; x++){
  1892. dst[2*x+1]= (3*src[x] + src[x+1])>>2;
  1893. dst[2*x+2]= ( src[x] + 3*src[x+1])>>2;
  1894. }
  1895. dst[2*srcWidth-1]= src[srcWidth-1];
  1896. #else
  1897. for (x=0; x<srcWidth; x++){
  1898. dst[2*x+0]=
  1899. dst[2*x+1]= src[x];
  1900. }
  1901. #endif
  1902. #if HAVE_MMX
  1903. __asm__ volatile( EMMS" \n\t"
  1904. SFENCE" \n\t"
  1905. :::"memory");
  1906. #endif
  1907. }
  1908. /**
  1909. * Height should be a multiple of 2 and width should be a multiple of 16.
  1910. * (If this is a problem for anyone then tell me, and I will fix it.)
  1911. * Chrominance data is only taken from every second line, others are ignored.
  1912. * FIXME: Write HQ version.
  1913. */
  1914. static inline void RENAME(uyvytoyv12)(const uint8_t *src, uint8_t *ydst, uint8_t *udst, uint8_t *vdst,
  1915. long width, long height,
  1916. long lumStride, long chromStride, long srcStride)
  1917. {
  1918. long y;
  1919. const long chromWidth= width>>1;
  1920. for (y=0; y<height; y+=2)
  1921. {
  1922. #if HAVE_MMX
  1923. __asm__ volatile(
  1924. "xor %%"REG_a", %%"REG_a" \n\t"
  1925. "pcmpeqw %%mm7, %%mm7 \n\t"
  1926. "psrlw $8, %%mm7 \n\t" // FF,00,FF,00...
  1927. ASMALIGN(4)
  1928. "1: \n\t"
  1929. PREFETCH" 64(%0, %%"REG_a", 4) \n\t"
  1930. "movq (%0, %%"REG_a", 4), %%mm0 \n\t" // UYVY UYVY(0)
  1931. "movq 8(%0, %%"REG_a", 4), %%mm1 \n\t" // UYVY UYVY(4)
  1932. "movq %%mm0, %%mm2 \n\t" // UYVY UYVY(0)
  1933. "movq %%mm1, %%mm3 \n\t" // UYVY UYVY(4)
  1934. "pand %%mm7, %%mm0 \n\t" // U0V0 U0V0(0)
  1935. "pand %%mm7, %%mm1 \n\t" // U0V0 U0V0(4)
  1936. "psrlw $8, %%mm2 \n\t" // Y0Y0 Y0Y0(0)
  1937. "psrlw $8, %%mm3 \n\t" // Y0Y0 Y0Y0(4)
  1938. "packuswb %%mm1, %%mm0 \n\t" // UVUV UVUV(0)
  1939. "packuswb %%mm3, %%mm2 \n\t" // YYYY YYYY(0)
  1940. MOVNTQ" %%mm2, (%1, %%"REG_a", 2) \n\t"
  1941. "movq 16(%0, %%"REG_a", 4), %%mm1 \n\t" // UYVY UYVY(8)
  1942. "movq 24(%0, %%"REG_a", 4), %%mm2 \n\t" // UYVY UYVY(12)
  1943. "movq %%mm1, %%mm3 \n\t" // UYVY UYVY(8)
  1944. "movq %%mm2, %%mm4 \n\t" // UYVY UYVY(12)
  1945. "pand %%mm7, %%mm1 \n\t" // U0V0 U0V0(8)
  1946. "pand %%mm7, %%mm2 \n\t" // U0V0 U0V0(12)
  1947. "psrlw $8, %%mm3 \n\t" // Y0Y0 Y0Y0(8)
  1948. "psrlw $8, %%mm4 \n\t" // Y0Y0 Y0Y0(12)
  1949. "packuswb %%mm2, %%mm1 \n\t" // UVUV UVUV(8)
  1950. "packuswb %%mm4, %%mm3 \n\t" // YYYY YYYY(8)
  1951. MOVNTQ" %%mm3, 8(%1, %%"REG_a", 2) \n\t"
  1952. "movq %%mm0, %%mm2 \n\t" // UVUV UVUV(0)
  1953. "movq %%mm1, %%mm3 \n\t" // UVUV UVUV(8)
  1954. "psrlw $8, %%mm0 \n\t" // V0V0 V0V0(0)
  1955. "psrlw $8, %%mm1 \n\t" // V0V0 V0V0(8)
  1956. "pand %%mm7, %%mm2 \n\t" // U0U0 U0U0(0)
  1957. "pand %%mm7, %%mm3 \n\t" // U0U0 U0U0(8)
  1958. "packuswb %%mm1, %%mm0 \n\t" // VVVV VVVV(0)
  1959. "packuswb %%mm3, %%mm2 \n\t" // UUUU UUUU(0)
  1960. MOVNTQ" %%mm0, (%3, %%"REG_a") \n\t"
  1961. MOVNTQ" %%mm2, (%2, %%"REG_a") \n\t"
  1962. "add $8, %%"REG_a" \n\t"
  1963. "cmp %4, %%"REG_a" \n\t"
  1964. " jb 1b \n\t"
  1965. ::"r"(src), "r"(ydst), "r"(udst), "r"(vdst), "g" (chromWidth)
  1966. : "memory", "%"REG_a
  1967. );
  1968. ydst += lumStride;
  1969. src += srcStride;
  1970. __asm__ volatile(
  1971. "xor %%"REG_a", %%"REG_a" \n\t"
  1972. ASMALIGN(4)
  1973. "1: \n\t"
  1974. PREFETCH" 64(%0, %%"REG_a", 4) \n\t"
  1975. "movq (%0, %%"REG_a", 4), %%mm0 \n\t" // YUYV YUYV(0)
  1976. "movq 8(%0, %%"REG_a", 4), %%mm1 \n\t" // YUYV YUYV(4)
  1977. "movq 16(%0, %%"REG_a", 4), %%mm2 \n\t" // YUYV YUYV(8)
  1978. "movq 24(%0, %%"REG_a", 4), %%mm3 \n\t" // YUYV YUYV(12)
  1979. "psrlw $8, %%mm0 \n\t" // Y0Y0 Y0Y0(0)
  1980. "psrlw $8, %%mm1 \n\t" // Y0Y0 Y0Y0(4)
  1981. "psrlw $8, %%mm2 \n\t" // Y0Y0 Y0Y0(8)
  1982. "psrlw $8, %%mm3 \n\t" // Y0Y0 Y0Y0(12)
  1983. "packuswb %%mm1, %%mm0 \n\t" // YYYY YYYY(0)
  1984. "packuswb %%mm3, %%mm2 \n\t" // YYYY YYYY(8)
  1985. MOVNTQ" %%mm0, (%1, %%"REG_a", 2) \n\t"
  1986. MOVNTQ" %%mm2, 8(%1, %%"REG_a", 2) \n\t"
  1987. "add $8, %%"REG_a" \n\t"
  1988. "cmp %4, %%"REG_a" \n\t"
  1989. " jb 1b \n\t"
  1990. ::"r"(src), "r"(ydst), "r"(udst), "r"(vdst), "g" (chromWidth)
  1991. : "memory", "%"REG_a
  1992. );
  1993. #else
  1994. long i;
  1995. for (i=0; i<chromWidth; i++)
  1996. {
  1997. udst[i] = src[4*i+0];
  1998. ydst[2*i+0] = src[4*i+1];
  1999. vdst[i] = src[4*i+2];
  2000. ydst[2*i+1] = src[4*i+3];
  2001. }
  2002. ydst += lumStride;
  2003. src += srcStride;
  2004. for (i=0; i<chromWidth; i++)
  2005. {
  2006. ydst[2*i+0] = src[4*i+1];
  2007. ydst[2*i+1] = src[4*i+3];
  2008. }
  2009. #endif
  2010. udst += chromStride;
  2011. vdst += chromStride;
  2012. ydst += lumStride;
  2013. src += srcStride;
  2014. }
  2015. #if HAVE_MMX
  2016. __asm__ volatile( EMMS" \n\t"
  2017. SFENCE" \n\t"
  2018. :::"memory");
  2019. #endif
  2020. }
  2021. /**
  2022. * Height should be a multiple of 2 and width should be a multiple of 2.
  2023. * (If this is a problem for anyone then tell me, and I will fix it.)
  2024. * Chrominance data is only taken from every second line,
  2025. * others are ignored in the C version.
  2026. * FIXME: Write HQ version.
  2027. */
  2028. static inline void RENAME(rgb24toyv12)(const uint8_t *src, uint8_t *ydst, uint8_t *udst, uint8_t *vdst,
  2029. long width, long height,
  2030. long lumStride, long chromStride, long srcStride)
  2031. {
  2032. long y;
  2033. const long chromWidth= width>>1;
  2034. #if HAVE_MMX
  2035. for (y=0; y<height-2; y+=2)
  2036. {
  2037. long i;
  2038. for (i=0; i<2; i++)
  2039. {
  2040. __asm__ volatile(
  2041. "mov %2, %%"REG_a" \n\t"
  2042. "movq "MANGLE(ff_bgr2YCoeff)", %%mm6 \n\t"
  2043. "movq "MANGLE(ff_w1111)", %%mm5 \n\t"
  2044. "pxor %%mm7, %%mm7 \n\t"
  2045. "lea (%%"REG_a", %%"REG_a", 2), %%"REG_d" \n\t"
  2046. ASMALIGN(4)
  2047. "1: \n\t"
  2048. PREFETCH" 64(%0, %%"REG_d") \n\t"
  2049. "movd (%0, %%"REG_d"), %%mm0 \n\t"
  2050. "movd 3(%0, %%"REG_d"), %%mm1 \n\t"
  2051. "punpcklbw %%mm7, %%mm0 \n\t"
  2052. "punpcklbw %%mm7, %%mm1 \n\t"
  2053. "movd 6(%0, %%"REG_d"), %%mm2 \n\t"
  2054. "movd 9(%0, %%"REG_d"), %%mm3 \n\t"
  2055. "punpcklbw %%mm7, %%mm2 \n\t"
  2056. "punpcklbw %%mm7, %%mm3 \n\t"
  2057. "pmaddwd %%mm6, %%mm0 \n\t"
  2058. "pmaddwd %%mm6, %%mm1 \n\t"
  2059. "pmaddwd %%mm6, %%mm2 \n\t"
  2060. "pmaddwd %%mm6, %%mm3 \n\t"
  2061. #ifndef FAST_BGR2YV12
  2062. "psrad $8, %%mm0 \n\t"
  2063. "psrad $8, %%mm1 \n\t"
  2064. "psrad $8, %%mm2 \n\t"
  2065. "psrad $8, %%mm3 \n\t"
  2066. #endif
  2067. "packssdw %%mm1, %%mm0 \n\t"
  2068. "packssdw %%mm3, %%mm2 \n\t"
  2069. "pmaddwd %%mm5, %%mm0 \n\t"
  2070. "pmaddwd %%mm5, %%mm2 \n\t"
  2071. "packssdw %%mm2, %%mm0 \n\t"
  2072. "psraw $7, %%mm0 \n\t"
  2073. "movd 12(%0, %%"REG_d"), %%mm4 \n\t"
  2074. "movd 15(%0, %%"REG_d"), %%mm1 \n\t"
  2075. "punpcklbw %%mm7, %%mm4 \n\t"
  2076. "punpcklbw %%mm7, %%mm1 \n\t"
  2077. "movd 18(%0, %%"REG_d"), %%mm2 \n\t"
  2078. "movd 21(%0, %%"REG_d"), %%mm3 \n\t"
  2079. "punpcklbw %%mm7, %%mm2 \n\t"
  2080. "punpcklbw %%mm7, %%mm3 \n\t"
  2081. "pmaddwd %%mm6, %%mm4 \n\t"
  2082. "pmaddwd %%mm6, %%mm1 \n\t"
  2083. "pmaddwd %%mm6, %%mm2 \n\t"
  2084. "pmaddwd %%mm6, %%mm3 \n\t"
  2085. #ifndef FAST_BGR2YV12
  2086. "psrad $8, %%mm4 \n\t"
  2087. "psrad $8, %%mm1 \n\t"
  2088. "psrad $8, %%mm2 \n\t"
  2089. "psrad $8, %%mm3 \n\t"
  2090. #endif
  2091. "packssdw %%mm1, %%mm4 \n\t"
  2092. "packssdw %%mm3, %%mm2 \n\t"
  2093. "pmaddwd %%mm5, %%mm4 \n\t"
  2094. "pmaddwd %%mm5, %%mm2 \n\t"
  2095. "add $24, %%"REG_d" \n\t"
  2096. "packssdw %%mm2, %%mm4 \n\t"
  2097. "psraw $7, %%mm4 \n\t"
  2098. "packuswb %%mm4, %%mm0 \n\t"
  2099. "paddusb "MANGLE(ff_bgr2YOffset)", %%mm0 \n\t"
  2100. MOVNTQ" %%mm0, (%1, %%"REG_a") \n\t"
  2101. "add $8, %%"REG_a" \n\t"
  2102. " js 1b \n\t"
  2103. : : "r" (src+width*3), "r" (ydst+width), "g" (-width)
  2104. : "%"REG_a, "%"REG_d
  2105. );
  2106. ydst += lumStride;
  2107. src += srcStride;
  2108. }
  2109. src -= srcStride*2;
  2110. __asm__ volatile(
  2111. "mov %4, %%"REG_a" \n\t"
  2112. "movq "MANGLE(ff_w1111)", %%mm5 \n\t"
  2113. "movq "MANGLE(ff_bgr2UCoeff)", %%mm6 \n\t"
  2114. "pxor %%mm7, %%mm7 \n\t"
  2115. "lea (%%"REG_a", %%"REG_a", 2), %%"REG_d" \n\t"
  2116. "add %%"REG_d", %%"REG_d" \n\t"
  2117. ASMALIGN(4)
  2118. "1: \n\t"
  2119. PREFETCH" 64(%0, %%"REG_d") \n\t"
  2120. PREFETCH" 64(%1, %%"REG_d") \n\t"
  2121. #if HAVE_MMX2 || HAVE_AMD3DNOW
  2122. "movq (%0, %%"REG_d"), %%mm0 \n\t"
  2123. "movq (%1, %%"REG_d"), %%mm1 \n\t"
  2124. "movq 6(%0, %%"REG_d"), %%mm2 \n\t"
  2125. "movq 6(%1, %%"REG_d"), %%mm3 \n\t"
  2126. PAVGB" %%mm1, %%mm0 \n\t"
  2127. PAVGB" %%mm3, %%mm2 \n\t"
  2128. "movq %%mm0, %%mm1 \n\t"
  2129. "movq %%mm2, %%mm3 \n\t"
  2130. "psrlq $24, %%mm0 \n\t"
  2131. "psrlq $24, %%mm2 \n\t"
  2132. PAVGB" %%mm1, %%mm0 \n\t"
  2133. PAVGB" %%mm3, %%mm2 \n\t"
  2134. "punpcklbw %%mm7, %%mm0 \n\t"
  2135. "punpcklbw %%mm7, %%mm2 \n\t"
  2136. #else
  2137. "movd (%0, %%"REG_d"), %%mm0 \n\t"
  2138. "movd (%1, %%"REG_d"), %%mm1 \n\t"
  2139. "movd 3(%0, %%"REG_d"), %%mm2 \n\t"
  2140. "movd 3(%1, %%"REG_d"), %%mm3 \n\t"
  2141. "punpcklbw %%mm7, %%mm0 \n\t"
  2142. "punpcklbw %%mm7, %%mm1 \n\t"
  2143. "punpcklbw %%mm7, %%mm2 \n\t"
  2144. "punpcklbw %%mm7, %%mm3 \n\t"
  2145. "paddw %%mm1, %%mm0 \n\t"
  2146. "paddw %%mm3, %%mm2 \n\t"
  2147. "paddw %%mm2, %%mm0 \n\t"
  2148. "movd 6(%0, %%"REG_d"), %%mm4 \n\t"
  2149. "movd 6(%1, %%"REG_d"), %%mm1 \n\t"
  2150. "movd 9(%0, %%"REG_d"), %%mm2 \n\t"
  2151. "movd 9(%1, %%"REG_d"), %%mm3 \n\t"
  2152. "punpcklbw %%mm7, %%mm4 \n\t"
  2153. "punpcklbw %%mm7, %%mm1 \n\t"
  2154. "punpcklbw %%mm7, %%mm2 \n\t"
  2155. "punpcklbw %%mm7, %%mm3 \n\t"
  2156. "paddw %%mm1, %%mm4 \n\t"
  2157. "paddw %%mm3, %%mm2 \n\t"
  2158. "paddw %%mm4, %%mm2 \n\t"
  2159. "psrlw $2, %%mm0 \n\t"
  2160. "psrlw $2, %%mm2 \n\t"
  2161. #endif
  2162. "movq "MANGLE(ff_bgr2VCoeff)", %%mm1 \n\t"
  2163. "movq "MANGLE(ff_bgr2VCoeff)", %%mm3 \n\t"
  2164. "pmaddwd %%mm0, %%mm1 \n\t"
  2165. "pmaddwd %%mm2, %%mm3 \n\t"
  2166. "pmaddwd %%mm6, %%mm0 \n\t"
  2167. "pmaddwd %%mm6, %%mm2 \n\t"
  2168. #ifndef FAST_BGR2YV12
  2169. "psrad $8, %%mm0 \n\t"
  2170. "psrad $8, %%mm1 \n\t"
  2171. "psrad $8, %%mm2 \n\t"
  2172. "psrad $8, %%mm3 \n\t"
  2173. #endif
  2174. "packssdw %%mm2, %%mm0 \n\t"
  2175. "packssdw %%mm3, %%mm1 \n\t"
  2176. "pmaddwd %%mm5, %%mm0 \n\t"
  2177. "pmaddwd %%mm5, %%mm1 \n\t"
  2178. "packssdw %%mm1, %%mm0 \n\t" // V1 V0 U1 U0
  2179. "psraw $7, %%mm0 \n\t"
  2180. #if HAVE_MMX2 || HAVE_AMD3DNOW
  2181. "movq 12(%0, %%"REG_d"), %%mm4 \n\t"
  2182. "movq 12(%1, %%"REG_d"), %%mm1 \n\t"
  2183. "movq 18(%0, %%"REG_d"), %%mm2 \n\t"
  2184. "movq 18(%1, %%"REG_d"), %%mm3 \n\t"
  2185. PAVGB" %%mm1, %%mm4 \n\t"
  2186. PAVGB" %%mm3, %%mm2 \n\t"
  2187. "movq %%mm4, %%mm1 \n\t"
  2188. "movq %%mm2, %%mm3 \n\t"
  2189. "psrlq $24, %%mm4 \n\t"
  2190. "psrlq $24, %%mm2 \n\t"
  2191. PAVGB" %%mm1, %%mm4 \n\t"
  2192. PAVGB" %%mm3, %%mm2 \n\t"
  2193. "punpcklbw %%mm7, %%mm4 \n\t"
  2194. "punpcklbw %%mm7, %%mm2 \n\t"
  2195. #else
  2196. "movd 12(%0, %%"REG_d"), %%mm4 \n\t"
  2197. "movd 12(%1, %%"REG_d"), %%mm1 \n\t"
  2198. "movd 15(%0, %%"REG_d"), %%mm2 \n\t"
  2199. "movd 15(%1, %%"REG_d"), %%mm3 \n\t"
  2200. "punpcklbw %%mm7, %%mm4 \n\t"
  2201. "punpcklbw %%mm7, %%mm1 \n\t"
  2202. "punpcklbw %%mm7, %%mm2 \n\t"
  2203. "punpcklbw %%mm7, %%mm3 \n\t"
  2204. "paddw %%mm1, %%mm4 \n\t"
  2205. "paddw %%mm3, %%mm2 \n\t"
  2206. "paddw %%mm2, %%mm4 \n\t"
  2207. "movd 18(%0, %%"REG_d"), %%mm5 \n\t"
  2208. "movd 18(%1, %%"REG_d"), %%mm1 \n\t"
  2209. "movd 21(%0, %%"REG_d"), %%mm2 \n\t"
  2210. "movd 21(%1, %%"REG_d"), %%mm3 \n\t"
  2211. "punpcklbw %%mm7, %%mm5 \n\t"
  2212. "punpcklbw %%mm7, %%mm1 \n\t"
  2213. "punpcklbw %%mm7, %%mm2 \n\t"
  2214. "punpcklbw %%mm7, %%mm3 \n\t"
  2215. "paddw %%mm1, %%mm5 \n\t"
  2216. "paddw %%mm3, %%mm2 \n\t"
  2217. "paddw %%mm5, %%mm2 \n\t"
  2218. "movq "MANGLE(ff_w1111)", %%mm5 \n\t"
  2219. "psrlw $2, %%mm4 \n\t"
  2220. "psrlw $2, %%mm2 \n\t"
  2221. #endif
  2222. "movq "MANGLE(ff_bgr2VCoeff)", %%mm1 \n\t"
  2223. "movq "MANGLE(ff_bgr2VCoeff)", %%mm3 \n\t"
  2224. "pmaddwd %%mm4, %%mm1 \n\t"
  2225. "pmaddwd %%mm2, %%mm3 \n\t"
  2226. "pmaddwd %%mm6, %%mm4 \n\t"
  2227. "pmaddwd %%mm6, %%mm2 \n\t"
  2228. #ifndef FAST_BGR2YV12
  2229. "psrad $8, %%mm4 \n\t"
  2230. "psrad $8, %%mm1 \n\t"
  2231. "psrad $8, %%mm2 \n\t"
  2232. "psrad $8, %%mm3 \n\t"
  2233. #endif
  2234. "packssdw %%mm2, %%mm4 \n\t"
  2235. "packssdw %%mm3, %%mm1 \n\t"
  2236. "pmaddwd %%mm5, %%mm4 \n\t"
  2237. "pmaddwd %%mm5, %%mm1 \n\t"
  2238. "add $24, %%"REG_d" \n\t"
  2239. "packssdw %%mm1, %%mm4 \n\t" // V3 V2 U3 U2
  2240. "psraw $7, %%mm4 \n\t"
  2241. "movq %%mm0, %%mm1 \n\t"
  2242. "punpckldq %%mm4, %%mm0 \n\t"
  2243. "punpckhdq %%mm4, %%mm1 \n\t"
  2244. "packsswb %%mm1, %%mm0 \n\t"
  2245. "paddb "MANGLE(ff_bgr2UVOffset)", %%mm0 \n\t"
  2246. "movd %%mm0, (%2, %%"REG_a") \n\t"
  2247. "punpckhdq %%mm0, %%mm0 \n\t"
  2248. "movd %%mm0, (%3, %%"REG_a") \n\t"
  2249. "add $4, %%"REG_a" \n\t"
  2250. " js 1b \n\t"
  2251. : : "r" (src+chromWidth*6), "r" (src+srcStride+chromWidth*6), "r" (udst+chromWidth), "r" (vdst+chromWidth), "g" (-chromWidth)
  2252. : "%"REG_a, "%"REG_d
  2253. );
  2254. udst += chromStride;
  2255. vdst += chromStride;
  2256. src += srcStride*2;
  2257. }
  2258. __asm__ volatile( EMMS" \n\t"
  2259. SFENCE" \n\t"
  2260. :::"memory");
  2261. #else
  2262. y=0;
  2263. #endif
  2264. for (; y<height; y+=2)
  2265. {
  2266. long i;
  2267. for (i=0; i<chromWidth; i++)
  2268. {
  2269. unsigned int b = src[6*i+0];
  2270. unsigned int g = src[6*i+1];
  2271. unsigned int r = src[6*i+2];
  2272. unsigned int Y = ((RY*r + GY*g + BY*b)>>RGB2YUV_SHIFT) + 16;
  2273. unsigned int V = ((RV*r + GV*g + BV*b)>>RGB2YUV_SHIFT) + 128;
  2274. unsigned int U = ((RU*r + GU*g + BU*b)>>RGB2YUV_SHIFT) + 128;
  2275. udst[i] = U;
  2276. vdst[i] = V;
  2277. ydst[2*i] = Y;
  2278. b = src[6*i+3];
  2279. g = src[6*i+4];
  2280. r = src[6*i+5];
  2281. Y = ((RY*r + GY*g + BY*b)>>RGB2YUV_SHIFT) + 16;
  2282. ydst[2*i+1] = Y;
  2283. }
  2284. ydst += lumStride;
  2285. src += srcStride;
  2286. for (i=0; i<chromWidth; i++)
  2287. {
  2288. unsigned int b = src[6*i+0];
  2289. unsigned int g = src[6*i+1];
  2290. unsigned int r = src[6*i+2];
  2291. unsigned int Y = ((RY*r + GY*g + BY*b)>>RGB2YUV_SHIFT) + 16;
  2292. ydst[2*i] = Y;
  2293. b = src[6*i+3];
  2294. g = src[6*i+4];
  2295. r = src[6*i+5];
  2296. Y = ((RY*r + GY*g + BY*b)>>RGB2YUV_SHIFT) + 16;
  2297. ydst[2*i+1] = Y;
  2298. }
  2299. udst += chromStride;
  2300. vdst += chromStride;
  2301. ydst += lumStride;
  2302. src += srcStride;
  2303. }
  2304. }
  2305. static void RENAME(interleaveBytes)(uint8_t *src1, uint8_t *src2, uint8_t *dest,
  2306. long width, long height, long src1Stride,
  2307. long src2Stride, long dstStride){
  2308. long h;
  2309. for (h=0; h < height; h++)
  2310. {
  2311. long w;
  2312. #if HAVE_MMX
  2313. #if HAVE_SSE2
  2314. __asm__(
  2315. "xor %%"REG_a", %%"REG_a" \n\t"
  2316. "1: \n\t"
  2317. PREFETCH" 64(%1, %%"REG_a") \n\t"
  2318. PREFETCH" 64(%2, %%"REG_a") \n\t"
  2319. "movdqa (%1, %%"REG_a"), %%xmm0 \n\t"
  2320. "movdqa (%1, %%"REG_a"), %%xmm1 \n\t"
  2321. "movdqa (%2, %%"REG_a"), %%xmm2 \n\t"
  2322. "punpcklbw %%xmm2, %%xmm0 \n\t"
  2323. "punpckhbw %%xmm2, %%xmm1 \n\t"
  2324. "movntdq %%xmm0, (%0, %%"REG_a", 2) \n\t"
  2325. "movntdq %%xmm1, 16(%0, %%"REG_a", 2) \n\t"
  2326. "add $16, %%"REG_a" \n\t"
  2327. "cmp %3, %%"REG_a" \n\t"
  2328. " jb 1b \n\t"
  2329. ::"r"(dest), "r"(src1), "r"(src2), "r" (width-15)
  2330. : "memory", "%"REG_a""
  2331. );
  2332. #else
  2333. __asm__(
  2334. "xor %%"REG_a", %%"REG_a" \n\t"
  2335. "1: \n\t"
  2336. PREFETCH" 64(%1, %%"REG_a") \n\t"
  2337. PREFETCH" 64(%2, %%"REG_a") \n\t"
  2338. "movq (%1, %%"REG_a"), %%mm0 \n\t"
  2339. "movq 8(%1, %%"REG_a"), %%mm2 \n\t"
  2340. "movq %%mm0, %%mm1 \n\t"
  2341. "movq %%mm2, %%mm3 \n\t"
  2342. "movq (%2, %%"REG_a"), %%mm4 \n\t"
  2343. "movq 8(%2, %%"REG_a"), %%mm5 \n\t"
  2344. "punpcklbw %%mm4, %%mm0 \n\t"
  2345. "punpckhbw %%mm4, %%mm1 \n\t"
  2346. "punpcklbw %%mm5, %%mm2 \n\t"
  2347. "punpckhbw %%mm5, %%mm3 \n\t"
  2348. MOVNTQ" %%mm0, (%0, %%"REG_a", 2) \n\t"
  2349. MOVNTQ" %%mm1, 8(%0, %%"REG_a", 2) \n\t"
  2350. MOVNTQ" %%mm2, 16(%0, %%"REG_a", 2) \n\t"
  2351. MOVNTQ" %%mm3, 24(%0, %%"REG_a", 2) \n\t"
  2352. "add $16, %%"REG_a" \n\t"
  2353. "cmp %3, %%"REG_a" \n\t"
  2354. " jb 1b \n\t"
  2355. ::"r"(dest), "r"(src1), "r"(src2), "r" (width-15)
  2356. : "memory", "%"REG_a
  2357. );
  2358. #endif
  2359. for (w= (width&(~15)); w < width; w++)
  2360. {
  2361. dest[2*w+0] = src1[w];
  2362. dest[2*w+1] = src2[w];
  2363. }
  2364. #else
  2365. for (w=0; w < width; w++)
  2366. {
  2367. dest[2*w+0] = src1[w];
  2368. dest[2*w+1] = src2[w];
  2369. }
  2370. #endif
  2371. dest += dstStride;
  2372. src1 += src1Stride;
  2373. src2 += src2Stride;
  2374. }
  2375. #if HAVE_MMX
  2376. __asm__(
  2377. EMMS" \n\t"
  2378. SFENCE" \n\t"
  2379. ::: "memory"
  2380. );
  2381. #endif
  2382. }
  2383. static inline void RENAME(vu9_to_vu12)(const uint8_t *src1, const uint8_t *src2,
  2384. uint8_t *dst1, uint8_t *dst2,
  2385. long width, long height,
  2386. long srcStride1, long srcStride2,
  2387. long dstStride1, long dstStride2)
  2388. {
  2389. long y,x,w,h;
  2390. w=width/2; h=height/2;
  2391. #if HAVE_MMX
  2392. __asm__ volatile(
  2393. PREFETCH" %0 \n\t"
  2394. PREFETCH" %1 \n\t"
  2395. ::"m"(*(src1+srcStride1)),"m"(*(src2+srcStride2)):"memory");
  2396. #endif
  2397. for (y=0;y<h;y++){
  2398. const uint8_t* s1=src1+srcStride1*(y>>1);
  2399. uint8_t* d=dst1+dstStride1*y;
  2400. x=0;
  2401. #if HAVE_MMX
  2402. for (;x<w-31;x+=32)
  2403. {
  2404. __asm__ volatile(
  2405. PREFETCH" 32%1 \n\t"
  2406. "movq %1, %%mm0 \n\t"
  2407. "movq 8%1, %%mm2 \n\t"
  2408. "movq 16%1, %%mm4 \n\t"
  2409. "movq 24%1, %%mm6 \n\t"
  2410. "movq %%mm0, %%mm1 \n\t"
  2411. "movq %%mm2, %%mm3 \n\t"
  2412. "movq %%mm4, %%mm5 \n\t"
  2413. "movq %%mm6, %%mm7 \n\t"
  2414. "punpcklbw %%mm0, %%mm0 \n\t"
  2415. "punpckhbw %%mm1, %%mm1 \n\t"
  2416. "punpcklbw %%mm2, %%mm2 \n\t"
  2417. "punpckhbw %%mm3, %%mm3 \n\t"
  2418. "punpcklbw %%mm4, %%mm4 \n\t"
  2419. "punpckhbw %%mm5, %%mm5 \n\t"
  2420. "punpcklbw %%mm6, %%mm6 \n\t"
  2421. "punpckhbw %%mm7, %%mm7 \n\t"
  2422. MOVNTQ" %%mm0, %0 \n\t"
  2423. MOVNTQ" %%mm1, 8%0 \n\t"
  2424. MOVNTQ" %%mm2, 16%0 \n\t"
  2425. MOVNTQ" %%mm3, 24%0 \n\t"
  2426. MOVNTQ" %%mm4, 32%0 \n\t"
  2427. MOVNTQ" %%mm5, 40%0 \n\t"
  2428. MOVNTQ" %%mm6, 48%0 \n\t"
  2429. MOVNTQ" %%mm7, 56%0"
  2430. :"=m"(d[2*x])
  2431. :"m"(s1[x])
  2432. :"memory");
  2433. }
  2434. #endif
  2435. for (;x<w;x++) d[2*x]=d[2*x+1]=s1[x];
  2436. }
  2437. for (y=0;y<h;y++){
  2438. const uint8_t* s2=src2+srcStride2*(y>>1);
  2439. uint8_t* d=dst2+dstStride2*y;
  2440. x=0;
  2441. #if HAVE_MMX
  2442. for (;x<w-31;x+=32)
  2443. {
  2444. __asm__ volatile(
  2445. PREFETCH" 32%1 \n\t"
  2446. "movq %1, %%mm0 \n\t"
  2447. "movq 8%1, %%mm2 \n\t"
  2448. "movq 16%1, %%mm4 \n\t"
  2449. "movq 24%1, %%mm6 \n\t"
  2450. "movq %%mm0, %%mm1 \n\t"
  2451. "movq %%mm2, %%mm3 \n\t"
  2452. "movq %%mm4, %%mm5 \n\t"
  2453. "movq %%mm6, %%mm7 \n\t"
  2454. "punpcklbw %%mm0, %%mm0 \n\t"
  2455. "punpckhbw %%mm1, %%mm1 \n\t"
  2456. "punpcklbw %%mm2, %%mm2 \n\t"
  2457. "punpckhbw %%mm3, %%mm3 \n\t"
  2458. "punpcklbw %%mm4, %%mm4 \n\t"
  2459. "punpckhbw %%mm5, %%mm5 \n\t"
  2460. "punpcklbw %%mm6, %%mm6 \n\t"
  2461. "punpckhbw %%mm7, %%mm7 \n\t"
  2462. MOVNTQ" %%mm0, %0 \n\t"
  2463. MOVNTQ" %%mm1, 8%0 \n\t"
  2464. MOVNTQ" %%mm2, 16%0 \n\t"
  2465. MOVNTQ" %%mm3, 24%0 \n\t"
  2466. MOVNTQ" %%mm4, 32%0 \n\t"
  2467. MOVNTQ" %%mm5, 40%0 \n\t"
  2468. MOVNTQ" %%mm6, 48%0 \n\t"
  2469. MOVNTQ" %%mm7, 56%0"
  2470. :"=m"(d[2*x])
  2471. :"m"(s2[x])
  2472. :"memory");
  2473. }
  2474. #endif
  2475. for (;x<w;x++) d[2*x]=d[2*x+1]=s2[x];
  2476. }
  2477. #if HAVE_MMX
  2478. __asm__(
  2479. EMMS" \n\t"
  2480. SFENCE" \n\t"
  2481. ::: "memory"
  2482. );
  2483. #endif
  2484. }
  2485. static inline void RENAME(yvu9_to_yuy2)(const uint8_t *src1, const uint8_t *src2, const uint8_t *src3,
  2486. uint8_t *dst,
  2487. long width, long height,
  2488. long srcStride1, long srcStride2,
  2489. long srcStride3, long dstStride)
  2490. {
  2491. long y,x,w,h;
  2492. w=width/2; h=height;
  2493. for (y=0;y<h;y++){
  2494. const uint8_t* yp=src1+srcStride1*y;
  2495. const uint8_t* up=src2+srcStride2*(y>>2);
  2496. const uint8_t* vp=src3+srcStride3*(y>>2);
  2497. uint8_t* d=dst+dstStride*y;
  2498. x=0;
  2499. #if HAVE_MMX
  2500. for (;x<w-7;x+=8)
  2501. {
  2502. __asm__ volatile(
  2503. PREFETCH" 32(%1, %0) \n\t"
  2504. PREFETCH" 32(%2, %0) \n\t"
  2505. PREFETCH" 32(%3, %0) \n\t"
  2506. "movq (%1, %0, 4), %%mm0 \n\t" /* Y0Y1Y2Y3Y4Y5Y6Y7 */
  2507. "movq (%2, %0), %%mm1 \n\t" /* U0U1U2U3U4U5U6U7 */
  2508. "movq (%3, %0), %%mm2 \n\t" /* V0V1V2V3V4V5V6V7 */
  2509. "movq %%mm0, %%mm3 \n\t" /* Y0Y1Y2Y3Y4Y5Y6Y7 */
  2510. "movq %%mm1, %%mm4 \n\t" /* U0U1U2U3U4U5U6U7 */
  2511. "movq %%mm2, %%mm5 \n\t" /* V0V1V2V3V4V5V6V7 */
  2512. "punpcklbw %%mm1, %%mm1 \n\t" /* U0U0 U1U1 U2U2 U3U3 */
  2513. "punpcklbw %%mm2, %%mm2 \n\t" /* V0V0 V1V1 V2V2 V3V3 */
  2514. "punpckhbw %%mm4, %%mm4 \n\t" /* U4U4 U5U5 U6U6 U7U7 */
  2515. "punpckhbw %%mm5, %%mm5 \n\t" /* V4V4 V5V5 V6V6 V7V7 */
  2516. "movq %%mm1, %%mm6 \n\t"
  2517. "punpcklbw %%mm2, %%mm1 \n\t" /* U0V0 U0V0 U1V1 U1V1*/
  2518. "punpcklbw %%mm1, %%mm0 \n\t" /* Y0U0 Y1V0 Y2U0 Y3V0*/
  2519. "punpckhbw %%mm1, %%mm3 \n\t" /* Y4U1 Y5V1 Y6U1 Y7V1*/
  2520. MOVNTQ" %%mm0, (%4, %0, 8) \n\t"
  2521. MOVNTQ" %%mm3, 8(%4, %0, 8) \n\t"
  2522. "punpckhbw %%mm2, %%mm6 \n\t" /* U2V2 U2V2 U3V3 U3V3*/
  2523. "movq 8(%1, %0, 4), %%mm0 \n\t"
  2524. "movq %%mm0, %%mm3 \n\t"
  2525. "punpcklbw %%mm6, %%mm0 \n\t" /* Y U2 Y V2 Y U2 Y V2*/
  2526. "punpckhbw %%mm6, %%mm3 \n\t" /* Y U3 Y V3 Y U3 Y V3*/
  2527. MOVNTQ" %%mm0, 16(%4, %0, 8) \n\t"
  2528. MOVNTQ" %%mm3, 24(%4, %0, 8) \n\t"
  2529. "movq %%mm4, %%mm6 \n\t"
  2530. "movq 16(%1, %0, 4), %%mm0 \n\t"
  2531. "movq %%mm0, %%mm3 \n\t"
  2532. "punpcklbw %%mm5, %%mm4 \n\t"
  2533. "punpcklbw %%mm4, %%mm0 \n\t" /* Y U4 Y V4 Y U4 Y V4*/
  2534. "punpckhbw %%mm4, %%mm3 \n\t" /* Y U5 Y V5 Y U5 Y V5*/
  2535. MOVNTQ" %%mm0, 32(%4, %0, 8) \n\t"
  2536. MOVNTQ" %%mm3, 40(%4, %0, 8) \n\t"
  2537. "punpckhbw %%mm5, %%mm6 \n\t"
  2538. "movq 24(%1, %0, 4), %%mm0 \n\t"
  2539. "movq %%mm0, %%mm3 \n\t"
  2540. "punpcklbw %%mm6, %%mm0 \n\t" /* Y U6 Y V6 Y U6 Y V6*/
  2541. "punpckhbw %%mm6, %%mm3 \n\t" /* Y U7 Y V7 Y U7 Y V7*/
  2542. MOVNTQ" %%mm0, 48(%4, %0, 8) \n\t"
  2543. MOVNTQ" %%mm3, 56(%4, %0, 8) \n\t"
  2544. : "+r" (x)
  2545. : "r"(yp), "r" (up), "r"(vp), "r"(d)
  2546. :"memory");
  2547. }
  2548. #endif
  2549. for (; x<w; x++)
  2550. {
  2551. const long x2 = x<<2;
  2552. d[8*x+0] = yp[x2];
  2553. d[8*x+1] = up[x];
  2554. d[8*x+2] = yp[x2+1];
  2555. d[8*x+3] = vp[x];
  2556. d[8*x+4] = yp[x2+2];
  2557. d[8*x+5] = up[x];
  2558. d[8*x+6] = yp[x2+3];
  2559. d[8*x+7] = vp[x];
  2560. }
  2561. }
  2562. #if HAVE_MMX
  2563. __asm__(
  2564. EMMS" \n\t"
  2565. SFENCE" \n\t"
  2566. ::: "memory"
  2567. );
  2568. #endif
  2569. }
  2570. static inline void RENAME(rgb2rgb_init)(void){
  2571. rgb15to16 = RENAME(rgb15to16);
  2572. rgb15tobgr24 = RENAME(rgb15tobgr24);
  2573. rgb15to32 = RENAME(rgb15to32);
  2574. rgb16tobgr24 = RENAME(rgb16tobgr24);
  2575. rgb16to32 = RENAME(rgb16to32);
  2576. rgb16to15 = RENAME(rgb16to15);
  2577. rgb24tobgr16 = RENAME(rgb24tobgr16);
  2578. rgb24tobgr15 = RENAME(rgb24tobgr15);
  2579. rgb24tobgr32 = RENAME(rgb24tobgr32);
  2580. rgb32to16 = RENAME(rgb32to16);
  2581. rgb32to15 = RENAME(rgb32to15);
  2582. rgb32tobgr24 = RENAME(rgb32tobgr24);
  2583. rgb24to15 = RENAME(rgb24to15);
  2584. rgb24to16 = RENAME(rgb24to16);
  2585. rgb24tobgr24 = RENAME(rgb24tobgr24);
  2586. rgb32tobgr32 = RENAME(rgb32tobgr32);
  2587. rgb32tobgr16 = RENAME(rgb32tobgr16);
  2588. rgb32tobgr15 = RENAME(rgb32tobgr15);
  2589. yv12toyuy2 = RENAME(yv12toyuy2);
  2590. yv12touyvy = RENAME(yv12touyvy);
  2591. yuv422ptoyuy2 = RENAME(yuv422ptoyuy2);
  2592. yuv422ptouyvy = RENAME(yuv422ptouyvy);
  2593. yuy2toyv12 = RENAME(yuy2toyv12);
  2594. // uyvytoyv12 = RENAME(uyvytoyv12);
  2595. // yvu9toyv12 = RENAME(yvu9toyv12);
  2596. planar2x = RENAME(planar2x);
  2597. rgb24toyv12 = RENAME(rgb24toyv12);
  2598. interleaveBytes = RENAME(interleaveBytes);
  2599. vu9_to_vu12 = RENAME(vu9_to_vu12);
  2600. yvu9_to_yuy2 = RENAME(yvu9_to_yuy2);
  2601. }