[U-Boot] PATCH add rgb555 for at91

[Giulio Benetti]

Signed-off-by: giulio.benetti at micronovasrl.com

diff -urpN b/common/lcd.c a/common/lcd.c
--- b/common/lcd.c      2009-06-14 21:30:39.000000000 +0200
+++ a/common/lcd.c      2009-06-18 12:45:15.000000000 +0200
@@ -1,4 +1,4 @@
-/*
+/*OC
  * Common LCD routines for supported CPUs
  *
  * (C) Copyright 2001-2002
@@ -575,6 +575,10 @@ void bitmap_plot (int x, int y)
                        lut_entry = ((colreg & 0x000F) << 11) |
                                    ((colreg & 0x00F0) <<  2) |
                                    ((colreg & 0x0F00) >>  7);
+#elif defined (CONFIG_ATMEL_LCD_RGB555)
+                       lut_entry = ((colreg & 0x000F) << 1) |
+                                   ((colreg & 0x00F0) <<  2) |
+                                   ((colreg & 0x0F00) <<  3);
 #else /* CONFIG_ATMEL_LCD_RGB565 */
                        lut_entry = ((colreg & 0x000F) << 1) |
                                    ((colreg & 0x00F0) << 3) |
diff -urpN b/drivers/video/atmel_lcdfb.c a/drivers/video/atmel_lcdfb.c
--- b/drivers/video/atmel_lcdfb.c       2009-06-14 21:30:39.000000000 +0200
+++ a/drivers/video/atmel_lcdfb.c       2009-06-18 12:45:15.000000000 +0200
@@ -57,6 +57,9 @@ void lcd_setcolreg(ushort regno, ushort
 #if defined(CONFIG_ATMEL_LCD_BGR555)
        lcdc_writel(panel_info.mmio, ATMEL_LCDC_LUT(regno),
                    (red >> 3) | ((green & 0xf8) << 2) | ((blue & 0xf8) << 7));
+#elif defined(CONFIG_ATMEL_LCD_RGB555)
+       lcdc_writel(panel_info.mmio, ATMEL_LCDC_LUT(regno),
+                   (blue >> 3) | ((green & 0xf8) << 2) | ((red & 0xf8) << 7));
 #else
        lcdc_writel(panel_info.mmio, ATMEL_LCDC_LUT(regno),
                    (blue >> 3) | ((green & 0xfc) << 3) | ((red & 0xf8) << 8));


-- 
Giulio Benetti
R&D
Micronova srl