]> git.kernelconcepts.de Git - karo-tx-uboot.git/blobdiff - common/lcd.c
lcd: Provide an API to access LCD parameters
[karo-tx-uboot.git] / common / lcd.c
index d104b2604943df7251b3bbdab7e50e78d79f9eda..4cea04e247d4352ef52761b2ea34eb2c38ecb05c 100644 (file)
 #include <config.h>
 #include <common.h>
 #include <command.h>
-#include <version.h>
 #include <stdarg.h>
 #include <linux/types.h>
-#include <devices.h>
+#include <stdio_dev.h>
 #if defined(CONFIG_POST)
 #include <post.h>
 #endif
 #include <lcd.h>
 #include <watchdog.h>
 
-#if defined(CONFIG_PXA250)
+#if defined(CONFIG_CPU_PXA25X) || defined(CONFIG_CPU_PXA27X) || \
+       defined(CONFIG_CPU_MONAHANS)
+#define CONFIG_CPU_PXA
 #include <asm/byteorder.h>
 #endif
 
 
 #if defined(CONFIG_ATMEL_LCD)
 #include <atmel_lcdc.h>
-#include <nand.h>
 #endif
 
 /************************************************************************/
 /* ** FONT DATA                                                                */
 /************************************************************************/
 #include <video_font.h>                /* Get font data, width and height      */
+#include <video_font_data.h>
 
 /************************************************************************/
 /* ** LOGO DATA                                                                */
 /************************************************************************/
 #ifdef CONFIG_LCD_LOGO
 # include <bmp_logo.h>         /* Get logo data, width and height      */
-# if (CONSOLE_COLOR_WHITE >= BMP_LOGO_OFFSET)
+# include <bmp_logo_data.h>
+# if (CONSOLE_COLOR_WHITE >= BMP_LOGO_OFFSET) && (LCD_BPP != LCD_COLOR16)
 #  error Default Color Map overlaps with Logo Color Map
 # endif
 #endif
@@ -74,76 +76,42 @@ DECLARE_GLOBAL_DATA_PTR;
 
 ulong lcd_setmem (ulong addr);
 
-static void lcd_drawchars (ushort x, ushort y, uchar *str, int count);
-static inline void lcd_puts_xy (ushort x, ushort y, uchar *s);
-static inline void lcd_putc_xy (ushort x, ushort y, uchar  c);
+static void lcd_drawchars(ushort x, ushort y, uchar *str, int count);
+static inline void lcd_puts_xy(ushort x, ushort y, uchar *s);
+static inline void lcd_putc_xy(ushort x, ushort y, uchar  c);
 
-static int lcd_init (void *lcdbase);
+static int lcd_init(void *lcdbase);
 
-static int lcd_clear (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[]);
-extern void lcd_ctrl_init (void *lcdbase);
-extern void lcd_enable (void);
 static void *lcd_logo (void);
 
-
-#if LCD_BPP == LCD_COLOR8
-extern void lcd_setcolreg (ushort regno,
-                               ushort red, ushort green, ushort blue);
-#endif
-#if LCD_BPP == LCD_MONOCHROME
-extern void lcd_initcolregs (void);
-#endif
-
-static int lcd_getbgcolor (void);
-static void lcd_setfgcolor (int color);
-static void lcd_setbgcolor (int color);
+static int lcd_getbgcolor(void);
+static void lcd_setfgcolor(int color);
+static void lcd_setbgcolor(int color);
 
 char lcd_is_enabled = 0;
-extern vidinfo_t panel_info;
 
 #ifdef NOT_USED_SO_FAR
-static void lcd_getcolreg (ushort regno,
+static void lcd_getcolreg(ushort regno,
                                ushort *red, ushort *green, ushort *blue);
-static int lcd_getfgcolor (void);
+static int lcd_getfgcolor(void);
 #endif /* NOT_USED_SO_FAR */
 
 /************************************************************************/
 
 /*----------------------------------------------------------------------*/
 
-static void console_scrollup (void)
+static void console_scrollup(void)
 {
-#if 1
        /* Copy up rows ignoring the first one */
-       memcpy (CONSOLE_ROW_FIRST, CONSOLE_ROW_SECOND, CONSOLE_SCROLL_SIZE);
+       memcpy(CONSOLE_ROW_FIRST, CONSOLE_ROW_SECOND, CONSOLE_SCROLL_SIZE);
 
        /* Clear the last one */
-       memset (CONSOLE_ROW_LAST, COLOR_MASK(lcd_color_bg), CONSOLE_ROW_SIZE);
-#else
-       /*
-        * Poor attempt to optimize speed by moving "long"s.
-        * But the code is ugly, and not a bit faster :-(
-        */
-       ulong *t = (ulong *)CONSOLE_ROW_FIRST;
-       ulong *s = (ulong *)CONSOLE_ROW_SECOND;
-       ulong    l = CONSOLE_SCROLL_SIZE / sizeof(ulong);
-       uchar  c = lcd_color_bg & 0xFF;
-       ulong val= (c<<24) | (c<<16) | (c<<8) | c;
-
-       while (l--)
-               *t++ = *s++;
-
-       t = (ulong *)CONSOLE_ROW_LAST;
-       l = CONSOLE_ROW_SIZE / sizeof(ulong);
-
-       while (l-- > 0)
-               *t++ = val;
-#endif
+       memset(CONSOLE_ROW_LAST, COLOR_MASK(lcd_color_bg), CONSOLE_ROW_SIZE);
 }
 
 /*----------------------------------------------------------------------*/
 
-static inline void console_back (void)
+static inline void console_back(void)
 {
        if (--console_col < 0) {
                console_col = CONSOLE_COLS-1 ;
@@ -152,14 +120,13 @@ static inline void console_back (void)
                }
        }
 
-       lcd_putc_xy (console_col * VIDEO_FONT_WIDTH,
-                    console_row * VIDEO_FONT_HEIGHT,
-                    ' ');
+       lcd_putc_xy(console_col * VIDEO_FONT_WIDTH,
+               console_row * VIDEO_FONT_HEIGHT, ' ');
 }
 
 /*----------------------------------------------------------------------*/
 
