Mercurial > mplayer.hg
annotate postproc/rgb2rgb_template.c @ 2738:dfa63a7db294
rgb24to32 now is faster
author | nick |
---|---|
date | Tue, 06 Nov 2001 13:53:43 +0000 |
parents | ae79207a3055 |
children | 1583214489a2 |
rev | line source |
---|---|
2694 | 1 /* |
2538
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
2 * |
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
3 * rgb2rgb.c, Software RGB to RGB convertor |
2732 | 4 * pluralize by Software PAL8 to RGB convertor |
5 * Software YUV to YUV convertor | |
6 * Software YUV to RGB convertor | |
2538
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
7 * Written by Nick Kurshev. |
2702 | 8 * palette stuff & yuv stuff by Michael |
2538
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
9 */ |
2504 | 10 #include <inttypes.h> |
11 #include "../config.h" | |
12 #include "rgb2rgb.h" | |
2538
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
13 #include "../mmx_defs.h" |
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
14 |
2535 | 15 #ifdef HAVE_MMX |
2538
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
16 static const uint64_t mask32 __attribute__((aligned(8))) = 0x00FFFFFF00FFFFFFULL; |
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
17 static const uint64_t mask24l __attribute__((aligned(8))) = 0x0000000000FFFFFFULL; |
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
18 static const uint64_t mask24h __attribute__((aligned(8))) = 0x0000FFFFFF000000ULL; |
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
19 static const uint64_t mask15b __attribute__((aligned(8))) = 0x001F001F001F001FULL; /* 00000000 00011111 xxB */ |
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
20 static const uint64_t mask15rg __attribute__((aligned(8))) = 0x7FE07FE07FE07FE0ULL; /* 01111111 11100000 RGx */ |
2698
22652c028692
faster 15to16 bit rgb (the mmx routine is limited by memory speed so there is no difference ): but the c routine is faster
michael
parents:
2697
diff
changeset
|
21 static const uint64_t mask15s __attribute__((aligned(8))) = 0xFFE0FFE0FFE0FFE0ULL; |
2535 | 22 #endif |
2513 | 23 |
2718 | 24 void rgb24to32(const uint8_t *src,uint8_t *dst,unsigned src_size) |
2504 | 25 { |
2508 | 26 uint8_t *dest = dst; |
2677 | 27 const uint8_t *s = src; |
28 const uint8_t *end; | |
2510 | 29 #ifdef HAVE_MMX |
30 uint8_t *mm_end; | |
31 #endif | |
2504 | 32 end = s + src_size; |
2510 | 33 #ifdef HAVE_MMX |
2538
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
34 __asm __volatile(PREFETCH" %0"::"m"(*s):"memory"); |
2516 | 35 mm_end = (uint8_t*)((((unsigned long)end)/(MMREG_SIZE*2))*(MMREG_SIZE*2)); |
2538
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
36 __asm __volatile("movq %0, %%mm7"::"m"(mask32):"memory"); |
2516 | 37 if(mm_end == end) mm_end -= MMREG_SIZE*2; |
2510 | 38 while(s < mm_end) |
39 { | |
2511 | 40 __asm __volatile( |
2538
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
41 PREFETCH" 32%1\n\t" |
2510 | 42 "movd %1, %%mm0\n\t" |
2738 | 43 "punpckldq 3%1, %%mm0\n\t" |
44 "movd 6%1, %%mm1\n\t" | |
45 "punpckldq 9%1, %%mm1\n\t" | |
46 "movd 12%1, %%mm2\n\t" | |
47 "punpckldq 15%1, %%mm2\n\t" | |
48 "movd 18%1, %%mm3\n\t" | |
49 "punpckldq 21%1, %%mm3\n\t" | |
2510 | 50 "pand %%mm7, %%mm0\n\t" |
2738 | 51 "pand %%mm7, %%mm1\n\t" |
2510 | 52 "pand %%mm7, %%mm2\n\t" |
2738 | 53 "pand %%mm7, %%mm3\n\t" |
2511 | 54 MOVNTQ" %%mm0, %0\n\t" |
2738 | 55 MOVNTQ" %%mm1, 8%0\n\t" |
56 MOVNTQ" %%mm2, 16%0\n\t" | |
57 MOVNTQ" %%mm3, 24%0" | |
2510 | 58 :"=m"(*dest) |
59 :"m"(*s) | |
60 :"memory"); | |
2738 | 61 dest += 32; |
62 s += 24; | |
2510 | 63 } |
2513 | 64 __asm __volatile(SFENCE:::"memory"); |
2511 | 65 __asm __volatile(EMMS:::"memory"); |
2510 | 66 #endif |
2504 | 67 while(s < end) |
68 { | |
2508 | 69 *dest++ = *s++; |
70 *dest++ = *s++; | |
71 *dest++ = *s++; | |
72 *dest++ = 0; | |
2504 | 73 } |
74 } | |
2505 | 75 |
2718 | 76 void rgb32to24(const uint8_t *src,uint8_t *dst,unsigned src_size) |
2505 | 77 { |
78 uint8_t *dest = dst; | |
2677 | 79 const uint8_t *s = src; |
80 const uint8_t *end; | |
2517 | 81 #ifdef HAVE_MMX |
82 uint8_t *mm_end; | |
83 #endif | |
2505 | 84 end = s + src_size; |
2517 | 85 #ifdef HAVE_MMX |
2538
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
86 __asm __volatile(PREFETCH" %0"::"m"(*s):"memory"); |
2517 | 87 mm_end = (uint8_t*)((((unsigned long)end)/(MMREG_SIZE*2))*(MMREG_SIZE*2)); |
88 __asm __volatile( | |
2538
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
89 "movq %0, %%mm7\n\t" |
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
90 "movq %1, %%mm6" |
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
91 ::"m"(mask24l),"m"(mask24h):"memory"); |
2517 | 92 if(mm_end == end) mm_end -= MMREG_SIZE*2; |
93 while(s < mm_end) | |
94 { | |
95 __asm __volatile( | |
2538
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
96 PREFETCH" 32%1\n\t" |
2517 | 97 "movq %1, %%mm0\n\t" |
98 "movq 8%1, %%mm1\n\t" | |
99 "movq %%mm0, %%mm2\n\t" | |
100 "movq %%mm1, %%mm3\n\t" | |
101 "psrlq $8, %%mm2\n\t" | |
102 "psrlq $8, %%mm3\n\t" | |
103 "pand %%mm7, %%mm0\n\t" | |
104 "pand %%mm7, %%mm1\n\t" | |
105 "pand %%mm6, %%mm2\n\t" | |
106 "pand %%mm6, %%mm3\n\t" | |
107 "por %%mm2, %%mm0\n\t" | |
108 "por %%mm3, %%mm1\n\t" | |
109 MOVNTQ" %%mm0, %0\n\t" | |
110 MOVNTQ" %%mm1, 6%0" | |
111 :"=m"(*dest) | |
112 :"m"(*s) | |
113 :"memory"); | |
114 dest += 12; | |
115 s += 16; | |
116 } | |
117 __asm __volatile(SFENCE:::"memory"); | |
118 __asm __volatile(EMMS:::"memory"); | |
119 #endif | |
2505 | 120 while(s < end) |
121 { | |
122 *dest++ = *s++; | |
123 *dest++ = *s++; | |
124 *dest++ = *s++; | |
125 s++; | |
126 } | |
127 } | |
2506 | 128 |
2538
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
129 /* |
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
130 Original by Strepto/Astral |
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
131 ported to gcc & bugfixed : A'rpi |
2564 | 132 MMX2, 3DNOW optimization by Nick Kurshev |
2698
22652c028692
faster 15to16 bit rgb (the mmx routine is limited by memory speed so there is no difference ): but the c routine is faster
michael
parents:
2697
diff
changeset
|
133 32bit c version, and and&add trick by Michael Niedermayer |
2538
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
134 */ |
2718 | 135 void rgb15to16(const uint8_t *src,uint8_t *dst,unsigned src_size) |
2506 | 136 { |
137 #ifdef HAVE_MMX | |
2677 | 138 register const char* s=src+src_size; |
2506 | 139 register char* d=dst+src_size; |
140 register int offs=-src_size; | |
2698
22652c028692
faster 15to16 bit rgb (the mmx routine is limited by memory speed so there is no difference ): but the c routine is faster
michael
parents:
2697
diff
changeset
|
141 __asm __volatile(PREFETCH" %0"::"m"(*(s+offs))); |
2538
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
142 __asm __volatile( |
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
143 "movq %0, %%mm4\n\t" |
2698
22652c028692
faster 15to16 bit rgb (the mmx routine is limited by memory speed so there is no difference ): but the c routine is faster
michael
parents:
2697
diff
changeset
|
144 ::"m"(mask15s)); |
2538
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
145 while(offs<0) |
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
146 { |
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
147 __asm __volatile( |
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
148 PREFETCH" 32%1\n\t" |
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
149 "movq %1, %%mm0\n\t" |
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
150 "movq 8%1, %%mm2\n\t" |
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
151 "movq %%mm0, %%mm1\n\t" |
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
152 "movq %%mm2, %%mm3\n\t" |
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
153 "pand %%mm4, %%mm0\n\t" |
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
154 "pand %%mm4, %%mm2\n\t" |
2698
22652c028692
faster 15to16 bit rgb (the mmx routine is limited by memory speed so there is no difference ): but the c routine is faster
michael
parents:
2697
diff
changeset
|
155 "paddw %%mm1, %%mm0\n\t" |
22652c028692
faster 15to16 bit rgb (the mmx routine is limited by memory speed so there is no difference ): but the c routine is faster
michael
parents:
2697
diff
changeset
|
156 "paddw %%mm3, %%mm2\n\t" |
2538
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
157 MOVNTQ" %%mm0, %0\n\t" |
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
158 MOVNTQ" %%mm2, 8%0" |
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
159 :"=m"(*(d+offs)) |
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
160 :"m"(*(s+offs)) |
2698
22652c028692
faster 15to16 bit rgb (the mmx routine is limited by memory speed so there is no difference ): but the c routine is faster
michael
parents:
2697
diff
changeset
|
161 ); |
2538
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
162 offs+=16; |
2506 | 163 } |
2538
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
164 __asm __volatile(SFENCE:::"memory"); |
71320898b333
Finish mmx2, 3dnow optimiz. 15to16 should be tested. Better fix of can't compile
nick
parents:
2535
diff
changeset
|
165 __asm __volatile(EMMS:::"memory"); |
2506 | 166 #else |
2698
22652c028692
faster 15to16 bit rgb (the mmx routine is limited by memory speed so there is no difference ): but the c routine is faster
michael
parents:
2697
diff
changeset
|
167 #if 0 |
2677 | 168 const uint16_t *s1=( uint16_t * )src; |
2506 | 169 uint16_t *d1=( uint16_t * )dst; |
170 uint16_t *e=((uint8_t *)s1)+src_size; | |
171 while( s1<e ){ | |
172 register int x=*( s1++ ); | |
173 /* rrrrrggggggbbbbb | |
174 0rrrrrgggggbbbbb | |
175 0111 1111 1110 0000=0x7FE0 | |
176 00000000000001 1111=0x001F */ | |
177 *( d1++ )=( x&0x001F )|( ( x&0x7FE0 )<<1 ); | |
178 } | |
2698
22652c028692
faster 15to16 bit rgb (the mmx routine is limited by memory speed so there is no difference ): but the c routine is faster
michael
parents:
2697
diff
changeset
|
179 #else |
2718 | 180 const unsigned *s1=( unsigned * )src; |
181 unsigned *d1=( unsigned * )dst; | |
2698
22652c028692
faster 15to16 bit rgb (the mmx routine is limited by memory speed so there is no difference ): but the c routine is faster
michael
parents:
2697
diff
changeset
|
182 int i; |
22652c028692
faster 15to16 bit rgb (the mmx routine is limited by memory speed so there is no difference ): but the c routine is faster
michael
parents:
2697
diff
changeset
|
183 int size= src_size>>2; |
22652c028692
faster 15to16 bit rgb (the mmx routine is limited by memory speed so there is no difference ): but the c routine is faster
michael
parents:
2697
diff
changeset
|
184 for(i=0; i<size; i++) |
22652c028692
faster 15to16 bit rgb (the mmx routine is limited by memory speed so there is no difference ): but the c routine is faster
michael
parents:
2697
diff
changeset
|
185 { |
22652c028692
faster 15to16 bit rgb (the mmx routine is limited by memory speed so there is no difference ): but the c routine is faster
michael
parents:
2697
diff
changeset
|
186 register int x= s1[i]; |
22652c028692
faster 15to16 bit rgb (the mmx routine is limited by memory speed so there is no difference ): but the c routine is faster
michael
parents:
2697
diff
changeset
|
187 // d1[i] = x + (x&0x7FE07FE0); //faster but need msbit =0 which might not allways be true |
22652c028692
faster 15to16 bit rgb (the mmx routine is limited by memory speed so there is no difference ): but the c routine is faster
michael
parents:
2697
diff
changeset
|
188 d1[i] = (x&0x7FFF7FFF) + (x&0x7FE07FE0); |
22652c028692
faster 15to16 bit rgb (the mmx routine is limited by memory speed so there is no difference ): but the c routine is faster
michael
parents:
2697
diff
changeset
|
189 |
22652c028692
faster 15to16 bit rgb (the mmx routine is limited by memory speed so there is no difference ): but the c routine is faster
michael
parents:
2697
diff
changeset
|
190 } |
22652c028692
faster 15to16 bit rgb (the mmx routine is limited by memory speed so there is no difference ): but the c routine is faster
michael
parents:
2697
diff
changeset
|
191 #endif |
2506 | 192 #endif |
193 } | |
2694 | 194 |
195 /** | |
196 * Pallete is assumed to contain bgr32 | |
197 */ | |
2718 | 198 void palette8torgb32(const uint8_t *src, uint8_t *dst, unsigned num_pixels, const uint8_t *palette) |
2694 | 199 { |
2718 | 200 unsigned i; |
2702 | 201 for(i=0; i<num_pixels; i++) |
2718 | 202 ((unsigned *)dst)[i] = ((unsigned *)palette)[ src[i] ]; |
2694 | 203 } |
204 | |
2697 | 205 /** |
206 * Pallete is assumed to contain bgr32 | |
207 */ | |
2718 | 208 void palette8torgb24(const uint8_t *src, uint8_t *dst, unsigned num_pixels, const uint8_t *palette) |
2697 | 209 { |
2718 | 210 unsigned i; |
2697 | 211 /* |
212 writes 1 byte o much and might cause alignment issues on some architectures? | |
2702 | 213 for(i=0; i<num_pixels; i++) |
2718 | 214 ((unsigned *)(&dst[i*3])) = ((unsigned *)palette)[ src[i] ]; |
2697 | 215 */ |
2702 | 216 for(i=0; i<num_pixels; i++) |
2697 | 217 { |
218 //FIXME slow? | |
219 dst[0]= palette[ src[i]*4+0 ]; | |
220 dst[1]= palette[ src[i]*4+1 ]; | |
221 dst[2]= palette[ src[i]*4+2 ]; | |
222 dst+= 3; | |
223 } | |
224 } | |
225 | |
2718 | 226 void rgb32to16(const uint8_t *src, uint8_t *dst, unsigned src_size) |
2694 | 227 { |
2719
fafa73d6d80c
Fixed rgb32(24)to16 stuff, rgb32(24)to15 is still broken
nick
parents:
2718
diff
changeset
|
228 unsigned j,i,num_pixels=src_size/4; |
fafa73d6d80c
Fixed rgb32(24)to16 stuff, rgb32(24)to15 is still broken
nick
parents:
2718
diff
changeset
|
229 uint16_t *d = (uint16_t *)dst; |
fafa73d6d80c
Fixed rgb32(24)to16 stuff, rgb32(24)to15 is still broken
nick
parents:
2718
diff
changeset
|
230 for(i=0,j=0; j<num_pixels; i+=4,j++) |
2694 | 231 { |
232 const int b= src[i+0]; | |
233 const int g= src[i+1]; | |
234 const int r= src[i+2]; | |
235 | |
2719
fafa73d6d80c
Fixed rgb32(24)to16 stuff, rgb32(24)to15 is still broken
nick
parents:
2718
diff
changeset
|
236 d[j]= (b>>3) | ((g&0xFC)<<3) | ((r&0xF8)<<8); |
2694 | 237 } |
238 } | |
239 | |
2718 | 240 void rgb32to15(const uint8_t *src, uint8_t *dst, unsigned src_size) |
2694 | 241 { |
2719
fafa73d6d80c
Fixed rgb32(24)to16 stuff, rgb32(24)to15 is still broken
nick
parents:
2718
diff
changeset
|
242 unsigned j,i,num_pixels=src_size/4; |
fafa73d6d80c
Fixed rgb32(24)to16 stuff, rgb32(24)to15 is still broken
nick
parents:
2718
diff
changeset
|
243 uint16_t *d = (uint16_t *)dst; |
fafa73d6d80c
Fixed rgb32(24)to16 stuff, rgb32(24)to15 is still broken
nick
parents:
2718
diff
changeset
|
244 for(i=0,j=0; j<num_pixels; i+=4,j++) |
2694 | 245 { |
246 const int b= src[i+0]; | |
247 const int g= src[i+1]; | |
248 const int r= src[i+2]; | |
249 | |
2720 | 250 d[j]= (b>>3) | ((g&0xF8)<<2) | ((r&0xF8)<<7); |
2694 | 251 } |
252 } | |
253 | |
2718 | 254 void rgb24to16(const uint8_t *src, uint8_t *dst, unsigned src_size) |
255 { | |
2719
fafa73d6d80c
Fixed rgb32(24)to16 stuff, rgb32(24)to15 is still broken
nick
parents:
2718
diff
changeset
|
256 unsigned j,i,num_pixels=src_size/3; |
fafa73d6d80c
Fixed rgb32(24)to16 stuff, rgb32(24)to15 is still broken
nick
parents:
2718
diff
changeset
|
257 uint16_t *d = (uint16_t *)dst; |
2738 | 258 #if 0/*def HAVE_MMX*/ |
259 unsigned mm_npix; | |
260 const uint64_t mm_fc = 0xFCFCFCFCFCFCFCFCULL, mm_f8 = 0xF8F8F8F8F8F8F8F8ULL; | |
261 mm_npix = ((num_pixels)/(MMREG_SIZE*2))*(MMREG_SIZE*2); | |
262 num_pixels -= mm_npix; | |
263 __asm __volatile(PREFETCH" %0"::"m"(*src):"memory"); | |
264 __asm __volatile( | |
265 "movq %0, %%mm7\n\t" | |
266 "movq %1, %%mm6\n\t" | |
267 ::"m"(mm_fc),"m"(mm_f8)); | |
268 | |
269 for(j=0,i=0;j<mm_npix;j+=4,i+=12) | |
270 { | |
271 __asm __volatile( | |
272 PREFETCH" 32%1\n\t" | |
273 "movd %1, %%mm0\n\t" | |
274 "punpckldq 3%1, %%mm0\n\t" | |
275 "movd 6%1, %%mm3\n\t" | |
276 "punpckldq 9%1, %%mm3\n\t" | |
277 "movq %%mm0, %%mm1\n\t" | |
278 "movq %%mm0, %%mm2\n\t" | |
279 "movq %%mm3, %%mm4\n\t" | |
280 "movq %%mm3, %%mm5\n\t" | |
281 "psrlq $3, %%mm0\n\t" | |
282 "psrlq $3, %%mm3\n\t" | |
283 "pand %%mm7, %%mm1\n\t" | |
284 "pand %%mm7, %%mm4\n\t" | |
285 "psllq $3, %%mm1\n\t" | |
286 "psllq $3, %%mm4\n\t" | |
287 "pand %%mm6, %%mm2\n\t" | |
288 "pand %%mm6, %%mm5\n\t" | |
289 "psllq $8, %%mm2\n\t" | |
290 "psllq $8, %%mm5\n\t" | |
291 "por %%mm1, %%mm0\n\t" | |
292 "por %%mm2, %%mm0\n\t" | |
293 "por %%mm4, %%mm3\n\t" | |
294 "por %%mm5, %%mm3\n\t" | |
295 "punpcklwd %%mm3, %%mm0\n\t" | |
296 MOVNTQ" %%mm0, %0\n\t" | |
297 :"=m"(d[j]):"m"(src[i]):"memory"); | |
298 } | |
299 #endif | |
2719
fafa73d6d80c
Fixed rgb32(24)to16 stuff, rgb32(24)to15 is still broken
nick
parents:
2718
diff
changeset
|
300 for(i=0,j=0; j<num_pixels; i+=3,j++) |
2718 | 301 { |
302 const int b= src[i+0]; | |
303 const int g= src[i+1]; | |
304 const int r= src[i+2]; | |
305 | |
2719
fafa73d6d80c
Fixed rgb32(24)to16 stuff, rgb32(24)to15 is still broken
nick
parents:
2718
diff
changeset
|
306 d[j]= (b>>3) | ((g&0xFC)<<3) | ((r&0xF8)<<8); |
2718 | 307 } |
308 } | |
309 | |
310 void rgb24to15(const uint8_t *src, uint8_t *dst, unsigned src_size) | |
311 { | |
2719
fafa73d6d80c
Fixed rgb32(24)to16 stuff, rgb32(24)to15 is still broken
nick
parents:
2718
diff
changeset
|
312 unsigned j,i,num_pixels=src_size/3; |
fafa73d6d80c
Fixed rgb32(24)to16 stuff, rgb32(24)to15 is still broken
nick
parents:
2718
diff
changeset
|
313 uint16_t *d = (uint16_t *)dst; |
fafa73d6d80c
Fixed rgb32(24)to16 stuff, rgb32(24)to15 is still broken
nick
parents:
2718
diff
changeset
|
314 for(i=0,j=0; j<num_pixels; i+=3,j++) |
2718 | 315 { |
316 const int b= src[i+0]; | |
317 const int g= src[i+1]; | |
318 const int r= src[i+2]; | |
319 | |
2720 | 320 d[j]= (b>>3) | ((g&0xF8)<<2) | ((r&0xF8)<<7); |
2718 | 321 } |
322 } | |
2694 | 323 |
324 /** | |
325 * Palette is assumed to contain bgr16, see rgb32to16 to convert the palette | |
326 */ | |
2718 | 327 void palette8torgb16(const uint8_t *src, uint8_t *dst, unsigned num_pixels, const uint8_t *palette) |
2694 | 328 { |
2718 | 329 unsigned i; |
2702 | 330 for(i=0; i<num_pixels; i++) |
2694 | 331 ((uint16_t *)dst)[i] = ((uint16_t *)palette)[ src[i] ]; |
332 } | |
333 | |
334 /** | |
335 * Pallete is assumed to contain bgr15, see rgb32to15 to convert the palette | |
336 */ | |
2718 | 337 void palette8torgb15(const uint8_t *src, uint8_t *dst, unsigned num_pixels, const uint8_t *palette) |
2694 | 338 { |
2718 | 339 unsigned i; |
2702 | 340 for(i=0; i<num_pixels; i++) |
2694 | 341 ((uint16_t *)dst)[i] = ((uint16_t *)palette)[ src[i] ]; |
2697 | 342 } |
2702 | 343 /** |
344 * | |
2724 | 345 * height should be a multiple of 2 and width should be a multiple of 16 (if this is a |
346 * problem for anyone then tell me, and ill fix it) | |
2702 | 347 */ |
2723 | 348 void yv12toyuy2(const uint8_t *ysrc, const uint8_t *usrc, const uint8_t *vsrc, uint8_t *dst, |
2725 | 349 unsigned int width, unsigned int height, |
350 unsigned int lumStride, unsigned int chromStride, unsigned int dstStride) | |
2701 | 351 { |
2723 | 352 int y; |
353 const int chromWidth= width>>1; | |
354 for(y=0; y<height; y++) | |
355 { | |
2702 | 356 #ifdef HAVE_MMX |
2723 | 357 //FIXME handle 2 lines a once (fewer prefetch, reuse some chrom, but very likely limited by mem anyway) |
358 asm volatile( | |
359 "xorl %%eax, %%eax \n\t" | |
360 "1: \n\t" | |
361 PREFETCH" 32(%1, %%eax, 2) \n\t" | |
362 PREFETCH" 32(%2, %%eax) \n\t" | |
363 PREFETCH" 32(%3, %%eax) \n\t" | |
364 "movq (%2, %%eax), %%mm0 \n\t" // U(0) | |
365 "movq %%mm0, %%mm2 \n\t" // U(0) | |
366 "movq (%3, %%eax), %%mm1 \n\t" // V(0) | |
367 "punpcklbw %%mm1, %%mm0 \n\t" // UVUV UVUV(0) | |
368 "punpckhbw %%mm1, %%mm2 \n\t" // UVUV UVUV(8) | |
369 | |
370 "movq (%1, %%eax,2), %%mm3 \n\t" // Y(0) | |
371 "movq 8(%1, %%eax,2), %%mm5 \n\t" // Y(8) | |
372 "movq %%mm3, %%mm4 \n\t" // Y(0) | |
373 "movq %%mm5, %%mm6 \n\t" // Y(8) | |
374 "punpcklbw %%mm0, %%mm3 \n\t" // YUYV YUYV(0) | |
375 "punpckhbw %%mm0, %%mm4 \n\t" // YUYV YUYV(4) | |
376 "punpcklbw %%mm2, %%mm5 \n\t" // YUYV YUYV(8) | |
377 "punpckhbw %%mm2, %%mm6 \n\t" // YUYV YUYV(12) | |
2702 | 378 |
2723 | 379 MOVNTQ" %%mm3, (%0, %%eax, 4) \n\t" |
380 MOVNTQ" %%mm4, 8(%0, %%eax, 4) \n\t" | |
381 MOVNTQ" %%mm5, 16(%0, %%eax, 4) \n\t" | |
382 MOVNTQ" %%mm6, 24(%0, %%eax, 4) \n\t" | |
2702 | 383 |
2723 | 384 "addl $8, %%eax \n\t" |
385 "cmpl %4, %%eax \n\t" | |
386 " jb 1b \n\t" | |
387 ::"r"(dst), "r"(ysrc), "r"(usrc), "r"(vsrc), "r" (chromWidth) | |
388 : "%eax" | |
389 ); | |
2702 | 390 #else |
2723 | 391 int i; |
392 for(i=0; i<chromWidth; i++) | |
393 { | |
394 dst[4*i+0] = ysrc[2*i+0]; | |
395 dst[4*i+1] = usrc[i]; | |
396 dst[4*i+2] = ysrc[2*i+1]; | |
397 dst[4*i+3] = vsrc[i]; | |
398 } | |
399 #endif | |
400 if(y&1) | |
401 { | |
402 usrc += chromStride; | |
403 vsrc += chromStride; | |
404 } | |
405 ysrc += lumStride; | |
406 dst += dstStride; | |
2701 | 407 } |
2723 | 408 #ifdef HAVE_MMX |
409 asm( EMMS" \n\t" | |
410 SFENCE" \n\t" | |
411 :::"memory"); | |
2702 | 412 #endif |
2701 | 413 } |
414 | |
2724 | 415 /** |
416 * | |
417 * height should be a multiple of 2 and width should be a multiple of 16 (if this is a | |
418 * problem for anyone then tell me, and ill fix it) | |
419 */ | |
420 void yuy2toyv12(const uint8_t *src, uint8_t *ydst, uint8_t *udst, uint8_t *vdst, | |
2725 | 421 unsigned int width, unsigned int height, |
422 unsigned int lumStride, unsigned int chromStride, unsigned int srcStride) | |
2701 | 423 { |
2724 | 424 int y; |
425 const int chromWidth= width>>1; | |
426 for(y=0; y<height; y+=2) | |
427 { | |
2704 | 428 #ifdef HAVE_MMX |
2724 | 429 asm volatile( |
430 "xorl %%eax, %%eax \n\t" | |
431 "pcmpeqw %%mm7, %%mm7 \n\t" | |
432 "psrlw $8, %%mm7 \n\t" // FF,00,FF,00... | |
433 "1: \n\t" | |
434 PREFETCH" 64(%0, %%eax, 4) \n\t" | |
435 "movq (%0, %%eax, 4), %%mm0 \n\t" // YUYV YUYV(0) | |
436 "movq 8(%0, %%eax, 4), %%mm1 \n\t" // YUYV YUYV(4) | |
437 "movq %%mm0, %%mm2 \n\t" // YUYV YUYV(0) | |
438 "movq %%mm1, %%mm3 \n\t" // YUYV YUYV(4) | |
439 "psrlw $8, %%mm0 \n\t" // U0V0 U0V0(0) | |
440 "psrlw $8, %%mm1 \n\t" // U0V0 U0V0(4) | |
441 "pand %%mm7, %%mm2 \n\t" // Y0Y0 Y0Y0(0) | |
442 "pand %%mm7, %%mm3 \n\t" // Y0Y0 Y0Y0(4) | |
443 "packuswb %%mm1, %%mm0 \n\t" // UVUV UVUV(0) | |
444 "packuswb %%mm3, %%mm2 \n\t" // YYYY YYYY(0) | |
445 | |
446 MOVNTQ" %%mm2, (%1, %%eax, 2) \n\t" | |
2704 | 447 |
2724 | 448 "movq 16(%0, %%eax, 4), %%mm1 \n\t" // YUYV YUYV(8) |
449 "movq 24(%0, %%eax, 4), %%mm2 \n\t" // YUYV YUYV(12) | |
450 "movq %%mm1, %%mm3 \n\t" // YUYV YUYV(8) | |
451 "movq %%mm2, %%mm4 \n\t" // YUYV YUYV(12) | |
452 "psrlw $8, %%mm1 \n\t" // U0V0 U0V0(8) | |
453 "psrlw $8, %%mm2 \n\t" // U0V0 U0V0(12) | |
454 "pand %%mm7, %%mm3 \n\t" // Y0Y0 Y0Y0(8) | |
455 "pand %%mm7, %%mm4 \n\t" // Y0Y0 Y0Y0(12) | |
456 "packuswb %%mm2, %%mm1 \n\t" // UVUV UVUV(8) | |
457 "packuswb %%mm4, %%mm3 \n\t" // YYYY YYYY(8) | |
2704 | 458 |
2724 | 459 MOVNTQ" %%mm3, 8(%1, %%eax, 2) \n\t" |
460 | |
461 "movq %%mm0, %%mm2 \n\t" // UVUV UVUV(0) | |
462 "movq %%mm1, %%mm3 \n\t" // UVUV UVUV(8) | |
463 "psrlw $8, %%mm0 \n\t" // V0V0 V0V0(0) | |
464 "psrlw $8, %%mm1 \n\t" // V0V0 V0V0(8) | |
465 "pand %%mm7, %%mm2 \n\t" // U0U0 U0U0(0) | |
466 "pand %%mm7, %%mm3 \n\t" // U0U0 U0U0(8) | |
467 "packuswb %%mm1, %%mm0 \n\t" // VVVV VVVV(0) | |
468 "packuswb %%mm3, %%mm2 \n\t" // UUUU UUUU(0) | |
2704 | 469 |
2724 | 470 MOVNTQ" %%mm0, (%3, %%eax) \n\t" |
471 MOVNTQ" %%mm2, (%2, %%eax) \n\t" | |
472 | |
473 "addl $8, %%eax \n\t" | |
474 "cmpl %4, %%eax \n\t" | |
475 " jb 1b \n\t" | |
2725 | 476 ::"r"(src), "r"(ydst), "r"(udst), "r"(vdst), "r" (chromWidth) |
477 : "memory", "%eax" | |
478 ); | |
2704 | 479 |
2725 | 480 asm volatile( |
481 "xorl %%eax, %%eax \n\t" | |
2724 | 482 "1: \n\t" |
483 PREFETCH" 64(%0, %%eax, 4) \n\t" | |
484 "movq (%0, %%eax, 4), %%mm0 \n\t" // YUYV YUYV(0) | |
485 "movq 8(%0, %%eax, 4), %%mm1 \n\t" // YUYV YUYV(4) | |
486 "movq 16(%0, %%eax, 4), %%mm2 \n\t" // YUYV YUYV(8) | |
487 "movq 24(%0, %%eax, 4), %%mm3 \n\t" // YUYV YUYV(12) | |
488 "pand %%mm7, %%mm0 \n\t" // Y0Y0 Y0Y0(0) | |
489 "pand %%mm7, %%mm1 \n\t" // Y0Y0 Y0Y0(4) | |
490 "pand %%mm7, %%mm2 \n\t" // Y0Y0 Y0Y0(8) | |
491 "pand %%mm7, %%mm3 \n\t" // Y0Y0 Y0Y0(12) | |
492 "packuswb %%mm1, %%mm0 \n\t" // YYYY YYYY(0) | |
493 "packuswb %%mm3, %%mm2 \n\t" // YYYY YYYY(8) | |
2704 | 494 |
2724 | 495 MOVNTQ" %%mm0, (%1, %%eax, 2) \n\t" |
496 MOVNTQ" %%mm2, 8(%1, %%eax, 2) \n\t" | |
497 | |
498 "addl $8, %%eax \n\t" | |
2725 | 499 "cmpl %4, %%eax \n\t" |
2724 | 500 " jb 1b \n\t" |
2704 | 501 |
2725 | 502 ::"r"(src+srcStride), "r"(ydst+lumStride), "r"(udst), "r"(vdst), "r" (chromWidth) |
2724 | 503 : "memory", "%eax" |
504 ); | |
2704 | 505 #else |
2724 | 506 int i; |
507 for(i=0; i<chromWidth; i++) | |
508 { | |
509 ydst[2*i+0] = src[4*i+0]; | |
510 udst[i] = src[4*i+1]; | |
511 ydst[2*i+1] = src[4*i+2]; | |
512 vdst[i] = src[4*i+3]; | |
513 } | |
514 ydst += lumStride; | |
515 src += srcStride; | |
516 | |
517 for(i=0; i<chromWidth; i++) | |
518 { | |
519 ydst[2*i+0] = src[4*i+0]; | |
520 ydst[2*i+1] = src[4*i+2]; | |
521 } | |
522 #endif | |
523 udst += chromStride; | |
524 vdst += chromStride; | |
525 ydst += lumStride; | |
526 src += srcStride; | |
2701 | 527 } |
2724 | 528 #ifdef HAVE_MMX |
529 asm( EMMS" \n\t" | |
530 SFENCE" \n\t" | |
531 :::"memory"); | |
2704 | 532 #endif |
2723 | 533 } |