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