xref: /openbmc/u-boot/common/lcd.c (revision 9973e3c6)
1 /*
2  * Common LCD routines for supported CPUs
3  *
4  * (C) Copyright 2001-2002
5  * Wolfgang Denk, DENX Software Engineering -- wd@denx.de
6  *
7  * See file CREDITS for list of people who contributed to this
8  * project.
9  *
10  * This program is free software; you can redistribute it and/or
11  * modify it under the terms of the GNU General Public License as
12  * published by the Free Software Foundation; either version 2 of
13  * the License, or (at your option) any later version.
14  *
15  * This program is distributed in the hope that it will be useful,
16  * but WITHOUT ANY WARRANTY; without even the implied warranty of
17  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.	 See the
18  * GNU General Public License for more details.
19  *
20  * You should have received a copy of the GNU General Public License
21  * along with this program; if not, write to the Free Software
22  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
23  * MA 02111-1307 USA
24  */
25 
26 /************************************************************************/
27 /* ** HEADER FILES							*/
28 /************************************************************************/
29 
30 /* #define DEBUG */
31 
32 #include <config.h>
33 #include <common.h>
34 #include <command.h>
35 #include <version.h>
36 #include <stdarg.h>
37 #include <linux/types.h>
38 #include <devices.h>
39 #if defined(CONFIG_POST)
40 #include <post.h>
41 #endif
42 #include <lcd.h>
43 #include <watchdog.h>
44 
45 #if defined(CONFIG_PXA250)
46 #include <asm/byteorder.h>
47 #endif
48 
49 #if defined(CONFIG_MPC823)
50 #include <lcdvideo.h>
51 #endif
52 
53 #if defined(CONFIG_ATMEL_LCD)
54 #include <atmel_lcdc.h>
55 #include <nand.h>
56 #endif
57 
58 #ifdef CONFIG_LCD
59 
60 /************************************************************************/
61 /* ** FONT DATA								*/
62 /************************************************************************/
63 #include <video_font.h>		/* Get font data, width and height	*/
64 
65 /************************************************************************/
66 /* ** LOGO DATA								*/
67 /************************************************************************/
68 #ifdef CONFIG_LCD_LOGO
69 # include <bmp_logo.h>		/* Get logo data, width and height	*/
70 # if (CONSOLE_COLOR_WHITE >= BMP_LOGO_OFFSET)
71 #  error Default Color Map overlaps with Logo Color Map
72 # endif
73 #endif
74 
75 DECLARE_GLOBAL_DATA_PTR;
76 
77 ulong lcd_setmem (ulong addr);
78 
79 static void lcd_drawchars (ushort x, ushort y, uchar *str, int count);
80 static inline void lcd_puts_xy (ushort x, ushort y, uchar *s);
81 static inline void lcd_putc_xy (ushort x, ushort y, uchar  c);
82 
83 static int lcd_init (void *lcdbase);
84 
85 static int lcd_clear (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[]);
86 extern void lcd_ctrl_init (void *lcdbase);
87 extern void lcd_enable (void);
88 static void *lcd_logo (void);
89 
90 
91 #if LCD_BPP == LCD_COLOR8
92 extern void lcd_setcolreg (ushort regno,
93 				ushort red, ushort green, ushort blue);
94 #endif
95 #if LCD_BPP == LCD_MONOCHROME
96 extern void lcd_initcolregs (void);
97 #endif
98 
99 static int lcd_getbgcolor (void);
100 static void lcd_setfgcolor (int color);
101 static void lcd_setbgcolor (int color);
102 
103 char lcd_is_enabled = 0;
104 extern vidinfo_t panel_info;
105 
106 #ifdef	NOT_USED_SO_FAR
107 static void lcd_getcolreg (ushort regno,
108 				ushort *red, ushort *green, ushort *blue);
109 static int lcd_getfgcolor (void);
110 #endif	/* NOT_USED_SO_FAR */
111 
112 /************************************************************************/
113 
114 /*----------------------------------------------------------------------*/
115 
116 static void console_scrollup (void)
117 {
118 #if 1
119 	/* Copy up rows ignoring the first one */
120 	memcpy (CONSOLE_ROW_FIRST, CONSOLE_ROW_SECOND, CONSOLE_SCROLL_SIZE);
121 
122 	/* Clear the last one */
123 	memset (CONSOLE_ROW_LAST, COLOR_MASK(lcd_color_bg), CONSOLE_ROW_SIZE);
124 #else
125 	/*
126 	 * Poor attempt to optimize speed by moving "long"s.
127 	 * But the code is ugly, and not a bit faster :-(
128 	 */
129 	ulong *t = (ulong *)CONSOLE_ROW_FIRST;
130 	ulong *s = (ulong *)CONSOLE_ROW_SECOND;
131 	ulong    l = CONSOLE_SCROLL_SIZE / sizeof(ulong);
132 	uchar  c = lcd_color_bg & 0xFF;
133 	ulong val= (c<<24) | (c<<16) | (c<<8) | c;
134 
135 	while (l--)
136 		*t++ = *s++;
137 
138 	t = (ulong *)CONSOLE_ROW_LAST;
139 	l = CONSOLE_ROW_SIZE / sizeof(ulong);
140 
141 	while (l-- > 0)
142 		*t++ = val;
143 #endif
144 }
145 
146 /*----------------------------------------------------------------------*/
147 
148 static inline void console_back (void)
149 {
150 	if (--console_col < 0) {
151 		console_col = CONSOLE_COLS-1 ;
152 		if (--console_row < 0) {
153 			console_row = 0;
154 		}
155 	}
156 
157 	lcd_putc_xy (console_col * VIDEO_FONT_WIDTH,
158 		     console_row * VIDEO_FONT_HEIGHT,
159 		     ' ');
160 }
161 
162 /*----------------------------------------------------------------------*/
163 
164 static inline void console_newline (void)
165 {
166 	++console_row;
167 	console_col = 0;
168 
169 	/* Check if we need to scroll the terminal */
170 	if (console_row >= CONSOLE_ROWS) {
171 		/* Scroll everything up */
172 		console_scrollup () ;
173 		--console_row;
174 	}
175 }
176 
177 /*----------------------------------------------------------------------*/
178 
179 void lcd_putc (const char c)
180 {
181 	if (!lcd_is_enabled) {
182 		serial_putc(c);
183 		return;
184 	}
185 
186 	switch (c) {
187 	case '\r':	console_col = 0;
188 			return;
189 
190 	case '\n':	console_newline();
191 			return;
192 
193 	case '\t':	/* Tab (8 chars alignment) */
194 			console_col |=  8;
195 			console_col &= ~7;
196 
197 			if (console_col >= CONSOLE_COLS) {
198 				console_newline();
199 			}
200 			return;
201 
202 	case '\b':	console_back();
203 			return;
204 
205 	default:	lcd_putc_xy (console_col * VIDEO_FONT_WIDTH,
206 				     console_row * VIDEO_FONT_HEIGHT,
207 				     c);
208 			if (++console_col >= CONSOLE_COLS) {
209 				console_newline();
210 			}
211 			return;
212 	}
213 	/* NOTREACHED */
214 }
215 
216 /*----------------------------------------------------------------------*/
217 
218 void lcd_puts (const char *s)
219 {
220 	if (!lcd_is_enabled) {
221 		serial_puts (s);
222 		return;
223 	}
224 
225 	while (*s) {
226 		lcd_putc (*s++);
227 	}
228 }
229 
230 /************************************************************************/
231 /* ** Low-Level Graphics Routines					*/
232 /************************************************************************/
233 
234 static void lcd_drawchars (ushort x, ushort y, uchar *str, int count)
235 {
236 	uchar *dest;
237 	ushort off, row;
238 
239 	dest = (uchar *)(lcd_base + y * lcd_line_length + x * (1 << LCD_BPP) / 8);
240 	off  = x * (1 << LCD_BPP) % 8;
241 
242 	for (row=0;  row < VIDEO_FONT_HEIGHT;  ++row, dest += lcd_line_length)  {
243 		uchar *s = str;
244 		uchar *d = dest;
245 		int i;
246 
247 #if LCD_BPP == LCD_MONOCHROME
248 		uchar rest = *d & -(1 << (8-off));
249 		uchar sym;
250 #endif
251 		for (i=0; i<count; ++i) {
252 			uchar c, bits;
253 
254 			c = *s++;
255 			bits = video_fontdata[c * VIDEO_FONT_HEIGHT + row];
256 
257 #if LCD_BPP == LCD_MONOCHROME
258 			sym  = (COLOR_MASK(lcd_color_fg) & bits) |
259 			       (COLOR_MASK(lcd_color_bg) & ~bits);
260 
261 			*d++ = rest | (sym >> off);
262 			rest = sym << (8-off);
263 #elif LCD_BPP == LCD_COLOR8
264 			for (c=0; c<8; ++c) {
265 				*d++ = (bits & 0x80) ?
266 						lcd_color_fg : lcd_color_bg;
267 				bits <<= 1;
268 			}
269 #elif LCD_BPP == LCD_COLOR16
270 			for (c=0; c<16; ++c) {
271 				*d++ = (bits & 0x80) ?
272 						lcd_color_fg : lcd_color_bg;
273 				bits <<= 1;
274 			}
275 #endif
276 		}
277 #if LCD_BPP == LCD_MONOCHROME
278 		*d  = rest | (*d & ((1 << (8-off)) - 1));
279 #endif
280 	}
281 }
282 
283 /*----------------------------------------------------------------------*/
284 
285 static inline void lcd_puts_xy (ushort x, ushort y, uchar *s)
286 {
287 #if defined(CONFIG_LCD_LOGO) && !defined(CONFIG_LCD_INFO_BELOW_LOGO)
288 	lcd_drawchars (x, y+BMP_LOGO_HEIGHT, s, strlen ((char *)s));
289 #else
290 	lcd_drawchars (x, y, s, strlen ((char *)s));
291 #endif
292 }
293 
294 /*----------------------------------------------------------------------*/
295 
296 static inline void lcd_putc_xy (ushort x, ushort y, uchar c)
297 {
298 #if defined(CONFIG_LCD_LOGO) && !defined(CONFIG_LCD_INFO_BELOW_LOGO)
299 	lcd_drawchars (x, y+BMP_LOGO_HEIGHT, &c, 1);
300 #else
301 	lcd_drawchars (x, y, &c, 1);
302 #endif
303 }
304 
305 /************************************************************************/
306 /**  Small utility to check that you got the colours right		*/
307 /************************************************************************/
308 #ifdef LCD_TEST_PATTERN
309 
310 #define	N_BLK_VERT	2
311 #define	N_BLK_HOR	3
312 
313 static int test_colors[N_BLK_HOR*N_BLK_VERT] = {
314 	CONSOLE_COLOR_RED,	CONSOLE_COLOR_GREEN,	CONSOLE_COLOR_YELLOW,
315 	CONSOLE_COLOR_BLUE,	CONSOLE_COLOR_MAGENTA,	CONSOLE_COLOR_CYAN,
316 };
317 
318 static void test_pattern (void)
319 {
320 	ushort v_max  = panel_info.vl_row;
321 	ushort h_max  = panel_info.vl_col;
322 	ushort v_step = (v_max + N_BLK_VERT - 1) / N_BLK_VERT;
323 	ushort h_step = (h_max + N_BLK_HOR  - 1) / N_BLK_HOR;
324 	ushort v, h;
325 	uchar *pix = (uchar *)lcd_base;
326 
327 	printf ("[LCD] Test Pattern: %d x %d [%d x %d]\n",
328 		h_max, v_max, h_step, v_step);
329 
330 	/* WARNING: Code silently assumes 8bit/pixel */
331 	for (v=0; v<v_max; ++v) {
332 		uchar iy = v / v_step;
333 		for (h=0; h<h_max; ++h) {
334 			uchar ix = N_BLK_HOR * iy + (h/h_step);
335 			*pix++ = test_colors[ix];
336 		}
337 	}
338 }
339 #endif /* LCD_TEST_PATTERN */
340 
341 
342 /************************************************************************/
343 /* ** GENERIC Initialization Routines					*/
344 /************************************************************************/
345 
346 int drv_lcd_init (void)
347 {
348 	device_t lcddev;
349 	int rc;
350 
351 	lcd_base = (void *)(gd->fb_base);
352 
353 	lcd_line_length = (panel_info.vl_col * NBITS (panel_info.vl_bpix)) / 8;
354 
355 	lcd_init (lcd_base);		/* LCD initialization */
356 
357 	/* Device initialization */
358 	memset (&lcddev, 0, sizeof (lcddev));
359 
360 	strcpy (lcddev.name, "lcd");
361 	lcddev.ext   = 0;			/* No extensions */
362 	lcddev.flags = DEV_FLAGS_OUTPUT;	/* Output only */
363 	lcddev.putc  = lcd_putc;		/* 'putc' function */
364 	lcddev.puts  = lcd_puts;		/* 'puts' function */
365 
366 	rc = device_register (&lcddev);
367 
368 	return (rc == 0) ? 1 : rc;
369 }
370 
371 /*----------------------------------------------------------------------*/
372 static int lcd_clear (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
373 {
374 #if LCD_BPP == LCD_MONOCHROME
375 	/* Setting the palette */
376 	lcd_initcolregs();
377 
378 #elif LCD_BPP == LCD_COLOR8
379 	/* Setting the palette */
380 	lcd_setcolreg  (CONSOLE_COLOR_BLACK,       0,    0,    0);
381 	lcd_setcolreg  (CONSOLE_COLOR_RED,	0xFF,    0,    0);
382 	lcd_setcolreg  (CONSOLE_COLOR_GREEN,       0, 0xFF,    0);
383 	lcd_setcolreg  (CONSOLE_COLOR_YELLOW,	0xFF, 0xFF,    0);
384 	lcd_setcolreg  (CONSOLE_COLOR_BLUE,        0,    0, 0xFF);
385 	lcd_setcolreg  (CONSOLE_COLOR_MAGENTA,	0xFF,    0, 0xFF);
386 	lcd_setcolreg  (CONSOLE_COLOR_CYAN,	   0, 0xFF, 0xFF);
387 	lcd_setcolreg  (CONSOLE_COLOR_GREY,	0xAA, 0xAA, 0xAA);
388 	lcd_setcolreg  (CONSOLE_COLOR_WHITE,	0xFF, 0xFF, 0xFF);
389 #endif
390 
391 #ifndef CFG_WHITE_ON_BLACK
392 	lcd_setfgcolor (CONSOLE_COLOR_BLACK);
393 	lcd_setbgcolor (CONSOLE_COLOR_WHITE);
394 #else
395 	lcd_setfgcolor (CONSOLE_COLOR_WHITE);
396 	lcd_setbgcolor (CONSOLE_COLOR_BLACK);
397 #endif	/* CFG_WHITE_ON_BLACK */
398 
399 #ifdef	LCD_TEST_PATTERN
400 	test_pattern();
401 #else
402 	/* set framebuffer to background color */
403 	memset ((char *)lcd_base,
404 		COLOR_MASK(lcd_getbgcolor()),
405 		lcd_line_length*panel_info.vl_row);
406 #endif
407 	/* Paint the logo and retrieve LCD base address */
408 	debug ("[LCD] Drawing the logo...\n");
409 	lcd_console_address = lcd_logo ();
410 
411 	console_col = 0;
412 	console_row = 0;
413 
414 	return (0);
415 }
416 
417 U_BOOT_CMD(
418 	cls,	1,	1,	lcd_clear,
419 	"cls     - clear screen\n",
420 	NULL
421 );
422 
423 /*----------------------------------------------------------------------*/
424 
425 static int lcd_init (void *lcdbase)
426 {
427 	/* Initialize the lcd controller */
428 	debug ("[LCD] Initializing LCD frambuffer at %p\n", lcdbase);
429 
430 	lcd_ctrl_init (lcdbase);
431 	lcd_clear (NULL, 1, 1, NULL);	/* dummy args */
432 	lcd_enable ();
433 
434 	/* Initialize the console */
435 	console_col = 0;
436 #ifdef CONFIG_LCD_INFO_BELOW_LOGO
437 	console_row = 7 + BMP_LOGO_HEIGHT / VIDEO_FONT_HEIGHT;
438 #else
439 	console_row = 1;	/* leave 1 blank line below logo */
440 #endif
441 	lcd_is_enabled = 1;
442 
443 	return 0;
444 }
445 
446 
447 /************************************************************************/
448 /* ** ROM capable initialization part - needed to reserve FB memory	*/
449 /************************************************************************/
450 /*
451  * This is called early in the system initialization to grab memory
452  * for the LCD controller.
453  * Returns new address for monitor, after reserving LCD buffer memory
454  *
455  * Note that this is running from ROM, so no write access to global data.
456  */
457 ulong lcd_setmem (ulong addr)
458 {
459 	ulong size;
460 	int line_length = (panel_info.vl_col * NBITS (panel_info.vl_bpix)) / 8;
461 
462 	debug ("LCD panel info: %d x %d, %d bit/pix\n",
463 		panel_info.vl_col, panel_info.vl_row, NBITS (panel_info.vl_bpix) );
464 
465 	size = line_length * panel_info.vl_row;
466 
467 	/* Round up to nearest full page */
468 	size = (size + (PAGE_SIZE - 1)) & ~(PAGE_SIZE - 1);
469 
470 	/* Allocate pages for the frame buffer. */
471 	addr -= size;
472 
473 	debug ("Reserving %ldk for LCD Framebuffer at: %08lx\n", size>>10, addr);
474 
475 	return (addr);
476 }
477 
478 /*----------------------------------------------------------------------*/
479 
480 static void lcd_setfgcolor (int color)
481 {
482 #ifdef CONFIG_ATMEL_LCD
483 	lcd_color_fg = color;
484 #else
485 	lcd_color_fg = color & 0x0F;
486 #endif
487 }
488 
489 /*----------------------------------------------------------------------*/
490 
491 static void lcd_setbgcolor (int color)
492 {
493 #ifdef CONFIG_ATMEL_LCD
494 	lcd_color_bg = color;
495 #else
496 	lcd_color_bg = color & 0x0F;
497 #endif
498 }
499 
500 /*----------------------------------------------------------------------*/
501 
502 #ifdef	NOT_USED_SO_FAR
503 static int lcd_getfgcolor (void)
504 {
505 	return lcd_color_fg;
506 }
507 #endif	/* NOT_USED_SO_FAR */
508 
509 /*----------------------------------------------------------------------*/
510 
511 static int lcd_getbgcolor (void)
512 {
513 	return lcd_color_bg;
514 }
515 
516 /*----------------------------------------------------------------------*/
517 
518 /************************************************************************/
519 /* ** Chipset depending Bitmap / Logo stuff...                          */
520 /************************************************************************/
521 #ifdef CONFIG_LCD_LOGO
522 void bitmap_plot (int x, int y)
523 {
524 #ifdef CONFIG_ATMEL_LCD
525 	uint *cmap;
526 #else
527 	ushort *cmap;
528 #endif
529 	ushort i, j;
530 	uchar *bmap;
531 	uchar *fb;
532 	ushort *fb16;
533 #if defined(CONFIG_PXA250)
534 	struct pxafb_info *fbi = &panel_info.pxa;
535 #elif defined(CONFIG_MPC823)
536 	volatile immap_t *immr = (immap_t *) CFG_IMMR;
537 	volatile cpm8xx_t *cp = &(immr->im_cpm);
538 #endif
539 
540 	debug ("Logo: width %d  height %d  colors %d  cmap %d\n",
541 		BMP_LOGO_WIDTH, BMP_LOGO_HEIGHT, BMP_LOGO_COLORS,
542 		sizeof(bmp_logo_palette)/(sizeof(ushort)));
543 
544 	bmap = &bmp_logo_bitmap[0];
545 	fb   = (uchar *)(lcd_base + y * lcd_line_length + x);
546 
547 	if (NBITS(panel_info.vl_bpix) < 12) {
548 		/* Leave room for default color map */
549 #if defined(CONFIG_PXA250)
550 		cmap = (ushort *)fbi->palette;
551 #elif defined(CONFIG_MPC823)
552 		cmap = (ushort *)&(cp->lcd_cmap[BMP_LOGO_OFFSET*sizeof(ushort)]);
553 #elif defined(CONFIG_ATMEL_LCD)
554 		cmap = (uint *) (panel_info.mmio + ATMEL_LCDC_LUT(0));
555 #endif
556 
557 		WATCHDOG_RESET();
558 
559 		/* Set color map */
560 		for (i=0; i<(sizeof(bmp_logo_palette)/(sizeof(ushort))); ++i) {
561 			ushort colreg = bmp_logo_palette[i];
562 #ifdef CONFIG_ATMEL_LCD
563 			uint lut_entry;
564 #ifdef CONFIG_ATMEL_LCD_BGR555
565 			lut_entry = ((colreg & 0x000F) << 11) |
566 				    ((colreg & 0x00F0) <<  2) |
567 				    ((colreg & 0x0F00) >>  7);
568 #else /* CONFIG_ATMEL_LCD_RGB565 */
569 			lut_entry = ((colreg & 0x000F) << 1) |
570 				    ((colreg & 0x00F0) << 3) |
571 				    ((colreg & 0x0F00) << 4);
572 #endif
573 			*(cmap + BMP_LOGO_OFFSET) = lut_entry;
574 			cmap++;
575 #else /* !CONFIG_ATMEL_LCD */
576 #ifdef  CFG_INVERT_COLORS
577 			*cmap++ = 0xffff - colreg;
578 #else
579 			*cmap++ = colreg;
580 #endif
581 #endif /* CONFIG_ATMEL_LCD */
582 		}
583 
584 		WATCHDOG_RESET();
585 
586 		for (i=0; i<BMP_LOGO_HEIGHT; ++i) {
587 			memcpy (fb, bmap, BMP_LOGO_WIDTH);
588 			bmap += BMP_LOGO_WIDTH;
589 			fb   += panel_info.vl_col;
590 		}
591 	}
592 	else { /* true color mode */
593 		fb16 = (ushort *)(lcd_base + y * lcd_line_length + x);
594 		for (i=0; i<BMP_LOGO_HEIGHT; ++i) {
595 			for (j=0; j<BMP_LOGO_WIDTH; j++) {
596 				fb16[j] = bmp_logo_palette[(bmap[j])];
597 				}
598 			bmap += BMP_LOGO_WIDTH;
599 			fb16 += panel_info.vl_col;
600 		}
601 	}
602 
603 	WATCHDOG_RESET();
604 }
605 #endif /* CONFIG_LCD_LOGO */
606 
607 /*----------------------------------------------------------------------*/
608 #if defined(CONFIG_CMD_BMP) || defined(CONFIG_SPLASH_SCREEN)
609 /*
610  * Display the BMP file located at address bmp_image.
611  * Only uncompressed.
612  */
613 int lcd_display_bitmap(ulong bmp_image, int x, int y)
614 {
615 #ifdef CONFIG_ATMEL_LCD
616 	uint *cmap;
617 #elif !defined(CONFIG_MCC200)
618 	ushort *cmap;
619 #endif
620 	ushort i, j;
621 	uchar *fb;
622 	bmp_image_t *bmp=(bmp_image_t *)bmp_image;
623 	uchar *bmap;
624 	ushort padded_line;
625 	unsigned long width, height;
626 	unsigned long pwidth = panel_info.vl_col;
627 	unsigned colors,bpix;
628 	unsigned long compression;
629 #if defined(CONFIG_PXA250)
630 	struct pxafb_info *fbi = &panel_info.pxa;
631 #elif defined(CONFIG_MPC823)
632 	volatile immap_t *immr = (immap_t *) CFG_IMMR;
633 	volatile cpm8xx_t *cp = &(immr->im_cpm);
634 #endif
635 
636 	if (!((bmp->header.signature[0]=='B') &&
637 		(bmp->header.signature[1]=='M'))) {
638 		printf ("Error: no valid bmp image at %lx\n", bmp_image);
639 		return 1;
640 }
641 
642 	width = le32_to_cpu (bmp->header.width);
643 	height = le32_to_cpu (bmp->header.height);
644 	colors = 1<<le16_to_cpu (bmp->header.bit_count);
645 	compression = le32_to_cpu (bmp->header.compression);
646 
647 	bpix = NBITS(panel_info.vl_bpix);
648 
649 	if ((bpix != 1) && (bpix != 8)) {
650 		printf ("Error: %d bit/pixel mode not supported by U-Boot\n",
651 			bpix);
652 		return 1;
653 	}
654 
655 	if (bpix != le16_to_cpu(bmp->header.bit_count)) {
656 		printf ("Error: %d bit/pixel mode, but BMP has %d bit/pixel\n",
657 			bpix,
658 			le16_to_cpu(bmp->header.bit_count));
659 		return 1;
660 	}
661 
662 	debug ("Display-bmp: %d x %d  with %d colors\n",
663 		(int)width, (int)height, (int)colors);
664 
665 #if !defined(CONFIG_MCC200)
666 	/* MCC200 LCD doesn't need CMAP, supports 1bpp b&w only */
667 	if (bpix==8) {
668 #if defined(CONFIG_PXA250)
669 		cmap = (ushort *)fbi->palette;
670 #elif defined(CONFIG_MPC823)
671 		cmap = (ushort *)&(cp->lcd_cmap[255*sizeof(ushort)]);
672 #elif defined(CONFIG_ATMEL_LCD)
673 		cmap = (uint *) (panel_info.mmio + ATMEL_LCDC_LUT(0));
674 #else
675 # error "Don't know location of color map"
676 #endif
677 
678 		/* Set color map */
679 		for (i=0; i<colors; ++i) {
680 			bmp_color_table_entry_t cte = bmp->color_table[i];
681 			ushort colreg =
682 				( ((cte.red)   << 8) & 0xf800) |
683 				( ((cte.green) << 3) & 0x07e0) |
684 				( ((cte.blue)  >> 3) & 0x001f) ;
685 #ifdef CFG_INVERT_COLORS
686 			*cmap = 0xffff - colreg;
687 #else
688 			*cmap = colreg;
689 #endif
690 #if defined(CONFIG_PXA250)
691 			cmap++;
692 #elif defined(CONFIG_MPC823)
693 			cmap--;
694 #endif
695 		}
696 	}
697 #endif
698 
699 	/*
700 	 *  BMP format for Monochrome assumes that the state of a
701 	 * pixel is described on a per Bit basis, not per Byte.
702 	 *  So, in case of Monochrome BMP we should align widths
703 	 * on a byte boundary and convert them from Bit to Byte
704 	 * units.
705 	 *  Probably, PXA250 and MPC823 process 1bpp BMP images in
706 	 * their own ways, so make the converting to be MCC200
707 	 * specific.
708 	 */
709 #if defined(CONFIG_MCC200)
710 	if (bpix==1)
711 	{
712 		width = ((width + 7) & ~7) >> 3;
713 		x     = ((x + 7) & ~7) >> 3;
714 		pwidth= ((pwidth + 7) & ~7) >> 3;
715 	}
716 #endif
717 
718 	padded_line = (width&0x3) ? ((width&~0x3)+4) : (width);
719 	if ((x + width)>pwidth)
720 		width = pwidth - x;
721 	if ((y + height)>panel_info.vl_row)
722 		height = panel_info.vl_row - y;
723 
724 	bmap = (uchar *)bmp + le32_to_cpu (bmp->header.data_offset);
725 	fb   = (uchar *) (lcd_base +
726 		(y + height - 1) * lcd_line_length + x);
727 	for (i = 0; i < height; ++i) {
728 		WATCHDOG_RESET();
729 		for (j = 0; j < width ; j++)
730 #if defined(CONFIG_PXA250)
731 			*(fb++)=*(bmap++);
732 #elif defined(CONFIG_MPC823) || defined(CONFIG_MCC200)
733 			*(fb++)=255-*(bmap++);
734 #endif
735 		bmap += (width - padded_line);
736 		fb   -= (width + lcd_line_length);
737 	}
738 
739 	return (0);
740 }
741 #endif
742 
743 
744 static void *lcd_logo (void)
745 {
746 #ifdef CONFIG_LCD_INFO
747 	char info[80];
748 	char temp[32];
749 #ifdef CONFIG_ATMEL_LCD
750 	int i;
751 	ulong dram_size, nand_size;
752 #endif
753 #endif /* CONFIG_LCD_INFO */
754 
755 #ifdef CONFIG_SPLASH_SCREEN
756 	char *s;
757 	ulong addr;
758 	static int do_splash = 1;
759 
760 	if (do_splash && (s = getenv("splashimage")) != NULL) {
761 		addr = simple_strtoul(s, NULL, 16);
762 		do_splash = 0;
763 
764 		if (lcd_display_bitmap (addr, 0, 0) == 0) {
765 			return ((void *)lcd_base);
766 		}
767 	}
768 #endif /* CONFIG_SPLASH_SCREEN */
769 
770 #ifdef CONFIG_LCD_LOGO
771 	bitmap_plot (0, 0);
772 #endif /* CONFIG_LCD_LOGO */
773 
774 #ifdef CONFIG_MPC823
775 # ifdef CONFIG_LCD_INFO
776 	sprintf (info, "%s (%s - %s) ", U_BOOT_VERSION, __DATE__, __TIME__);
777 	lcd_drawchars (LCD_INFO_X, LCD_INFO_Y, (uchar *)info, strlen(info));
778 
779 	sprintf (info, "(C) 2004 DENX Software Engineering");
780 	lcd_drawchars (LCD_INFO_X, LCD_INFO_Y + VIDEO_FONT_HEIGHT,
781 					(uchar *)info, strlen(info));
782 
783 	sprintf (info, "    Wolfgang DENK, wd@denx.de");
784 	lcd_drawchars (LCD_INFO_X, LCD_INFO_Y + VIDEO_FONT_HEIGHT * 2,
785 					(uchar *)info, strlen(info));
786 #  ifdef CONFIG_LCD_INFO_BELOW_LOGO
787 	sprintf (info, "MPC823 CPU at %s MHz",
788 		strmhz(temp, gd->cpu_clk));
789 	lcd_drawchars (LCD_INFO_X, LCD_INFO_Y + VIDEO_FONT_HEIGHT * 3,
790 					info, strlen(info));
791 	sprintf (info, "  %ld MB RAM, %ld MB Flash",
792 		gd->ram_size >> 20,
793 		gd->bd->bi_flashsize >> 20 );
794 	lcd_drawchars (LCD_INFO_X, LCD_INFO_Y + VIDEO_FONT_HEIGHT * 4,
795 					info, strlen(info));
796 #  else
797 	/* leave one blank line */
798 
799 	sprintf (info, "MPC823 CPU at %s MHz, %ld MB RAM, %ld MB Flash",
800 		strmhz(temp, gd->cpu_clk),
801 		gd->ram_size >> 20,
802 		gd->bd->bi_flashsize >> 20 );
803 	lcd_drawchars (LCD_INFO_X, LCD_INFO_Y + VIDEO_FONT_HEIGHT * 4,
804 					(uchar *)info, strlen(info));
805 
806 #  endif /* CONFIG_LCD_INFO_BELOW_LOGO */
807 # endif /* CONFIG_LCD_INFO */
808 #endif /* CONFIG_MPC823 */
809 
810 #ifdef CONFIG_ATMEL_LCD
811 # ifdef CONFIG_LCD_INFO
812 	sprintf (info, "%s", U_BOOT_VERSION);
813 	lcd_drawchars (LCD_INFO_X, LCD_INFO_Y, (uchar *)info, strlen(info));
814 
815 	sprintf (info, "(C) 2008 ATMEL Corp");
816 	lcd_drawchars (LCD_INFO_X, LCD_INFO_Y + VIDEO_FONT_HEIGHT,
817 					(uchar *)info, strlen(info));
818 
819 	sprintf (info, "at91support@atmel.com");
820 	lcd_drawchars (LCD_INFO_X, LCD_INFO_Y + VIDEO_FONT_HEIGHT * 2,
821 					(uchar *)info, strlen(info));
822 
823 	sprintf (info, "%s CPU at %s MHz",
824 		AT91_CPU_NAME,
825 		strmhz(temp, AT91_MAIN_CLOCK));
826 	lcd_drawchars (LCD_INFO_X, LCD_INFO_Y + VIDEO_FONT_HEIGHT * 3,
827 					(uchar *)info, strlen(info));
828 
829 	dram_size = 0;
830 	for (i = 0; i < CONFIG_NR_DRAM_BANKS; i++)
831 		dram_size += gd->bd->bi_dram[i].size;
832 	nand_size = 0;
833 	for (i = 0; i < CFG_MAX_NAND_DEVICE; i++)
834 		nand_size += nand_info[i].size;
835 	sprintf (info, "  %ld MB SDRAM, %ld MB NAND",
836 		dram_size >> 20,
837 		nand_size >> 20 );
838 	lcd_drawchars (LCD_INFO_X, LCD_INFO_Y + VIDEO_FONT_HEIGHT * 4,
839 					(uchar *)info, strlen(info));
840 # endif /* CONFIG_LCD_INFO */
841 #endif /* CONFIG_ATMEL_LCD */
842 
843 
844 #if defined(CONFIG_LCD_LOGO) && !defined(CONFIG_LCD_INFO_BELOW_LOGO)
845 	return ((void *)((ulong)lcd_base + BMP_LOGO_HEIGHT * lcd_line_length));
846 #else
847 	return ((void *)lcd_base);
848 #endif /* CONFIG_LCD_LOGO && !CONFIG_LCD_INFO_BELOW_LOGO */
849 }
850 
851 /************************************************************************/
852 /************************************************************************/
853 
854 #endif /* CONFIG_LCD */
855