]> git.ipfire.org Git - people/ms/u-boot.git/blame - common/lcd.c
lcd: remove unused includes
[people/ms/u-boot.git] / common / lcd.c
CommitLineData
8655b6f8
WD
1/*
2 * Common LCD routines for supported CPUs
3 *
4 * (C) Copyright 2001-2002
5 * Wolfgang Denk, DENX Software Engineering -- wd@denx.de
6 *
3765b3e7 7 * SPDX-License-Identifier: GPL-2.0+
8655b6f8
WD
8 */
9
10/************************************************************************/
11/* ** HEADER FILES */
12/************************************************************************/
13
14/* #define DEBUG */
15
16#include <config.h>
17#include <common.h>
18#include <command.h>
c0880485 19#include <env_callback.h>
8655b6f8 20#include <linux/types.h>
52cb4d4f 21#include <stdio_dev.h>
8655b6f8 22#include <lcd.h>
8b0bfc68 23#include <watchdog.h>
dca2a1c1 24#include <asm/unaligned.h>
dd4425e8 25#include <splash.h>
7d95f2a3
SG
26#include <asm/io.h>
27#include <asm/unaligned.h>
11b8dfa7 28#include <fdt_support.h>
dd4425e8 29
6a195d2d
SW
30#if defined(CONFIG_LCD_DT_SIMPLEFB)
31#include <libfdt.h>
32#endif
33
8655b6f8
WD
34/************************************************************************/
35/* ** FONT DATA */
36/************************************************************************/
37#include <video_font.h> /* Get font data, width and height */
38
88804d19
WD
39/************************************************************************/
40/* ** LOGO DATA */
41/************************************************************************/
42#ifdef CONFIG_LCD_LOGO
43# include <bmp_logo.h> /* Get logo data, width and height */
c270730f 44# include <bmp_logo_data.h>
acb13868 45# if (CONSOLE_COLOR_WHITE >= BMP_LOGO_OFFSET) && (LCD_BPP != LCD_COLOR16)
88804d19
WD
46# error Default Color Map overlaps with Logo Color Map
47# endif
48#endif
8655b6f8 49
7d95f2a3
SG
50#ifdef CONFIG_SANDBOX
51#include <asm/sdl.h>
52#endif
53
676d319e
SG
54#ifndef CONFIG_LCD_ALIGNMENT
55#define CONFIG_LCD_ALIGNMENT PAGE_SIZE
56#endif
57
a7de2953
NK
58#if (LCD_BPP != LCD_COLOR8) && (LCD_BPP != LCD_COLOR16) && \
59 (LCD_BPP != LCD_COLOR32)
a5796c51
JH
60# error Unsupported LCD BPP.
61#endif
62
d87080b7 63DECLARE_GLOBAL_DATA_PTR;
8655b6f8 64
8f47d917 65static int lcd_init(void *lcdbase);
8655b6f8 66
6b035141 67static void *lcd_logo(void);
8655b6f8 68
8f47d917
NK
69static void lcd_setfgcolor(int color);
70static void lcd_setbgcolor(int color);
8655b6f8 71
46d1d5dd
WD
72static int lcd_color_fg;
73static int lcd_color_bg;
f1d205a1 74int lcd_line_length;
46d1d5dd 75
8655b6f8 76char lcd_is_enabled = 0;
8655b6f8 77
00a0ca59 78static void *lcd_base; /* Start of framebuffer memory */
9a8efc46 79
9a8efc46 80static char lcd_flush_dcache; /* 1 to flush dcache after each lcd update */
8655b6f8
WD
81
82/************************************************************************/
83
9a8efc46
SG
84/* Flush LCD activity to the caches */
85void lcd_sync(void)
86{
87 /*
88 * flush_dcache_range() is declared in common.h but it seems that some
89 * architectures do not actually implement it. Is there a way to find
90 * out whether it exists? For now, ARM is safe.
91 */
92#if defined(CONFIG_ARM) && !defined(CONFIG_SYS_DCACHE_OFF)
93 int line_length;
94
95 if (lcd_flush_dcache)
96 flush_dcache_range((u32)lcd_base,
97 (u32)(lcd_base + lcd_get_size(&line_length)));
7d95f2a3
SG
98#elif defined(CONFIG_SANDBOX) && defined(CONFIG_VIDEO_SANDBOX_SDL)
99 static ulong last_sync;
100
101 if (get_timer(last_sync) > 10) {
102 sandbox_sdl_sync(lcd_base);
103 last_sync = get_timer(0);
104 }
9a8efc46
SG
105#endif
106}
107
108void lcd_set_flush_dcache(int flush)
109{
110 lcd_flush_dcache = (flush != 0);
111}
112
8655b6f8
WD
113/*----------------------------------------------------------------------*/
114
709ea543
SG
115static void lcd_stub_putc(struct stdio_dev *dev, const char c)
116{
117 lcd_putc(c);
118}
119
709ea543
SG
120static void lcd_stub_puts(struct stdio_dev *dev, const char *s)
121{
122 lcd_puts(s);
123}
124
8655b6f8
WD
125/************************************************************************/
126/** Small utility to check that you got the colours right */
127/************************************************************************/
128#ifdef LCD_TEST_PATTERN
129
130#define N_BLK_VERT 2
131#define N_BLK_HOR 3
132
6b035141 133static int test_colors[N_BLK_HOR * N_BLK_VERT] = {
8655b6f8
WD
134 CONSOLE_COLOR_RED, CONSOLE_COLOR_GREEN, CONSOLE_COLOR_YELLOW,
135 CONSOLE_COLOR_BLUE, CONSOLE_COLOR_MAGENTA, CONSOLE_COLOR_CYAN,
136};
137
8f47d917 138static void test_pattern(void)
8655b6f8
WD
139{
140 ushort v_max = panel_info.vl_row;
141 ushort h_max = panel_info.vl_col;
142 ushort v_step = (v_max + N_BLK_VERT - 1) / N_BLK_VERT;
143 ushort h_step = (h_max + N_BLK_HOR - 1) / N_BLK_HOR;
144 ushort v, h;
145 uchar *pix = (uchar *)lcd_base;
146
8f47d917 147 printf("[LCD] Test Pattern: %d x %d [%d x %d]\n",
8655b6f8
WD
148 h_max, v_max, h_step, v_step);
149
150 /* WARNING: Code silently assumes 8bit/pixel */
8f47d917 151 for (v = 0; v < v_max; ++v) {
8655b6f8 152 uchar iy = v / v_step;
8f47d917 153 for (h = 0; h < h_max; ++h) {
6b035141 154 uchar ix = N_BLK_HOR * iy + h / h_step;
8655b6f8
WD
155 *pix++ = test_colors[ix];
156 }
157 }
158}
159#endif /* LCD_TEST_PATTERN */
160
161
162/************************************************************************/
163/* ** GENERIC Initialization Routines */
164/************************************************************************/
cefa4717
AG
165/*
166 * With most lcd drivers the line length is set up
167 * by calculating it from panel_info parameters. Some
168 * drivers need to calculate the line length differently,
169 * so make the function weak to allow overriding it.
170 */
171__weak int lcd_get_size(int *line_length)
676d319e
SG
172{
173 *line_length = (panel_info.vl_col * NBITS(panel_info.vl_bpix)) / 8;
174 return *line_length * panel_info.vl_row;
175}
176
6b035141 177int drv_lcd_init(void)
8655b6f8 178{
52cb4d4f 179 struct stdio_dev lcddev;
8655b6f8
WD
180 int rc;
181
7d95f2a3 182 lcd_base = map_sysmem(gd->fb_base, 0);
8655b6f8 183
8f47d917 184 lcd_init(lcd_base); /* LCD initialization */
8655b6f8
WD
185
186 /* Device initialization */
8f47d917 187 memset(&lcddev, 0, sizeof(lcddev));
8655b6f8 188
8f47d917 189 strcpy(lcddev.name, "lcd");
8655b6f8
WD
190 lcddev.ext = 0; /* No extensions */
191 lcddev.flags = DEV_FLAGS_OUTPUT; /* Output only */
709ea543
SG
192 lcddev.putc = lcd_stub_putc; /* 'putc' function */
193 lcddev.puts = lcd_stub_puts; /* 'puts' function */
8655b6f8 194
6b035141 195 rc = stdio_register(&lcddev);
8655b6f8
WD
196
197 return (rc == 0) ? 1 : rc;
198}
199
200/*----------------------------------------------------------------------*/
02110903 201void lcd_clear(void)
8655b6f8 202{
140beb94 203 short console_rows, console_cols;
4d03634e 204 int bg_color;
f4469f50 205#if LCD_BPP == LCD_COLOR8
8655b6f8 206 /* Setting the palette */
8f47d917
NK
207 lcd_setcolreg(CONSOLE_COLOR_BLACK, 0, 0, 0);
208 lcd_setcolreg(CONSOLE_COLOR_RED, 0xFF, 0, 0);
209 lcd_setcolreg(CONSOLE_COLOR_GREEN, 0, 0xFF, 0);
210 lcd_setcolreg(CONSOLE_COLOR_YELLOW, 0xFF, 0xFF, 0);
211 lcd_setcolreg(CONSOLE_COLOR_BLUE, 0, 0, 0xFF);
212 lcd_setcolreg(CONSOLE_COLOR_MAGENTA, 0xFF, 0, 0xFF);
213 lcd_setcolreg(CONSOLE_COLOR_CYAN, 0, 0xFF, 0xFF);
214 lcd_setcolreg(CONSOLE_COLOR_GREY, 0xAA, 0xAA, 0xAA);
215 lcd_setcolreg(CONSOLE_COLOR_WHITE, 0xFF, 0xFF, 0xFF);
8655b6f8
WD
216#endif
217
6d0f6bcf 218#ifndef CONFIG_SYS_WHITE_ON_BLACK
8f47d917
NK
219 lcd_setfgcolor(CONSOLE_COLOR_BLACK);
220 lcd_setbgcolor(CONSOLE_COLOR_WHITE);
4d03634e 221 bg_color = CONSOLE_COLOR_WHITE;
8655b6f8 222#else
8f47d917
NK
223 lcd_setfgcolor(CONSOLE_COLOR_WHITE);
224 lcd_setbgcolor(CONSOLE_COLOR_BLACK);
4d03634e 225 bg_color = CONSOLE_COLOR_BLACK;
6d0f6bcf 226#endif /* CONFIG_SYS_WHITE_ON_BLACK */
8655b6f8
WD
227
228#ifdef LCD_TEST_PATTERN
229 test_pattern();
230#else
231 /* set framebuffer to background color */
57d76a89 232#if (LCD_BPP != LCD_COLOR32)
4d03634e 233 memset((char *)lcd_base, bg_color, lcd_line_length * panel_info.vl_row);
57d76a89
HP
234#else
235 u32 *ppix = lcd_base;
236 u32 i;
237 for (i = 0;
238 i < (lcd_line_length * panel_info.vl_row)/NBYTES(panel_info.vl_bpix);
239 i++) {
4d03634e 240 *ppix++ = bg_color;
57d76a89
HP
241 }
242#endif
8655b6f8
WD
243#endif
244 /* Paint the logo and retrieve LCD base address */
8f47d917 245 debug("[LCD] Drawing the logo...\n");
efd7c4a2
NK
246#if defined(CONFIG_LCD_LOGO) && !defined(CONFIG_LCD_INFO_BELOW_LOGO)
247 console_rows = (panel_info.vl_row - BMP_LOGO_HEIGHT);
248 console_rows /= VIDEO_FONT_HEIGHT;
249#else
250 console_rows = panel_info.vl_row / VIDEO_FONT_HEIGHT;
251#endif
252 console_cols = panel_info.vl_col / VIDEO_FONT_WIDTH;
2af13d6b 253 lcd_init_console(lcd_base, console_rows, console_cols);
140beb94 254 lcd_init_console(lcd_logo(), console_rows, console_cols);
9a8efc46
SG
255 lcd_sync();
256}
257
258static int do_lcd_clear(cmd_tbl_t *cmdtp, int flag, int argc,
259 char *const argv[])
260{
261 lcd_clear();
262 return 0;
8655b6f8
WD
263}
264
265U_BOOT_CMD(
02110903 266 cls, 1, 1, do_lcd_clear,
2fb2604d 267 "clear screen",
a89c33db 268 ""
8655b6f8
WD
269);
270
271/*----------------------------------------------------------------------*/
272
8f47d917 273static int lcd_init(void *lcdbase)
8655b6f8
WD
274{
275 /* Initialize the lcd controller */
8f47d917 276 debug("[LCD] Initializing LCD frambuffer at %p\n", lcdbase);
8655b6f8 277
8f47d917 278 lcd_ctrl_init(lcdbase);
1d3dea12
AG
279
280 /*
9316e144 281 * lcd_ctrl_init() of some drivers (i.e. bcm2835 on rpi) ignores
1d3dea12
AG
282 * the 'lcdbase' argument and uses custom lcd base address
283 * by setting up gd->fb_base. Check for this condition and fixup
284 * 'lcd_base' address.
285 */
7d95f2a3
SG
286 if (map_to_sysmem(lcdbase) != gd->fb_base)
287 lcd_base = map_sysmem(gd->fb_base, 0);
1d3dea12
AG
288
289 debug("[LCD] Using LCD frambuffer at %p\n", lcd_base);
290
6d330719 291 lcd_get_size(&lcd_line_length);
6f93d2b8 292 lcd_is_enabled = 1;
02110903 293 lcd_clear();
6b035141 294 lcd_enable();
8655b6f8
WD
295
296 /* Initialize the console */
140beb94 297 lcd_set_col(0);
88804d19 298#ifdef CONFIG_LCD_INFO_BELOW_LOGO
140beb94 299 lcd_set_row(7 + BMP_LOGO_HEIGHT / VIDEO_FONT_HEIGHT);
8655b6f8 300#else
140beb94 301 lcd_set_row(1); /* leave 1 blank line below logo */
8655b6f8 302#endif
8655b6f8
WD
303
304 return 0;
305}
306
307
308/************************************************************************/
309/* ** ROM capable initialization part - needed to reserve FB memory */
310/************************************************************************/
311/*
312 * This is called early in the system initialization to grab memory
313 * for the LCD controller.
314 * Returns new address for monitor, after reserving LCD buffer memory
315 *
316 * Note that this is running from ROM, so no write access to global data.
317 */
8f47d917 318ulong lcd_setmem(ulong addr)
8655b6f8
WD
319{
320 ulong size;
676d319e 321 int line_length;
8655b6f8 322
8f47d917
NK
323 debug("LCD panel info: %d x %d, %d bit/pix\n", panel_info.vl_col,
324 panel_info.vl_row, NBITS(panel_info.vl_bpix));
8655b6f8 325
676d319e 326 size = lcd_get_size(&line_length);
8655b6f8 327
676d319e
SG
328 /* Round up to nearest full page, or MMU section if defined */
329 size = ALIGN(size, CONFIG_LCD_ALIGNMENT);
330 addr = ALIGN(addr - CONFIG_LCD_ALIGNMENT + 1, CONFIG_LCD_ALIGNMENT);
8655b6f8
WD
331
332 /* Allocate pages for the frame buffer. */
333 addr -= size;
334
6b035141
JH
335 debug("Reserving %ldk for LCD Framebuffer at: %08lx\n",
336 size >> 10, addr);
8655b6f8 337
8f47d917 338 return addr;
8655b6f8
WD
339}
340
341/*----------------------------------------------------------------------*/
342
8f47d917 343static void lcd_setfgcolor(int color)
8655b6f8 344{
39cf4804 345 lcd_color_fg = color;
8655b6f8
WD
346}
347
4d03634e
NK
348int lcd_getfgcolor(void)
349{
350 return lcd_color_fg;
351}
352
8655b6f8
WD
353/*----------------------------------------------------------------------*/
354
8f47d917 355static void lcd_setbgcolor(int color)
8655b6f8 356{
39cf4804 357 lcd_color_bg = color;
8655b6f8
WD
358}
359
4d03634e
NK
360int lcd_getbgcolor(void)
361{
362 return lcd_color_bg;
363}
364
8655b6f8
WD
365/************************************************************************/
366/* ** Chipset depending Bitmap / Logo stuff... */
367/************************************************************************/
203c37b8 368
8655b6f8 369#ifdef CONFIG_LCD_LOGO
a02e9481
NK
370__weak void lcd_logo_set_cmap(void)
371{
2306457c
NK
372 int i;
373 ushort *cmap = configuration_get_cmap();
374
375 for (i = 0; i < ARRAY_SIZE(bmp_logo_palette); ++i)
376 *cmap++ = bmp_logo_palette[i];
a02e9481
NK
377}
378
8f47d917 379void bitmap_plot(int x, int y)
8655b6f8 380{
8655b6f8
WD
381 ushort i, j;
382 uchar *bmap;
383 uchar *fb;
384 ushort *fb16;
317461c1 385 unsigned bpix = NBITS(panel_info.vl_bpix);
8655b6f8 386
2306457c
NK
387 debug("Logo: width %d height %d colors %d\n",
388 BMP_LOGO_WIDTH, BMP_LOGO_HEIGHT, BMP_LOGO_COLORS);
8655b6f8
WD
389
390 bmap = &bmp_logo_bitmap[0];
317461c1 391 fb = (uchar *)(lcd_base + y * lcd_line_length + x * bpix / 8);
8655b6f8 392
317461c1 393 if (bpix < 12) {
8655b6f8 394 WATCHDOG_RESET();
a02e9481 395 lcd_logo_set_cmap();
8655b6f8
WD
396 WATCHDOG_RESET();
397
8f47d917
NK
398 for (i = 0; i < BMP_LOGO_HEIGHT; ++i) {
399 memcpy(fb, bmap, BMP_LOGO_WIDTH);
8655b6f8 400 bmap += BMP_LOGO_WIDTH;
6b035141 401 fb += panel_info.vl_col;
8655b6f8
WD
402 }
403 }
404 else { /* true color mode */
acb13868 405 u16 col16;
317461c1 406 fb16 = (ushort *)fb;
8f47d917
NK
407 for (i = 0; i < BMP_LOGO_HEIGHT; ++i) {
408 for (j = 0; j < BMP_LOGO_WIDTH; j++) {
acb13868
AR
409 col16 = bmp_logo_palette[(bmap[j]-16)];
410 fb16[j] =
411 ((col16 & 0x000F) << 1) |
412 ((col16 & 0x00F0) << 3) |
413 ((col16 & 0x0F00) << 4);
8655b6f8
WD
414 }
415 bmap += BMP_LOGO_WIDTH;
416 fb16 += panel_info.vl_col;
417 }
418 }
419
420 WATCHDOG_RESET();
9a8efc46 421 lcd_sync();
8655b6f8 422}
2b5cb3d3
AG
423#else
424static inline void bitmap_plot(int x, int y) {}
8655b6f8
WD
425#endif /* CONFIG_LCD_LOGO */
426
427/*----------------------------------------------------------------------*/
c3517f91 428#if defined(CONFIG_CMD_BMP) || defined(CONFIG_SPLASH_SCREEN)
8655b6f8
WD
429/*
430 * Display the BMP file located at address bmp_image.
431 * Only uncompressed.
432 */
1ca298ce
MW
433
434#ifdef CONFIG_SPLASH_SCREEN_ALIGN
435#define BMP_ALIGN_CENTER 0x7FFF
7c7e280a
NK
436
437static void splash_align_axis(int *axis, unsigned long panel_size,
438 unsigned long picture_size)
439{
440 unsigned long panel_picture_delta = panel_size - picture_size;
441 unsigned long axis_alignment;
442
443 if (*axis == BMP_ALIGN_CENTER)
444 axis_alignment = panel_picture_delta / 2;
445 else if (*axis < 0)
446 axis_alignment = panel_picture_delta + *axis + 1;
447 else
448 return;
449
b4141195 450 *axis = max(0, (int)axis_alignment);
7c7e280a 451}
1ca298ce
MW
452#endif
453
45d7f525
TWHT
454
455#ifdef CONFIG_LCD_BMP_RLE8
456
457#define BMP_RLE8_ESCAPE 0
458#define BMP_RLE8_EOL 0
459#define BMP_RLE8_EOBMP 1
460#define BMP_RLE8_DELTA 2
461
462static void draw_unencoded_bitmap(ushort **fbp, uchar *bmap, ushort *cmap,
463 int cnt)
464{
465 while (cnt > 0) {
466 *(*fbp)++ = cmap[*bmap++];
467 cnt--;
468 }
469}
470
471static void draw_encoded_bitmap(ushort **fbp, ushort c, int cnt)
472{
473 ushort *fb = *fbp;
474 int cnt_8copy = cnt >> 3;
475
476 cnt -= cnt_8copy << 3;
477 while (cnt_8copy > 0) {
478 *fb++ = c;
479 *fb++ = c;
480 *fb++ = c;
481 *fb++ = c;
482 *fb++ = c;
483 *fb++ = c;
484 *fb++ = c;
485 *fb++ = c;
486 cnt_8copy--;
487 }
488 while (cnt > 0) {
489 *fb++ = c;
490 cnt--;
491 }
6b035141 492 *fbp = fb;
45d7f525
TWHT
493}
494
495/*
6b035141 496 * Do not call this function directly, must be called from lcd_display_bitmap.
45d7f525
TWHT
497 */
498static void lcd_display_rle8_bitmap(bmp_image_t *bmp, ushort *cmap, uchar *fb,
499 int x_off, int y_off)
500{
501 uchar *bmap;
502 ulong width, height;
503 ulong cnt, runlen;
504 int x, y;
505 int decode = 1;
506
dca2a1c1
PM
507 width = get_unaligned_le32(&bmp->header.width);
508 height = get_unaligned_le32(&bmp->header.height);
509 bmap = (uchar *)bmp + get_unaligned_le32(&bmp->header.data_offset);
45d7f525
TWHT
510
511 x = 0;
512 y = height - 1;
513
514 while (decode) {
515 if (bmap[0] == BMP_RLE8_ESCAPE) {
516 switch (bmap[1]) {
517 case BMP_RLE8_EOL:
518 /* end of line */
519 bmap += 2;
520 x = 0;
521 y--;
522 /* 16bpix, 2-byte per pixel, width should *2 */
523 fb -= (width * 2 + lcd_line_length);
524 break;
525 case BMP_RLE8_EOBMP:
526 /* end of bitmap */
527 decode = 0;
528 break;
529 case BMP_RLE8_DELTA:
530 /* delta run */
531 x += bmap[2];
532 y -= bmap[3];
533 /* 16bpix, 2-byte per pixel, x should *2 */
534 fb = (uchar *) (lcd_base + (y + y_off - 1)
535 * lcd_line_length + (x + x_off) * 2);
536 bmap += 4;
537 break;
538 default:
539 /* unencoded run */
540 runlen = bmap[1];
541 bmap += 2;
542 if (y < height) {
543 if (x < width) {
544 if (x + runlen > width)
545 cnt = width - x;
546 else
547 cnt = runlen;
548 draw_unencoded_bitmap(
549 (ushort **)&fb,
550 bmap, cmap, cnt);
551 }
552 x += runlen;
553 }
554 bmap += runlen;
555 if (runlen & 1)
556 bmap++;
557 }
558 } else {
559 /* encoded run */
560 if (y < height) {
561 runlen = bmap[0];
562 if (x < width) {
563 /* aggregate the same code */
564 while (bmap[0] == 0xff &&
565 bmap[2] != BMP_RLE8_ESCAPE &&
566 bmap[1] == bmap[3]) {
567 runlen += bmap[2];
568 bmap += 2;
569 }
570 if (x + runlen > width)
571 cnt = width - x;
572 else
573 cnt = runlen;
574 draw_encoded_bitmap((ushort **)&fb,
575 cmap[bmap[1]], cnt);
576 }
577 x += runlen;
578 }
579 bmap += 2;
580 }
581 }
582}
583#endif
584
27fad01b
NK
585__weak void fb_put_byte(uchar **fb, uchar **from)
586{
587 *(*fb)++ = *(*from)++;
588}
bfdcc65e
NK
589
590#if defined(CONFIG_BMP_16BPP)
b3d12e9b 591__weak void fb_put_word(uchar **fb, uchar **from)
bfdcc65e
NK
592{
593 *(*fb)++ = *(*from)++;
594 *(*fb)++ = *(*from)++;
595}
bfdcc65e
NK
596#endif /* CONFIG_BMP_16BPP */
597
0b29a896
NK
598__weak void lcd_set_cmap(bmp_image_t *bmp, unsigned colors)
599{
600 int i;
601 bmp_color_table_entry_t cte;
602 ushort *cmap = configuration_get_cmap();
603
604 for (i = 0; i < colors; ++i) {
605 cte = bmp->color_table[i];
606 *cmap = (((cte.red) << 8) & 0xf800) |
607 (((cte.green) << 3) & 0x07e0) |
608 (((cte.blue) >> 3) & 0x001f);
609#if defined(CONFIG_MPC823)
610 cmap--;
611#else
612 cmap++;
613#endif
614 }
615}
616
8655b6f8
WD
617int lcd_display_bitmap(ulong bmp_image, int x, int y)
618{
00cc5595 619 ushort *cmap_base = NULL;
8655b6f8
WD
620 ushort i, j;
621 uchar *fb;
7d95f2a3 622 bmp_image_t *bmp = (bmp_image_t *)map_sysmem(bmp_image, 0);
8655b6f8 623 uchar *bmap;
fecac46c 624 ushort padded_width;
b245e65e 625 unsigned long width, height, byte_width;
e8143e72 626 unsigned long pwidth = panel_info.vl_col;
b245e65e 627 unsigned colors, bpix, bmp_bpix;
8655b6f8 628
6b035141
JH
629 if (!bmp || !(bmp->header.signature[0] == 'B' &&
630 bmp->header.signature[1] == 'M')) {
8f47d917
NK
631 printf("Error: no valid bmp image at %lx\n", bmp_image);
632
8655b6f8 633 return 1;
b245e65e 634 }
8655b6f8 635
dca2a1c1
PM
636 width = get_unaligned_le32(&bmp->header.width);
637 height = get_unaligned_le32(&bmp->header.height);
638 bmp_bpix = get_unaligned_le16(&bmp->header.bit_count);
639
b245e65e 640 colors = 1 << bmp_bpix;
8655b6f8
WD
641
642 bpix = NBITS(panel_info.vl_bpix);
643
6b035141 644 if (bpix != 1 && bpix != 8 && bpix != 16 && bpix != 32) {
b245e65e
GL
645 printf ("Error: %d bit/pixel mode, but BMP has %d bit/pixel\n",
646 bpix, bmp_bpix);
8f47d917 647
8655b6f8
WD
648 return 1;
649 }
650
a305fb15
HP
651 /*
652 * We support displaying 8bpp BMPs on 16bpp LCDs
653 * and displaying 24bpp BMPs on 32bpp LCDs
654 * */
655 if (bpix != bmp_bpix &&
656 !(bmp_bpix == 8 && bpix == 16) &&
657 !(bmp_bpix == 24 && bpix == 32)) {
8655b6f8 658 printf ("Error: %d bit/pixel mode, but BMP has %d bit/pixel\n",
dca2a1c1 659 bpix, get_unaligned_le16(&bmp->header.bit_count));
8655b6f8
WD
660 return 1;
661 }
662
8f47d917 663 debug("Display-bmp: %d x %d with %d colors\n",
8655b6f8
WD
664 (int)width, (int)height, (int)colors);
665
0b29a896
NK
666 if (bmp_bpix == 8)
667 lcd_set_cmap(bmp, colors);
e8143e72 668
6b035141 669 padded_width = (width & 0x3 ? (width & ~0x3) + 4 : width);
1ca298ce
MW
670
671#ifdef CONFIG_SPLASH_SCREEN_ALIGN
7c7e280a
NK
672 splash_align_axis(&x, pwidth, width);
673 splash_align_axis(&y, panel_info.vl_row, height);
1ca298ce
MW
674#endif /* CONFIG_SPLASH_SCREEN_ALIGN */
675
8f47d917 676 if ((x + width) > pwidth)
e8143e72 677 width = pwidth - x;
8f47d917 678 if ((y + height) > panel_info.vl_row)
8655b6f8
WD
679 height = panel_info.vl_row - y;
680
dca2a1c1
PM
681 bmap = (uchar *)bmp + get_unaligned_le32(&bmp->header.data_offset);
682 fb = (uchar *)(lcd_base +
8d46d5b1 683 (y + height - 1) * lcd_line_length + x * bpix / 8);
a303dfb0 684
b245e65e 685 switch (bmp_bpix) {
a303dfb0 686 case 1: /* pass through */
0156444c 687 case 8: {
0b29a896 688 cmap_base = configuration_get_cmap();
45d7f525 689#ifdef CONFIG_LCD_BMP_RLE8
dca2a1c1
PM
690 u32 compression = get_unaligned_le32(&bmp->header.compression);
691 if (compression == BMP_BI_RLE8) {
45d7f525
TWHT
692 if (bpix != 16) {
693 /* TODO implement render code for bpix != 16 */
694 printf("Error: only support 16 bpix");
695 return 1;
696 }
697 lcd_display_rle8_bitmap(bmp, cmap_base, fb, x, y);
698 break;
699 }
700#endif
701
b245e65e
GL
702 if (bpix != 16)
703 byte_width = width;
704 else
705 byte_width = width * 2;
706
a303dfb0
MJ
707 for (i = 0; i < height; ++i) {
708 WATCHDOG_RESET();
b245e65e
GL
709 for (j = 0; j < width; j++) {
710 if (bpix != 16) {
27fad01b 711 fb_put_byte(&fb, &bmap);
b245e65e
GL
712 } else {
713 *(uint16_t *)fb = cmap_base[*(bmap++)];
714 fb += sizeof(uint16_t) / sizeof(*fb);
715 }
716 }
fecac46c 717 bmap += (padded_width - width);
6b035141 718 fb -= byte_width + lcd_line_length;
a303dfb0
MJ
719 }
720 break;
0156444c 721 }
a303dfb0
MJ
722#if defined(CONFIG_BMP_16BPP)
723 case 16:
724 for (i = 0; i < height; ++i) {
725 WATCHDOG_RESET();
bfdcc65e
NK
726 for (j = 0; j < width; j++)
727 fb_put_word(&fb, &bmap);
728
fecac46c 729 bmap += (padded_width - width) * 2;
6b035141 730 fb -= width * 2 + lcd_line_length;
a303dfb0
MJ
731 }
732 break;
733#endif /* CONFIG_BMP_16BPP */
a305fb15
HP
734#if defined(CONFIG_BMP_24BMP)
735 case 24:
736 for (i = 0; i < height; ++i) {
737 for (j = 0; j < width; j++) {
738 *(fb++) = *(bmap++);
739 *(fb++) = *(bmap++);
740 *(fb++) = *(bmap++);
741 *(fb++) = 0;
742 }
743 fb -= lcd_line_length + width * (bpix / 8);
744 }
745 break;
746#endif /* CONFIG_BMP_24BMP */
fb6a9aab
DL
747#if defined(CONFIG_BMP_32BPP)
748 case 32:
749 for (i = 0; i < height; ++i) {
750 for (j = 0; j < width; j++) {
751 *(fb++) = *(bmap++);
752 *(fb++) = *(bmap++);
753 *(fb++) = *(bmap++);
754 *(fb++) = *(bmap++);
755 }
6b035141 756 fb -= lcd_line_length + width * (bpix / 8);
fb6a9aab
DL
757 }
758 break;
759#endif /* CONFIG_BMP_32BPP */
a303dfb0
MJ
760 default:
761 break;
762 };
8655b6f8 763
9a8efc46 764 lcd_sync();
8f47d917 765 return 0;
8655b6f8 766}
c3517f91 767#endif
8655b6f8 768
8f47d917 769static void *lcd_logo(void)
8655b6f8 770{
8655b6f8
WD
771#ifdef CONFIG_SPLASH_SCREEN
772 char *s;
773 ulong addr;
774 static int do_splash = 1;
775
776 if (do_splash && (s = getenv("splashimage")) != NULL) {
1ca298ce 777 int x = 0, y = 0;
8655b6f8
WD
778 do_splash = 0;
779
581bb419 780 if (splash_screen_prepare())
dd4425e8 781 return (void *)lcd_base;
581bb419 782
1ca298ce 783 addr = simple_strtoul (s, NULL, 16);
ff8fb56b
AG
784
785 splash_get_pos(&x, &y);
1ca298ce 786
d3a555ed 787 if (bmp_display(addr, x, y) == 0)
8f47d917 788 return (void *)lcd_base;
8655b6f8
WD
789 }
790#endif /* CONFIG_SPLASH_SCREEN */
791
2b5cb3d3 792 bitmap_plot(0, 0);
8655b6f8 793
6b59e03e 794#ifdef CONFIG_LCD_INFO
140beb94
NK
795 lcd_set_col(LCD_INFO_X / VIDEO_FONT_WIDTH);
796 lcd_set_row(LCD_INFO_Y / VIDEO_FONT_HEIGHT);
6b59e03e
HS
797 lcd_show_board_info();
798#endif /* CONFIG_LCD_INFO */
39cf4804 799
88804d19 800#if defined(CONFIG_LCD_LOGO) && !defined(CONFIG_LCD_INFO_BELOW_LOGO)
8f47d917 801 return (void *)((ulong)lcd_base + BMP_LOGO_HEIGHT * lcd_line_length);
8655b6f8 802#else
8f47d917 803 return (void *)lcd_base;
6b035141 804#endif /* CONFIG_LCD_LOGO && !defined(CONFIG_LCD_INFO_BELOW_LOGO) */
8655b6f8
WD
805}
806
c0880485
NK
807#ifdef CONFIG_SPLASHIMAGE_GUARD
808static int on_splashimage(const char *name, const char *value, enum env_op op,
809 int flags)
810{
811 ulong addr;
812 int aligned;
813
814 if (op == env_op_delete)
815 return 0;
816
817 addr = simple_strtoul(value, NULL, 16);
818 /* See README.displaying-bmps */
819 aligned = (addr % 4 == 2);
820 if (!aligned) {
821 printf("Invalid splashimage value. Value must be 16 bit aligned, but not 32 bit aligned\n");
822 return -1;
823 }
824
825 return 0;
826}
827
828U_BOOT_ENV_CALLBACK(splashimage, on_splashimage);
829#endif
830
395166cf
VB
831int lcd_get_pixel_width(void)
832{
833 return panel_info.vl_col;
834}
835
836int lcd_get_pixel_height(void)
837{
838 return panel_info.vl_row;
839}
840
6a195d2d
SW
841#if defined(CONFIG_LCD_DT_SIMPLEFB)
842static int lcd_dt_simplefb_configure_node(void *blob, int off)
843{
6a195d2d 844#if LCD_BPP == LCD_COLOR16
11b8dfa7
HG
845 return fdt_setup_simplefb_node(blob, off, gd->fb_base,
846 panel_info.vl_col, panel_info.vl_row,
847 panel_info.vl_col * 2, "r5g6b5");
6a195d2d 848#else
11b8dfa7 849 return -1;
6a195d2d 850#endif
6a195d2d
SW
851}
852
853int lcd_dt_simplefb_add_node(void *blob)
854{
5af7d0f0
SW
855 static const char compat[] = "simple-framebuffer";
856 static const char disabled[] = "disabled";
6a195d2d
SW
857 int off, ret;
858
859 off = fdt_add_subnode(blob, 0, "framebuffer");
860 if (off < 0)
861 return -1;
862
863 ret = fdt_setprop(blob, off, "status", disabled, sizeof(disabled));
864 if (ret < 0)
865 return -1;
866
867 ret = fdt_setprop(blob, off, "compatible", compat, sizeof(compat));
868 if (ret < 0)
869 return -1;
870
871 return lcd_dt_simplefb_configure_node(blob, off);
872}
873
874int lcd_dt_simplefb_enable_existing_node(void *blob)
875{
876 int off;
877
878 off = fdt_node_offset_by_compatible(blob, -1, "simple-framebuffer");
879 if (off < 0)
880 return -1;
881
882 return lcd_dt_simplefb_configure_node(blob, off);
883}
884#endif