Commit | Line | Data |
---|---|---|
fcfbc150 | 1 | /* |
a3aece93 | 2 | * rgb2rgb.c, Software RGB to RGB convertor |
6611aa83 NK |
3 | * pluralize by Software PAL8 to RGB convertor |
4 | * Software YUV to YUV convertor | |
5 | * Software YUV to RGB convertor | |
a3aece93 | 6 | * Written by Nick Kurshev. |
4fadc2b4 DB |
7 | * palette & YUV & runtime CPU stuff by Michael (michaelni@gmx.at) |
8 | * | |
d026b45e DB |
9 | * This file is part of FFmpeg. |
10 | * | |
11 | * FFmpeg is free software; you can redistribute it and/or modify | |
4fadc2b4 DB |
12 | * it under the terms of the GNU General Public License as published by |
13 | * the Free Software Foundation; either version 2 of the License, or | |
14 | * (at your option) any later version. | |
15 | * | |
d026b45e | 16 | * FFmpeg is distributed in the hope that it will be useful, |
4fadc2b4 DB |
17 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
18 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
19 | * GNU General Public License for more details. | |
20 | * | |
21 | * You should have received a copy of the GNU General Public License | |
d026b45e | 22 | * along with FFmpeg; if not, write to the Free Software |
b19bcbaa | 23 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA |
6a4970ab | 24 | * |
807e0c66 LA |
25 | * the C code (not assembly, mmx, ...) of this file can be used |
26 | * under the LGPL license too | |
a3aece93 | 27 | */ |
b234ae81 | 28 | #include <inttypes.h> |
b2d374c9 | 29 | #include "config.h" |
b234ae81 | 30 | #include "rgb2rgb.h" |
700490a4 | 31 | #include "swscale.h" |
94c4def2 LA |
32 | #include "swscale_internal.h" |
33 | #include "x86_cpu.h" | |
b2d374c9 | 34 | #include "bswap.h" |
a3aece93 | 35 | |
21316f3c MN |
36 | #define FAST_BGR2YV12 // use 7 bit coeffs instead of 15bit |
37 | ||
30c48a0a BF |
38 | void (*rgb24to32)(const uint8_t *src, uint8_t *dst, long src_size); |
39 | void (*rgb24to16)(const uint8_t *src, uint8_t *dst, long src_size); | |
40 | void (*rgb24to15)(const uint8_t *src, uint8_t *dst, long src_size); | |
41 | void (*rgb32to24)(const uint8_t *src, uint8_t *dst, long src_size); | |
42 | void (*rgb32to16)(const uint8_t *src, uint8_t *dst, long src_size); | |
43 | void (*rgb32to15)(const uint8_t *src, uint8_t *dst, long src_size); | |
44 | void (*rgb15to16)(const uint8_t *src, uint8_t *dst, long src_size); | |
45 | void (*rgb15to24)(const uint8_t *src, uint8_t *dst, long src_size); | |
46 | void (*rgb15to32)(const uint8_t *src, uint8_t *dst, long src_size); | |
47 | void (*rgb16to15)(const uint8_t *src, uint8_t *dst, long src_size); | |
48 | void (*rgb16to24)(const uint8_t *src, uint8_t *dst, long src_size); | |
49 | void (*rgb16to32)(const uint8_t *src, uint8_t *dst, long src_size); | |
7f526efd RD |
50 | //void (*rgb24tobgr32)(const uint8_t *src, uint8_t *dst, long src_size); |
51 | void (*rgb24tobgr24)(const uint8_t *src, uint8_t *dst, long src_size); | |
52 | void (*rgb24tobgr16)(const uint8_t *src, uint8_t *dst, long src_size); | |
53 | void (*rgb24tobgr15)(const uint8_t *src, uint8_t *dst, long src_size); | |
54 | void (*rgb32tobgr32)(const uint8_t *src, uint8_t *dst, long src_size); | |
55 | //void (*rgb32tobgr24)(const uint8_t *src, uint8_t *dst, long src_size); | |
56 | void (*rgb32tobgr16)(const uint8_t *src, uint8_t *dst, long src_size); | |
57 | void (*rgb32tobgr15)(const uint8_t *src, uint8_t *dst, long src_size); | |
700490a4 MN |
58 | |
59 | void (*yv12toyuy2)(const uint8_t *ysrc, const uint8_t *usrc, const uint8_t *vsrc, uint8_t *dst, | |
6e42e6c4 DB |
60 | long width, long height, |
61 | long lumStride, long chromStride, long dstStride); | |
caeaabe7 | 62 | void (*yv12touyvy)(const uint8_t *ysrc, const uint8_t *usrc, const uint8_t *vsrc, uint8_t *dst, |
6e42e6c4 DB |
63 | long width, long height, |
64 | long lumStride, long chromStride, long dstStride); | |
700490a4 | 65 | void (*yuv422ptoyuy2)(const uint8_t *ysrc, const uint8_t *usrc, const uint8_t *vsrc, uint8_t *dst, |
6e42e6c4 DB |
66 | long width, long height, |
67 | long lumStride, long chromStride, long dstStride); | |
700490a4 | 68 | void (*yuy2toyv12)(const uint8_t *src, uint8_t *ydst, uint8_t *udst, uint8_t *vdst, |
6e42e6c4 DB |
69 | long width, long height, |
70 | long lumStride, long chromStride, long srcStride); | |
700490a4 | 71 | void (*rgb24toyv12)(const uint8_t *src, uint8_t *ydst, uint8_t *udst, uint8_t *vdst, |
6e42e6c4 DB |
72 | long width, long height, |
73 | long lumStride, long chromStride, long srcStride); | |
7f526efd | 74 | void (*planar2x)(const uint8_t *src, uint8_t *dst, long width, long height, |
6e42e6c4 | 75 | long srcStride, long dstStride); |
700490a4 | 76 | void (*interleaveBytes)(uint8_t *src1, uint8_t *src2, uint8_t *dst, |
6e42e6c4 DB |
77 | long width, long height, long src1Stride, |
78 | long src2Stride, long dstStride); | |
700490a4 | 79 | void (*vu9_to_vu12)(const uint8_t *src1, const uint8_t *src2, |
6e42e6c4 DB |
80 | uint8_t *dst1, uint8_t *dst2, |
81 | long width, long height, | |
82 | long srcStride1, long srcStride2, | |
83 | long dstStride1, long dstStride2); | |
700490a4 | 84 | void (*yvu9_to_yuy2)(const uint8_t *src1, const uint8_t *src2, const uint8_t *src3, |
6e42e6c4 DB |
85 | uint8_t *dst, |
86 | long width, long height, | |
87 | long srcStride1, long srcStride2, | |
88 | long srcStride3, long dstStride); | |
700490a4 | 89 | |
9bde778e | 90 | #if defined(ARCH_X86) && defined(CONFIG_GPL) |
6e42e6c4 DB |
91 | static const uint64_t mmx_null __attribute__((aligned(8))) = 0x0000000000000000ULL; |
92 | static const uint64_t mmx_one __attribute__((aligned(8))) = 0xFFFFFFFFFFFFFFFFULL; | |
93 | static const uint64_t mask32b attribute_used __attribute__((aligned(8))) = 0x000000FF000000FFULL; | |
94 | static const uint64_t mask32g attribute_used __attribute__((aligned(8))) = 0x0000FF000000FF00ULL; | |
95 | static const uint64_t mask32r attribute_used __attribute__((aligned(8))) = 0x00FF000000FF0000ULL; | |
96 | static const uint64_t mask32 __attribute__((aligned(8))) = 0x00FFFFFF00FFFFFFULL; | |
97 | static const uint64_t mask3216br __attribute__((aligned(8))) = 0x00F800F800F800F8ULL; | |
98 | static const uint64_t mask3216g __attribute__((aligned(8))) = 0x0000FC000000FC00ULL; | |
99 | static const uint64_t mask3215g __attribute__((aligned(8))) = 0x0000F8000000F800ULL; | |
100 | static const uint64_t mul3216 __attribute__((aligned(8))) = 0x2000000420000004ULL; | |
101 | static const uint64_t mul3215 __attribute__((aligned(8))) = 0x2000000820000008ULL; | |
102 | static const uint64_t mask24b attribute_used __attribute__((aligned(8))) = 0x00FF0000FF0000FFULL; | |
103 | static const uint64_t mask24g attribute_used __attribute__((aligned(8))) = 0xFF0000FF0000FF00ULL; | |
104 | static const uint64_t mask24r attribute_used __attribute__((aligned(8))) = 0x0000FF0000FF0000ULL; | |
105 | static const uint64_t mask24l __attribute__((aligned(8))) = 0x0000000000FFFFFFULL; | |
106 | static const uint64_t mask24h __attribute__((aligned(8))) = 0x0000FFFFFF000000ULL; | |
107 | static const uint64_t mask24hh __attribute__((aligned(8))) = 0xffff000000000000ULL; | |
108 | static const uint64_t mask24hhh __attribute__((aligned(8))) = 0xffffffff00000000ULL; | |
109 | static const uint64_t mask24hhhh __attribute__((aligned(8))) = 0xffffffffffff0000ULL; | |
110 | static const uint64_t mask15b __attribute__((aligned(8))) = 0x001F001F001F001FULL; /* 00000000 00011111 xxB */ | |
111 | static const uint64_t mask15rg __attribute__((aligned(8))) = 0x7FE07FE07FE07FE0ULL; /* 01111111 11100000 RGx */ | |
112 | static const uint64_t mask15s __attribute__((aligned(8))) = 0xFFE0FFE0FFE0FFE0ULL; | |
113 | static const uint64_t mask15g __attribute__((aligned(8))) = 0x03E003E003E003E0ULL; | |
114 | static const uint64_t mask15r __attribute__((aligned(8))) = 0x7C007C007C007C00ULL; | |
0d9f3d85 | 115 | #define mask16b mask15b |
6e42e6c4 DB |
116 | static const uint64_t mask16g __attribute__((aligned(8))) = 0x07E007E007E007E0ULL; |
117 | static const uint64_t mask16r __attribute__((aligned(8))) = 0xF800F800F800F800ULL; | |
118 | static const uint64_t red_16mask __attribute__((aligned(8))) = 0x0000f8000000f800ULL; | |
119 | static const uint64_t green_16mask __attribute__((aligned(8))) = 0x000007e0000007e0ULL; | |
120 | static const uint64_t blue_16mask __attribute__((aligned(8))) = 0x0000001f0000001fULL; | |
121 | static const uint64_t red_15mask __attribute__((aligned(8))) = 0x00007c0000007c00ULL; | |
122 | static const uint64_t green_15mask __attribute__((aligned(8))) = 0x000003e0000003e0ULL; | |
123 | static const uint64_t blue_15mask __attribute__((aligned(8))) = 0x0000001f0000001fULL; | |
21316f3c MN |
124 | |
125 | #ifdef FAST_BGR2YV12 | |
6e42e6c4 DB |
126 | static const uint64_t bgr2YCoeff attribute_used __attribute__((aligned(8))) = 0x000000210041000DULL; |
127 | static const uint64_t bgr2UCoeff attribute_used __attribute__((aligned(8))) = 0x0000FFEEFFDC0038ULL; | |
128 | static const uint64_t bgr2VCoeff attribute_used __attribute__((aligned(8))) = 0x00000038FFD2FFF8ULL; | |
21316f3c | 129 | #else |
6e42e6c4 DB |
130 | static const uint64_t bgr2YCoeff attribute_used __attribute__((aligned(8))) = 0x000020E540830C8BULL; |
131 | static const uint64_t bgr2UCoeff attribute_used __attribute__((aligned(8))) = 0x0000ED0FDAC23831ULL; | |
132 | static const uint64_t bgr2VCoeff attribute_used __attribute__((aligned(8))) = 0x00003831D0E6F6EAULL; | |
21316f3c | 133 | #endif |
6e42e6c4 DB |
134 | static const uint64_t bgr2YOffset attribute_used __attribute__((aligned(8))) = 0x1010101010101010ULL; |
135 | static const uint64_t bgr2UVOffset attribute_used __attribute__((aligned(8))) = 0x8080808080808080ULL; | |
136 | static const uint64_t w1111 attribute_used __attribute__((aligned(8))) = 0x0001000100010001ULL; | |
21316f3c | 137 | |
99969243 MN |
138 | #if 0 |
139 | static volatile uint64_t __attribute__((aligned(8))) b5Dither; | |
140 | static volatile uint64_t __attribute__((aligned(8))) g5Dither; | |
141 | static volatile uint64_t __attribute__((aligned(8))) g6Dither; | |
142 | static volatile uint64_t __attribute__((aligned(8))) r5Dither; | |
143 | ||
144 | static uint64_t __attribute__((aligned(8))) dither4[2]={ | |
6e42e6c4 DB |
145 | 0x0103010301030103LL, |
146 | 0x0200020002000200LL,}; | |
99969243 MN |
147 | |
148 | static uint64_t __attribute__((aligned(8))) dither8[2]={ | |
6e42e6c4 DB |
149 | 0x0602060206020602LL, |
150 | 0x0004000400040004LL,}; | |
99969243 | 151 | #endif |
3d6a30d9 | 152 | #endif /* defined(ARCH_X86) */ |
79811694 | 153 | |
1de97d84 MN |
154 | #define RGB2YUV_SHIFT 8 |
155 | #define BY ((int)( 0.098*(1<<RGB2YUV_SHIFT)+0.5)) | |
156 | #define BV ((int)(-0.071*(1<<RGB2YUV_SHIFT)+0.5)) | |
157 | #define BU ((int)( 0.439*(1<<RGB2YUV_SHIFT)+0.5)) | |
158 | #define GY ((int)( 0.504*(1<<RGB2YUV_SHIFT)+0.5)) | |
159 | #define GV ((int)(-0.368*(1<<RGB2YUV_SHIFT)+0.5)) | |
160 | #define GU ((int)(-0.291*(1<<RGB2YUV_SHIFT)+0.5)) | |
161 | #define RY ((int)( 0.257*(1<<RGB2YUV_SHIFT)+0.5)) | |
162 | #define RV ((int)( 0.439*(1<<RGB2YUV_SHIFT)+0.5)) | |
163 | #define RU ((int)(-0.148*(1<<RGB2YUV_SHIFT)+0.5)) | |
164 | ||
165 | //Note: we have C, MMX, MMX2, 3DNOW version therse no 3DNOW+MMX2 one | |
166 | //Plain C versions | |
167 | #undef HAVE_MMX | |
168 | #undef HAVE_MMX2 | |
169 | #undef HAVE_3DNOW | |
52075cde | 170 | #undef HAVE_SSE2 |
1de97d84 MN |
171 | #define RENAME(a) a ## _C |
172 | #include "rgb2rgb_template.c" | |
173 | ||
9bde778e | 174 | #if defined(ARCH_X86) && defined(CONFIG_GPL) |
1de97d84 MN |
175 | |
176 | //MMX versions | |
177 | #undef RENAME | |
178 | #define HAVE_MMX | |
179 | #undef HAVE_MMX2 | |
180 | #undef HAVE_3DNOW | |
52075cde | 181 | #undef HAVE_SSE2 |
1de97d84 MN |
182 | #define RENAME(a) a ## _MMX |
183 | #include "rgb2rgb_template.c" | |
184 | ||
185 | //MMX2 versions | |
186 | #undef RENAME | |
187 | #define HAVE_MMX | |
188 | #define HAVE_MMX2 | |
189 | #undef HAVE_3DNOW | |
52075cde | 190 | #undef HAVE_SSE2 |
1de97d84 MN |
191 | #define RENAME(a) a ## _MMX2 |
192 | #include "rgb2rgb_template.c" | |
193 | ||
194 | //3DNOW versions | |
195 | #undef RENAME | |
196 | #define HAVE_MMX | |
197 | #undef HAVE_MMX2 | |
198 | #define HAVE_3DNOW | |
52075cde | 199 | #undef HAVE_SSE2 |
abdcd337 | 200 | #define RENAME(a) a ## _3DNOW |
1de97d84 MN |
201 | #include "rgb2rgb_template.c" |
202 | ||
6e1c66bc | 203 | #endif //ARCH_X86 || ARCH_X86_64 |
b238eb2e | 204 | |
a3aece93 | 205 | /* |
700490a4 | 206 | rgb15->rgb16 Original by Strepto/Astral |
a3aece93 | 207 | ported to gcc & bugfixed : A'rpi |
51da31f1 | 208 | MMX2, 3DNOW optimization by Nick Kurshev |
9b2c28e6 | 209 | 32bit c version, and and&add trick by Michael Niedermayer |
a3aece93 | 210 | */ |
fcfbc150 | 211 | |
700490a4 | 212 | void sws_rgb2rgb_init(int flags){ |
9bde778e | 213 | #if (defined(HAVE_MMX2) || defined(HAVE_3DNOW) || defined(HAVE_MMX)) && defined(CONFIG_GPL) |
6e42e6c4 DB |
214 | if (flags & SWS_CPU_CAPS_MMX2) |
215 | rgb2rgb_init_MMX2(); | |
216 | else if (flags & SWS_CPU_CAPS_3DNOW) | |
217 | rgb2rgb_init_3DNOW(); | |
218 | else if (flags & SWS_CPU_CAPS_MMX) | |
219 | rgb2rgb_init_MMX(); | |
220 | else | |
dbdae6ec | 221 | #endif /* defined(HAVE_MMX2) || defined(HAVE_3DNOW) || defined(HAVE_MMX) */ |
6e42e6c4 | 222 | rgb2rgb_init_C(); |
ac4d0aea | 223 | } |
700490a4 | 224 | |
fcfbc150 | 225 | /** |
10ef990d | 226 | * Palette is assumed to contain BGR32. |
fcfbc150 | 227 | */ |
7f526efd | 228 | void palette8torgb32(const uint8_t *src, uint8_t *dst, long num_pixels, const uint8_t *palette) |
fcfbc150 | 229 | { |
6e42e6c4 | 230 | long i; |
9780c7ff AB |
231 | |
232 | /* | |
6e42e6c4 | 233 | for (i=0; i<num_pixels; i++) |
30c48a0a | 234 | ((unsigned *)dst)[i] = ((unsigned *)palette)[src[i]]; |
9780c7ff | 235 | */ |
fcfbc150 | 236 | |
6e42e6c4 DB |
237 | for (i=0; i<num_pixels; i++) |
238 | { | |
239 | #ifdef WORDS_BIGENDIAN | |
30c48a0a BF |
240 | dst[3]= palette[src[i]*4+2]; |
241 | dst[2]= palette[src[i]*4+1]; | |
242 | dst[1]= palette[src[i]*4+0]; | |
6e42e6c4 DB |
243 | #else |
244 | //FIXME slow? | |
30c48a0a BF |
245 | dst[0]= palette[src[i]*4+2]; |
246 | dst[1]= palette[src[i]*4+1]; | |
247 | dst[2]= palette[src[i]*4+0]; | |
6e42e6c4 DB |
248 | //dst[3]= 0; /* do we need this cleansing? */ |
249 | #endif | |
250 | dst+= 4; | |
251 | } | |
6c1baeb0 | 252 | } |
9780c7ff | 253 | |
7f526efd | 254 | void palette8tobgr32(const uint8_t *src, uint8_t *dst, long num_pixels, const uint8_t *palette) |
6c1baeb0 | 255 | { |
6e42e6c4 DB |
256 | long i; |
257 | for (i=0; i<num_pixels; i++) | |
258 | { | |
259 | #ifdef WORDS_BIGENDIAN | |
30c48a0a BF |
260 | dst[3]= palette[src[i]*4+0]; |
261 | dst[2]= palette[src[i]*4+1]; | |
262 | dst[1]= palette[src[i]*4+2]; | |
6e42e6c4 DB |
263 | #else |
264 | //FIXME slow? | |
30c48a0a BF |
265 | dst[0]= palette[src[i]*4+0]; |
266 | dst[1]= palette[src[i]*4+1]; | |
267 | dst[2]= palette[src[i]*4+2]; | |
6e42e6c4 DB |
268 | //dst[3]= 0; /* do we need this cleansing? */ |
269 | #endif | |
270 | ||
271 | dst+= 4; | |
272 | } | |
6c1baeb0 | 273 | } |
6c1baeb0 | 274 | |
9ce6584e | 275 | /** |
10ef990d | 276 | * Palette is assumed to contain BGR32. |
9ce6584e | 277 | */ |
7f526efd | 278 | void palette8torgb24(const uint8_t *src, uint8_t *dst, long num_pixels, const uint8_t *palette) |
9ce6584e | 279 | { |
6e42e6c4 | 280 | long i; |
9ce6584e | 281 | /* |
6e42e6c4 DB |
282 | writes 1 byte o much and might cause alignment issues on some architectures? |
283 | for (i=0; i<num_pixels; i++) | |
30c48a0a | 284 | ((unsigned *)(&dst[i*3])) = ((unsigned *)palette)[src[i]]; |
9ce6584e | 285 | */ |
6e42e6c4 DB |
286 | for (i=0; i<num_pixels; i++) |
287 | { | |
288 | //FIXME slow? | |
30c48a0a BF |
289 | dst[0]= palette[src[i]*4+2]; |
290 | dst[1]= palette[src[i]*4+1]; | |
291 | dst[2]= palette[src[i]*4+0]; | |
6e42e6c4 DB |
292 | dst+= 3; |
293 | } | |
9ce6584e MN |
294 | } |
295 | ||
7f526efd | 296 | void palette8tobgr24(const uint8_t *src, uint8_t *dst, long num_pixels, const uint8_t *palette) |
6c1baeb0 | 297 | { |
6e42e6c4 | 298 | long i; |
6c1baeb0 | 299 | /* |
6e42e6c4 DB |
300 | writes 1 byte o much and might cause alignment issues on some architectures? |
301 | for (i=0; i<num_pixels; i++) | |
30c48a0a | 302 | ((unsigned *)(&dst[i*3])) = ((unsigned *)palette)[src[i]]; |
6c1baeb0 | 303 | */ |
6e42e6c4 DB |
304 | for (i=0; i<num_pixels; i++) |
305 | { | |
306 | //FIXME slow? | |
30c48a0a BF |
307 | dst[0]= palette[src[i]*4+0]; |
308 | dst[1]= palette[src[i]*4+1]; | |
309 | dst[2]= palette[src[i]*4+2]; | |
6e42e6c4 DB |
310 | dst+= 3; |
311 | } | |
6c1baeb0 AB |
312 | } |
313 | ||
fcfbc150 MN |
314 | /** |
315 | * Palette is assumed to contain bgr16, see rgb32to16 to convert the palette | |
316 | */ | |
7f526efd | 317 | void palette8torgb16(const uint8_t *src, uint8_t *dst, long num_pixels, const uint8_t *palette) |
fcfbc150 | 318 | { |
6e42e6c4 DB |
319 | long i; |
320 | for (i=0; i<num_pixels; i++) | |
30c48a0a | 321 | ((uint16_t *)dst)[i] = ((uint16_t *)palette)[src[i]]; |
fcfbc150 | 322 | } |
7f526efd | 323 | void palette8tobgr16(const uint8_t *src, uint8_t *dst, long num_pixels, const uint8_t *palette) |
6c1baeb0 | 324 | { |
6e42e6c4 DB |
325 | long i; |
326 | for (i=0; i<num_pixels; i++) | |
30c48a0a | 327 | ((uint16_t *)dst)[i] = bswap_16(((uint16_t *)palette)[src[i]]); |
6c1baeb0 | 328 | } |
fcfbc150 MN |
329 | |
330 | /** | |
10ef990d | 331 | * Palette is assumed to contain BGR15, see rgb32to15 to convert the palette. |
fcfbc150 | 332 | */ |
7f526efd | 333 | void palette8torgb15(const uint8_t *src, uint8_t *dst, long num_pixels, const uint8_t *palette) |
fcfbc150 | 334 | { |
6e42e6c4 DB |
335 | long i; |
336 | for (i=0; i<num_pixels; i++) | |
30c48a0a | 337 | ((uint16_t *)dst)[i] = ((uint16_t *)palette)[src[i]]; |
9ce6584e | 338 | } |
7f526efd | 339 | void palette8tobgr15(const uint8_t *src, uint8_t *dst, long num_pixels, const uint8_t *palette) |
6c1baeb0 | 340 | { |
6e42e6c4 DB |
341 | long i; |
342 | for (i=0; i<num_pixels; i++) | |
30c48a0a | 343 | ((uint16_t *)dst)[i] = bswap_16(((uint16_t *)palette)[src[i]]); |
6c1baeb0 | 344 | } |
99969243 | 345 | |
7f526efd | 346 | void rgb32tobgr24(const uint8_t *src, uint8_t *dst, long src_size) |
ac4d0aea | 347 | { |
6e42e6c4 DB |
348 | long i; |
349 | long num_pixels = src_size >> 2; | |
350 | for (i=0; i<num_pixels; i++) | |
351 | { | |
352 | #ifdef WORDS_BIGENDIAN | |
353 | /* RGB32 (= A,B,G,R) -> BGR24 (= B,G,R) */ | |
354 | dst[3*i + 0] = src[4*i + 1]; | |
355 | dst[3*i + 1] = src[4*i + 2]; | |
356 | dst[3*i + 2] = src[4*i + 3]; | |
357 | #else | |
358 | dst[3*i + 0] = src[4*i + 2]; | |
359 | dst[3*i + 1] = src[4*i + 1]; | |
360 | dst[3*i + 2] = src[4*i + 0]; | |
361 | #endif | |
362 | } | |
ac4d0aea MN |
363 | } |
364 | ||
7f526efd | 365 | void rgb24tobgr32(const uint8_t *src, uint8_t *dst, long src_size) |
ac4d0aea | 366 | { |
6e42e6c4 DB |
367 | long i; |
368 | for (i=0; 3*i<src_size; i++) | |
369 | { | |
370 | #ifdef WORDS_BIGENDIAN | |
371 | /* RGB24 (= R,G,B) -> BGR32 (= A,R,G,B) */ | |
372 | dst[4*i + 0] = 0; | |
373 | dst[4*i + 1] = src[3*i + 0]; | |
374 | dst[4*i + 2] = src[3*i + 1]; | |
375 | dst[4*i + 3] = src[3*i + 2]; | |
376 | #else | |
377 | dst[4*i + 0] = src[3*i + 2]; | |
378 | dst[4*i + 1] = src[3*i + 1]; | |
379 | dst[4*i + 2] = src[3*i + 0]; | |
380 | dst[4*i + 3] = 0; | |
381 | #endif | |
382 | } | |
ac4d0aea MN |
383 | } |
384 | ||
7f526efd | 385 | void rgb16tobgr32(const uint8_t *src, uint8_t *dst, long src_size) |
ac4d0aea | 386 | { |
6e42e6c4 DB |
387 | const uint16_t *end; |
388 | uint8_t *d = (uint8_t *)dst; | |
389 | const uint16_t *s = (uint16_t *)src; | |
390 | end = s + src_size/2; | |
391 | while (s < end) | |
392 | { | |
393 | register uint16_t bgr; | |
394 | bgr = *s++; | |
395 | #ifdef WORDS_BIGENDIAN | |
396 | *d++ = 0; | |
397 | *d++ = (bgr&0x1F)<<3; | |
398 | *d++ = (bgr&0x7E0)>>3; | |
399 | *d++ = (bgr&0xF800)>>8; | |
400 | #else | |
401 | *d++ = (bgr&0xF800)>>8; | |
402 | *d++ = (bgr&0x7E0)>>3; | |
403 | *d++ = (bgr&0x1F)<<3; | |
404 | *d++ = 0; | |
405 | #endif | |
406 | } | |
ac4d0aea MN |
407 | } |
408 | ||
7f526efd | 409 | void rgb16tobgr24(const uint8_t *src, uint8_t *dst, long src_size) |
ac4d0aea | 410 | { |
6e42e6c4 DB |
411 | const uint16_t *end; |
412 | uint8_t *d = (uint8_t *)dst; | |
413 | const uint16_t *s = (const uint16_t *)src; | |
414 | end = s + src_size/2; | |
415 | while (s < end) | |
416 | { | |
417 | register uint16_t bgr; | |
418 | bgr = *s++; | |
419 | *d++ = (bgr&0xF800)>>8; | |
420 | *d++ = (bgr&0x7E0)>>3; | |
421 | *d++ = (bgr&0x1F)<<3; | |
422 | } | |
ac4d0aea MN |
423 | } |
424 | ||
7f526efd | 425 | void rgb16tobgr16(const uint8_t *src, uint8_t *dst, long src_size) |
ac4d0aea | 426 | { |
6e42e6c4 DB |
427 | long i; |
428 | long num_pixels = src_size >> 1; | |
429 | ||
430 | for (i=0; i<num_pixels; i++) | |
431 | { | |
432 | unsigned b,g,r; | |
433 | register uint16_t rgb; | |
434 | rgb = src[2*i]; | |
435 | r = rgb&0x1F; | |
436 | g = (rgb&0x7E0)>>5; | |
437 | b = (rgb&0xF800)>>11; | |
438 | dst[2*i] = (b&0x1F) | ((g&0x3F)<<5) | ((r&0x1F)<<11); | |
439 | } | |
ac4d0aea MN |
440 | } |
441 | ||
7f526efd | 442 | void rgb16tobgr15(const uint8_t *src, uint8_t *dst, long src_size) |
ac4d0aea | 443 | { |
6e42e6c4 DB |
444 | long i; |
445 | long num_pixels = src_size >> 1; | |
446 | ||
447 | for (i=0; i<num_pixels; i++) | |
448 | { | |
449 | unsigned b,g,r; | |
450 | register uint16_t rgb; | |
451 | rgb = src[2*i]; | |
452 | r = rgb&0x1F; | |
453 | g = (rgb&0x7E0)>>5; | |
454 | b = (rgb&0xF800)>>11; | |
455 | dst[2*i] = (b&0x1F) | ((g&0x1F)<<5) | ((r&0x1F)<<10); | |
456 | } | |
ac4d0aea MN |
457 | } |
458 | ||
7f526efd | 459 | void rgb15tobgr32(const uint8_t *src, uint8_t *dst, long src_size) |
ac4d0aea | 460 | { |
6e42e6c4 DB |
461 | const uint16_t *end; |
462 | uint8_t *d = (uint8_t *)dst; | |
463 | const uint16_t *s = (const uint16_t *)src; | |
464 | end = s + src_size/2; | |
465 | while (s < end) | |
466 | { | |
467 | register uint16_t bgr; | |
468 | bgr = *s++; | |
469 | #ifdef WORDS_BIGENDIAN | |
470 | *d++ = 0; | |
471 | *d++ = (bgr&0x1F)<<3; | |
472 | *d++ = (bgr&0x3E0)>>2; | |
473 | *d++ = (bgr&0x7C00)>>7; | |
474 | #else | |
475 | *d++ = (bgr&0x7C00)>>7; | |
476 | *d++ = (bgr&0x3E0)>>2; | |
477 | *d++ = (bgr&0x1F)<<3; | |
478 | *d++ = 0; | |
479 | #endif | |
480 | } | |
ac4d0aea MN |
481 | } |
482 | ||
7f526efd | 483 | void rgb15tobgr24(const uint8_t *src, uint8_t *dst, long src_size) |
ac4d0aea | 484 | { |
6e42e6c4 DB |
485 | const uint16_t *end; |
486 | uint8_t *d = (uint8_t *)dst; | |
487 | const uint16_t *s = (uint16_t *)src; | |
488 | end = s + src_size/2; | |
489 | while (s < end) | |
490 | { | |
491 | register uint16_t bgr; | |
492 | bgr = *s++; | |
493 | *d++ = (bgr&0x7C00)>>7; | |
494 | *d++ = (bgr&0x3E0)>>2; | |
495 | *d++ = (bgr&0x1F)<<3; | |
496 | } | |
ac4d0aea MN |
497 | } |
498 | ||
7f526efd | 499 | void rgb15tobgr16(const uint8_t *src, uint8_t *dst, long src_size) |
ac4d0aea | 500 | { |
6e42e6c4 DB |
501 | long i; |
502 | long num_pixels = src_size >> 1; | |
503 | ||
504 | for (i=0; i<num_pixels; i++) | |
505 | { | |
506 | unsigned b,g,r; | |
507 | register uint16_t rgb; | |
508 | rgb = src[2*i]; | |
509 | r = rgb&0x1F; | |
510 | g = (rgb&0x3E0)>>5; | |
511 | b = (rgb&0x7C00)>>10; | |
512 | dst[2*i] = (b&0x1F) | ((g&0x3F)<<5) | ((r&0x1F)<<11); | |
513 | } | |
ac4d0aea MN |
514 | } |
515 | ||
7f526efd | 516 | void rgb15tobgr15(const uint8_t *src, uint8_t *dst, long src_size) |
ac4d0aea | 517 | { |
6e42e6c4 DB |
518 | long i; |
519 | long num_pixels = src_size >> 1; | |
520 | ||
521 | for (i=0; i<num_pixels; i++) | |
522 | { | |
523 | unsigned b,g,r; | |
524 | register uint16_t rgb; | |
525 | rgb = src[2*i]; | |
526 | r = rgb&0x1F; | |
527 | g = (rgb&0x3E0)>>5; | |
528 | b = (rgb&0x7C00)>>10; | |
529 | dst[2*i] = (b&0x1F) | ((g&0x1F)<<5) | ((r&0x1F)<<10); | |
530 | } | |
ac4d0aea MN |
531 | } |
532 | ||
7f526efd | 533 | void rgb8tobgr8(const uint8_t *src, uint8_t *dst, long src_size) |
ac4d0aea | 534 | { |
6e42e6c4 DB |
535 | long i; |
536 | long num_pixels = src_size; | |
537 | for (i=0; i<num_pixels; i++) | |
538 | { | |
539 | unsigned b,g,r; | |
540 | register uint8_t rgb; | |
541 | rgb = src[i]; | |
542 | r = (rgb&0x07); | |
543 | g = (rgb&0x38)>>3; | |
544 | b = (rgb&0xC0)>>6; | |
545 | dst[i] = ((b<<1)&0x07) | ((g&0x07)<<3) | ((r&0x03)<<6); | |
546 | } | |
ac4d0aea | 547 | } |