开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 电子书籍 > VC书籍 > 查看源码
yuv2rgb_mmx.c
资源名称：VC++视频传输.rar　[点击查看]
上传用户：hxb_1234
上传日期：2010-03-30
资源大小：8328k
文件大小：22k
源码类别：

VC书籍

开发平台：

Visual C++

yuv2rgb_mmx.c：源码内容
  4. #include <memory.h> 
  7. #include "portab.h"
  8. #include "yuv2rgb.h"
  12. #define MAXIMUM_Y_WIDTH 800
  15. #define _USE_PREFETCH
  19. static uint64_t mmw_mult_Y    = 0x2568256825682568;
  20. static uint64_t mmw_mult_U_G  = 0xf36ef36ef36ef36e;
  21. static uint64_t mmw_mult_U_B  = 0x40cf40cf40cf40cf;
  22. static uint64_t mmw_mult_V_R  = 0x3343334333433343;
  23. static uint64_t mmw_mult_V_G  = 0xe5e2e5e2e5e2e5e2;
  26. static uint64_t mmb_0x10      = 0x1010101010101010;
  27. static uint64_t mmw_0x0080    = 0x0080008000800080;
  28. static uint64_t mmw_0x00ff    = 0x00ff00ff00ff00ff;
  30. static uint64_t mmw_cut_red   = 0x7c007c007c007c00;
  31. static uint64_t mmw_cut_green = 0x03e003e003e003e0;
  32. static uint64_t mmw_cut_blue  = 0x001f001f001f001f;
  36. void yuv2rgb_32(uint8_t *puc_y, int stride_y, 
  37.                 uint8_t *puc_u, uint8_t *puc_v, int stride_uv, 
  38.                 uint8_t *puc_out, int width_y, int height_y,
  39. unsigned int _stride_out) {
  41. int y, horiz_count;
  42. int stride_out = width_y * 4;
  44. if (height_y < 0) {
  46. height_y  = -height_y;
  47. puc_y     += (height_y   - 1) * stride_y ;
  48. puc_u     += (height_y/2 - 1) * stride_uv;
  49. puc_v     += (height_y/2 - 1) * stride_uv;
  50. stride_y  = -stride_y;
  51. stride_uv = -stride_uv;
  52. }
  54. horiz_count = -(width_y >> 3);
  56. for (y=0; y<height_y; y++) {
  58. _asm {
  59. push eax
  60. push ebx
  61. push ecx
  62. push edx
  63. push edi
  65. mov eax, puc_out       
  66. mov ebx, puc_y       
  67. mov ecx, puc_u       
  68. mov edx, puc_v
  69. mov edi, horiz_count
  71. horiz_loop:
  73. movd mm2, [ecx]
  74. pxor mm7, mm7
  76. movd mm3, [edx]
  77. punpcklbw mm2, mm7       ; mm2 = __u3__u2__u1__u0
  79. movq mm0, [ebx]          ; mm0 = y7y6y5y4y3y2y1y0  
  80. punpcklbw mm3, mm7       ; mm3 = __v3__v2__v1__v0
  82. movq mm1, mmw_0x00ff     ; mm1 = 00ff00ff00ff00ff 
  84. psubusb mm0, mmb_0x10    ; mm0 -= 16
  86. psubw mm2, mmw_0x0080    ; mm2 -= 128
  87. pand mm1, mm0            ; mm1 = __y6__y4__y2__y0
  89. psubw mm3, mmw_0x0080    ; mm3 -= 128
  90. psllw mm1, 3             ; mm1 *= 8
  92. psrlw mm0, 8             ; mm0 = __y7__y5__y3__y1
  93. psllw mm2, 3             ; mm2 *= 8
  95. pmulhw mm1, mmw_mult_Y   ; mm1 *= luma coeff 
  96. psllw mm0, 3             ; mm0 *= 8
  98. psllw mm3, 3             ; mm3 *= 8
  99. movq mm5, mm3            ; mm5 = mm3 = v
  101. pmulhw mm5, mmw_mult_V_R ; mm5 = red chroma
  102. movq mm4, mm2            ; mm4 = mm2 = u
  104. pmulhw mm0, mmw_mult_Y   ; mm0 *= luma coeff 
  105. movq mm7, mm1            ; even luma part
  107. pmulhw mm2, mmw_mult_U_G ; mm2 *= u green coeff 
  108. paddsw mm7, mm5          ; mm7 = luma + chroma    __r6__r4__r2__r0
  110. pmulhw mm3, mmw_mult_V_G ; mm3 *= v green coeff  
  111. packuswb mm7, mm7        ; mm7 = r6r4r2r0r6r4r2r0
  113. pmulhw mm4, mmw_mult_U_B ; mm4 = blue chroma
  114. paddsw mm5, mm0          ; mm5 = luma + chroma    __r7__r5__r3__r1
  116. packuswb mm5, mm5        ; mm6 = r7r5r3r1r7r5r3r1
  117. paddsw mm2, mm3          ; mm2 = green chroma
  119. movq mm3, mm1            ; mm3 = __y6__y4__y2__y0
  120. movq mm6, mm1            ; mm6 = __y6__y4__y2__y0
  122. paddsw mm3, mm4          ; mm3 = luma + chroma    __b6__b4__b2__b0
  123. paddsw mm6, mm2          ; mm6 = luma + chroma    __g6__g4__g2__g0
  125. punpcklbw mm7, mm5       ; mm7 = r7r6r5r4r3r2r1r0
  126. paddsw mm2, mm0          ; odd luma part plus chroma part    __g7__g5__g3__g1
  128. packuswb mm6, mm6        ; mm2 = g6g4g2g0g6g4g2g0
  129. packuswb mm2, mm2        ; mm2 = g7g5g3g1g7g5g3g1
  131. packuswb mm3, mm3        ; mm3 = b6b4b2b0b6b4b2b0
  132. paddsw mm4, mm0          ; odd luma part plus chroma part    __b7__b5__b3__b1
  134. packuswb mm4, mm4        ; mm4 = b7b5b3b1b7b5b3b1
  135. punpcklbw mm6, mm2       ; mm6 = g7g6g5g4g3g2g1g0
  137. punpcklbw mm3, mm4       ; mm3 = b7b6b5b4b3b2b1b0
  139. /* 32-bit shuffle.... */
  140. pxor mm0, mm0            ; is this needed?
  142. movq mm1, mm6            ; mm1 = g7g6g5g4g3g2g1g0
  143. punpcklbw mm1, mm0       ; mm1 = __g3__g2__g1__g0
  145. movq mm0, mm3            ; mm0 = b7b6b5b4b3b2b1b0
  146. punpcklbw mm0, mm7       ; mm0 = r3b3r2b2r1b1r0b0
  148. movq mm2, mm0            ; mm2 = r3b3r2b2r1b1r0b0
  150. punpcklbw mm0, mm1       ; mm0 = __r1g1b1__r0g0b0
  151. punpckhbw mm2, mm1       ; mm2 = __r3g3b3__r2g2b2
  154. movq  [eax], mm0         ; eax[0] = __r1g1b1__r0g0b0
  155. movq mm1, mm6            ; mm1 = g7g6g5g4g3g2g1g0
  157. movq 8[eax], mm2         ; eax[8] = __r3g3b3__r2g2b2
  160. pxor mm0, mm0            ; is this needed?
  162. punpckhbw mm1, mm0       ; mm1 = __g7__g6__g5__g4
  164. movq mm0, mm3            ; mm0 = b7b6b5b4b3b2b1b0
  165. punpckhbw mm0, mm7       ; mm0 = r7b7r6b6r5b5r4b4
  167. movq mm2, mm0            ; mm2 = r7b7r6b6r5b5r4b4
  169. punpcklbw mm0, mm1       ; mm0 = __r5g5b5__r4g4b4
  170. punpckhbw mm2, mm1       ; mm2 = __r7g7b7__r6g6b6
  173. add ebx, 8               ; puc_y   += 8;
  174. add ecx, 4               ; puc_u   += 4;
  176. movq 16[eax], mm0        ; eax[16] = __r5g5b5__r4g4b4
  177. add edx, 4               ; puc_v   += 4;
  179. movq 24[eax], mm2        ; eax[24] = __r7g7b7__r6g6b6
  182. add eax, 32              ; puc_out += 32
  184. inc edi
  185. jne horiz_loop
  187. pop edi 
  188. pop edx 
  189. pop ecx
  190. pop ebx 
  191. pop eax
  193. emms
  195. }
  196. puc_y   += stride_y;
  197. if (y%2) {
  198. puc_u   += stride_uv;
  199. puc_v   += stride_uv;
  200. }
  201. puc_out += stride_out;
  202. }
  203. }
  210. void yuv2rgb_24(uint8_t *puc_y, int stride_y, 
  211.                 uint8_t *puc_u, uint8_t *puc_v, int stride_uv, 
  212.                 uint8_t *puc_out, int width_y, int height_y,
  213. unsigned int _stride_out) {
  215. int y, horiz_count;
  216. uint8_t *puc_out_remembered;
  217. int stride_out = width_y * 3;
  219. if (height_y < 0) {
  221. height_y  = -height_y;
  222. puc_y     += (height_y   - 1) * stride_y ;
  223. puc_u     += (height_y/2 - 1) * stride_uv;
  224. puc_v     += (height_y/2 - 1) * stride_uv;
  225. stride_y  = -stride_y;
  226. stride_uv = -stride_uv;
  227. }
  229. horiz_count = -(width_y >> 3);
  231. for (y=0; y<height_y; y++) {
  233. if (y == height_y-1) {
  234. uint8_t temp_buff[3*MAXIMUM_Y_WIDTH+1];
  235. puc_out_remembered = puc_out;
  236. puc_out = temp_buff; 
  237. }
  239. _asm {
  240. push eax
  241. push ebx
  242. push ecx
  243. push edx
  244. push edi
  246. mov eax, puc_out       
  247. mov ebx, puc_y       
  248. mov ecx, puc_u       
  249. mov edx, puc_v
  250. mov edi, horiz_count
  252. horiz_loop:
  254. movd mm2, [ecx]
  255. pxor mm7, mm7
  257. movd mm3, [edx]
  258. punpcklbw mm2, mm7       ; mm2 = __u3__u2__u1__u0
  260. movq mm0, [ebx]          ; mm0 = y7y6y5y4y3y2y1y0  
  261. punpcklbw mm3, mm7       ; mm3 = __v3__v2__v1__v0
  263. movq mm1, mmw_0x00ff     ; mm1 = 00ff00ff00ff00ff 
  265. psubusb mm0, mmb_0x10    ; mm0 -= 16
  267. psubw mm2, mmw_0x0080    ; mm2 -= 128
  268. pand mm1, mm0            ; mm1 = __y6__y4__y2__y0
  270. psubw mm3, mmw_0x0080    ; mm3 -= 128
  271. psllw mm1, 3             ; mm1 *= 8
  273. psrlw mm0, 8             ; mm0 = __y7__y5__y3__y1
  274. psllw mm2, 3             ; mm2 *= 8
  276. pmulhw mm1, mmw_mult_Y   ; mm1 *= luma coeff 
  277. psllw mm0, 3             ; mm0 *= 8
  279. psllw mm3, 3             ; mm3 *= 8
  280. movq mm5, mm3            ; mm5 = mm3 = v
  282. pmulhw mm5, mmw_mult_V_R ; mm5 = red chroma
  283. movq mm4, mm2            ; mm4 = mm2 = u
  285. pmulhw mm0, mmw_mult_Y   ; mm0 *= luma coeff 
  286. movq mm7, mm1            ; even luma part
  288. pmulhw mm2, mmw_mult_U_G ; mm2 *= u green coeff 
  289. paddsw mm7, mm5          ; mm7 = luma + chroma    __r6__r4__r2__r0
  291. pmulhw mm3, mmw_mult_V_G ; mm3 *= v green coeff  
  292. packuswb mm7, mm7        ; mm7 = r6r4r2r0r6r4r2r0
  294. pmulhw mm4, mmw_mult_U_B ; mm4 = blue chroma
  295. paddsw mm5, mm0          ; mm5 = luma + chroma    __r7__r5__r3__r1
  297. packuswb mm5, mm5        ; mm6 = r7r5r3r1r7r5r3r1
  298. paddsw mm2, mm3          ; mm2 = green chroma
  300. movq mm3, mm1            ; mm3 = __y6__y4__y2__y0
  301. movq mm6, mm1            ; mm6 = __y6__y4__y2__y0
  303. paddsw mm3, mm4          ; mm3 = luma + chroma    __b6__b4__b2__b0
  304. paddsw mm6, mm2          ; mm6 = luma + chroma    __g6__g4__g2__g0
  306. punpcklbw mm7, mm5       ; mm7 = r7r6r5r4r3r2r1r0
  307. paddsw mm2, mm0          ; odd luma part plus chroma part    __g7__g5__g3__g1
  309. packuswb mm6, mm6        ; mm2 = g6g4g2g0g6g4g2g0
  310. packuswb mm2, mm2        ; mm2 = g7g5g3g1g7g5g3g1
  312. packuswb mm3, mm3        ; mm3 = b6b4b2b0b6b4b2b0
  313. paddsw mm4, mm0          ; odd luma part plus chroma part    __b7__b5__b3__b1
  315. packuswb mm4, mm4        ; mm4 = b7b5b3b1b7b5b3b1
  316. punpcklbw mm6, mm2       ; mm6 = g7g6g5g4g3g2g1g0
  318. punpcklbw mm3, mm4       ; mm3 = b7b6b5b4b3b2b1b0
  320. pxor mm0, mm0            ; is this needed?
  322. movq mm1, mm6            ; mm1 = g7g6g5g4g3g2g1g0
  323. punpcklbw mm1, mm0       ; mm1 = __g3__g2__g1__g0
  325. movq mm0, mm3            ; mm0 = b7b6b5b4b3b2b1b0
  326. punpcklbw mm0, mm7       ; mm0 = r3b3r2b2r1b1r0b0
  328. movq mm2, mm0            ; mm2 = r3b3r2b2r1b1r0b0
  330. punpcklbw mm0, mm1       ; mm0 = __r1g1b1__r0g0b0
  331. punpckhbw mm2, mm1       ; mm2 = __r3g3b3__r2g2b2
  333. movd   [eax], mm0        ; eax[0] = __r0g0b0
  334. psrlq mm0, 32            ; mm0 = __r1g1b1
  336. movd  3[eax], mm0        ; eax[3] = __r1g1b1
  338. movd  6[eax], mm2        ; eax[6] = __r2g2b2
  341. psrlq mm2, 32            ; mm2 = __r3g3b3
  343. movd  9[eax], mm2        ; eax[9] = __r3g3b3
  345. pxor mm0, mm0            ; is this needed?
  347. movq mm1, mm6            ; mm1 = g7g6g5g4g3g2g1g0
  348. punpckhbw mm1, mm0       ; mm1 = __g7__g6__g5__g4
  350. movq mm0, mm3            ; mm0 = b7b6b5b4b3b2b1b0
  351. punpckhbw mm0, mm7       ; mm0 = r7b7r6b6r5b5r4b4
  353. movq mm2, mm0            ; mm2 = r7b7r6b6r5b5r4b4
  355. punpcklbw mm0, mm1       ; mm0 = __r5g5b5__r4g4b4
  356. punpckhbw mm2, mm1       ; mm2 = __r7g7b7__r6g6b6
  359. movd 12[eax], mm0        ; eax[12] = __r4g4b4
  360. psrlq mm0, 32            ; mm0 = __r5g5b5
  362. movd 15[eax], mm0        ; eax[15] = __r5g5b5
  363. add ebx, 8               ; puc_y   += 8;
  365. movd 18[eax], mm2        ; eax[18] = __r6g6b6
  366. psrlq mm2, 32            ; mm2 = __r7g7b7
  368. add ecx, 4               ; puc_u   += 4;
  369. add edx, 4               ; puc_v   += 4;
  371. movd 21[eax], mm2        ; eax[21] = __r7g7b7
  372. add eax, 24              ; puc_out += 24
  374. inc edi
  375. jne horiz_loop
  377. pop edi 
  378. pop edx 
  379. pop ecx
  380. pop ebx 
  381. pop eax
  383. emms
  385. }
  388. if (y == height_y-1) {
  389. int x = 3 * width_y;                  
  390. uint8_t *ps = puc_out;                
  391. uint8_t *pd = puc_out_remembered;    
  392. while (x--) *(pd++) = *(ps++);      
  393. }
  395. puc_y   += stride_y;
  396. if (y%2) {
  397. puc_u   += stride_uv;
  398. puc_v   += stride_uv;
  399. }
  400. puc_out += stride_out; 
  402. }
  403. }
  410. static uint64_t mask_5 = 0xf8f8f8f8f8f8f8f8;
  411. static uint64_t mask_6 = 0xfcfcfcfcfcfcfcfc;
  413. static uint64_t mask_blue = 0x1f1f1f1f1f1f1f1f;
  416. void yuv2rgb_555(uint8_t *puc_y, int stride_y, 
  417.                  uint8_t *puc_u, uint8_t *puc_v, int stride_uv, 
  418.                  uint8_t *puc_out, int width_y, int height_y,
  419.  unsigned int _stride_out) {
  422. int y, horiz_count;
  423. int stride_out = width_y * 2;
  425. if (height_y < 0) {
  427. height_y  = -height_y;
  428. puc_y     += (height_y   - 1) * stride_y ;
  429. puc_u     += (height_y/2 - 1) * stride_uv;
  430. puc_v     += (height_y/2 - 1) * stride_uv;
  431. stride_y  = -stride_y;
  432. stride_uv = -stride_uv;
  433. }
  435. horiz_count = -(width_y >> 3);
  437. for (y=0; y<height_y; y++) {
  439. _asm {
  440. push eax
  441. push ebx
  442. push ecx
  443. push edx
  444. push edi
  446. mov eax, puc_out       
  447. mov ebx, puc_y       
  448. mov ecx, puc_u       
  449. mov edx, puc_v
  450. mov edi, horiz_count
  452. horiz_loop:
  454. movd mm2, [ecx]  ; mm2 = ________u3u2u1u0
  455. movd mm3, [edx]  ; mm3 = ________v3v2v1v0
  456. movq mm0, [ebx]          ; mm0 = y7y6y5y4y3y2y1y0  
  458. pxor mm7, mm7  ; zero mm7
  460. punpcklbw mm2, mm7       ; mm2 = __u3__u2__u1__u0
  461. punpcklbw mm3, mm7       ; mm3 = __v3__v2__v1__v0
  462. psubw mm2, mmw_0x0080    ; mm2 -= 128
  463. psubw mm3, mmw_0x0080    ; mm3 -= 128
  464. psllw mm2, 3             ; mm2 *= 8
  465. psllw mm3, 3             ; mm3 *= 8
  466. movq mm4, mm2            ; mm4 = mm2 = u
  467. movq mm5, mm3            ; mm5 = mm3 = v
  468. pmulhw mm2, mmw_mult_U_G ; mm2 *= u green coeff 
  469. pmulhw mm3, mmw_mult_V_G ; mm3 *= v green coeff  
  470. pmulhw mm4, mmw_mult_U_B ; mm4 = blue chroma
  471. pmulhw mm5, mmw_mult_V_R ; mm5 = red chroma
  472. paddsw mm2, mm3  ; mm2 = green chroma
  475. psubusb mm0, mmb_0x10    ; mm0 -= 16
  476. movq mm1, mmw_0x00ff     ; mm1 = 00ff00ff00ff00ff 
  477. psrlw mm0, 8             ; mm0 = __y7__y5__y3__y1 luma odd
  478. pand mm1, mm0            ; mm1 = __y6__y4__y2__y0 luma even
  479. psllw mm0, 3             ; mm0 *= 8
  480. psllw mm1, 3             ; mm1 *= 8
  481. pmulhw mm0, mmw_mult_Y   ; mm0 luma odd *= luma coeff 
  482. pmulhw mm1, mmw_mult_Y   ; mm1 luma even *= luma coeff 
  485. movq mm3, mm4  ; copy blue chroma
  486. movq mm6, mm5  ; copy red chroma
  487. movq mm7, mm2  ; copy green chroma
  488. paddsw mm3, mm0  ; mm3 = luma odd + blue chroma
  489. paddsw mm4, mm1  ; mm4 = luma even + blue chroma
  490. paddsw mm6, mm0  ; mm6 = luma odd + red chroma
  491. paddsw mm5, mm1  ; mm5 = luma even + red chroma
  492. paddsw mm7, mm0  ; mm7 = luma odd + green chroma
  493. paddsw mm2, mm1  ; mm2 = luma even + green chroma
  495. packuswb mm3, mm3
  496. packuswb mm4, mm4
  497. packuswb mm6, mm6
  498. packuswb mm5, mm5
  499. packuswb mm7, mm7
  500. packuswb mm2, mm2
  502. punpcklbw mm4, mm3  ; mm4 = b7b6b5b4b3b2b1b0 blue
  503. punpcklbw mm5, mm6  ; mm5 = r7r6r5r4r3r2r1r0 red
  504. punpcklbw mm2, mm7  ; mm2 = g7g6g5g4g3g2g1g0 green
  507. pand mm4, mask_5
  508. pand mm5, mask_5
  509. pand mm2, mask_5
  513. psrlw mm4, 3  ; mm4 = blue shifted
  514. pand mm4, mask_blue  ; mask the blue again
  515. pxor mm7, mm7  ; zero mm7
  516. movq mm1, mm4  ; mm1 = copy blue
  517. movq mm3, mm5  ; mm3 = copy red
  518. movq mm6, mm2  ; mm6 = copy green
  520. punpckhbw mm1, mm7
  521. punpckhbw mm3, mm7
  522. punpckhbw mm6, mm7
  523. psllw mm6, 2  ; shift green
  524. psllw mm3, 7  ; shift red
  525. por mm6, mm3
  526. por mm6, mm1
  527. movq 8[eax], mm6
  529. punpcklbw mm2, mm7  ; mm2 = __g3__g2__g1__g0 already masked
  530. punpcklbw mm5, mm7
  531. punpcklbw mm4, mm7
  532. psllw mm2, 2  ; shift green
  533. psllw mm5, 7  ; shift red
  534. por mm2, mm5
  535. por mm2, mm4
  536. movq [eax], mm2
  538. add ebx, 8               ; puc_y   += 8;
  539. add ecx, 4               ; puc_u   += 4;
  540. add edx, 4               ; puc_v   += 4;
  541. add eax, 16              ; puc_out += 16 // wrote 16 bytes
  543. inc edi
  544. jne horiz_loop
  546. pop edi 
  547. pop edx 
  548. pop ecx
  549. pop ebx 
  550. pop eax
  552. emms
  554. }
  555. puc_y   += stride_y;
  556. if (y%2) {
  557. puc_u   += stride_uv;
  558. puc_v   += stride_uv;
  559. }
  560. puc_out += stride_out;
  561. }
  562. }
  564. /***/
  566. #define _S(a) (a)>255 ? 255 : (a)<0 ? 0 : (a)
  568. #define _R(y,u,v) (0x2568*(y)          + 0x3343*(u)) /0x2000
  569. #define _G(y,u,v) (0x2568*(y) - 0x0c92*(v) - 0x1a1e*(u)) /0x2000
  570. #define _B(y,u,v) (0x2568*(y) + 0x40cf*(v))      /0x2000
  572. #define _mR 0x7c00
  573. #define _mG 0x03e0
  574. #define _mB 0x001f
  576. #define _Ps565(r,g,b) ( ((r & 0xF8) >> 3) | (((g & 0xF8) << 3)) | (((b & 0xF8) << 8)) )
  579. void yuv2rgb_565(uint8_t *puc_y, int stride_y, 
  580.                 uint8_t *puc_u, uint8_t *puc_v, int stride_uv, 
  581.                 uint8_t *puc_out, int width_y, int height_y,
  582. unsigned int _stride_out) 
  583. {
  585. int y, horiz_count;
  586. unsigned short * pus_out;
  587. int stride_out = width_y * 2;
  589. if (height_y < 0) {
  591. height_y  = -height_y;
  592. puc_y     += (height_y   - 1) * stride_y ;
  593. puc_u     += (height_y/2 - 1) * stride_uv;
  594. puc_v     += (height_y/2 - 1) * stride_uv;
  595. stride_y  = -stride_y;
  596. stride_uv = -stride_uv;
  597. }
  598. pus_out = (unsigned short *) puc_out;
  600. horiz_count = -(width_y >> 3);
  602. for (y=0; y<height_y; y++) 
  603. {
  606. _asm {
  607. push eax
  608. push ebx
  609. push ecx
  610. push edx
  611. push edi
  613. mov eax, puc_out       
  614. mov ebx, puc_y       
  615. mov ecx, puc_u       
  616. mov edx, puc_v
  617. mov edi, horiz_count
  619. horiz_loop:
  622. movd mm2, [ecx]  ; mm2 = ________u3u2u1u0
  623. movd mm3, [edx]  ; mm3 = ________v3v2v1v0
  624. movq mm0, [ebx]          ; mm0 = y7y6y5y4y3y2y1y0  
  626. pxor mm7, mm7  ; zero mm7
  628. punpcklbw mm2, mm7       ; mm2 = __u3__u2__u1__u0
  629. punpcklbw mm3, mm7       ; mm3 = __v3__v2__v1__v0
  630. psubw mm2, mmw_0x0080    ; mm2 -= 128
  631. psubw mm3, mmw_0x0080    ; mm3 -= 128
  632. psllw mm2, 3             ; mm2 *= 8
  633. psllw mm3, 3             ; mm3 *= 8
  634. movq mm4, mm2            ; mm4 = mm2 = u
  635. movq mm5, mm3            ; mm5 = mm3 = v
  636. pmulhw mm2, mmw_mult_U_G ; mm2 *= u green coeff 
  637. pmulhw mm3, mmw_mult_V_G ; mm3 *= v green coeff  
  638. pmulhw mm4, mmw_mult_U_B ; mm4 = blue chroma
  639. pmulhw mm5, mmw_mult_V_R ; mm5 = red chroma
  640. paddsw mm2, mm3  ; mm2 = green chroma
  643. psubusb mm0, mmb_0x10    ; mm0 -= 16
  644. movq mm1, mmw_0x00ff     ; mm1 = 00ff00ff00ff00ff 
  645. psrlw mm0, 8             ; mm0 = __y7__y5__y3__y1 luma odd
  646. pand mm1, mm0            ; mm1 = __y6__y4__y2__y0 luma even
  647. psllw mm0, 3             ; mm0 *= 8
  648. psllw mm1, 3             ; mm1 *= 8
  649. pmulhw mm0, mmw_mult_Y   ; mm0 luma odd *= luma coeff 
  650. pmulhw mm1, mmw_mult_Y   ; mm1 luma even *= luma coeff 
  653. movq mm3, mm4  ; copy blue chroma
  654. movq mm6, mm5  ; copy red chroma
  655. movq mm7, mm2  ; copy green chroma
  656. paddsw mm3, mm0  ; mm3 = luma odd + blue chroma
  657. paddsw mm4, mm1  ; mm4 = luma even + blue chroma
  658. paddsw mm6, mm0  ; mm6 = luma odd + red chroma
  659. paddsw mm5, mm1  ; mm5 = luma even + red chroma
  660. paddsw mm7, mm0  ; mm7 = luma odd + green chroma
  661. paddsw mm2, mm1  ; mm2 = luma even + green chroma
  663. packuswb mm3, mm3
  664. packuswb mm4, mm4
  665. packuswb mm6, mm6
  666. packuswb mm5, mm5
  667. packuswb mm7, mm7
  668. packuswb mm2, mm2
  670. punpcklbw mm4, mm3  ; mm4 = b7b6b5b4b3b2b1b0 blue
  671. punpcklbw mm5, mm6  ; mm5 = r7r6r5r4r3r2r1r0 red
  672. punpcklbw mm2, mm7  ; mm2 = g7g6g5g4g3g2g1g0 green
  675. pand mm4, mask_5
  676. pand mm5, mask_5
  677. pand mm2, mask_5
  681. psrlw mm4, 3  ; mm4 = red shifted
  682. pand mm4, mask_blue  ; mask the blue again
  683. pxor mm7, mm7  ; zero mm7
  684. movq mm1, mm5  ; mm1 = copy blue
  685. movq mm3, mm4  ; mm3 = copy red
  686. movq mm6, mm2  ; mm6 = copy green
  688. punpckhbw mm1, mm7
  689. punpckhbw mm3, mm7
  690. punpckhbw mm6, mm7
  691. psllw mm6, 3  ; shift green
  692. psllw mm1, 8  ; shift blue
  693. por mm6, mm3
  694. por mm6, mm1
  695. movq 8[eax], mm6
  697. punpcklbw mm2, mm7  ; mm2 = __g3__g2__g1__g0 already masked
  698. punpcklbw mm4, mm7
  699. punpcklbw mm5, mm7
  700. psllw mm2, 3  ; shift green
  701. psllw mm5, 8  ; shift blue
  702. por mm2, mm4
  703. por mm2, mm5
  704. movq [eax], mm2
  706. add ebx, 8               ; puc_y   += 8;
  707. add ecx, 4               ; puc_u   += 4;
  708. add edx, 4               ; puc_v   += 4;
  709. add eax, 16              ; puc_out += 16 // wrote 16 bytes
  711. inc edi
  712. jne horiz_loop
  714. pop edi 
  715. pop edx 
  716. pop ecx
  717. pop ebx 
  718. pop eax
  720. emms
  722. }
  723. /***/
  725. puc_y   += stride_y;
  726. if (y%2) {
  727. puc_u   += stride_uv;
  728. puc_v   += stride_uv;
  729. }
  730. puc_out += stride_out;
  731. }
  732. }
  734. /***/
  741.  
  744. void yuy2_out(uint8_t *puc_y, int stride_y, 
  745.   uint8_t *puc_u, uint8_t *puc_v, int stride_uv, 
  746.   uint8_t *puc_out, int width_y, int height_y,
  747. unsigned int stride_out) 
  748. { 
  749. int y;
  750. uint8_t* puc_out2;
  751. unsigned int stride_diff = 4 * stride_out - 2 * width_y; 
  753. if (height_y < 0) {
  755. height_y  = -height_y;
  756. puc_y     += (height_y   - 1) * stride_y ;
  757. puc_u     += (height_y/2 - 1) * stride_uv;
  758. puc_v     += (height_y/2 - 1) * stride_uv;
  759. stride_y  = -stride_y;
  760. stride_uv = -stride_uv;
  761. }
  762. puc_out2 = puc_out + 2 * stride_out;
  763. for (y=height_y/2; y; y--) {
  764. register uint8_t *py, *py2, *pu, *pv;
  765. register int x;
  766. uint32_t tmp;
  768. py = puc_y;
  769. py2 = puc_y + stride_y;
  770. pu = puc_u;
  771. pv = puc_v;
  772. for (x=width_y/2; x; x--) {
  773. tmp = *(py++);
  774. tmp |= *(pu++) << 8;
  775. tmp |= *(py++) << 16;
  776. tmp |= *(pv++) << 24;
  777. *(uint32_t*)puc_out=tmp;
  778. puc_out += 4;
  780. tmp &= 0xFF00FF00;
  781. tmp |= *(py2++);
  782. tmp |= *(py2++) << 16;
  783. *(uint32_t*)puc_out2=tmp;
  784. puc_out2 += 4;
  785. }
  787. puc_y += 2*stride_y;
  788. puc_u += stride_uv;
  789. puc_v += stride_uv;
  791. puc_out += stride_diff;
  792. puc_out2 += stride_diff;
  793. }
  795. }
  799. void uyvy_out(uint8_t *puc_y, int stride_y, 
  800.   uint8_t *puc_u, uint8_t *puc_v, int stride_uv, 
  801.   uint8_t *puc_out, int width_y, int height_y,
  802. unsigned int stride_out) 
  803. { 
  804. int y;
  805. uint8_t* puc_out2;
  806. unsigned int stride_diff = 4 * stride_out - 2 * width_y; 
  808. if (height_y < 0) {
  810. height_y  = -height_y;
  811. puc_y     += (height_y   - 1) * stride_y ;
  812. puc_u     += (height_y/2 - 1) * stride_uv;
  813. puc_v     += (height_y/2 - 1) * stride_uv;
  814. stride_y  = -stride_y;
  815. stride_uv = -stride_uv;
  816. }
  817. puc_out2 = puc_out + 2 * stride_out;
  818. for (y=height_y/2; y; y--) {
  819. register uint8_t *py, *py2, *pu, *pv;
  820. register int x;
  821. uint32_t tmp;
  823. py = puc_y;
  824. py2 = puc_y + stride_y;
  825. pu = puc_u;
  826. pv = puc_v;
  827. for (x=width_y/2; x; x--) {
  828. tmp = *(pu++);
  829. tmp |= *(py++) << 8;
  830. tmp |= *(pv++) << 16;
  831. tmp |= *(py++) << 24;
  832. *(uint32_t*)puc_out=tmp;
  833. puc_out += 4;
  835. tmp &= 0x00FF00FF;
  836. tmp |= *(py2++) << 8;
  837. tmp |= *(py2++) << 24;
  838. *(uint32_t*)puc_out2=tmp;
  839. puc_out2 += 4;
  840. }
  842. puc_y += 2*stride_y;
  843. puc_u += stride_uv;
  844. puc_v += stride_uv;
  846. puc_out += stride_diff;
  847. puc_out2 += stride_diff;
  848. }
  850. }
  854. void yuv12_out(uint8_t *puc_y, int stride_y, 
  855.   uint8_t *puc_u, uint8_t *puc_v, int stride_uv, 
  856.   uint8_t *puc_out, int width_y, int height_y,
  857. unsigned int stride_out) 
  858. { 
  859. int i;
  861. unsigned char * pauc_out[3];
  863. if (height_y < 0) {
  865. height_y = -height_y;
  866. puc_y     += (height_y   - 1) * stride_y ;
  867. puc_u     += (height_y/2 - 1) * stride_uv;
  868. puc_v     += (height_y/2 - 1) * stride_uv;
  869. stride_y  = -stride_y;
  870. stride_uv = -stride_uv;
  871. }
  873. pauc_out[0] = puc_out;
  874. pauc_out[1] = puc_out + stride_out * height_y;
  875. pauc_out[2] = puc_out + stride_out * height_y * 5 / 4;
  877. for (i=0; i<height_y; i++) {
  879. memcpy(pauc_out[0], puc_y, width_y);
  881. pauc_out[0] += stride_out;
  882. puc_y += stride_y;
  883. }
  885. for (i=0; i<height_y/2; i++) {
  887. memcpy(pauc_out[2], puc_u, width_y/2); 
  888. memcpy(pauc_out[1], puc_v, width_y/2);
  890. pauc_out[1] += stride_out/2;
  891. pauc_out[2] += stride_out/2;
  892. puc_u += stride_uv;
  893. puc_v += stride_uv;
  894. }
  895. }
  897. /***/