|  | /* | 
|  | * Common LCD routines for supported CPUs | 
|  | * | 
|  | * (C) Copyright 2001-2002 | 
|  | * Wolfgang Denk, DENX Software Engineering -- wd@denx.de | 
|  | * | 
|  | * See file CREDITS for list of people who contributed to this | 
|  | * project. | 
|  | * | 
|  | * This program is free software; you can redistribute it and/or | 
|  | * modify it under the terms of the GNU General Public License as | 
|  | * published by the Free Software Foundation; either version 2 of | 
|  | * the License, or (at your option) any later version. | 
|  | * | 
|  | * This program is distributed in the hope that it will be useful, | 
|  | * but WITHOUT ANY WARRANTY; without even the implied warranty of | 
|  | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.	 See the | 
|  | * GNU General Public License for more details. | 
|  | * | 
|  | * You should have received a copy of the GNU General Public License | 
|  | * along with this program; if not, write to the Free Software | 
|  | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, | 
|  | * MA 02111-1307 USA | 
|  | */ | 
|  |  | 
|  | /************************************************************************/ | 
|  | /* ** HEADER FILES							*/ | 
|  | /************************************************************************/ | 
|  |  | 
|  | /* #define DEBUG */ | 
|  |  | 
|  | #include <config.h> | 
|  | #include <common.h> | 
|  | #include <command.h> | 
|  | #include <version.h> | 
|  | #include <stdarg.h> | 
|  | #include <linux/types.h> | 
|  | #include <devices.h> | 
|  | #if defined(CONFIG_POST) | 
|  | #include <post.h> | 
|  | #endif | 
|  | #include <lcd.h> | 
|  | #include <watchdog.h> | 
|  |  | 
|  | #if defined(CONFIG_PXA250) | 
|  | #include <asm/byteorder.h> | 
|  | #endif | 
|  |  | 
|  | #if defined(CONFIG_MPC823) | 
|  | #include <lcdvideo.h> | 
|  | #endif | 
|  |  | 
|  | #ifdef CONFIG_LCD | 
|  |  | 
|  | /************************************************************************/ | 
|  | /* ** FONT DATA								*/ | 
|  | /************************************************************************/ | 
|  | #include <video_font.h>		/* Get font data, width and height	*/ | 
|  |  | 
|  | /************************************************************************/ | 
|  | /* ** LOGO DATA								*/ | 
|  | /************************************************************************/ | 
|  | #ifdef CONFIG_LCD_LOGO | 
|  | # include <bmp_logo.h>		/* Get logo data, width and height	*/ | 
|  | # if (CONSOLE_COLOR_WHITE >= BMP_LOGO_OFFSET) | 
|  | #  error Default Color Map overlaps with Logo Color Map | 
|  | # endif | 
|  | #endif | 
|  |  | 
|  | 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 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); | 
|  |  | 
|  | char lcd_is_enabled = 0; | 
|  | extern vidinfo_t panel_info; | 
|  |  | 
|  | #ifdef	NOT_USED_SO_FAR | 
|  | static void lcd_getcolreg (ushort regno, | 
|  | ushort *red, ushort *green, ushort *blue); | 
|  | static int lcd_getfgcolor (void); | 
|  | #endif	/* NOT_USED_SO_FAR */ | 
|  |  | 
|  | /************************************************************************/ | 
|  |  | 
|  | /*----------------------------------------------------------------------*/ | 
|  |  | 
|  | static void console_scrollup (void) | 
|  | { | 
|  | #if 1 | 
|  | /* Copy up rows ignoring the first one */ | 
|  | 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 | 
|  | } | 
|  |  | 
|  | /*----------------------------------------------------------------------*/ | 
|  |  | 
|  | static inline void console_back (void) | 
|  | { | 
|  | if (--console_col < 0) { | 
|  | console_col = CONSOLE_COLS-1 ; | 
|  | if (--console_row < 0) { | 
|  | console_row = 0; | 
|  | } | 
|  | } | 
|  |  | 
|  | lcd_putc_xy (console_col * VIDEO_FONT_WIDTH, | 
|  | console_row * VIDEO_FONT_HEIGHT, | 
|  | ' '); | 
|  | } | 
|  |  | 
|  | /*----------------------------------------------------------------------*/ | 
|  |  | 
|  | static inline void console_newline (void) | 
|  | { | 
|  | ++console_row; | 
|  | console_col = 0; | 
|  |  | 
|  | /* Check if we need to scroll the terminal */ | 
|  | if (console_row >= CONSOLE_ROWS) { | 
|  | /* Scroll everything up */ | 
|  | console_scrollup () ; | 
|  | --console_row; | 
|  | } | 
|  | } | 
|  |  | 
|  | /*----------------------------------------------------------------------*/ | 
|  |  | 
|  | void lcd_putc (const char c) | 
|  | { | 
|  | if (!lcd_is_enabled) { | 
|  | serial_putc(c); | 
|  | return; | 
|  | } | 
|  |  | 
|  | switch (c) { | 
|  | case '\r':	console_col = 0; | 
|  | return; | 
|  |  | 
|  | case '\n':	console_newline(); | 
|  | return; | 
|  |  | 
|  | case '\t':	/* Tab (8 chars alignment) */ | 
|  | console_col |=  8; | 
|  | console_col &= ~7; | 
|  |  | 
|  | if (console_col >= CONSOLE_COLS) { | 
|  | console_newline(); | 
|  | } | 
|  | return; | 
|  |  | 
|  | case '\b':	console_back(); | 
|  | return; | 
|  |  | 
|  | default:	lcd_putc_xy (console_col * VIDEO_FONT_WIDTH, | 
|  | console_row * VIDEO_FONT_HEIGHT, | 
|  | c); | 
|  | if (++console_col >= CONSOLE_COLS) { | 
|  | console_newline(); | 
|  | } | 
|  | return; | 
|  | } | 
|  | /* NOTREACHED */ | 
|  | } | 
|  |  | 
|  | /*----------------------------------------------------------------------*/ | 
|  |  | 
|  | void lcd_puts (const char *s) | 
|  | { | 
|  | if (!lcd_is_enabled) { | 
|  | serial_puts (s); | 
|  | return; | 
|  | } | 
|  |  | 
|  | while (*s) { | 
|  | lcd_putc (*s++); | 
|  | } | 
|  | } | 
|  |  | 
|  | /************************************************************************/ | 
|  | /* ** Low-Level Graphics Routines					*/ | 
|  | /************************************************************************/ | 
|  |  | 
|  | static void lcd_drawchars (ushort x, ushort y, uchar *str, int count) | 
|  | { | 
|  | uchar *dest; | 
|  | ushort off, row; | 
|  |  | 
|  | 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)  { | 
|  | uchar *s = str; | 
|  | uchar *d = dest; | 
|  | int i; | 
|  |  | 
|  | #if LCD_BPP == LCD_MONOCHROME | 
|  | uchar rest = *d & -(1 << (8-off)); | 
|  | uchar sym; | 
|  | #endif | 
|  | for (i=0; i<count; ++i) { | 
|  | uchar c, bits; | 
|  |  | 
|  | c = *s++; | 
|  | bits = video_fontdata[c * VIDEO_FONT_HEIGHT + row]; | 
|  |  | 
|  | #if LCD_BPP == LCD_MONOCHROME | 
|  | sym  = (COLOR_MASK(lcd_color_fg) & 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) { | 
|  | *d++ = (bits & 0x80) ? | 
|  | lcd_color_fg : lcd_color_bg; | 
|  | bits <<= 1; | 
|  | } | 
|  | #elif LCD_BPP == LCD_COLOR16 | 
|  | for (c=0; c<16; ++c) { | 
|  | *d++ = (bits & 0x80) ? | 
|  | lcd_color_fg : lcd_color_bg; | 
|  | bits <<= 1; | 
|  | } | 
|  | #endif | 
|  | } | 
|  | #if LCD_BPP == LCD_MONOCHROME | 
|  | *d  = rest | (*d & ((1 << (8-off)) - 1)); | 
|  | #endif | 
|  | } | 
|  | } | 
|  |  | 
|  | /*----------------------------------------------------------------------*/ | 
|  |  | 
|  | 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 | 
|  | } | 
|  |  | 
|  | /*----------------------------------------------------------------------*/ | 
|  |  | 
|  | 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 | 
|  | } | 
|  |  | 
|  | /************************************************************************/ | 
|  | /**  Small utility to check that you got the colours right		*/ | 
|  | /************************************************************************/ | 
|  | #ifdef LCD_TEST_PATTERN | 
|  |  | 
|  | #define	N_BLK_VERT	2 | 
|  | #define	N_BLK_HOR	3 | 
|  |  | 
|  | static int test_colors[N_BLK_HOR*N_BLK_VERT] = { | 
|  | CONSOLE_COLOR_RED,	CONSOLE_COLOR_GREEN,	CONSOLE_COLOR_YELLOW, | 
|  | CONSOLE_COLOR_BLUE,	CONSOLE_COLOR_MAGENTA,	CONSOLE_COLOR_CYAN, | 
|  | }; | 
|  |  | 
|  | static void test_pattern (void) | 
|  | { | 
|  | ushort v_max  = panel_info.vl_row; | 
|  | ushort h_max  = panel_info.vl_col; | 
|  | ushort v_step = (v_max + N_BLK_VERT - 1) / N_BLK_VERT; | 
|  | ushort h_step = (h_max + N_BLK_HOR  - 1) / N_BLK_HOR; | 
|  | ushort v, h; | 
|  | uchar *pix = (uchar *)lcd_base; | 
|  |  | 
|  | 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) { | 
|  | uchar iy = v / v_step; | 
|  | for (h=0; h<h_max; ++h) { | 
|  | uchar ix = N_BLK_HOR * iy + (h/h_step); | 
|  | *pix++ = test_colors[ix]; | 
|  | } | 
|  | } | 
|  | } | 
|  | #endif /* LCD_TEST_PATTERN */ | 
|  |  | 
|  |  | 
|  | /************************************************************************/ | 
|  | /* ** GENERIC Initialization Routines					*/ | 
|  | /************************************************************************/ | 
|  |  | 
|  | int drv_lcd_init (void) | 
|  | { | 
|  | device_t 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 */ | 
|  |  | 
|  | /* Device initialization */ | 
|  | memset (&lcddev, 0, sizeof (lcddev)); | 
|  |  | 
|  | 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); | 
|  |  | 
|  | return (rc == 0) ? 1 : rc; | 
|  | } | 
|  |  | 
|  | /*----------------------------------------------------------------------*/ | 
|  | static int lcd_clear (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[]) | 
|  | { | 
|  | #if LCD_BPP == LCD_MONOCHROME | 
|  | /* Setting the palette */ | 
|  | lcd_initcolregs(); | 
|  |  | 
|  | #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); | 
|  | #endif | 
|  |  | 
|  | #ifndef CFG_WHITE_ON_BLACK | 
|  | lcd_setfgcolor (CONSOLE_COLOR_BLACK); | 
|  | lcd_setbgcolor (CONSOLE_COLOR_WHITE); | 
|  | #else | 
|  | lcd_setfgcolor (CONSOLE_COLOR_WHITE); | 
|  | lcd_setbgcolor (CONSOLE_COLOR_BLACK); | 
|  | #endif	/* CFG_WHITE_ON_BLACK */ | 
|  |  | 
|  | #ifdef	LCD_TEST_PATTERN | 
|  | test_pattern(); | 
|  | #else | 
|  | /* set framebuffer to background color */ | 
|  | 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"); | 
|  | 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 | 
|  | ); | 
|  |  | 
|  | /*----------------------------------------------------------------------*/ | 
|  |  | 
|  | static int lcd_init (void *lcdbase) | 
|  | { | 
|  | /* Initialize the lcd controller */ | 
|  | debug ("[LCD] Initializing LCD frambuffer at %p\n", lcdbase); | 
|  |  | 
|  | lcd_ctrl_init (lcdbase); | 
|  | lcd_clear (NULL, 1, 1, NULL);	/* dummy args */ | 
|  | lcd_enable (); | 
|  |  | 
|  | /* Initialize the console */ | 
|  | console_col = 0; | 
|  | #ifdef CONFIG_LCD_INFO_BELOW_LOGO | 
|  | console_row = 7 + BMP_LOGO_HEIGHT / VIDEO_FONT_HEIGHT; | 
|  | #else | 
|  | console_row = 1;	/* leave 1 blank line below logo */ | 
|  | #endif | 
|  | lcd_is_enabled = 1; | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  |  | 
|  | /************************************************************************/ | 
|  | /* ** ROM capable initialization part - needed to reserve FB memory	*/ | 
|  | /************************************************************************/ | 
|  | /* | 
|  | * This is called early in the system initialization to grab memory | 
|  | * for the LCD controller. | 
|  | * Returns new address for monitor, after reserving LCD buffer memory | 
|  | * | 
|  | * Note that this is running from ROM, so no write access to global data. | 
|  | */ | 
|  | ulong lcd_setmem (ulong addr) | 
|  | { | 
|  | ulong size; | 
|  | 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) ); | 
|  |  | 
|  | size = line_length * panel_info.vl_row; | 
|  |  | 
|  | /* Round up to nearest full page */ | 
|  | size = (size + (PAGE_SIZE - 1)) & ~(PAGE_SIZE - 1); | 
|  |  | 
|  | /* Allocate pages for the frame buffer. */ | 
|  | addr -= size; | 
|  |  | 
|  | debug ("Reserving %ldk for LCD Framebuffer at: %08lx\n", size>>10, addr); | 
|  |  | 
|  | return (addr); | 
|  | } | 
|  |  | 
|  | /*----------------------------------------------------------------------*/ | 
|  |  | 
|  | static void lcd_setfgcolor (int color) | 
|  | { | 
|  | lcd_color_fg = color & 0x0F; | 
|  | } | 
|  |  | 
|  | /*----------------------------------------------------------------------*/ | 
|  |  | 
|  | static void lcd_setbgcolor (int color) | 
|  | { | 
|  | lcd_color_bg = color & 0x0F; | 
|  | } | 
|  |  | 
|  | /*----------------------------------------------------------------------*/ | 
|  |  | 
|  | #ifdef	NOT_USED_SO_FAR | 
|  | static int lcd_getfgcolor (void) | 
|  | { | 
|  | return lcd_color_fg; | 
|  | } | 
|  | #endif	/* NOT_USED_SO_FAR */ | 
|  |  | 
|  | /*----------------------------------------------------------------------*/ | 
|  |  | 
|  | static int lcd_getbgcolor (void) | 
|  | { | 
|  | return lcd_color_bg; | 
|  | } | 
|  |  | 
|  | /*----------------------------------------------------------------------*/ | 
|  |  | 
|  | /************************************************************************/ | 
|  | /* ** Chipset depending Bitmap / Logo stuff...                          */ | 
|  | /************************************************************************/ | 
|  | #ifdef CONFIG_LCD_LOGO | 
|  | void bitmap_plot (int x, int y) | 
|  | { | 
|  | ushort *cmap; | 
|  | 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 *) CFG_IMMR; | 
|  | volatile cpm8xx_t *cp = &(immr->im_cpm); | 
|  | #endif | 
|  |  | 
|  | debug ("Logo: width %d  height %d  colors %d  cmap %d\n", | 
|  | BMP_LOGO_WIDTH, BMP_LOGO_HEIGHT, BMP_LOGO_COLORS, | 
|  | sizeof(bmp_logo_palette)/(sizeof(ushort))); | 
|  |  | 
|  | 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)]); | 
|  | #endif | 
|  |  | 
|  | WATCHDOG_RESET(); | 
|  |  | 
|  | /* Set color map */ | 
|  | for (i=0; i<(sizeof(bmp_logo_palette)/(sizeof(ushort))); ++i) { | 
|  | ushort colreg = bmp_logo_palette[i]; | 
|  | #ifdef  CFG_INVERT_COLORS | 
|  | *cmap++ = 0xffff - colreg; | 
|  | #else | 
|  | *cmap++ = colreg; | 
|  | #endif | 
|  | } | 
|  |  | 
|  | WATCHDOG_RESET(); | 
|  |  | 
|  | 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 */ | 
|  | 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])]; | 
|  | } | 
|  | bmap += BMP_LOGO_WIDTH; | 
|  | fb16 += panel_info.vl_col; | 
|  | } | 
|  | } | 
|  |  | 
|  | WATCHDOG_RESET(); | 
|  | } | 
|  | #endif /* CONFIG_LCD_LOGO */ | 
|  |  | 
|  | /*----------------------------------------------------------------------*/ | 
|  | #if defined(CONFIG_CMD_BMP) || defined(CONFIG_SPLASH_SCREEN) | 
|  | /* | 
|  | * Display the BMP file located at address bmp_image. | 
|  | * Only uncompressed. | 
|  | */ | 
|  | int lcd_display_bitmap(ulong bmp_image, int x, int y) | 
|  | { | 
|  | #if !defined(CONFIG_MCC200) | 
|  | ushort *cmap; | 
|  | #endif | 
|  | 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 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 *) CFG_IMMR; | 
|  | volatile cpm8xx_t *cp = &(immr->im_cpm); | 
|  | #endif | 
|  |  | 
|  | 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); | 
|  |  | 
|  | bpix = NBITS(panel_info.vl_bpix); | 
|  |  | 
|  | if ((bpix != 1) && (bpix != 8)) { | 
|  | printf ("Error: %d bit/pixel mode not supported by U-Boot\n", | 
|  | bpix); | 
|  | return 1; | 
|  | } | 
|  |  | 
|  | if (bpix != le16_to_cpu(bmp->header.bit_count)) { | 
|  | 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", | 
|  | (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)]); | 
|  | #else | 
|  | # error "Don't know location of color map" | 
|  | #endif | 
|  |  | 
|  | /* Set color map */ | 
|  | for (i=0; i<colors; ++i) { | 
|  | bmp_color_table_entry_t cte = bmp->color_table[i]; | 
|  | ushort colreg = | 
|  | ( ((cte.red)   << 8) & 0xf800) | | 
|  | ( ((cte.green) << 3) & 0x07e0) | | 
|  | ( ((cte.blue)  >> 3) & 0x001f) ; | 
|  | #ifdef CFG_INVERT_COLORS | 
|  | *cmap = 0xffff - colreg; | 
|  | #else | 
|  | *cmap = colreg; | 
|  | #endif | 
|  | #if defined(CONFIG_PXA250) | 
|  | cmap++; | 
|  | #elif defined(CONFIG_MPC823) | 
|  | cmap--; | 
|  | #endif | 
|  | } | 
|  | } | 
|  | #endif | 
|  |  | 
|  | /* | 
|  | *  BMP format for Monochrome assumes that the state of a | 
|  | * pixel is described on a per Bit basis, not per Byte. | 
|  | *  So, in case of Monochrome BMP we should align widths | 
|  | * on a byte boundary and convert them from Bit to Byte | 
|  | * units. | 
|  | *  Probably, PXA250 and MPC823 process 1bpp BMP images in | 
|  | * their own ways, so make the converting to be MCC200 | 
|  | * specific. | 
|  | */ | 
|  | #if defined(CONFIG_MCC200) | 
|  | if (bpix==1) | 
|  | { | 
|  | width = ((width + 7) & ~7) >> 3; | 
|  | x     = ((x + 7) & ~7) >> 3; | 
|  | pwidth= ((pwidth + 7) & ~7) >> 3; | 
|  | } | 
|  | #endif | 
|  |  | 
|  | padded_line = (width&0x3) ? ((width&~0x3)+4) : (width); | 
|  | if ((x + width)>pwidth) | 
|  | width = pwidth - x; | 
|  | if ((y + height)>panel_info.vl_row) | 
|  | height = panel_info.vl_row - y; | 
|  |  | 
|  | 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) | 
|  | *(fb++)=*(bmap++); | 
|  | #elif defined(CONFIG_MPC823) || defined(CONFIG_MCC200) | 
|  | *(fb++)=255-*(bmap++); | 
|  | #endif | 
|  | bmap += (width - padded_line); | 
|  | fb   -= (width + lcd_line_length); | 
|  | } | 
|  |  | 
|  | return (0); | 
|  | } | 
|  | #endif | 
|  |  | 
|  |  | 
|  | static void *lcd_logo (void) | 
|  | { | 
|  | #ifdef CONFIG_LCD_INFO | 
|  | char info[80]; | 
|  | char temp[32]; | 
|  | #endif /* CONFIG_LCD_INFO */ | 
|  |  | 
|  | #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); | 
|  | do_splash = 0; | 
|  |  | 
|  | if (lcd_display_bitmap (addr, 0, 0) == 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) 2004 DENX Software Engineering"); | 
|  | 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 */ | 
|  |  | 
|  | #if defined(CONFIG_LCD_LOGO) && !defined(CONFIG_LCD_INFO_BELOW_LOGO) | 
|  | return ((void *)((ulong)lcd_base + BMP_LOGO_HEIGHT * lcd_line_length)); | 
|  | #else | 
|  | return ((void *)lcd_base); | 
|  | #endif /* CONFIG_LCD_LOGO && !CONFIG_LCD_INFO_BELOW_LOGO */ | 
|  | } | 
|  |  | 
|  | /************************************************************************/ | 
|  | /************************************************************************/ | 
|  |  | 
|  | #endif /* CONFIG_LCD */ |