-static inline void console_newline (void)
+static inline void console_newline(void)
 {
        ++console_row;
        console_col = 0;
@@ -167,86 +134,112 @@ static inline void console_newline (void)
        /* Check if we need to scroll the terminal */
        if (console_row >= CONSOLE_ROWS) {
                /* Scroll everything up */
-               console_scrollup () ;
+               console_scrollup();
                --console_row;
        }
 }
 
 /*----------------------------------------------------------------------*/
 
-void lcd_putc (const char c)
+void lcd_putc(const char c)
 {
        if (!lcd_is_enabled) {
                serial_putc(c);
+
                return;
        }
 
        switch (c) {
-       case '\r':      console_col = 0;
-                       return;
+       case '\r':
+               console_col = 0;
 
-       case '\n':      console_newline();
-                       return;
+               return;
+       case '\n':
+               console_newline();
 
+               return;
        case '\t':      /* Tab (8 chars alignment) */
-                       console_col |=  8;
-                       console_col &= ~7;
+               console_col +=  8;
+               console_col &= ~7;
 
-                       if (console_col >= CONSOLE_COLS) {
-                               console_newline();
-                       }
-                       return;
+               if (console_col >= CONSOLE_COLS)
+                       console_newline();
 
-       case '\b':      console_back();
-                       return;
+               return;
+       case '\b':
+               console_back();
 
-       default:        lcd_putc_xy (console_col * VIDEO_FONT_WIDTH,
-                                    console_row * VIDEO_FONT_HEIGHT,
-                                    c);
-                       if (++console_col >= CONSOLE_COLS) {
-                               console_newline();
-                       }
-                       return;
+               return;
+       default:
+               lcd_putc_xy(console_col * VIDEO_FONT_WIDTH,
+                       console_row * VIDEO_FONT_HEIGHT, c);
+               if (++console_col >= CONSOLE_COLS)
+                       console_newline();
        }
-       /* NOTREACHED */
 }
 
 /*----------------------------------------------------------------------*/
 
-void lcd_puts (const char *s)
+void lcd_puts(const char *s)
 {
        if (!lcd_is_enabled) {
-               serial_puts (s);
+               serial_puts(s);
+
                return;
        }
 
        while (*s) {
-               lcd_putc (*s++);
+               lcd_putc(*s++);
        }
 }
 
+/*----------------------------------------------------------------------*/
+
+void lcd_printf(const char *fmt, ...)
+{
+       va_list args;
+       char buf[CONFIG_SYS_PBSIZE];
+
+       va_start(args, fmt);
+       vsprintf(buf, fmt, args);
+       va_end(args);
+
+       lcd_puts(buf);
+}
+
 /************************************************************************/
 /* ** Low-Level Graphics Routines                                      */
 /************************************************************************/
 
