[PATCH] fbv: support bgr555 format
|
|
Signed-off-by: Josh.Wu <josh.wu@atmel.com>
|
diff -Naur fbv-1.0b-ori/fb_display.c fbv-1.0b/fb_display.c
|
--- fbv-1.0b-ori/fb_display.c 2010-04-02 09:38:15.000000000 +0800
|
+++ fbv-1.0b/fb_display.c 2010-04-01 18:54:15.000000000 +0800
|
@@ -297,6 +297,14 @@
|
((b >> 3) & 31) );
|
}
|
|
+inline static unsigned short make15color_bgr(unsigned char r, unsigned char g, unsigned char b)
|
+{
|
+ return (
|
+ (((b >> 3) & 31) << 10) |
|
+ (((g >> 3) & 31) << 5) |
|
+ ((r >> 3) & 31) );
|
+}
|
+
|
inline static unsigned short make16color(unsigned char r, unsigned char g, unsigned char b)
|
{
|
return (
|
@@ -313,6 +321,14 @@
|
u_int16_t *s_fbbuff;
|
u_int32_t *i_fbbuff;
|
|
+ int is_bgr555 = 0;
|
+ struct fb_var_screeninfo var;
|
+ getVarScreenInfo(fh, &var);
|
+ if(var.red.offset == 0 &&
|
+ var.green.offset == 5 &&
|
+ var.blue.offset == 10)
|
+ is_bgr555 = 1;
|
+
|
switch(bpp)
|
{
|
case 8:
|
@@ -325,15 +341,23 @@
|
case 15:
|
*cpp = 2;
|
s_fbbuff = (unsigned short *) malloc(count * sizeof(unsigned short));
|
- for(i = 0; i < count ; i++)
|
- s_fbbuff[i] = make15color(rgbbuff[i*3], rgbbuff[i*3+1], rgbbuff[i*3+2]);
|
+ if(is_bgr555)
|
+ for(i = 0; i < count ; i++)
|
+ s_fbbuff[i] = make15color_bgr(rgbbuff[i*3], rgbbuff[i*3+1], rgbbuff[i*3+2]);
|
+ else
|
+ for(i = 0; i < count ; i++)
|
+ s_fbbuff[i] = make15color(rgbbuff[i*3], rgbbuff[i*3+1], rgbbuff[i*3+2]);
|
fbbuff = (void *) s_fbbuff;
|
break;
|
case 16:
|
*cpp = 2;
|
s_fbbuff = (unsigned short *) malloc(count * sizeof(unsigned short));
|
- for(i = 0; i < count ; i++)
|
- s_fbbuff[i] = make16color(rgbbuff[i*3], rgbbuff[i*3+1], rgbbuff[i*3+2]);
|
+ if(is_bgr555)
|
+ for(i = 0; i < count ; i++)
|
+ s_fbbuff[i] = make15color_bgr(rgbbuff[i*3], rgbbuff[i*3+1], rgbbuff[i*3+2]);
|
+ else
|
+ for(i = 0; i < count ; i++)
|
+ s_fbbuff[i] = make16color(rgbbuff[i*3], rgbbuff[i*3+1], rgbbuff[i*3+2]);
|
fbbuff = (void *) s_fbbuff;
|
break;
|
case 24:
|
