* Patches by Yuli Barcohen, 13 Jul 2003:
[platform/kernel/u-boot.git] / cpu / mpc8xx / lcd.c
1 /*
2  * (C) Copyright 2001-2002
3  * Wolfgang Denk, DENX Software Engineering -- wd@denx.de
4  *
5  * See file CREDITS for list of people who contributed to this
6  * project.
7  *
8  * This program is free software; you can redistribute it and/or
9  * modify it under the terms of the GNU General Public License as
10  * published by the Free Software Foundation; either version 2 of
11  * the License, or (at your option) any later version.
12  *
13  * This program is distributed in the hope that it will be useful,
14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
16  * GNU General Public License for more details.
17  *
18  * You should have received a copy of the GNU General Public License
19  * along with this program; if not, write to the Free Software
20  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
21  * MA 02111-1307 USA
22  */
23
24 /************************************************************************/
25 /* ** HEADER FILES                                                      */
26 /************************************************************************/
27
28 /* #define DEBUG */
29
30 #include <config.h>
31 #include <common.h>
32 #include <watchdog.h>
33 #include <version.h>
34 #include <stdarg.h>
35 #include <lcdvideo.h>
36 #include <linux/types.h>
37 #include <devices.h>
38 #if defined(CONFIG_POST)
39 #include <post.h>
40 #endif
41 #include <lcd.h>
42
43 #ifdef CONFIG_LCD
44
45 /************************************************************************/
46 /* ** CONFIG STUFF -- should be moved to board config file              */
47 /************************************************************************/
48 #define CONFIG_LCD_LOGO
49 #define LCD_INFO                /* Display Logo, (C) and system info    */
50
51 #if defined(CONFIG_V37) || defined(CONFIG_EDT32F10)
52 #undef CONFIG_LCD_LOGO
53 #undef LCD_INFO
54 #endif
55
56 /* #define LCD_TEST_PATTERN */  /* color backgnd for frame/color adjust */
57 /* #define CFG_INVERT_COLORS */ /* Not needed - adjust vl_dp instead    */
58 /************************************************************************/
59
60 /************************************************************************/
61 /* ** BITMAP DISPLAY SUPPORT  -- should probably be moved elsewhere     */
62 /************************************************************************/
63
64 #if (CONFIG_COMMANDS & CFG_CMD_BMP)
65 #include <bmp_layout.h>
66 #endif /* (CONFIG_COMMANDS & CFG_CMD_BMP) */
67
68 /************************************************************************/
69 /* ** FONT AND LOGO DATA                                                */
70 /************************************************************************/
71
72 #include <video_font.h>         /* Get font data, width and height      */
73
74 #ifdef CONFIG_LCD_LOGO
75 # include <bmp_logo.h>          /* Get logo data, width and height      */
76 #endif
77
78 /************************************************************************/
79 /************************************************************************/
80
81 /*
82  *  Information about displays we are using.  This is for configuring
83  *  the LCD controller and memory allocation.  Someone has to know what
84  *  is connected, as we can't autodetect anything.
85  */
86 #define CFG_HIGH        0       /* Pins are active high */
87 #define CFG_LOW         1       /* Pins are active low */
88
89 typedef struct vidinfo {
90     ushort      vl_col;         /* Number of columns (i.e. 640) */
91     ushort      vl_row;         /* Number of rows (i.e. 480) */
92     ushort      vl_width;       /* Width of display area in millimeters */
93     ushort      vl_height;      /* Height of display area in millimeters */
94
95     /* LCD configuration register.
96     */
97     u_char      vl_clkp;        /* Clock polarity */
98     u_char      vl_oep;         /* Output Enable polarity */
99     u_char      vl_hsp;         /* Horizontal Sync polarity */
100     u_char      vl_vsp;         /* Vertical Sync polarity */
101     u_char      vl_dp;          /* Data polarity */
102     u_char      vl_bpix;        /* Bits per pixel, 0 = 1, 1 = 2, 2 = 4, 3 = 8 */
103     u_char      vl_lbw;         /* LCD Bus width, 0 = 4, 1 = 8 */
104     u_char      vl_splt;        /* Split display, 0 = single-scan, 1 = dual-scan */
105     u_char      vl_clor;        /* Color, 0 = mono, 1 = color */
106     u_char      vl_tft;         /* 0 = passive, 1 = TFT */
107
108     /* Horizontal control register.  Timing from data sheet.
109     */
110     ushort      vl_wbl;         /* Wait between lines */
111
112     /* Vertical control register.
113     */
114     u_char      vl_vpw;         /* Vertical sync pulse width */
115     u_char      vl_lcdac;       /* LCD AC timing */
116     u_char      vl_wbf;         /* Wait between frames */
117 } vidinfo_t;
118
119 #define LCD_MONOCHROME  0
120 #define LCD_COLOR2      1
121 #define LCD_COLOR4      2
122 #define LCD_COLOR8      3
123
124 /*----------------------------------------------------------------------*/
125 #ifdef CONFIG_KYOCERA_KCS057QV1AJ
126 /*
127  *  Kyocera KCS057QV1AJ-G23. Passive, color, single scan.
128  */
129 #define LCD_BPP LCD_COLOR4
130
131 static vidinfo_t panel_info = {
132     640, 480, 132, 99, CFG_HIGH, CFG_HIGH, CFG_HIGH, CFG_HIGH, CFG_HIGH,
133     LCD_BPP, 1, 0, 1, 0,  5, 0, 0, 0
134                 /* wbl, vpw, lcdac, wbf */
135 };
136 #endif /* CONFIG_KYOCERA_KCS057QV1AJ */
137 /*----------------------------------------------------------------------*/
138
139 /*----------------------------------------------------------------------*/
140 #ifdef CONFIG_HITACHI_SP19X001_Z1A
141 /*
142  *  Hitachi SP19X001-. Active, color, single scan.
143  */
144 static vidinfo_t panel_info = {
145     640, 480, 154, 116, CFG_HIGH, CFG_HIGH, CFG_HIGH, CFG_HIGH, CFG_HIGH,
146     LCD_COLOR8, 1, 0, 1, 0, 0, 0, 0, 0
147                 /* wbl, vpw, lcdac, wbf */
148 };
149 #endif /* CONFIG_HITACHI_SP19X001_Z1A */
150 /*----------------------------------------------------------------------*/
151
152 /*----------------------------------------------------------------------*/
153 #ifdef CONFIG_NEC_NL6648AC33
154 /*
155  *  NEC NL6648AC33-18. Active, color, single scan.
156  */
157 static vidinfo_t panel_info = {
158     640, 480, 132, 99, CFG_HIGH, CFG_HIGH, CFG_LOW, CFG_LOW, CFG_HIGH,
159     3, 0, 0, 1, 1, 144, 2, 0, 33
160                 /* wbl, vpw, lcdac, wbf */
161 };
162 #endif /* CONFIG_NEC_NL6648AC33 */
163 /*----------------------------------------------------------------------*/
164
165 #ifdef CONFIG_NEC_NL6648BC20
166 /*
167  *  NEC NL6648BC20-08. 6.5", 640x480. Active, color, single scan.
168  */
169 static vidinfo_t panel_info = {
170     640, 480, 132, 99, CFG_HIGH, CFG_HIGH, CFG_LOW, CFG_LOW, CFG_HIGH,
171     3, 0, 0, 1, 1, 144, 2, 0, 33
172                 /* wbl, vpw, lcdac, wbf */
173 };
174 #endif /* CONFIG_NEC_NL6648BC20 */
175 /*----------------------------------------------------------------------*/
176
177 #ifdef CONFIG_SHARP_LQ104V7DS01
178 /*
179  *  SHARP LQ104V7DS01. 6.5", 640x480. Active, color, single scan.
180  */
181 static vidinfo_t panel_info = {
182     640, 480, 132, 99, CFG_HIGH, CFG_HIGH, CFG_LOW, CFG_LOW, CFG_LOW,
183     3, 0, 0, 1, 1, 25, 1, 0, 33
184                 /* wbl, vpw, lcdac, wbf */
185 };
186 #endif /* CONFIG_SHARP_LQ104V7DS01 */
187 /*----------------------------------------------------------------------*/
188
189 #ifdef CONFIG_SHARP_16x9
190 /*
191  * Sharp 320x240. Active, color, single scan.  It isn't 16x9, and I am
192  * not sure what it is.......
193  */
194 static vidinfo_t panel_info = {
195     320, 240, 0, 0, CFG_HIGH, CFG_HIGH, CFG_HIGH, CFG_HIGH, CFG_HIGH,
196     3, 0, 0, 1, 1, 15, 4, 0, 3
197 };
198 #endif /* CONFIG_SHARP_16x9 */
199 /*----------------------------------------------------------------------*/
200
201 #ifdef CONFIG_SHARP_LQ057Q3DC02
202 /*
203  * Sharp LQ057Q3DC02 display. Active, color, single scan.
204  */
205 #define LCD_DF 12
206
207 static vidinfo_t panel_info = {
208     320, 240, 0, 0, CFG_HIGH, CFG_HIGH, CFG_LOW, CFG_LOW, CFG_HIGH,
209     3, 0, 0, 1, 1, 15, 4, 0, 3
210                 /* wbl, vpw, lcdac, wbf */
211 };
212 #define LCD_INFO_BELOW_LOGO
213 #endif /* CONFIG_SHARP_LQ057Q3DC02 */
214 /*----------------------------------------------------------------------*/
215
216 #ifdef CONFIG_SHARP_LQ64D341
217 /*
218  * Sharp LQ64D341 display, 640x480. Active, color, single scan.
219  */
220 static vidinfo_t panel_info = {
221     640, 480, 0, 0, CFG_HIGH, CFG_HIGH, CFG_LOW, CFG_LOW, CFG_HIGH,
222     3, 0, 0, 1, 1, 128, 16, 0, 32
223                 /* wbl, vpw, lcdac, wbf */
224 };
225 #endif /* CONFIG_SHARP_LQ64D341 */
226
227 #ifdef CONFIG_SHARP_LQ084V1DG21
228 /*
229  * Sharp LQ084V1DG21 display, 640x480. Active, color, single scan.
230  */
231 static vidinfo_t panel_info = {
232     640, 480, 171, 129, CFG_HIGH, CFG_HIGH, CFG_LOW, CFG_LOW, CFG_LOW,
233     3, 0, 0, 1, 1, 160, 3, 0, 48
234                 /* wbl, vpw, lcdac, wbf */
235 };
236 #endif /* CONFIG_SHARP_LQ084V1DG21 */
237
238 /*----------------------------------------------------------------------*/
239
240 #ifdef CONFIG_HLD1045
241 /*
242  * HLD1045 display, 640x480. Active, color, single scan.
243  */
244 static vidinfo_t panel_info = {
245     640, 480, 0, 0, CFG_HIGH, CFG_HIGH, CFG_LOW, CFG_LOW, CFG_HIGH,
246     3, 0, 0, 1, 1, 160, 3, 0, 48
247                 /* wbl, vpw, lcdac, wbf */
248 };
249 #endif /* CONFIG_HLD1045 */
250 /*----------------------------------------------------------------------*/
251
252 #ifdef CONFIG_PRIMEVIEW_V16C6448AC
253 /*
254  * Prime View V16C6448AC
255  */
256 static vidinfo_t panel_info = {
257     640, 480, 130, 98, CFG_HIGH, CFG_HIGH, CFG_LOW, CFG_LOW, CFG_HIGH,
258     3, 0, 0, 1, 1, 144, 2, 0, 35
259                 /* wbl, vpw, lcdac, wbf */
260 };
261 #endif /* CONFIG_PRIMEVIEW_V16C6448AC */
262
263 /*----------------------------------------------------------------------*/
264
265 #ifdef CONFIG_OPTREX_BW
266 /*
267  * Optrex   CBL50840-2 NF-FW 99 22 M5
268  * or
269  * Hitachi  LMG6912RPFC-00T
270  * or
271  * Hitachi  SP14Q002
272  *
273  * 320x240. Black & white.
274  */
275 #define OPTREX_BPP      0       /* 0 - monochrome,     1 bpp */
276                                 /* 1 -  4 grey levels, 2 bpp */
277                                 /* 2 - 16 grey levels, 4 bpp */
278 static vidinfo_t panel_info = {
279     320, 240, 0, 0, CFG_HIGH, CFG_HIGH, CFG_HIGH, CFG_HIGH, CFG_LOW,
280     OPTREX_BPP, 0, 0, 0, 0, 0, 0, 0, 0, 4
281 };
282 #endif /* CONFIG_OPTREX_BW */
283
284 /*-----------------------------------------------------------------*/
285 #ifdef CONFIG_EDT32F10
286 /*
287  * Emerging Display Technologies 320x240. Passive, monochrome, single scan.
288  */
289 #define LCD_BPP         LCD_MONOCHROME
290 #define LCD_DF          10
291
292 static vidinfo_t panel_info = {
293     320, 240, 0, 0, CFG_HIGH, CFG_HIGH, CFG_HIGH, CFG_HIGH, CFG_LOW,
294     LCD_BPP,  0, 0, 0, 0, 33, 0, 0, 0
295 };
296 #endif
297 /*----------------------------------------------------------------------*/
298
299 #if defined(LCD_INFO_BELOW_LOGO)
300 # define LCD_INFO_X             0
301 # define LCD_INFO_Y             (BMP_LOGO_HEIGHT + VIDEO_FONT_HEIGHT)
302 #elif defined(CONFIG_LCD_LOGO)
303 # define LCD_INFO_X             (BMP_LOGO_WIDTH + 4 * VIDEO_FONT_WIDTH)
304 # define LCD_INFO_Y             (VIDEO_FONT_HEIGHT)
305 #else
306 # define LCD_INFO_X             (VIDEO_FONT_WIDTH)
307 # define LCD_INFO_Y             (VIDEO_FONT_HEIGHT)
308 #endif
309
310 #ifndef LCD_BPP
311 #define LCD_BPP                 LCD_COLOR8
312 #endif
313 #ifndef LCD_DF
314 #define LCD_DF                  1
315 #endif
316
317 #define NBITS(bit_code)         (1 << (bit_code))
318 #define NCOLORS(bit_code)       (1 << NBITS(bit_code))
319
320 static int lcd_line_length;
321
322 static int lcd_color_fg;
323 static int lcd_color_bg;
324
325 char lcd_is_enabled = 0;                /* Indicate that LCD is enabled */
326
327 /*
328  * Frame buffer memory information
329  */
330 static void *lcd_base;                  /* Start of framebuffer memory  */
331 static void *lcd_console_address;       /* Start of console buffer      */
332
333
334 /************************************************************************/
335 /* ** CONSOLE CONSTANTS                                                 */
336 /************************************************************************/
337
338 #if LCD_BPP == LCD_MONOCHROME
339
340 /*
341  * Simple color definitions
342  */
343 #define CONSOLE_COLOR_BLACK      0
344 #define CONSOLE_COLOR_WHITE      1      /* Must remain last / highest */
345
346 #else
347
348 /*
349  * Simple color definitions
350  */
351 #define CONSOLE_COLOR_BLACK      0
352 #define CONSOLE_COLOR_RED        1
353 #define CONSOLE_COLOR_GREEN      2
354 #define CONSOLE_COLOR_YELLOW     3
355 #define CONSOLE_COLOR_BLUE       4
356 #define CONSOLE_COLOR_MAGENTA    5
357 #define CONSOLE_COLOR_CYAN       6
358 #define CONSOLE_COLOR_GREY      14
359 #define CONSOLE_COLOR_WHITE     15      /* Must remain last / highest */
360
361 #endif
362
363 #if defined(CONFIG_LCD_LOGO) && (CONSOLE_COLOR_WHITE >= BMP_LOGO_OFFSET)
364 #error Default Color Map overlaps with Logo Color Map
365 #endif
366
367 /************************************************************************/
368
369 #ifndef PAGE_SIZE
370 #define PAGE_SIZE       4096
371 #endif
372
373
374 /************************************************************************/
375 /* ** CONSOLE DEFINITIONS & FUNCTIONS                                   */
376 /************************************************************************/
377
378 #if defined(CONFIG_LCD_LOGO) && !defined(LCD_INFO_BELOW_LOGO)
379 #define CONSOLE_ROWS            ((panel_info.vl_row-BMP_LOGO_HEIGHT) \
380                                         / VIDEO_FONT_HEIGHT)
381 #else
382 #define CONSOLE_ROWS            (panel_info.vl_row / VIDEO_FONT_HEIGHT)
383 #endif
384 #define CONSOLE_COLS            (panel_info.vl_col / VIDEO_FONT_WIDTH)
385 #define CONSOLE_ROW_SIZE        (VIDEO_FONT_HEIGHT * lcd_line_length)
386 #define CONSOLE_ROW_FIRST       (lcd_console_address)
387 #define CONSOLE_ROW_SECOND      (lcd_console_address + CONSOLE_ROW_SIZE)
388 #define CONSOLE_ROW_LAST        (lcd_console_address + CONSOLE_SIZE \
389                                         - CONSOLE_ROW_SIZE)
390 #define CONSOLE_SIZE            (CONSOLE_ROW_SIZE * CONSOLE_ROWS)
391 #define CONSOLE_SCROLL_SIZE     (CONSOLE_SIZE - CONSOLE_ROW_SIZE)
392
393 #if  LCD_BPP == LCD_MONOCHROME
394 #define COLOR_MASK(c)           ((c)      | (c) << 1 | (c) << 2 | (c) << 3 | \
395                                  (c) << 4 | (c) << 5 | (c) << 6 | (c) << 7)
396 #elif LCD_BPP == LCD_COLOR8
397 #define COLOR_MASK(c)           (c)
398 #else
399 #error Unsupported LCD BPP.
400 #endif
401
402 static short console_col;
403 static short console_row;
404
405 /************************************************************************/
406
407 ulong   lcd_setmem (ulong addr);
408
409 static void     lcd_drawchars  (ushort x, ushort y, uchar *str, int count);
410 static inline void lcd_puts_xy (ushort x, ushort y, uchar *s);
411 static inline void lcd_putc_xy (ushort x, ushort y, uchar  c);
412
413 int     lcd_init (void *lcdbase);
414
415 static void     lcd_ctrl_init (void *lcdbase);
416 static void     lcd_enable (void);
417 static void    *lcd_logo (void);
418 #if LCD_BPP == LCD_COLOR8
419 static void     lcd_setcolreg (ushort regno,
420                                 ushort red, ushort green, ushort blue);
421 #endif
422 #if LCD_BPP == LCD_MONOCHROME
423 static void     lcd_initcolregs (void);
424 #endif
425 static int      lcd_getbgcolor (void);
426 static void     lcd_setfgcolor (int color);
427 static void     lcd_setbgcolor (int color);
428
429 #if defined(CONFIG_RBC823)
430 void    lcd_disable (void);
431 #endif
432
433 #ifdef  NOT_USED_SO_FAR
434 static void     lcd_getcolreg (ushort regno,
435                                 ushort *red, ushort *green, ushort *blue);
436 static int      lcd_getfgcolor (void);
437 #endif  /* NOT_USED_SO_FAR */
438
439 /************************************************************************/
440
441 /*----------------------------------------------------------------------*/
442
443 static void console_scrollup (void)
444 {
445 #if 1
446         /* Copy up rows ignoring the first one */
447         memcpy (CONSOLE_ROW_FIRST, CONSOLE_ROW_SECOND, CONSOLE_SCROLL_SIZE);
448
449         /* Clear the last one */
450         memset (CONSOLE_ROW_LAST, COLOR_MASK(lcd_color_bg), CONSOLE_ROW_SIZE);
451 #else
452         /*
453          * Poor attempt to optimize speed by moving "long"s.
454          * But the code is ugly, and not a bit faster :-(
455          */
456         ulong *t = (ulong *)CONSOLE_ROW_FIRST;
457         ulong *s = (ulong *)CONSOLE_ROW_SECOND;
458         ulong    l = CONSOLE_SCROLL_SIZE / sizeof(ulong);
459         uchar  c = lcd_color_bg & 0xFF;
460         ulong val= (c<<24) | (c<<16) | (c<<8) | c;
461
462         while (l--)
463                 *t++ = *s++;
464
465         t = (ulong *)CONSOLE_ROW_LAST;
466         l = CONSOLE_ROW_SIZE / sizeof(ulong);
467
468         while (l-- > 0)
469                 *t++ = val;
470 #endif
471 }
472
473 /*----------------------------------------------------------------------*/
474
475 static inline void console_back (void)
476 {
477         if (--console_col < 0) {
478                 console_col = CONSOLE_COLS-1 ;
479                 if (--console_row < 0) {
480                         console_row = 0;
481                 }
482         }
483
484         lcd_putc_xy (console_col * VIDEO_FONT_WIDTH,
485                      console_row * VIDEO_FONT_HEIGHT,
486                      ' ');
487 }
488
489 /*----------------------------------------------------------------------*/
490
491 static inline void console_newline (void)
492 {
493         ++console_row;
494         console_col = 0;
495
496         /* Check if we need to scroll the terminal */
497         if (console_row >= CONSOLE_ROWS) {
498                 /* Scroll everything up */
499                 console_scrollup () ;
500                 --console_row;
501         }
502 }
503
504 /*----------------------------------------------------------------------*/
505
506 void lcd_putc (const char c)
507 {
508         if (!lcd_is_enabled) {
509                 serial_putc(c);
510                 return;
511         }
512
513         switch (c) {
514         case '\r':      console_col = 0;
515                         return;
516
517         case '\n':      console_newline();
518                         return;
519
520         case '\t':      /* Tab (8 chars alignment) */
521                         console_col |=  8;
522                         console_col &= ~7;
523
524                         if (console_col >= CONSOLE_COLS) {
525                                 console_newline();
526                         }
527                         return;
528
529         case '\b':      console_back();
530                         return;
531
532         default:        lcd_putc_xy (console_col * VIDEO_FONT_WIDTH,
533                                      console_row * VIDEO_FONT_HEIGHT,
534                                      c);
535                         if (++console_col >= CONSOLE_COLS) {
536                                 console_newline();
537                         }
538                         return;
539         }
540         /* NOTREACHED */
541 }
542
543 /*----------------------------------------------------------------------*/
544
545 void lcd_puts (const char *s)
546 {
547         if (!lcd_is_enabled) {
548                 serial_puts (s);
549                 return;
550         }
551
552         while (*s) {
553                 lcd_putc (*s++);
554         }
555 }
556
557 /************************************************************************/
558 /* ** Low-Level Graphics Routines                                       */
559 /************************************************************************/
560
561 static void lcd_drawchars (ushort x, ushort y, uchar *str, int count)
562 {
563         uchar *dest;
564         ushort off, row;
565
566         dest = (uchar *)(lcd_base + y * lcd_line_length + x * (1 << LCD_BPP) / 8);
567         off  = x * (1 << LCD_BPP) % 8;
568
569         for (row=0;  row < VIDEO_FONT_HEIGHT;  ++row, dest += lcd_line_length)  {
570                 uchar *s = str;
571                 uchar *d = dest;
572                 int i;
573
574 #if LCD_BPP == LCD_MONOCHROME
575                 uchar rest = *d & -(1 << (8-off));
576                 uchar sym;
577 #endif
578                 for (i=0; i<count; ++i) {
579                         uchar c, bits;
580
581                         c = *s++;
582                         bits = video_fontdata[c * VIDEO_FONT_HEIGHT + row];
583
584 #if LCD_BPP == LCD_MONOCHROME
585                         sym  = (COLOR_MASK(lcd_color_fg) & bits) |
586                                (COLOR_MASK(lcd_color_bg) & ~bits);
587
588                         *d++ = rest | (sym >> off);
589                         rest = sym << (8-off);
590 #elif LCD_BPP == LCD_COLOR8
591                         for (c=0; c<8; ++c) {
592                                 *d++ = (bits & 0x80) ?
593                                                 lcd_color_fg : lcd_color_bg;
594                                 bits <<= 1;
595                         }
596 #endif
597                 }
598
599 #if LCD_BPP == LCD_MONOCHROME
600                 *d  = rest | (*d & ((1 << (8-off)) - 1));
601 #endif
602         }
603 }
604
605 /*----------------------------------------------------------------------*/
606
607 static inline void lcd_puts_xy (ushort x, ushort y, uchar *s)
608 {
609 #if defined(CONFIG_LCD_LOGO) && !defined(LCD_INFO_BELOW_LOGO)
610         lcd_drawchars (x, y+BMP_LOGO_HEIGHT, s, strlen (s));
611 #else
612         lcd_drawchars (x, y, s, strlen (s));
613 #endif
614 }
615
616 /*----------------------------------------------------------------------*/
617
618 static inline void lcd_putc_xy (ushort x, ushort y, uchar c)
619 {
620 #if defined(CONFIG_LCD_LOGO) && !defined(LCD_INFO_BELOW_LOGO)
621         lcd_drawchars (x, y+BMP_LOGO_HEIGHT, &c, 1);
622 #else
623         lcd_drawchars (x, y, &c, 1);
624 #endif
625 }
626
627 /************************************************************************/
628 /**  Small utility to check that you got the colours right              */
629 /************************************************************************/
630 #ifdef LCD_TEST_PATTERN
631
632 #define N_BLK_VERT      2
633 #define N_BLK_HOR       3
634
635 static int test_colors[N_BLK_HOR*N_BLK_VERT] = {
636         CONSOLE_COLOR_RED,      CONSOLE_COLOR_GREEN,    CONSOLE_COLOR_YELLOW,
637         CONSOLE_COLOR_BLUE,     CONSOLE_COLOR_MAGENTA,  CONSOLE_COLOR_CYAN,
638 };
639
640 static void test_pattern (void)
641 {
642         ushort v_max  = panel_info.vl_row;
643         ushort h_max  = panel_info.vl_col;
644         ushort v_step = (v_max + N_BLK_VERT - 1) / N_BLK_VERT;
645         ushort h_step = (h_max + N_BLK_HOR  - 1) / N_BLK_HOR;
646         ushort v, h;
647         uchar *pix = (uchar *)lcd_base;
648
649         printf ("[LCD] Test Pattern: %d x %d [%d x %d]\n",
650                 h_max, v_max, h_step, v_step);
651
652         /* WARNING: Code silently assumes 8bit/pixel */
653         for (v=0; v<v_max; ++v) {
654                 uchar iy = v / v_step;
655                 for (h=0; h<h_max; ++h) {
656                         uchar ix = N_BLK_HOR * iy + (h/h_step);
657                         *pix++ = test_colors[ix];
658                 }
659         }
660 }
661 #endif /* LCD_TEST_PATTERN */
662
663
664 /************************************************************************/
665 /* ** GENERIC Initialization Routines                                   */
666 /************************************************************************/
667
668 int drv_lcd_init (void)
669 {
670         DECLARE_GLOBAL_DATA_PTR;
671
672         device_t lcddev;
673         int rc;
674
675         lcd_base = (void *)(gd->fb_base);
676
677         lcd_line_length = (panel_info.vl_col * NBITS (panel_info.vl_bpix)) / 8;
678
679         lcd_init (lcd_base);            /* LCD initialization */
680
681         /* Device initialization */
682         memset (&lcddev, 0, sizeof (lcddev));
683
684         strcpy (lcddev.name, "lcd");
685         lcddev.ext   = 0;                       /* No extensions */
686         lcddev.flags = DEV_FLAGS_OUTPUT;        /* Output only */
687         lcddev.putc  = lcd_putc;                /* 'putc' function */
688         lcddev.puts  = lcd_puts;                /* 'puts' function */
689
690         rc = device_register (&lcddev);
691
692         return (rc == 0) ? 1 : rc;
693 }
694
695 /*----------------------------------------------------------------------*/
696
697 int lcd_init (void *lcdbase)
698 {
699         /* Initialize the lcd controller */
700         debug ("[LCD] Initializing LCD frambuffer at %p\n", lcdbase);
701
702         lcd_ctrl_init (lcdbase);
703
704 #if LCD_BPP == LCD_MONOCHROME
705         /* Setting the palette */
706         lcd_initcolregs();
707
708 #elif LCD_BPP == LCD_COLOR8
709         /* Setting the palette */
710         lcd_setcolreg  (CONSOLE_COLOR_BLACK,       0,    0,    0);
711         lcd_setcolreg  (CONSOLE_COLOR_RED,      0xFF,    0,    0);
712         lcd_setcolreg  (CONSOLE_COLOR_GREEN,       0, 0xFF,    0);
713         lcd_setcolreg  (CONSOLE_COLOR_YELLOW,   0xFF, 0xFF,    0);
714         lcd_setcolreg  (CONSOLE_COLOR_BLUE,        0,    0, 0xFF);
715         lcd_setcolreg  (CONSOLE_COLOR_MAGENTA,  0xFF,    0, 0xFF);
716         lcd_setcolreg  (CONSOLE_COLOR_CYAN,        0, 0xFF, 0xFF);
717         lcd_setcolreg  (CONSOLE_COLOR_GREY,     0xAA, 0xAA, 0xAA);
718         lcd_setcolreg  (CONSOLE_COLOR_WHITE,    0xFF, 0xFF, 0xFF);
719 #endif
720
721 #ifndef CFG_WHITE_ON_BLACK
722         lcd_setfgcolor (CONSOLE_COLOR_BLACK);
723         lcd_setbgcolor (CONSOLE_COLOR_WHITE);
724 #else
725         lcd_setfgcolor (CONSOLE_COLOR_WHITE);
726         lcd_setbgcolor (CONSOLE_COLOR_BLACK);
727 #endif  /* CFG_WHITE_ON_BLACK */
728
729 #ifdef  LCD_TEST_PATTERN
730         test_pattern();
731 #else
732         /* set framebuffer to background color */
733         memset ((char *)lcd_base,
734                 COLOR_MASK(lcd_getbgcolor()),
735                 lcd_line_length*panel_info.vl_row);
736 #endif
737
738         lcd_enable ();
739
740         /* Paint the logo and retrieve LCD base address */
741         debug ("[LCD] Drawing the logo...\n");
742         lcd_console_address = lcd_logo ();
743
744         /* Initialize the console */
745         console_col = 0;
746 #ifdef LCD_INFO_BELOW_LOGO
747         console_row = 7 + BMP_LOGO_HEIGHT / VIDEO_FONT_HEIGHT;
748 #else
749         console_row = 1;        /* leave 1 blank line below logo */
750 #endif
751         lcd_is_enabled = 1;
752
753         return 0;
754 }
755
756
757 /************************************************************************/
758 /* ** ROM capable initialization part - needed to reserve FB memory     */
759 /************************************************************************/
760
761 /*
762  * This is called early in the system initialization to grab memory
763  * for the LCD controller.
764  * Returns new address for monitor, after reserving LCD buffer memory
765  *
766  * Note that this is running from ROM, so no write access to global data.
767  */
768 ulong lcd_setmem (ulong addr)
769 {
770         ulong size;
771         int line_length = (panel_info.vl_col * NBITS (panel_info.vl_bpix)) / 8;
772
773         debug ("LCD panel info: %d x %d, %d bit/pix\n",
774                 panel_info.vl_col, panel_info.vl_row, NBITS (panel_info.vl_bpix) );
775
776         size = line_length * panel_info.vl_row;
777
778         /* Round up to nearest full page */
779         size = (size + (PAGE_SIZE - 1)) & ~(PAGE_SIZE - 1);
780
781         /* Allocate pages for the frame buffer. */
782         addr -= size;
783
784         debug ("Reserving %ldk for LCD Framebuffer at: %08lx\n", size>>10, addr);
785
786         return (addr);
787 }
788
789
790 /************************************************************************/
791 /* ----------------- chipset specific functions ----------------------- */
792 /************************************************************************/
793
794 static void lcd_ctrl_init (void *lcdbase)
795 {
796         volatile immap_t *immr = (immap_t *) CFG_IMMR;
797         volatile lcd823_t *lcdp = &immr->im_lcd;
798
799         uint lccrtmp;
800         uint lchcr_hpc_tmp;
801
802         /* Initialize the LCD control register according to the LCD
803          * parameters defined.  We do everything here but enable
804          * the controller.
805          */
806
807         lccrtmp  = LCDBIT (LCCR_BNUM_BIT,
808                    (((panel_info.vl_row * panel_info.vl_col) * (1 << LCD_BPP)) / 128));
809
810         lccrtmp |= LCDBIT (LCCR_CLKP_BIT, panel_info.vl_clkp)   |
811                    LCDBIT (LCCR_OEP_BIT,  panel_info.vl_oep)    |
812                    LCDBIT (LCCR_HSP_BIT,  panel_info.vl_hsp)    |
813                    LCDBIT (LCCR_VSP_BIT,  panel_info.vl_vsp)    |
814                    LCDBIT (LCCR_DP_BIT,   panel_info.vl_dp)     |
815                    LCDBIT (LCCR_BPIX_BIT, panel_info.vl_bpix)   |
816                    LCDBIT (LCCR_LBW_BIT,  panel_info.vl_lbw)    |
817                    LCDBIT (LCCR_SPLT_BIT, panel_info.vl_splt)   |
818                    LCDBIT (LCCR_CLOR_BIT, panel_info.vl_clor)   |
819                    LCDBIT (LCCR_TFT_BIT,  panel_info.vl_tft);
820
821 #if 0
822         lccrtmp |= ((SIU_LEVEL5 / 2) << 12);
823         lccrtmp |= LCCR_EIEN;
824 #endif
825
826         lcdp->lcd_lccr = lccrtmp;
827         lcdp->lcd_lcsr = 0xFF;          /* Clear pending interrupts */
828
829         /* Initialize LCD controller bus priorities.
830          */
831 #ifdef CONFIG_RBC823
832         immr->im_siu_conf.sc_sdcr = (immr->im_siu_conf.sc_sdcr & ~0x0f) | 1;    /* RAID = 01, LAID = 00 */
833 #else
834         immr->im_siu_conf.sc_sdcr &= ~0x0f;     /* RAID = LAID = 0 */
835
836         /* set SHFT/CLOCK division factor 4
837          * This needs to be set based upon display type and processor
838          * speed.  The TFT displays run about 20 to 30 MHz.
839          * I was running 64 MHz processor speed.
840          * The value for this divider must be chosen so the result is
841          * an integer of the processor speed (i.e., divide by 3 with
842          * 64 MHz would be bad).
843          */
844         immr->im_clkrst.car_sccr &= ~0x1F;
845         immr->im_clkrst.car_sccr |= LCD_DF;     /* was 8 */
846
847 #endif /* CONFIG_RBC823 */
848
849 #if defined(CONFIG_RBC823)
850         /* Enable LCD on port D.
851          */
852         immr->im_ioport.iop_pddat &= 0x0300;
853         immr->im_ioport.iop_pdpar |= 0x1CFF;
854         immr->im_ioport.iop_pddir |= 0x1CFF;
855
856         /* Configure LCD_ON, VEE_ON, CCFL_ON on port B.
857          */
858         immr->im_cpm.cp_pbdat &= ~0x00005001;
859         immr->im_cpm.cp_pbpar &= ~0x00005001;
860         immr->im_cpm.cp_pbdir |=  0x00005001;
861 #elif !defined(CONFIG_EDT32F10)
862         /* Enable LCD on port D.
863          */
864         immr->im_ioport.iop_pdpar |= 0x1FFF;
865         immr->im_ioport.iop_pddir |= 0x1FFF;
866
867         /* Enable LCD_A/B/C on port B.
868          */
869         immr->im_cpm.cp_pbpar |= 0x00005001;
870         immr->im_cpm.cp_pbdir |= 0x00005001;
871 #else
872         /* Enable LCD on port D.
873          */
874         immr->im_ioport.iop_pdpar |= 0x1DFF;
875         immr->im_ioport.iop_pdpar &= ~0x0200;
876         immr->im_ioport.iop_pddir |= 0x1FFF;
877         immr->im_ioport.iop_pddat |= 0x0200;
878 #endif
879
880         /* Load the physical address of the linear frame buffer
881          * into the LCD controller.
882          * BIG NOTE:  This has to be modified to load A and B depending
883          * upon the split mode of the LCD.
884          */
885         lcdp->lcd_lcfaa = (ulong)lcd_base;
886         lcdp->lcd_lcfba = (ulong)lcd_base;
887
888         /* MORE HACKS...This must be updated according to 823 manual
889          * for different panels.
890          * Udi Finkelstein - done - see below:
891          * Note: You better not try unsupported combinations such as
892          * 4-bit wide passive dual scan LCD at 4/8 Bit color.
893          */
894         lchcr_hpc_tmp =
895                 (panel_info.vl_col *
896                  (panel_info.vl_tft ? 8 :
897                         (((2 - panel_info.vl_lbw) << /* 4 bit=2, 8-bit = 1 */
898                          /* use << to mult by: single scan = 1, dual scan = 2 */
899                           panel_info.vl_splt) *
900                          (panel_info.vl_bpix | 1)))) >> 3; /* 2/4 BPP = 1, 8/16 BPP = 3 */
901
902         lcdp->lcd_lchcr = LCHCR_BO |
903                           LCDBIT (LCHCR_AT_BIT, 4) |
904                           LCDBIT (LCHCR_HPC_BIT, lchcr_hpc_tmp) |
905                           panel_info.vl_wbl;
906
907         lcdp->lcd_lcvcr = LCDBIT (LCVCR_VPW_BIT, panel_info.vl_vpw) |
908                           LCDBIT (LCVCR_LCD_AC_BIT, panel_info.vl_lcdac) |
909                           LCDBIT (LCVCR_VPC_BIT, panel_info.vl_row) |
910                           panel_info.vl_wbf;
911
912 }
913
914 /*----------------------------------------------------------------------*/
915
916 #ifdef  NOT_USED_SO_FAR
917 static void
918 lcd_getcolreg (ushort regno, ushort *red, ushort *green, ushort *blue)
919 {
920         volatile immap_t *immr = (immap_t *) CFG_IMMR;
921         volatile cpm8xx_t *cp = &(immr->im_cpm);
922         unsigned short colreg, *cmap_ptr;
923
924         cmap_ptr = (unsigned short *)&cp->lcd_cmap[regno * 2];
925
926         colreg = *cmap_ptr;
927 #ifdef  CFG_INVERT_COLORS
928         colreg ^= 0x0FFF;
929 #endif
930
931         *red   = (colreg >> 8) & 0x0F;
932         *green = (colreg >> 4) & 0x0F;
933         *blue  =  colreg       & 0x0F;
934 }
935 #endif  /* NOT_USED_SO_FAR */
936
937 /*----------------------------------------------------------------------*/
938
939 #if LCD_BPP == LCD_COLOR8
940 static void
941 lcd_setcolreg (ushort regno, ushort red, ushort green, ushort blue)
942 {
943         volatile immap_t *immr = (immap_t *) CFG_IMMR;
944         volatile cpm8xx_t *cp = &(immr->im_cpm);
945         unsigned short colreg, *cmap_ptr;
946
947         cmap_ptr = (unsigned short *)&cp->lcd_cmap[regno * 2];
948
949         colreg = ((red   & 0x0F) << 8) |
950                  ((green & 0x0F) << 4) |
951                   (blue  & 0x0F) ;
952 #ifdef  CFG_INVERT_COLORS
953         colreg ^= 0x0FFF;
954 #endif
955         *cmap_ptr = colreg;
956
957         debug ("setcolreg: reg %2d @ %p: R=%02X G=%02X B=%02X => %02X%02X\n",
958                 regno, &(cp->lcd_cmap[regno * 2]),
959                 red, green, blue,
960                 cp->lcd_cmap[ regno * 2 ], cp->lcd_cmap[(regno * 2) + 1]);
961 }
962 #endif  /* LCD_COLOR8 */
963
964 /*----------------------------------------------------------------------*/
965
966 #if LCD_BPP == LCD_MONOCHROME
967 static
968 void lcd_initcolregs (void)
969 {
970         volatile immap_t *immr = (immap_t *) CFG_IMMR;
971         volatile cpm8xx_t *cp = &(immr->im_cpm);
972         ushort regno;
973
974         for (regno = 0; regno < 16; regno++) {
975                 cp->lcd_cmap[regno * 2] = 0;
976                 cp->lcd_cmap[(regno * 2) + 1] = regno & 0x0f;
977         }
978 }
979 #endif
980
981 /*----------------------------------------------------------------------*/
982
983 static void lcd_setfgcolor (int color)
984 {
985         lcd_color_fg = color & 0x0F;
986 }
987
988 /*----------------------------------------------------------------------*/
989
990 static void lcd_setbgcolor (int color)
991 {
992         lcd_color_bg = color & 0x0F;
993 }
994
995 /*----------------------------------------------------------------------*/
996
997 #ifdef  NOT_USED_SO_FAR
998 static int lcd_getfgcolor (void)
999 {
1000         return lcd_color_fg;
1001 }
1002 #endif  /* NOT_USED_SO_FAR */
1003
1004 /*----------------------------------------------------------------------*/
1005
1006 static int lcd_getbgcolor (void)
1007 {
1008         return lcd_color_bg;
1009 }
1010
1011 /*----------------------------------------------------------------------*/
1012
1013 static void lcd_enable (void)
1014 {
1015         volatile immap_t *immr = (immap_t *) CFG_IMMR;
1016         volatile lcd823_t *lcdp = &immr->im_lcd;
1017
1018         /* Enable the LCD panel */
1019 #ifndef CONFIG_RBC823
1020         immr->im_siu_conf.sc_sdcr |= (1 << (31 - 25));          /* LAM = 1 */
1021 #endif
1022         lcdp->lcd_lccr |= LCCR_PON;
1023
1024 #ifdef CONFIG_V37
1025         /* Turn on display backlight */
1026         immr->im_cpm.cp_pbpar |= 0x00008000;
1027         immr->im_cpm.cp_pbdir |= 0x00008000;
1028 #elif defined(CONFIG_RBC823)
1029         /* Turn on display backlight */
1030         immr->im_cpm.cp_pbdat |= 0x00004000;
1031 #endif
1032
1033 #if defined(CONFIG_LWMON)
1034     {   uchar c = pic_read (0x60);
1035 #if defined(CONFIG_LCD) && defined(CONFIG_LWMON) && (CONFIG_POST & CFG_POST_SYSMON)
1036         c |= 0x04;      /* Chip Enable LCD */
1037 #else
1038         c |= 0x07;      /* Power on CCFL, Enable CCFL, Chip Enable LCD */
1039 #endif
1040         pic_write (0x60, c);
1041     }
1042 #endif /* CONFIG_LWMON */
1043
1044 #if defined(CONFIG_R360MPI)
1045     {
1046         extern void r360_i2c_lcd_write (uchar data0, uchar data1);
1047
1048         r360_i2c_lcd_write(0x10, 0x01);
1049         r360_i2c_lcd_write(0x20, 0x01);
1050         r360_i2c_lcd_write(0x3F, 0xFF);
1051         r360_i2c_lcd_write(0x47, 0xFF);
1052     }
1053 #endif /* CONFIG_R360MPI */
1054 #ifdef CONFIG_RBC823
1055         udelay(200000); /* wait 200ms */
1056         /* Turn VEE_ON first */
1057         immr->im_cpm.cp_pbdat |= 0x00000001;
1058         udelay(200000); /* wait 200ms */
1059         /* Now turn on LCD_ON */
1060         immr->im_cpm.cp_pbdat |= 0x00001000;
1061 #endif
1062 #ifdef CONFIG_RRVISION
1063         debug ("PC4->Output(1): enable LVDS\n");
1064         debug ("PC5->Output(0): disable PAL clock\n");
1065         immr->im_ioport.iop_pddir |=  0x1000;
1066         immr->im_ioport.iop_pcpar &= ~(0x0C00);
1067         immr->im_ioport.iop_pcdir |=   0x0C00 ;
1068         immr->im_ioport.iop_pcdat |=   0x0800 ;
1069         immr->im_ioport.iop_pcdat &= ~(0x0400);
1070         debug ("PDPAR=0x%04X PDDIR=0x%04X PDDAT=0x%04X\n",
1071                immr->im_ioport.iop_pdpar,
1072                immr->im_ioport.iop_pddir,
1073                immr->im_ioport.iop_pddat);
1074         debug ("PCPAR=0x%04X PCDIR=0x%04X PCDAT=0x%04X\n",
1075                immr->im_ioport.iop_pcpar,
1076                immr->im_ioport.iop_pcdir,
1077                immr->im_ioport.iop_pcdat);
1078 #endif
1079 }
1080
1081 /*----------------------------------------------------------------------*/
1082
1083 #if defined (CONFIG_RBC823)
1084 void lcd_disable (void)
1085 {
1086         volatile immap_t *immr = (immap_t *) CFG_IMMR;
1087         volatile lcd823_t *lcdp = &immr->im_lcd;
1088
1089 #if defined(CONFIG_LWMON)
1090     {   uchar c = pic_read (0x60);
1091         c &= ~0x07;     /* Power off CCFL, Disable CCFL, Chip Disable LCD */
1092         pic_write (0x60, c);
1093     }
1094 #elif defined(CONFIG_R360MPI)
1095     {
1096         extern void r360_i2c_lcd_write (uchar data0, uchar data1);
1097
1098         r360_i2c_lcd_write(0x10, 0x00);
1099         r360_i2c_lcd_write(0x20, 0x00);
1100         r360_i2c_lcd_write(0x30, 0x00);
1101         r360_i2c_lcd_write(0x40, 0x00);
1102     }
1103 #endif /* CONFIG_LWMON */
1104         /* Disable the LCD panel */
1105         lcdp->lcd_lccr &= ~LCCR_PON;
1106 #ifdef CONFIG_RBC823
1107         /* Turn off display backlight, VEE and LCD_ON */
1108         immr->im_cpm.cp_pbdat &= ~0x00005001;
1109 #else
1110         immr->im_siu_conf.sc_sdcr &= ~(1 << (31 - 25)); /* LAM = 0 */
1111 #endif /* CONFIG_RBC823 */
1112 }
1113 #endif  /* NOT_USED_SO_FAR || CONFIG_RBC823 */
1114
1115
1116 /************************************************************************/
1117 /* ** Chipset depending Bitmap / Logo stuff...                          */
1118 /************************************************************************/
1119
1120
1121 #ifdef CONFIG_LCD_LOGO
1122 static void bitmap_plot (int x, int y)
1123 {
1124         volatile immap_t *immr = (immap_t *) CFG_IMMR;
1125         volatile cpm8xx_t *cp = &(immr->im_cpm);
1126         ushort *cmap;
1127         ushort i;
1128         uchar *bmap;
1129         uchar *fb;
1130
1131         debug ("Logo: width %d  height %d  colors %d  cmap %d\n",
1132                 BMP_LOGO_WIDTH, BMP_LOGO_HEIGHT, BMP_LOGO_COLORS,
1133                 sizeof(bmp_logo_palette)/(sizeof(ushort))
1134         );
1135
1136         /* Leave room for default color map */
1137         cmap = (ushort *)&(cp->lcd_cmap[BMP_LOGO_OFFSET*sizeof(ushort)]);
1138
1139         WATCHDOG_RESET();
1140
1141         /* Set color map */
1142         for (i=0; i<(sizeof(bmp_logo_palette)/(sizeof(ushort))); ++i) {
1143                 ushort colreg = bmp_logo_palette[i];
1144 #ifdef  CFG_INVERT_COLORS
1145                 colreg ^= 0xFFF;
1146 #endif
1147                 *cmap++ = colreg;
1148         }
1149
1150         bmap = &bmp_logo_bitmap[0];
1151         fb   = (char *)(lcd_base + y * lcd_line_length + x);
1152
1153         WATCHDOG_RESET();
1154
1155         for (i=0; i<BMP_LOGO_HEIGHT; ++i) {
1156                 memcpy (fb, bmap, BMP_LOGO_WIDTH);
1157                 bmap += BMP_LOGO_WIDTH;
1158                 fb   += panel_info.vl_col;
1159         }
1160
1161         WATCHDOG_RESET();
1162 }
1163 #endif /* CONFIG_LCD_LOGO */
1164
1165 #if (CONFIG_COMMANDS & CFG_CMD_BMP)
1166 /*
1167  * Display the BMP file located at address bmp_image.
1168  * Only uncompressed
1169  */
1170 int lcd_display_bitmap(ulong bmp_image)
1171 {
1172         volatile immap_t *immr = (immap_t *) CFG_IMMR;
1173         volatile cpm8xx_t *cp = &(immr->im_cpm);
1174         ushort *cmap;
1175         ushort i, j;
1176         uchar *fb;
1177         bmp_image_t *bmp=(bmp_image_t *)bmp_image;
1178         uchar *bmap;
1179         ushort padded_line;
1180         unsigned long width, height;
1181         unsigned colors,bpix;
1182         unsigned long compression;
1183
1184         WATCHDOG_RESET();
1185
1186         if (!((bmp->header.signature[0]=='B') &&
1187               (bmp->header.signature[1]=='M'))) {
1188                 printf ("Error: no valid bmp image at %lx\n", bmp_image);
1189                 return 1;
1190         }
1191
1192         width = le32_to_cpu (bmp->header.width);
1193         height = le32_to_cpu (bmp->header.height);
1194         colors = 1<<le16_to_cpu (bmp->header.bit_count);
1195         compression = le32_to_cpu (bmp->header.compression);
1196
1197         bpix = NBITS(panel_info.vl_bpix);
1198
1199         if ((bpix != 1) && (bpix != 8)) {
1200                 printf ("Error: %d bit/pixel mode not supported by U-Boot\n",
1201                         bpix);
1202                 return 1;
1203         }
1204
1205         if (bpix != le16_to_cpu(bmp->header.bit_count)) {
1206                 printf ("Error: %d bit/pixel mode, but BMP has %d bit/pixel\n",
1207                         bpix,
1208                         le16_to_cpu(bmp->header.bit_count));
1209                 return 1;
1210         }
1211
1212         if (compression!=BMP_BI_RGB) {
1213                 printf ("Error: compression type %ld not supported\n",
1214                         compression);
1215                 return 1;
1216         }
1217
1218         debug ("Display-bmp: %d x %d  with %d colors\n",
1219                width, height, colors);
1220
1221         if (bpix==8) {
1222                 /* Fill the entire color map */
1223                 cmap = (ushort *)&(cp->lcd_cmap[255*sizeof(ushort)]);
1224
1225                 /* Set color map */
1226                 for (i = 0; i < colors; ++i) {
1227                         bmp_color_table_entry_t cte = bmp->color_table[i];
1228                         ushort colreg =
1229                                 ((cte.red>>4)   << 8) |
1230                                 ((cte.green>>4) << 4) |
1231                                 (cte.blue>>4) ;
1232 #ifdef  CFG_INVERT_COLORS
1233                         colreg ^= 0xFFF;
1234 #endif
1235                         *cmap-- = colreg;
1236                 }
1237
1238                 WATCHDOG_RESET();
1239         }
1240
1241         padded_line = (width&0x3) ? ((width&~0x3)+4) : (width);
1242         if (width>panel_info.vl_col)
1243                 width = panel_info.vl_col;
1244         if (height>panel_info.vl_row)
1245                 height = panel_info.vl_row;
1246
1247         bmap = (uchar *)bmp + le32_to_cpu (bmp->header.data_offset);
1248         fb   = (uchar *)
1249                 (lcd_base +
1250                  (((height>=panel_info.vl_row) ? panel_info.vl_row : height)-1)
1251                  * lcd_line_length);
1252         for (i = 0; i < height; ++i) {
1253                 WATCHDOG_RESET();
1254                 for (j = 0; j < width ; j++)
1255                         *(fb++)=255-*(bmap++);
1256                 bmap += (width - padded_line);
1257                 fb   -= (width + lcd_line_length);
1258         }
1259
1260         return (0);
1261 }
1262 #endif /* (CONFIG_COMMANDS & CFG_CMD_BMP) */
1263
1264 /*----------------------------------------------------------------------*/
1265
1266 static void *lcd_logo (void)
1267 {
1268 #ifdef LCD_INFO
1269         DECLARE_GLOBAL_DATA_PTR;
1270
1271         char info[80];
1272         char temp[32];
1273 #endif /* LCD_INFO */
1274
1275 #ifdef CONFIG_SPLASH_SCREEN
1276         char *s;
1277         ulong addr;
1278
1279         if ((s = getenv("splashimage")) != NULL) {
1280                 addr = simple_strtoul(s, NULL, 16);
1281
1282                 if (lcd_display_bitmap (addr) == 0) {
1283                         return ((void *)lcd_base);
1284                 }
1285         }
1286 #endif  /* CONFIG_SPLASH_SCREEN */
1287
1288 #ifdef CONFIG_LCD_LOGO
1289         bitmap_plot (0, 0);
1290 #endif /* CONFIG_LCD_LOGO */
1291
1292
1293 #ifdef LCD_INFO
1294         sprintf (info, "%s (%s - %s) ", U_BOOT_VERSION, __DATE__, __TIME__);
1295         lcd_drawchars (LCD_INFO_X, LCD_INFO_Y, info, strlen(info));
1296
1297         sprintf (info, "(C) 2003 DENX Software Engineering");
1298         lcd_drawchars (LCD_INFO_X, LCD_INFO_Y + VIDEO_FONT_HEIGHT,
1299                                         info, strlen(info));
1300
1301         sprintf (info, "    Wolfgang DENK, wd@denx.de");
1302         lcd_drawchars (LCD_INFO_X, LCD_INFO_Y + VIDEO_FONT_HEIGHT * 2,
1303                                         info, strlen(info));
1304 #ifdef LCD_INFO_BELOW_LOGO
1305         sprintf (info, "MPC823 CPU at %s MHz",
1306                 strmhz(temp, gd->cpu_clk));
1307         lcd_drawchars (LCD_INFO_X, LCD_INFO_Y + VIDEO_FONT_HEIGHT * 3,
1308                                         info, strlen(info));
1309         sprintf (info, "  %ld MB RAM, %ld MB Flash",
1310                 gd->ram_size >> 20,
1311                 gd->bd->bi_flashsize >> 20 );
1312         lcd_drawchars (LCD_INFO_X, LCD_INFO_Y + VIDEO_FONT_HEIGHT * 4,
1313                                         info, strlen(info));
1314 #else
1315         /* leave one blank line */
1316
1317         sprintf (info, "MPC823 CPU at %s MHz, %ld MB RAM, %ld MB Flash",
1318                 strmhz(temp, gd->cpu_clk),
1319                 gd->ram_size >> 20,
1320                 gd->bd->bi_flashsize >> 20 );
1321         lcd_drawchars (LCD_INFO_X, LCD_INFO_Y + VIDEO_FONT_HEIGHT * 4,
1322                                         info, strlen(info));
1323 #endif /* LCD_INFO_BELOW_LOGO */
1324 #endif /* LCD_INFO */
1325
1326 #if defined(CONFIG_LCD_LOGO) && !defined(LCD_INFO_BELOW_LOGO)
1327         return ((void *)((ulong)lcd_base + BMP_LOGO_HEIGHT * lcd_line_length));
1328 #else
1329         return ((void *)lcd_base);
1330 #endif  /* CONFIG_LCD_LOGO */
1331 }
1332
1333 /************************************************************************/
1334 /************************************************************************/
1335
1336 #endif /* CONFIG_LCD */