-static void lcd_drawchars (ushort x, ushort y, uchar *str, int count)
+static void lcd_drawchars(ushort x, ushort y, uchar *str, int count)
 {
        uchar *dest;
-       ushort off, row;
+       ushort row;
+
+#if defined(CONFIG_LCD_LOGO) && !defined(CONFIG_LCD_INFO_BELOW_LOGO)
+       y += BMP_LOGO_HEIGHT;
+#endif
+
+#if LCD_BPP == LCD_MONOCHROME
+       ushort off  = x * (1 << LCD_BPP) % 8;
+#endif
 
        dest = (uchar *)(lcd_base + y * lcd_line_length + x * (1 << LCD_BPP) / 8);
-       off  = x * (1 << LCD_BPP) % 8;
 
-       for (row=0;  row < VIDEO_FONT_HEIGHT;  ++row, dest += lcd_line_length)  {
+       for (row = 0; row < VIDEO_FONT_HEIGHT; ++row, dest += lcd_line_length) {
                uchar *s = str;
-               uchar *d = dest;
                int i;
+#if LCD_BPP == LCD_COLOR16
+               ushort *d = (ushort *)dest;
+#else
+               uchar *d = dest;
+#endif
 
 #if LCD_BPP == LCD_MONOCHROME
                uchar rest = *d & -(1 << (8-off));
                uchar sym;
 #endif
-               for (i=0; i<count; ++i) {
+               for (i = 0; i < count; ++i) {
                        uchar c, bits;
 
                        c = *s++;
@@ -254,18 +247,18 @@ static void lcd_drawchars (ushort x, ushort y, uchar *str, int count)
 
 #if LCD_BPP == LCD_MONOCHROME
                        sym  = (COLOR_MASK(lcd_color_fg) & bits) |
-                              (COLOR_MASK(lcd_color_bg) & ~bits);
+                               (COLOR_MASK(lcd_color_bg) & ~bits);
 
                        *d++ = rest | (sym >> off);
                        rest = sym << (8-off);
 #elif LCD_BPP == LCD_COLOR8
-                       for (c=0; c<8; ++c) {
+                       for (c = 0; c < 8; ++c) {
                                *d++ = (bits & 0x80) ?
                                                lcd_color_fg : lcd_color_bg;
                                bits <<= 1;
                        }
 #elif LCD_BPP == LCD_COLOR16
-                       for (c=0; c<16; ++c) {
+                       for (c = 0; c < 8; ++c) {
                                *d++ = (bits & 0x80) ?
                                                lcd_color_fg : lcd_color_bg;
                                bits <<= 1;
@@ -280,24 +273,16 @@ static void lcd_drawchars (ushort x, ushort y, uchar *str, int count)
 
 /*----------------------------------------------------------------------*/
 
-static inline void lcd_puts_xy (ushort x, ushort y, uchar *s)
+static inline void lcd_puts_xy(ushort x, ushort y, uchar *s)
 {
-#if defined(CONFIG_LCD_LOGO) && !defined(CONFIG_LCD_INFO_BELOW_LOGO)
-       lcd_drawchars (x, y+BMP_LOGO_HEIGHT, s, strlen ((char *)s));
-#else
-       lcd_drawchars (x, y, s, strlen ((char *)s));
-#endif
+       lcd_drawchars(x, y, s, strlen((char *)s));
 }
 
 /*----------------------------------------------------------------------*/
 
-static inline void lcd_putc_xy (ushort x, ushort y, uchar c)
+static inline void lcd_putc_xy(ushort x, ushort y, uchar c)
 {
-#if defined(CONFIG_LCD_LOGO) && !defined(CONFIG_LCD_INFO_BELOW_LOGO)
-       lcd_drawchars (x, y+BMP_LOGO_HEIGHT, &c, 1);
-#else
-       lcd_drawchars (x, y, &c, 1);
-#endif
+       lcd_drawchars(x, y, &c, 1);
 }
 
 /************************************************************************/
@@ -313,7 +298,7 @@ static int test_colors[N_BLK_HOR*N_BLK_VERT] = {
        CONSOLE_COLOR_BLUE,     CONSOLE_COLOR_MAGENTA,  CONSOLE_COLOR_CYAN,
 };
 
-static void test_pattern (void)
+static void test_pattern(void)
 {
        ushort v_max  = panel_info.vl_row;
        ushort h_max  = panel_info.vl_col;
@@ -322,13 +307,13 @@ static void test_pattern (void)
        ushort v, h;
        uchar *pix = (uchar *)lcd_base;
 
-       printf ("[LCD] Test Pattern: %d x %d [%d x %d]\n",
+       printf("[LCD] Test Pattern: %d x %d [%d x %d]\n",
                h_max, v_max, h_step, v_step);
 
        /* WARNING: Code silently assumes 8bit/pixel */
-       for (v=0; v<v_max; ++v) {
+       for (v = 0; v < v_max; ++v) {
                uchar iy = v / v_step;
-               for (h=0; h<h_max; ++h) {
+               for (h = 0; h < h_max; ++h) {
                        uchar ix = N_BLK_HOR * iy + (h/h_step);
                        *pix++ = test_colors[ix];
                }
@@ -343,31 +328,38 @@ static void test_pattern (void)
 
 int drv_lcd_init (void)
 {
-       device_t lcddev;
+       struct stdio_dev lcddev;
        int rc;
 
        lcd_base = (void *)(gd->fb_base);
 
        lcd_line_length = (panel_info.vl_col * NBITS (panel_info.vl_bpix)) / 8;
 
-       lcd_init (lcd_base);            /* LCD initialization */
+       lcd_init(lcd_base);             /* LCD initialization */
 
        /* Device initialization */
-       memset (&lcddev, 0, sizeof (lcddev));
+       memset(&lcddev, 0, sizeof(lcddev));
 
-       strcpy (lcddev.name, "lcd");
+       strcpy(lcddev.name, "lcd");
        lcddev.ext   = 0;                       /* No extensions */
        lcddev.flags = DEV_FLAGS_OUTPUT;        /* Output only */
        lcddev.putc  = lcd_putc;                /* 'putc' function */
        lcddev.puts  = lcd_puts;                /* 'puts' function */
 
-       rc = device_register (&lcddev);
+       rc = stdio_register (&lcddev);
 
        return (rc == 0) ? 1 : rc;
 }
 
 /*----------------------------------------------------------------------*/
-static int lcd_clear (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
+static
+int do_lcd_clear(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[])
+{
+       lcd_clear();
+       return 0;
+}
+
+void lcd_clear(void)
 {
 #if LCD_BPP == LCD_MONOCHROME
        /* Setting the palette */
@@ -375,58 +367,57 @@ static int lcd_clear (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
 
 #elif LCD_BPP == LCD_COLOR8
        /* Setting the palette */
-       lcd_setcolreg  (CONSOLE_COLOR_BLACK,       0,    0,    0);
-       lcd_setcolreg  (CONSOLE_COLOR_RED,      0xFF,    0,    0);
-       lcd_setcolreg  (CONSOLE_COLOR_GREEN,       0, 0xFF,    0);
-       lcd_setcolreg  (CONSOLE_COLOR_YELLOW,   0xFF, 0xFF,    0);
-       lcd_setcolreg  (CONSOLE_COLOR_BLUE,        0,    0, 0xFF);
-       lcd_setcolreg  (CONSOLE_COLOR_MAGENTA,  0xFF,    0, 0xFF);
-       lcd_setcolreg  (CONSOLE_COLOR_CYAN,        0, 0xFF, 0xFF);
-       lcd_setcolreg  (CONSOLE_COLOR_GREY,     0xAA, 0xAA, 0xAA);
-       lcd_setcolreg  (CONSOLE_COLOR_WHITE,    0xFF, 0xFF, 0xFF);
+       lcd_setcolreg(CONSOLE_COLOR_BLACK, 0, 0, 0);
+       lcd_setcolreg(CONSOLE_COLOR_RED, 0xFF, 0, 0);
+       lcd_setcolreg(CONSOLE_COLOR_GREEN, 0, 0xFF, 0);
+       lcd_setcolreg(CONSOLE_COLOR_YELLOW, 0xFF, 0xFF, 0);
+       lcd_setcolreg(CONSOLE_COLOR_BLUE, 0, 0, 0xFF);
+       lcd_setcolreg(CONSOLE_COLOR_MAGENTA, 0xFF, 0, 0xFF);
+       lcd_setcolreg(CONSOLE_COLOR_CYAN, 0, 0xFF, 0xFF);
+       lcd_setcolreg(CONSOLE_COLOR_GREY, 0xAA, 0xAA, 0xAA);
+       lcd_setcolreg(CONSOLE_COLOR_WHITE, 0xFF, 0xFF, 0xFF);
 #endif
 
 #ifndef CONFIG_SYS_WHITE_ON_BLACK
-       lcd_setfgcolor (CONSOLE_COLOR_BLACK);
-       lcd_setbgcolor (CONSOLE_COLOR_WHITE);
+       lcd_setfgcolor(CONSOLE_COLOR_BLACK);
+       lcd_setbgcolor(CONSOLE_COLOR_WHITE);
 #else
-       lcd_setfgcolor (CONSOLE_COLOR_WHITE);
-       lcd_setbgcolor (CONSOLE_COLOR_BLACK);
+       lcd_setfgcolor(CONSOLE_COLOR_WHITE);
+       lcd_setbgcolor(CONSOLE_COLOR_BLACK);
 #endif /* CONFIG_SYS_WHITE_ON_BLACK */
 
 #ifdef LCD_TEST_PATTERN
        test_pattern();
 #else
        /* set framebuffer to background color */
-       memset ((char *)lcd_base,
+       memset((char *)lcd_base,
                COLOR_MASK(lcd_getbgcolor()),
                lcd_line_length*panel_info.vl_row);
 #endif
        /* Paint the logo and retrieve LCD base address */
-       debug ("[LCD] Drawing the logo...\n");
+       debug("[LCD] Drawing the logo...\n");
        lcd_console_address = lcd_logo ();
 
        console_col = 0;
        console_row = 0;
-
-       return (0);
 }
 
 U_BOOT_CMD(
-       cls,    1,      1,      lcd_clear,
-       "cls     - clear screen\n",
-       NULL
+       cls,    1,      1,      do_lcd_clear,
+       "clear screen",
+       ""
 );
 
 /*----------------------------------------------------------------------*/
 
-static int lcd_init (void *lcdbase)
+static int lcd_init(void *lcdbase)
 {
        /* Initialize the lcd controller */
-       debug ("[LCD] Initializing LCD frambuffer at %p\n", lcdbase);
+       debug("[LCD] Initializing LCD frambuffer at %p\n", lcdbase);
 
-       lcd_ctrl_init (lcdbase);
-       lcd_clear (NULL, 1, 1, NULL);   /* dummy args */
+       lcd_ctrl_init(lcdbase);
+       lcd_is_enabled = 1;
+       lcd_clear();
        lcd_enable ();
 
        /* Initialize the console */
@@ -436,7 +427,6 @@ static int lcd_init (void *lcdbase)
 #else
        console_row = 1;        /* leave 1 blank line below logo */
 #endif
-       lcd_is_enabled = 1;
 
        return 0;
 }
@@ -452,13 +442,13 @@ static int lcd_init (void *lcdbase)
  *
  * Note that this is running from ROM, so no write access to global data.
  */
-ulong lcd_setmem (ulong addr)
+ulong lcd_setmem(ulong addr)
 {
        ulong size;
-       int line_length = (panel_info.vl_col * NBITS (panel_info.vl_bpix)) / 8;
+       int line_length = (panel_info.vl_col * NBITS(panel_info.vl_bpix)) / 8;
 
-       debug ("LCD panel info: %d x %d, %d bit/pix\n",
-               panel_info.vl_col, panel_info.vl_row, NBITS (panel_info.vl_bpix) );
+       debug("LCD panel info: %d x %d, %d bit/pix\n", panel_info.vl_col,
+               panel_info.vl_row, NBITS(panel_info.vl_bpix));
 
        size = line_length * panel_info.vl_row;
 
@@ -468,37 +458,29 @@ ulong lcd_setmem (ulong addr)
        /* Allocate pages for the frame buffer. */
        addr -= size;
 
-       debug ("Reserving %ldk for LCD Framebuffer at: %08lx\n", size>>10, addr);
+       debug("Reserving %ldk for LCD Framebuffer at: %08lx\n", size>>10, addr);
 
-       return (addr);
+       return addr;
 }
 
 /*----------------------------------------------------------------------*/
 
-static void lcd_setfgcolor (int color)
+static void lcd_setfgcolor(int color)
 {
-#ifdef CONFIG_ATMEL_LCD
        lcd_color_fg = color;
-#else
-       lcd_color_fg = color & 0x0F;
-#endif
 }
 
 /*----------------------------------------------------------------------*/
 
-static void lcd_setbgcolor (int color)
+static void lcd_setbgcolor(int color)
 {
-#ifdef CONFIG_ATMEL_LCD
        lcd_color_bg = color;
-#else
-       lcd_color_bg = color & 0x0F;
-#endif
 }
 
 /*----------------------------------------------------------------------*/
 
 #ifdef NOT_USED_SO_FAR
-static int lcd_getfgcolor (void)
+static int lcd_getfgcolor(void)
 {
        return lcd_color_fg;
 }
@@ -506,7 +488,7 @@ static int lcd_getfgcolor (void)
 
 /*----------------------------------------------------------------------*/
 
-static int lcd_getbgcolor (void)
+static int lcd_getbgcolor(void)
 {
        return lcd_color_bg;
 }
@@ -516,57 +498,81 @@ static int lcd_getbgcolor (void)
 /************************************************************************/
 /* ** Chipset depending Bitmap / Logo stuff...                          */
 /************************************************************************/
+static inline ushort *configuration_get_cmap(void)
+{
+#if defined CONFIG_CPU_PXA
+       struct pxafb_info *fbi = &panel_info.pxa;
+       return (ushort *)fbi->palette;
+#elif defined(CONFIG_MPC823)
+       immap_t *immr = (immap_t *) CONFIG_SYS_IMMR;
+       cpm8xx_t *cp = &(immr->im_cpm);
+       return (ushort *)&(cp->lcd_cmap[255 * sizeof(ushort)]);
+#elif defined(CONFIG_ATMEL_LCD)
+       return (ushort *)(panel_info.mmio + ATMEL_LCDC_LUT(0));
+#elif !defined(CONFIG_ATMEL_HLCD) && !defined(CONFIG_EXYNOS_FB)
+       return panel_info.cmap;
+#else
+#if defined(CONFIG_LCD_LOGO)
+       return bmp_logo_palette;
+#else
+       return NULL;
+#endif
+#endif
+}
+
 #ifdef CONFIG_LCD_LOGO
-void bitmap_plot (int x, int y)
+void bitmap_plot(int x, int y)
 {
 #ifdef CONFIG_ATMEL_LCD
-       uint *cmap;
+       uint *cmap = (uint *)bmp_logo_palette;
 #else
-       ushort *cmap;
+       ushort *cmap = (ushort *)bmp_logo_palette;
 #endif
        ushort i, j;
        uchar *bmap;
        uchar *fb;
        ushort *fb16;
-#if defined(CONFIG_PXA250)
-       struct pxafb_info *fbi = &panel_info.pxa;
-#elif defined(CONFIG_MPC823)
-       volatile immap_t *immr = (immap_t *) CONFIG_SYS_IMMR;
-       volatile cpm8xx_t *cp = &(immr->im_cpm);
+#if defined(CONFIG_MPC823)
+       immap_t *immr = (immap_t *) CONFIG_SYS_IMMR;
+       cpm8xx_t *cp = &(immr->im_cpm);
 #endif
 
-       debug ("Logo: width %d  height %d  colors %d  cmap %d\n",
+       debug("Logo: width %d  height %d  colors %d  cmap %d\n",
                BMP_LOGO_WIDTH, BMP_LOGO_HEIGHT, BMP_LOGO_COLORS,
-               (int)(sizeof(bmp_logo_palette)/(sizeof(ushort))));
+               ARRAY_SIZE(bmp_logo_palette));
 
        bmap = &bmp_logo_bitmap[0];
        fb   = (uchar *)(lcd_base + y * lcd_line_length + x);
 
        if (NBITS(panel_info.vl_bpix) < 12) {
-               /* Leave room for default color map */
-#if defined(CONFIG_PXA250)
-               cmap = (ushort *)fbi->palette;
-#elif defined(CONFIG_MPC823)
-               cmap = (ushort *)&(cp->lcd_cmap[BMP_LOGO_OFFSET*sizeof(ushort)]);
+               /* Leave room for default color map
+                * default case: generic system with no cmap (most likely 16bpp)
+                * cmap was set to the source palette, so no change is done.
+                * This avoids even more ifdefs in the next stanza
+                */
+#if defined(CONFIG_MPC823)
+               cmap = (ushort *) &(cp->lcd_cmap[BMP_LOGO_OFFSET * sizeof(ushort)]);
 #elif defined(CONFIG_ATMEL_LCD)
-               cmap = (uint *) (panel_info.mmio + ATMEL_LCDC_LUT(0));
+               cmap = (uint *)configuration_get_cmap();
+#else
+               cmap = configuration_get_cmap();
 #endif
 
                WATCHDOG_RESET();
 
                /* Set color map */
-               for (i=0; i<(sizeof(bmp_logo_palette)/(sizeof(ushort))); ++i) {
+               for (i = 0; i < ARRAY_SIZE(bmp_logo_palette); ++i) {
                        ushort colreg = bmp_logo_palette[i];
 #ifdef CONFIG_ATMEL_LCD
                        uint lut_entry;
 #ifdef CONFIG_ATMEL_LCD_BGR555
                        lut_entry = ((colreg & 0x000F) << 11) |
-                                   ((colreg & 0x00F0) <<  2) |
-                                   ((colreg & 0x0F00) >>  7);
+                                       ((colreg & 0x00F0) <<  2) |
+                                       ((colreg & 0x0F00) >>  7);
 #else /* CONFIG_ATMEL_LCD_RGB565 */
                        lut_entry = ((colreg & 0x000F) << 1) |
-                                   ((colreg & 0x00F0) << 3) |
-                                   ((colreg & 0x0F00) << 4);
+                                       ((colreg & 0x00F0) << 3) |
+                                       ((colreg & 0x0F00) << 4);
 #endif
                        *(cmap + BMP_LOGO_OFFSET) = lut_entry;
                        cmap++;
@@ -581,17 +587,22 @@ void bitmap_plot (int x, int y)
 
                WATCHDOG_RESET();
 
-               for (i=0; i<BMP_LOGO_HEIGHT; ++i) {
-                       memcpy (fb, bmap, BMP_LOGO_WIDTH);
+               for (i = 0; i < BMP_LOGO_HEIGHT; ++i) {
+                       memcpy(fb, bmap, BMP_LOGO_WIDTH);
                        bmap += BMP_LOGO_WIDTH;
                        fb   += panel_info.vl_col;
                }
        }
        else { /* true color mode */
+               u16 col16;
                fb16 = (ushort *)(lcd_base + y * lcd_line_length + x);
-               for (i=0; i<BMP_LOGO_HEIGHT; ++i) {
-                       for (j=0; j<BMP_LOGO_WIDTH; j++) {
-                               fb16[j] = bmp_logo_palette[(bmap[j])];
+               for (i = 0; i < BMP_LOGO_HEIGHT; ++i) {
+                       for (j = 0; j < BMP_LOGO_WIDTH; j++) {
+                               col16 = bmp_logo_palette[(bmap[j]-16)];
+                               fb16[j] =
+                                       ((col16 & 0x000F) << 1) |
+                                       ((col16 & 0x00F0) << 3) |
+                                       ((col16 & 0x0F00) << 4);
                                }
                        bmap += BMP_LOGO_WIDTH;
                        fb16 += panel_info.vl_col;
@@ -600,6 +611,8 @@ void bitmap_plot (int x, int y)
 
        WATCHDOG_RESET();
 }
+#else
+static inline void bitmap_plot(int x, int y) {}
 #endif /* CONFIG_LCD_LOGO */
 
 /*----------------------------------------------------------------------*/
@@ -608,73 +621,106 @@ void bitmap_plot (int x, int y)
  * Display the BMP file located at address bmp_image.
  * Only uncompressed.
  */
+
+#ifdef CONFIG_SPLASH_SCREEN_ALIGN
+#define BMP_ALIGN_CENTER       0x7FFF
+
+static void splash_align_axis(int *axis, unsigned long panel_size,
+                                       unsigned long picture_size)
+{
+       unsigned long panel_picture_delta = panel_size - picture_size;
+       unsigned long axis_alignment;
+
+       if (*axis == BMP_ALIGN_CENTER)
+               axis_alignment = panel_picture_delta / 2;
+       else if (*axis < 0)
+               axis_alignment = panel_picture_delta + *axis + 1;
+       else
+               return;
+
+       *axis = max(0, axis_alignment);
+}
+#endif
+
+#if defined(CONFIG_MPC823) || defined(CONFIG_MCC200)
+#define FB_PUT_BYTE(fb, from) *(fb)++ = (255 - *(from)++)
+#else
+#define FB_PUT_BYTE(fb, from) *(fb)++ = *(from)++
+#endif
+
+#if defined(CONFIG_BMP_16BPP)
+#if defined(CONFIG_ATMEL_LCD_BGR555)
+static inline void fb_put_word(uchar **fb, uchar **from)
+{
+       *(*fb)++ = (((*from)[0] & 0x1f) << 2) | ((*from)[1] & 0x03);
+       *(*fb)++ = ((*from)[0] & 0xe0) | (((*from)[1] & 0x7c) >> 2);
+       *from += 2;
+}
+#else
+static inline void fb_put_word(uchar **fb, uchar **from)
+{
+       *(*fb)++ = *(*from)++;
+       *(*fb)++ = *(*from)++;
+}
+#endif
+#endif /* CONFIG_BMP_16BPP */
+
 int lcd_display_bitmap(ulong bmp_image, int x, int y)
 {
-#ifdef CONFIG_ATMEL_LCD
-       uint *cmap;
-#elif !defined(CONFIG_MCC200)
-       ushort *cmap;
+#if !defined(CONFIG_MCC200)
+       ushort *cmap = NULL;
 #endif
+       ushort *cmap_base = NULL;
        ushort i, j;
        uchar *fb;
        bmp_image_t *bmp=(bmp_image_t *)bmp_image;
        uchar *bmap;
        ushort padded_line;
-       unsigned long width, height;
+       unsigned long width, height, byte_width;
        unsigned long pwidth = panel_info.vl_col;
-       unsigned colors,bpix;
-       unsigned long compression;
-#if defined(CONFIG_PXA250)
-       struct pxafb_info *fbi = &panel_info.pxa;
-#elif defined(CONFIG_MPC823)
-       volatile immap_t *immr = (immap_t *) CONFIG_SYS_IMMR;
-       volatile cpm8xx_t *cp = &(immr->im_cpm);
-#endif
+       unsigned colors, bpix, bmp_bpix;
+
+       if (!bmp || !((bmp->header.signature[0] == 'B') &&
+               (bmp->header.signature[1] == 'M'))) {
+               printf("Error: no valid bmp image at %lx\n", bmp_image);
 
-       if (!((bmp->header.signature[0]=='B') &&
-               (bmp->header.signature[1]=='M'))) {
-               printf ("Error: no valid bmp image at %lx\n", bmp_image);
                return 1;
-}
+       }
 
-       width = le32_to_cpu (bmp->header.width);
-       height = le32_to_cpu (bmp->header.height);
-       colors = 1<<le16_to_cpu (bmp->header.bit_count);
-       compression = le32_to_cpu (bmp->header.compression);
+       width = le32_to_cpu(bmp->header.width);
+       height = le32_to_cpu(bmp->header.height);
+       bmp_bpix = le16_to_cpu(bmp->header.bit_count);
+       colors = 1 << bmp_bpix;
 
        bpix = NBITS(panel_info.vl_bpix);
 
-       if ((bpix != 1) && (bpix != 8)) {
-               printf ("Error: %d bit/pixel mode not supported by U-Boot\n",
-                       bpix);
+       if ((bpix != 1) && (bpix != 8) && (bpix != 16) && (bpix != 32)) {
+               printf ("Error: %d bit/pixel mode, but BMP has %d bit/pixel\n",
+                       bpix, bmp_bpix);
+
                return 1;
        }
 
-       if (bpix != le16_to_cpu(bmp->header.bit_count)) {
+       /* We support displaying 8bpp BMPs on 16bpp LCDs */
+       if (bpix != bmp_bpix && (bmp_bpix != 8 || bpix != 16 || bpix != 32)) {
                printf ("Error: %d bit/pixel mode, but BMP has %d bit/pixel\n",
                        bpix,
                        le16_to_cpu(bmp->header.bit_count));
+
                return 1;
        }
 
-       debug ("Display-bmp: %d x %d  with %d colors\n",
+       debug("Display-bmp: %d x %d  with %d colors\n",
                (int)width, (int)height, (int)colors);
 
 #if !defined(CONFIG_MCC200)
        /* MCC200 LCD doesn't need CMAP, supports 1bpp b&w only */
-       if (bpix==8) {
-#if defined(CONFIG_PXA250)
-               cmap = (ushort *)fbi->palette;
-#elif defined(CONFIG_MPC823)
-               cmap = (ushort *)&(cp->lcd_cmap[255*sizeof(ushort)]);
-#elif defined(CONFIG_ATMEL_LCD)
-               cmap = (uint *) (panel_info.mmio + ATMEL_LCDC_LUT(0));
-#else
-# error "Don't know location of color map"
-#endif
+       if (bmp_bpix == 8) {
+               cmap = configuration_get_cmap();
+               cmap_base = cmap;
 
                /* Set color map */
-               for (i=0; i<colors; ++i) {
+               for (i = 0; i < colors; ++i) {
                        bmp_color_table_entry_t cte = bmp->color_table[i];
 #if !defined(CONFIG_ATMEL_LCD)
                        ushort colreg =
@@ -686,10 +732,10 @@ int lcd_display_bitmap(ulong bmp_image, int x, int y)
 #else
                        *cmap = colreg;
 #endif
-#if defined(CONFIG_PXA250)
-                       cmap++;
-#elif defined(CONFIG_MPC823)
+#if defined(CONFIG_MPC823)
                        cmap--;
+#else
+                       cmap++;
 #endif
 #else /* CONFIG_ATMEL_LCD */
                        lcd_setcolreg(i, cte.red, cte.green, cte.blue);
@@ -709,8 +755,7 @@ int lcd_display_bitmap(ulong bmp_image, int x, int y)
         * specific.
         */
 #if defined(CONFIG_MCC200)
-       if (bpix==1)
-       {
+       if (bpix == 1) {
                width = ((width + 7) & ~7) >> 3;
                x     = ((x + 7) & ~7) >> 3;
                pwidth= ((pwidth + 7) & ~7) >> 3;
@@ -718,150 +763,153 @@ int lcd_display_bitmap(ulong bmp_image, int x, int y)
 #endif
 
        padded_line = (width&0x3) ? ((width&~0x3)+4) : (width);
-       if ((x + width)>pwidth)
+
+#ifdef CONFIG_SPLASH_SCREEN_ALIGN
+       splash_align_axis(&x, pwidth, width);
+       splash_align_axis(&y, panel_info.vl_row, height);
+#endif /* CONFIG_SPLASH_SCREEN_ALIGN */
+
+       if ((x + width) > pwidth)
                width = pwidth - x;
-       if ((y + height)>panel_info.vl_row)
+       if ((y + height) > panel_info.vl_row)
                height = panel_info.vl_row - y;
 
-       bmap = (uchar *)bmp + le32_to_cpu (bmp->header.data_offset);
+       bmap = (uchar *)bmp + le32_to_cpu(bmp->header.data_offset);
        fb   = (uchar *) (lcd_base +
-               (y + height - 1) * lcd_line_length + x);
-       for (i = 0; i < height; ++i) {
-               WATCHDOG_RESET();
-               for (j = 0; j < width ; j++)
-#if defined(CONFIG_PXA250) || defined(CONFIG_ATMEL_LCD)
-                       *(fb++) = *(bmap++);
-#elif defined(CONFIG_MPC823) || defined(CONFIG_MCC200)
-                       *(fb++)=255-*(bmap++);
-#endif
-               bmap += (width - padded_line);
-               fb   -= (width + lcd_line_length);
-       }
+               (y + height - 1) * lcd_line_length + x * bpix / 8);
+
+       switch (bmp_bpix) {
+       case 1: /* pass through */
+       case 8:
+               if (bpix != 16)
+                       byte_width = width;
+               else
+                       byte_width = width * 2;
+
+               for (i = 0; i < height; ++i) {
+                       WATCHDOG_RESET();
+                       for (j = 0; j < width; j++) {
+                               if (bpix != 16) {
+                                       FB_PUT_BYTE(fb, bmap);
+                               } else {
+                                       *(uint16_t *)fb = cmap_base[*(bmap++)];
+                                       fb += sizeof(uint16_t) / sizeof(*fb);
+                               }
+                       }
+                       bmap += (width - padded_line);
+                       fb   -= (byte_width + lcd_line_length);
+               }
+               break;
 
-       return (0);
-}
-#endif
+#if defined(CONFIG_BMP_16BPP)
+       case 16:
+               for (i = 0; i < height; ++i) {
+                       WATCHDOG_RESET();
+                       for (j = 0; j < width; j++)
+                               fb_put_word(&fb, &bmap);
 
-#ifdef CONFIG_VIDEO_BMP_GZIP
-extern bmp_image_t *gunzip_bmp(unsigned long addr, unsigned long *lenp);
-#endif
+                       bmap += (padded_line - width) * 2;
+                       fb   -= (width * 2 + lcd_line_length);
+               }
+               break;
+#endif /* CONFIG_BMP_16BPP */
+
+#if defined(CONFIG_BMP_32BPP)
+       case 32:
+               for (i = 0; i < height; ++i) {
+                       for (j = 0; j < width; j++) {
+                               *(fb++) = *(bmap++);
+                               *(fb++) = *(bmap++);
+                               *(fb++) = *(bmap++);
+                               *(fb++) = *(bmap++);
+                       }
+                       fb  -= (lcd_line_length + width * (bpix / 8));
+               }
+               break;
+#endif /* CONFIG_BMP_32BPP */
+       default:
+               break;
+       };
 
-static void *lcd_logo (void)
-{
-#ifdef CONFIG_LCD_INFO
-       char info[80];
-       char temp[32];
-#ifdef CONFIG_ATMEL_LCD
-       int i;
-       ulong dram_size, nand_size;
+       return 0;
+}
 #endif
-#endif /* CONFIG_LCD_INFO */
 
+static void *lcd_logo(void)
+{
 #ifdef CONFIG_SPLASH_SCREEN
        char *s;
        ulong addr;
        static int do_splash = 1;
 
        if (do_splash && (s = getenv("splashimage")) != NULL) {
-               addr = simple_strtoul(s, NULL, 16);
+               int x = 0, y = 0;
                do_splash = 0;
 
-#ifdef CONFIG_VIDEO_BMP_GZIP
-               bmp_image_t *bmp = (bmp_image_t *)addr;
-               unsigned long len;
-
-               if (!((bmp->header.signature[0]=='B') &&
-                     (bmp->header.signature[1]=='M'))) {
-                       addr = (ulong)gunzip_bmp(addr, &len);
+               addr = simple_strtoul (s, NULL, 16);
+#ifdef CONFIG_SPLASH_SCREEN_ALIGN
+               s = getenv("splashpos");
+               if (s != NULL) {
+                       if (s[0] == 'm')
+                               x = BMP_ALIGN_CENTER;
+                       else
+                               x = simple_strtol(s, NULL, 0);
+
+                       s = strchr(s + 1, ',');
+                       if (s != NULL) {
+                               if (s[1] == 'm')
+                                       y = BMP_ALIGN_CENTER;
+                               else
+                                       y = simple_strtol (s + 1, NULL, 0);
+                       }
                }
-#endif
+#endif /* CONFIG_SPLASH_SCREEN_ALIGN */
 
-               if (lcd_display_bitmap (addr, 0, 0) == 0) {
-                       return ((void *)lcd_base);
-               }
+               if (bmp_display(addr, x, y) == 0)
+                       return (void *)lcd_base;
        }
 #endif /* CONFIG_SPLASH_SCREEN */
 
-#ifdef CONFIG_LCD_LOGO
-       bitmap_plot (0, 0);
-#endif /* CONFIG_LCD_LOGO */
-
-#ifdef CONFIG_MPC823
-# ifdef CONFIG_LCD_INFO
-       sprintf (info, "%s (%s - %s) ", U_BOOT_VERSION, __DATE__, __TIME__);
-       lcd_drawchars (LCD_INFO_X, LCD_INFO_Y, (uchar *)info, strlen(info));
-
-       sprintf (info, "(C) 2008 DENX Software Engineering GmbH");
-       lcd_drawchars (LCD_INFO_X, LCD_INFO_Y + VIDEO_FONT_HEIGHT,
-                                       (uchar *)info, strlen(info));
-
-       sprintf (info, "    Wolfgang DENK, wd@denx.de");
-       lcd_drawchars (LCD_INFO_X, LCD_INFO_Y + VIDEO_FONT_HEIGHT * 2,
-                                       (uchar *)info, strlen(info));
-#  ifdef CONFIG_LCD_INFO_BELOW_LOGO
-       sprintf (info, "MPC823 CPU at %s MHz",
-               strmhz(temp, gd->cpu_clk));
-       lcd_drawchars (LCD_INFO_X, LCD_INFO_Y + VIDEO_FONT_HEIGHT * 3,
-                                       info, strlen(info));
-       sprintf (info, "  %ld MB RAM, %ld MB Flash",
-               gd->ram_size >> 20,
-               gd->bd->bi_flashsize >> 20 );
-       lcd_drawchars (LCD_INFO_X, LCD_INFO_Y + VIDEO_FONT_HEIGHT * 4,
-                                       info, strlen(info));
-#  else
-       /* leave one blank line */
-
-       sprintf (info, "MPC823 CPU at %s MHz, %ld MB RAM, %ld MB Flash",
-               strmhz(temp, gd->cpu_clk),
-               gd->ram_size >> 20,
-               gd->bd->bi_flashsize >> 20 );
-       lcd_drawchars (LCD_INFO_X, LCD_INFO_Y + VIDEO_FONT_HEIGHT * 4,
-                                       (uchar *)info, strlen(info));
-
-#  endif /* CONFIG_LCD_INFO_BELOW_LOGO */
-# endif /* CONFIG_LCD_INFO */
-#endif /* CONFIG_MPC823 */
-
-#ifdef CONFIG_ATMEL_LCD
-# ifdef CONFIG_LCD_INFO
-       sprintf (info, "%s", U_BOOT_VERSION);
-       lcd_drawchars (LCD_INFO_X, LCD_INFO_Y, (uchar *)info, strlen(info));
-
-       sprintf (info, "(C) 2008 ATMEL Corp");
-       lcd_drawchars (LCD_INFO_X, LCD_INFO_Y + VIDEO_FONT_HEIGHT,
-                                       (uchar *)info, strlen(info));
-
-       sprintf (info, "at91support@atmel.com");
-       lcd_drawchars (LCD_INFO_X, LCD_INFO_Y + VIDEO_FONT_HEIGHT * 2,
-                                       (uchar *)info, strlen(info));
-
-       sprintf (info, "%s CPU at %s MHz",
-               AT91_CPU_NAME,
-               strmhz(temp, AT91_MAIN_CLOCK));
-       lcd_drawchars (LCD_INFO_X, LCD_INFO_Y + VIDEO_FONT_HEIGHT * 3,
-                                       (uchar *)info, strlen(info));
-
-       dram_size = 0;
-       for (i = 0; i < CONFIG_NR_DRAM_BANKS; i++)
-               dram_size += gd->bd->bi_dram[i].size;
-       nand_size = 0;
-       for (i = 0; i < CONFIG_SYS_MAX_NAND_DEVICE; i++)
-               nand_size += nand_info[i].size;
-       sprintf (info, "  %ld MB SDRAM, %ld MB NAND",
-               dram_size >> 20,
-               nand_size >> 20 );
-       lcd_drawchars (LCD_INFO_X, LCD_INFO_Y + VIDEO_FONT_HEIGHT * 4,
-                                       (uchar *)info, strlen(info));
-# endif /* CONFIG_LCD_INFO */
-#endif /* CONFIG_ATMEL_LCD */
+       bitmap_plot(0, 0);
 
+#ifdef CONFIG_LCD_INFO
+       console_col = LCD_INFO_X / VIDEO_FONT_WIDTH;
+       console_row = LCD_INFO_Y / VIDEO_FONT_HEIGHT;
+       lcd_show_board_info();
+#endif /* CONFIG_LCD_INFO */
 
 #if defined(CONFIG_LCD_LOGO) && !defined(CONFIG_LCD_INFO_BELOW_LOGO)
-       return ((void *)((ulong)lcd_base + BMP_LOGO_HEIGHT * lcd_line_length));
+       return (void *)((ulong)lcd_base + BMP_LOGO_HEIGHT * lcd_line_length);
 #else
-       return ((void *)lcd_base);
+       return (void *)lcd_base;
 #endif /* CONFIG_LCD_LOGO && !CONFIG_LCD_INFO_BELOW_LOGO */
 }
 
+void lcd_position_cursor(unsigned col, unsigned row)
+{
+       console_col = min(col, CONSOLE_COLS - 1);
+       console_row = min(row, CONSOLE_ROWS - 1);
+}
+
+int lcd_get_pixel_width(void)
+{
+       return panel_info.vl_col;
+}
+
+int lcd_get_pixel_height(void)
+{
+       return panel_info.vl_row;
+}
+
+int lcd_get_screen_rows(void)
+{
+       return CONSOLE_ROWS;
+}
+
+int lcd_get_screen_columns(void)
+{
+       return CONSOLE_COLS;
+}
+
 /************************************************************************/
 /************************************************************************/