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