2 * (C) GraÅžvydas "notaz" Ignotas, 2011,2012
4 * This work is licensed under the terms of any of these licenses
6 * - GNU GPL, version 2 or later.
7 * - GNU LGPL, version 2.1 or later.
8 * See the COPYING file in the top-level directory.
14 * note: these are intended for testing and should be avoided
15 * in favor of NEON version or platform-specific conversion
18 #if __BYTE_ORDER__ == __ORDER_BIG_ENDIAN__
19 #define SWAP16(x) __builtin_bswap16(x)
20 #define LE16TOHx2(x) ((SWAP16((x) >> 16) << 16) | SWAP16(x))
22 #define LE16TOHx2(x) (x)
27 void bgr555_to_rgb565(void *dst_, const void *src_, int bytes)
29 const unsigned int *src = src_;
30 unsigned int *dst = dst_;
31 unsigned int x, p, r, g, b;
33 for (x = 0; x < bytes / 4; x++) {
34 p = LE16TOHx2(src[x]);
36 r = (p & 0x001f001f) << 11;
37 g = (p & 0x03e003e0) << 1;
38 b = (p & 0x7c007c00) >> 10;
48 void bgr888_to_rgb565(void *dst_, const void *src_, int bytes)
50 const unsigned char *src = src_;
51 unsigned int *dst = dst_;
52 unsigned int r1, g1, b1, r2, g2, b2;
54 for (; bytes >= 6; bytes -= 6, src += 6, dst++) {
61 *dst = (r2 << 24) | (g2 << 19) | (b2 << 13) |
62 (r1 << 8) | (g1 << 3) | (b1 >> 3);
70 void bgr888_to_rgb565(void *dst_, const void *src_, int bytes)
72 const unsigned char *src = src_;
73 unsigned int *dst = dst_;
74 unsigned int r1, g1, b1, r2, g2, b2;
76 for (; bytes >= 6; bytes -= 6, src += 6, dst++) {
83 #if __BYTE_ORDER__ == __ORDER_BIG_ENDIAN__
84 *dst = (r1 << 24) | (g1 << 19) | (b1 << 13) |
85 (r2 << 8) | (g2 << 3) | (b2 >> 3);
87 *dst = (r2 << 24) | (g2 << 19) | (b2 << 13) |
88 (r1 << 8) | (g1 << 3) | (b1 >> 3);
94 void rgb888_to_rgb565(void *dst, const void *src, int bytes) {}
95 void bgr888_to_rgb888(void *dst, const void *src, int bytes) {}
97 #endif // __ARM_NEON__
100 static int yuv_ry[32], yuv_gy[32], yuv_by[32];
101 static unsigned char yuv_u[32 * 2], yuv_v[32 * 2];
103 void bgr_to_uyvy_init(void)
107 /* init yuv converter:
108 y0 = (int)((0.299f * r0) + (0.587f * g0) + (0.114f * b0));
109 y1 = (int)((0.299f * r1) + (0.587f * g1) + (0.114f * b1));
110 u = (int)(8 * 0.565f * (b0 - y0)) + 128;
111 v = (int)(8 * 0.713f * (r0 - y0)) + 128;
113 for (i = 0; i < 32; i++) {
114 yuv_ry[i] = (int)(0.299f * i * 65536.0f + 0.5f);
115 yuv_gy[i] = (int)(0.587f * i * 65536.0f + 0.5f);
116 yuv_by[i] = (int)(0.114f * i * 65536.0f + 0.5f);
118 for (i = -32; i < 32; i++) {
119 v = (int)(8 * 0.565f * i) + 128;
125 v = (int)(8 * 0.713f * i) + 128;
134 void rgb565_to_uyvy(void *d, const void *s, int pixels)
136 unsigned int *dst = d;
137 const unsigned short *src = s;
138 const unsigned char *yu = yuv_u + 32;
139 const unsigned char *yv = yuv_v + 32;
140 int r0, g0, b0, r1, g1, b1;
143 for (; pixels > 0; src += 2, dst++, pixels -= 2)
145 r0 = (src[0] >> 11) & 0x1f;
146 g0 = (src[0] >> 6) & 0x1f;
148 r1 = (src[1] >> 11) & 0x1f;
149 g1 = (src[1] >> 6) & 0x1f;
151 y0 = (yuv_ry[r0] + yuv_gy[g0] + yuv_by[b0]) >> 16;
152 y1 = (yuv_ry[r1] + yuv_gy[g1] + yuv_by[b1]) >> 16;
155 // valid Y range seems to be 16..235
156 y0 = 16 + 219 * y0 / 31;
157 y1 = 16 + 219 * y1 / 31;
159 *dst = (y1 << 24) | (v << 16) | (y0 << 8) | u;
163 void bgr555_to_uyvy(void *d, const void *s, int pixels)
165 unsigned int *dst = d;
166 const unsigned short *src = s;
167 const unsigned char *yu = yuv_u + 32;
168 const unsigned char *yv = yuv_v + 32;
169 int r0, g0, b0, r1, g1, b1;
172 for (; pixels > 0; src += 2, dst++, pixels -= 2)
174 b0 = (src[0] >> 10) & 0x1f;
175 g0 = (src[0] >> 5) & 0x1f;
177 b1 = (src[1] >> 10) & 0x1f;
178 g1 = (src[1] >> 5) & 0x1f;
180 y0 = (yuv_ry[r0] + yuv_gy[g0] + yuv_by[b0]) >> 16;
181 y1 = (yuv_ry[r1] + yuv_gy[g1] + yuv_by[b1]) >> 16;
184 y0 = 16 + 219 * y0 / 31;
185 y1 = 16 + 219 * y1 / 31;
187 *dst = (y1 << 24) | (v << 16) | (y0 << 8) | u;
191 void bgr888_to_uyvy(void *d, const void *s, int pixels)
193 unsigned int *dst = d;
194 const unsigned char *src8 = s;
195 const unsigned char *yu = yuv_u + 32;
196 const unsigned char *yv = yuv_v + 32;
197 int r0, g0, b0, r1, g1, b1;
200 for (; pixels > 0; src8 += 3*2, dst++, pixels -= 2)
202 r0 = src8[0], g0 = src8[1], b0 = src8[2];
203 r1 = src8[3], g1 = src8[4], b1 = src8[5];
204 y0 = (r0 * 19595 + g0 * 38470 + b0 * 7471) >> 16;
205 y1 = (r1 * 19595 + g1 * 38470 + b1 * 7471) >> 16;
206 u = yu[(b0 - y0) / 8];
207 v = yv[(r0 - y0) / 8];
208 y0 = 16 + 219 * y0 / 255;
209 y1 = 16 + 219 * y1 / 255;
211 *dst = (y1 << 24) | (v << 16) | (y0 << 8) | u;