183d290c5STom Rini // SPDX-License-Identifier: GPL-2.0+
2352d2591SJean-Christophe PLAGNIOL-VILLARD /*
3352d2591SJean-Christophe PLAGNIOL-VILLARD * (C) Copyright 2002 ELTEC Elektronik AG
4352d2591SJean-Christophe PLAGNIOL-VILLARD * Frank Gottschling <fgottschling@eltec.de>
5352d2591SJean-Christophe PLAGNIOL-VILLARD */
6352d2591SJean-Christophe PLAGNIOL-VILLARD
7352d2591SJean-Christophe PLAGNIOL-VILLARD /*
8352d2591SJean-Christophe PLAGNIOL-VILLARD * cfb_console.c
9352d2591SJean-Christophe PLAGNIOL-VILLARD *
10352d2591SJean-Christophe PLAGNIOL-VILLARD * Color Framebuffer Console driver for 8/15/16/24/32 bits per pixel.
11352d2591SJean-Christophe PLAGNIOL-VILLARD *
12352d2591SJean-Christophe PLAGNIOL-VILLARD * At the moment only the 8x16 font is tested and the font fore- and
13352d2591SJean-Christophe PLAGNIOL-VILLARD * background color is limited to black/white/gray colors. The Linux
14352d2591SJean-Christophe PLAGNIOL-VILLARD * logo can be placed in the upper left corner and additional board
1564e40d72SWolfgang Denk * information strings (that normally goes to serial port) can be drawn.
16352d2591SJean-Christophe PLAGNIOL-VILLARD *
1739f615edSSimon Glass * The console driver can use a keyboard interface for character input
1839f615edSSimon Glass * but this is deprecated. Only rk51 uses it.
1939f615edSSimon Glass *
2039f615edSSimon Glass * Character output goes to a memory-mapped video
21352d2591SJean-Christophe PLAGNIOL-VILLARD * framebuffer with little or big-endian organisation.
22352d2591SJean-Christophe PLAGNIOL-VILLARD * With environment setting 'console=serial' the console i/o can be
23352d2591SJean-Christophe PLAGNIOL-VILLARD * forced to serial port.
2464e40d72SWolfgang Denk *
2564e40d72SWolfgang Denk * The driver uses graphic specific defines/parameters/functions:
2664e40d72SWolfgang Denk *
2764e40d72SWolfgang Denk * (for SMI LynxE graphic chip)
2864e40d72SWolfgang Denk *
2964e40d72SWolfgang Denk * VIDEO_FB_LITTLE_ENDIAN - framebuffer organisation default: big endian
3064e40d72SWolfgang Denk * VIDEO_HW_RECTFILL - graphic driver supports hardware rectangle fill
3164e40d72SWolfgang Denk * VIDEO_HW_BITBLT - graphic driver supports hardware bit blt
3264e40d72SWolfgang Denk *
3364e40d72SWolfgang Denk * Console Parameters are set by graphic drivers global struct:
3464e40d72SWolfgang Denk *
3564e40d72SWolfgang Denk * VIDEO_VISIBLE_COLS - x resolution
3664e40d72SWolfgang Denk * VIDEO_VISIBLE_ROWS - y resolution
3764e40d72SWolfgang Denk * VIDEO_PIXEL_SIZE - storage size in byte per pixel
3864e40d72SWolfgang Denk * VIDEO_DATA_FORMAT - graphical data format GDF
3964e40d72SWolfgang Denk * VIDEO_FB_ADRS - start of video memory
4064e40d72SWolfgang Denk *
4164e40d72SWolfgang Denk * VIDEO_KBD_INIT_FCT - init function for keyboard
4264e40d72SWolfgang Denk * VIDEO_TSTC_FCT - keyboard_tstc function
4364e40d72SWolfgang Denk * VIDEO_GETC_FCT - keyboard_getc function
4464e40d72SWolfgang Denk *
451e681f9aSBastian Ruppert * CONFIG_VIDEO_LOGO - display Linux Logo in upper left corner.
461e681f9aSBastian Ruppert * Use CONFIG_SPLASH_SCREEN_ALIGN with
471e681f9aSBastian Ruppert * environment variable "splashpos" to place
481e681f9aSBastian Ruppert * the logo on other position. In this case
491e681f9aSBastian Ruppert * no CONSOLE_EXTRA_INFO is possible.
5064e40d72SWolfgang Denk * CONFIG_VIDEO_BMP_LOGO - use bmp_logo instead of linux_logo
5164e40d72SWolfgang Denk * CONFIG_CONSOLE_EXTRA_INFO - display additional board information
5264e40d72SWolfgang Denk * strings that normaly goes to serial
5364e40d72SWolfgang Denk * port. This define requires a board
5464e40d72SWolfgang Denk * specific function:
5564e40d72SWolfgang Denk * video_drawstring (VIDEO_INFO_X,
5664e40d72SWolfgang Denk * VIDEO_INFO_Y + i*VIDEO_FONT_HEIGHT,
5764e40d72SWolfgang Denk * info);
5864e40d72SWolfgang Denk * that fills a info buffer at i=row.
5964e40d72SWolfgang Denk * s.a: board/eltec/bab7xx.
6064e40d72SWolfgang Denk *
6164e40d72SWolfgang Denk * CONFIG_VIDEO_SW_CURSOR: - Draws a cursor after the last
6264e40d72SWolfgang Denk * character. No blinking is provided.
6364e40d72SWolfgang Denk * Uses the macros CURSOR_SET and
6464e40d72SWolfgang Denk * CURSOR_OFF.
65352d2591SJean-Christophe PLAGNIOL-VILLARD */
66352d2591SJean-Christophe PLAGNIOL-VILLARD
67352d2591SJean-Christophe PLAGNIOL-VILLARD #include <common.h>
685692ccfaSSimon Glass #include <fdtdec.h>
69*772b9e8bSPali Rohár #include <version_string.h>
70352d2591SJean-Christophe PLAGNIOL-VILLARD #include <malloc.h>
710a6eac84SSimon Glass #include <video.h>
72a9a62af1SWolfgang Denk #include <linux/compiler.h>
73352d2591SJean-Christophe PLAGNIOL-VILLARD
74c370d382SSimon Glass #if defined(CONFIG_VIDEO_MXS)
75fb8ddc24SMarek Vasut #define VIDEO_FB_16BPP_WORD_SWAP
76fb8ddc24SMarek Vasut #endif
77fb8ddc24SMarek Vasut
7864e40d72SWolfgang Denk /*
7964e40d72SWolfgang Denk * Defines for the MB862xx driver
8064e40d72SWolfgang Denk */
81bed53753SAnatolij Gustschin #ifdef CONFIG_VIDEO_MB862xx
82bed53753SAnatolij Gustschin
83bed53753SAnatolij Gustschin #ifdef CONFIG_VIDEO_CORALP
84bed53753SAnatolij Gustschin #define VIDEO_FB_LITTLE_ENDIAN
85bed53753SAnatolij Gustschin #endif
865d16ca87SAnatolij Gustschin #ifdef CONFIG_VIDEO_MB862xx_ACCEL
87bed53753SAnatolij Gustschin #define VIDEO_HW_RECTFILL
88bed53753SAnatolij Gustschin #define VIDEO_HW_BITBLT
89bed53753SAnatolij Gustschin #endif
905d16ca87SAnatolij Gustschin #endif
91bed53753SAnatolij Gustschin
9264e40d72SWolfgang Denk /*
9362a22dcaSHelmut Raiger * Defines for the i.MX31 driver (mx3fb.c)
9462a22dcaSHelmut Raiger */
95695af9abSFabio Estevam #if defined(CONFIG_VIDEO_MX3) || defined(CONFIG_VIDEO_IPUV3)
9662a22dcaSHelmut Raiger #define VIDEO_FB_16BPP_WORD_SWAP
9762a22dcaSHelmut Raiger #endif
9862a22dcaSHelmut Raiger
9962a22dcaSHelmut Raiger /*
10064e40d72SWolfgang Denk * Include video_fb.h after definitions of VIDEO_HW_RECTFILL etc.
10164e40d72SWolfgang Denk */
102352d2591SJean-Christophe PLAGNIOL-VILLARD #include <video_fb.h>
103352d2591SJean-Christophe PLAGNIOL-VILLARD
104dd4425e8SRobert Winkler #include <splash.h>
105dd4425e8SRobert Winkler
10664e40d72SWolfgang Denk /*
10764e40d72SWolfgang Denk * some Macros
10864e40d72SWolfgang Denk */
109352d2591SJean-Christophe PLAGNIOL-VILLARD #define VIDEO_VISIBLE_COLS (pGD->winSizeX)
110352d2591SJean-Christophe PLAGNIOL-VILLARD #define VIDEO_VISIBLE_ROWS (pGD->winSizeY)
111352d2591SJean-Christophe PLAGNIOL-VILLARD #define VIDEO_PIXEL_SIZE (pGD->gdfBytesPP)
112352d2591SJean-Christophe PLAGNIOL-VILLARD #define VIDEO_DATA_FORMAT (pGD->gdfIndex)
113352d2591SJean-Christophe PLAGNIOL-VILLARD #define VIDEO_FB_ADRS (pGD->frameAdrs)
114352d2591SJean-Christophe PLAGNIOL-VILLARD
11564e40d72SWolfgang Denk /*
11664e40d72SWolfgang Denk * Console device
11764e40d72SWolfgang Denk */
118352d2591SJean-Christophe PLAGNIOL-VILLARD
119352d2591SJean-Christophe PLAGNIOL-VILLARD #include <linux/types.h>
12052cb4d4fSJean-Christophe PLAGNIOL-VILLARD #include <stdio_dev.h>
121352d2591SJean-Christophe PLAGNIOL-VILLARD #include <video_font.h>
122352d2591SJean-Christophe PLAGNIOL-VILLARD
123352d2591SJean-Christophe PLAGNIOL-VILLARD #if defined(CONFIG_CMD_DATE)
124352d2591SJean-Christophe PLAGNIOL-VILLARD #include <rtc.h>
125352d2591SJean-Christophe PLAGNIOL-VILLARD #endif
126352d2591SJean-Christophe PLAGNIOL-VILLARD
127352d2591SJean-Christophe PLAGNIOL-VILLARD #if defined(CONFIG_CMD_BMP) || defined(CONFIG_SPLASH_SCREEN)
128352d2591SJean-Christophe PLAGNIOL-VILLARD #include <watchdog.h>
129352d2591SJean-Christophe PLAGNIOL-VILLARD #include <bmp_layout.h>
130ff8fb56bSAnatolij Gustschin #include <splash.h>
131352d2591SJean-Christophe PLAGNIOL-VILLARD #endif
132352d2591SJean-Christophe PLAGNIOL-VILLARD
133a4206575SSimon Glass #if !defined(CONFIG_VIDEO_SW_CURSOR)
134352d2591SJean-Christophe PLAGNIOL-VILLARD /* no Cursor defined */
135352d2591SJean-Christophe PLAGNIOL-VILLARD #define CURSOR_ON
136352d2591SJean-Christophe PLAGNIOL-VILLARD #define CURSOR_OFF
137352d2591SJean-Christophe PLAGNIOL-VILLARD #define CURSOR_SET
138352d2591SJean-Christophe PLAGNIOL-VILLARD #endif
139352d2591SJean-Christophe PLAGNIOL-VILLARD
1407fe0933cSSimon Glass #if defined(CONFIG_VIDEO_SW_CURSOR)
141352d2591SJean-Christophe PLAGNIOL-VILLARD void console_cursor(int state);
14264e40d72SWolfgang Denk
14365618636STimur Tabi #define CURSOR_ON console_cursor(1)
14465618636STimur Tabi #define CURSOR_OFF console_cursor(0)
14503d31fcfSGabe Black #define CURSOR_SET video_set_cursor()
1467fe0933cSSimon Glass #endif /* CONFIG_VIDEO_SW_CURSOR */
147352d2591SJean-Christophe PLAGNIOL-VILLARD
148352d2591SJean-Christophe PLAGNIOL-VILLARD #ifdef CONFIG_VIDEO_LOGO
149352d2591SJean-Christophe PLAGNIOL-VILLARD #ifdef CONFIG_VIDEO_BMP_LOGO
150352d2591SJean-Christophe PLAGNIOL-VILLARD #include <bmp_logo.h>
151c270730fSChe-Liang Chiou #include <bmp_logo_data.h>
152352d2591SJean-Christophe PLAGNIOL-VILLARD #define VIDEO_LOGO_WIDTH BMP_LOGO_WIDTH
153352d2591SJean-Christophe PLAGNIOL-VILLARD #define VIDEO_LOGO_HEIGHT BMP_LOGO_HEIGHT
154352d2591SJean-Christophe PLAGNIOL-VILLARD #define VIDEO_LOGO_LUT_OFFSET BMP_LOGO_OFFSET
155352d2591SJean-Christophe PLAGNIOL-VILLARD #define VIDEO_LOGO_COLORS BMP_LOGO_COLORS
156352d2591SJean-Christophe PLAGNIOL-VILLARD
157352d2591SJean-Christophe PLAGNIOL-VILLARD #else /* CONFIG_VIDEO_BMP_LOGO */
158352d2591SJean-Christophe PLAGNIOL-VILLARD #define LINUX_LOGO_WIDTH 80
159352d2591SJean-Christophe PLAGNIOL-VILLARD #define LINUX_LOGO_HEIGHT 80
160352d2591SJean-Christophe PLAGNIOL-VILLARD #define LINUX_LOGO_COLORS 214
161352d2591SJean-Christophe PLAGNIOL-VILLARD #define LINUX_LOGO_LUT_OFFSET 0x20
162352d2591SJean-Christophe PLAGNIOL-VILLARD #define __initdata
163352d2591SJean-Christophe PLAGNIOL-VILLARD #include <linux_logo.h>
164352d2591SJean-Christophe PLAGNIOL-VILLARD #define VIDEO_LOGO_WIDTH LINUX_LOGO_WIDTH
165352d2591SJean-Christophe PLAGNIOL-VILLARD #define VIDEO_LOGO_HEIGHT LINUX_LOGO_HEIGHT
166352d2591SJean-Christophe PLAGNIOL-VILLARD #define VIDEO_LOGO_LUT_OFFSET LINUX_LOGO_LUT_OFFSET
167352d2591SJean-Christophe PLAGNIOL-VILLARD #define VIDEO_LOGO_COLORS LINUX_LOGO_COLORS
168352d2591SJean-Christophe PLAGNIOL-VILLARD #endif /* CONFIG_VIDEO_BMP_LOGO */
169352d2591SJean-Christophe PLAGNIOL-VILLARD #define VIDEO_INFO_X (VIDEO_LOGO_WIDTH)
170352d2591SJean-Christophe PLAGNIOL-VILLARD #define VIDEO_INFO_Y (VIDEO_FONT_HEIGHT/2)
171352d2591SJean-Christophe PLAGNIOL-VILLARD #else /* CONFIG_VIDEO_LOGO */
172352d2591SJean-Christophe PLAGNIOL-VILLARD #define VIDEO_LOGO_WIDTH 0
173352d2591SJean-Christophe PLAGNIOL-VILLARD #define VIDEO_LOGO_HEIGHT 0
174352d2591SJean-Christophe PLAGNIOL-VILLARD #endif /* CONFIG_VIDEO_LOGO */
175352d2591SJean-Christophe PLAGNIOL-VILLARD
176352d2591SJean-Christophe PLAGNIOL-VILLARD #define VIDEO_COLS VIDEO_VISIBLE_COLS
177352d2591SJean-Christophe PLAGNIOL-VILLARD #define VIDEO_ROWS VIDEO_VISIBLE_ROWS
178c67a8767SHans de Goede #ifndef VIDEO_LINE_LEN
179352d2591SJean-Christophe PLAGNIOL-VILLARD #define VIDEO_LINE_LEN (VIDEO_COLS * VIDEO_PIXEL_SIZE)
180c67a8767SHans de Goede #endif
181c67a8767SHans de Goede #define VIDEO_SIZE (VIDEO_ROWS * VIDEO_LINE_LEN)
182352d2591SJean-Christophe PLAGNIOL-VILLARD #define VIDEO_BURST_LEN (VIDEO_COLS/8)
183352d2591SJean-Christophe PLAGNIOL-VILLARD
184352d2591SJean-Christophe PLAGNIOL-VILLARD #ifdef CONFIG_VIDEO_LOGO
185be129aa7SMatthias Weisser #define CONSOLE_ROWS ((VIDEO_ROWS - video_logo_height) / VIDEO_FONT_HEIGHT)
186352d2591SJean-Christophe PLAGNIOL-VILLARD #else
187352d2591SJean-Christophe PLAGNIOL-VILLARD #define CONSOLE_ROWS (VIDEO_ROWS / VIDEO_FONT_HEIGHT)
188352d2591SJean-Christophe PLAGNIOL-VILLARD #endif
189352d2591SJean-Christophe PLAGNIOL-VILLARD
190352d2591SJean-Christophe PLAGNIOL-VILLARD #define CONSOLE_COLS (VIDEO_COLS / VIDEO_FONT_WIDTH)
191352d2591SJean-Christophe PLAGNIOL-VILLARD #define CONSOLE_ROW_SIZE (VIDEO_FONT_HEIGHT * VIDEO_LINE_LEN)
192352d2591SJean-Christophe PLAGNIOL-VILLARD #define CONSOLE_ROW_FIRST (video_console_address)
193352d2591SJean-Christophe PLAGNIOL-VILLARD #define CONSOLE_ROW_SECOND (video_console_address + CONSOLE_ROW_SIZE)
194352d2591SJean-Christophe PLAGNIOL-VILLARD #define CONSOLE_ROW_LAST (video_console_address + CONSOLE_SIZE - CONSOLE_ROW_SIZE)
195352d2591SJean-Christophe PLAGNIOL-VILLARD #define CONSOLE_SIZE (CONSOLE_ROW_SIZE * CONSOLE_ROWS)
1963c0b668fSSimon Glass
1973c0b668fSSimon Glass /* By default we scroll by a single line */
1983c0b668fSSimon Glass #ifndef CONFIG_CONSOLE_SCROLL_LINES
1993c0b668fSSimon Glass #define CONFIG_CONSOLE_SCROLL_LINES 1
2003c0b668fSSimon Glass #endif
201352d2591SJean-Christophe PLAGNIOL-VILLARD
202352d2591SJean-Christophe PLAGNIOL-VILLARD /* Macros */
203352d2591SJean-Christophe PLAGNIOL-VILLARD #ifdef VIDEO_FB_LITTLE_ENDIAN
20464e40d72SWolfgang Denk #define SWAP16(x) ((((x) & 0x00ff) << 8) | \
20564e40d72SWolfgang Denk ((x) >> 8) \
20664e40d72SWolfgang Denk )
20764e40d72SWolfgang Denk #define SWAP32(x) ((((x) & 0x000000ff) << 24) | \
20864e40d72SWolfgang Denk (((x) & 0x0000ff00) << 8) | \
20964e40d72SWolfgang Denk (((x) & 0x00ff0000) >> 8) | \
21064e40d72SWolfgang Denk (((x) & 0xff000000) >> 24) \
21164e40d72SWolfgang Denk )
21264e40d72SWolfgang Denk #define SHORTSWAP32(x) ((((x) & 0x000000ff) << 8) | \
21364e40d72SWolfgang Denk (((x) & 0x0000ff00) >> 8) | \
21464e40d72SWolfgang Denk (((x) & 0x00ff0000) << 8) | \
21564e40d72SWolfgang Denk (((x) & 0xff000000) >> 8) \
21664e40d72SWolfgang Denk )
217352d2591SJean-Christophe PLAGNIOL-VILLARD #else
218352d2591SJean-Christophe PLAGNIOL-VILLARD #define SWAP16(x) (x)
219352d2591SJean-Christophe PLAGNIOL-VILLARD #define SWAP32(x) (x)
220229b6dceSWolfgang Grandegger #if defined(VIDEO_FB_16BPP_WORD_SWAP)
221bed53753SAnatolij Gustschin #define SHORTSWAP32(x) (((x) >> 16) | ((x) << 16))
222cc347801SAndrew Dyer #else
223cc347801SAndrew Dyer #define SHORTSWAP32(x) (x)
224bed53753SAnatolij Gustschin #endif
225352d2591SJean-Christophe PLAGNIOL-VILLARD #endif
226352d2591SJean-Christophe PLAGNIOL-VILLARD
227bfd4be80SAnatolij Gustschin DECLARE_GLOBAL_DATA_PTR;
228bfd4be80SAnatolij Gustschin
229352d2591SJean-Christophe PLAGNIOL-VILLARD /* Locals */
230352d2591SJean-Christophe PLAGNIOL-VILLARD static GraphicDevice *pGD; /* Pointer to Graphic array */
231352d2591SJean-Christophe PLAGNIOL-VILLARD
232352d2591SJean-Christophe PLAGNIOL-VILLARD static void *video_fb_address; /* frame buffer address */
233352d2591SJean-Christophe PLAGNIOL-VILLARD static void *video_console_address; /* console buffer start address */
234352d2591SJean-Christophe PLAGNIOL-VILLARD
235be129aa7SMatthias Weisser static int video_logo_height = VIDEO_LOGO_HEIGHT;
236be129aa7SMatthias Weisser
237a45adde9SAnatolij Gustschin static int __maybe_unused cursor_state;
238a45adde9SAnatolij Gustschin static int __maybe_unused old_col;
239a45adde9SAnatolij Gustschin static int __maybe_unused old_row;
24003d31fcfSGabe Black
24157912939SWolfgang Denk static int console_col; /* cursor col */
24257912939SWolfgang Denk static int console_row; /* cursor row */
243352d2591SJean-Christophe PLAGNIOL-VILLARD
244352d2591SJean-Christophe PLAGNIOL-VILLARD static u32 eorx, fgx, bgx; /* color pats */
245352d2591SJean-Christophe PLAGNIOL-VILLARD
246bfd4be80SAnatolij Gustschin static int cfb_do_flush_cache;
247bfd4be80SAnatolij Gustschin
24833a35bbbSPali Rohár #ifdef CONFIG_CFB_CONSOLE_ANSI
24933a35bbbSPali Rohár static char ansi_buf[10];
25033a35bbbSPali Rohár static int ansi_buf_size;
25133a35bbbSPali Rohár static int ansi_colors_need_revert;
25233a35bbbSPali Rohár static int ansi_cursor_hidden;
25333a35bbbSPali Rohár #endif
25433a35bbbSPali Rohár
255352d2591SJean-Christophe PLAGNIOL-VILLARD static const int video_font_draw_table8[] = {
256352d2591SJean-Christophe PLAGNIOL-VILLARD 0x00000000, 0x000000ff, 0x0000ff00, 0x0000ffff,
257352d2591SJean-Christophe PLAGNIOL-VILLARD 0x00ff0000, 0x00ff00ff, 0x00ffff00, 0x00ffffff,
258352d2591SJean-Christophe PLAGNIOL-VILLARD 0xff000000, 0xff0000ff, 0xff00ff00, 0xff00ffff,
25964e40d72SWolfgang Denk 0xffff0000, 0xffff00ff, 0xffffff00, 0xffffffff
26064e40d72SWolfgang Denk };
261352d2591SJean-Christophe PLAGNIOL-VILLARD
262352d2591SJean-Christophe PLAGNIOL-VILLARD static const int video_font_draw_table15[] = {
26364e40d72SWolfgang Denk 0x00000000, 0x00007fff, 0x7fff0000, 0x7fff7fff
26464e40d72SWolfgang Denk };
265352d2591SJean-Christophe PLAGNIOL-VILLARD
266352d2591SJean-Christophe PLAGNIOL-VILLARD static const int video_font_draw_table16[] = {
26764e40d72SWolfgang Denk 0x00000000, 0x0000ffff, 0xffff0000, 0xffffffff
26864e40d72SWolfgang Denk };
269352d2591SJean-Christophe PLAGNIOL-VILLARD
270352d2591SJean-Christophe PLAGNIOL-VILLARD static const int video_font_draw_table24[16][3] = {
271352d2591SJean-Christophe PLAGNIOL-VILLARD {0x00000000, 0x00000000, 0x00000000},
272352d2591SJean-Christophe PLAGNIOL-VILLARD {0x00000000, 0x00000000, 0x00ffffff},
273352d2591SJean-Christophe PLAGNIOL-VILLARD {0x00000000, 0x0000ffff, 0xff000000},
274352d2591SJean-Christophe PLAGNIOL-VILLARD {0x00000000, 0x0000ffff, 0xffffffff},
275352d2591SJean-Christophe PLAGNIOL-VILLARD {0x000000ff, 0xffff0000, 0x00000000},
276352d2591SJean-Christophe PLAGNIOL-VILLARD {0x000000ff, 0xffff0000, 0x00ffffff},
277352d2591SJean-Christophe PLAGNIOL-VILLARD {0x000000ff, 0xffffffff, 0xff000000},
278352d2591SJean-Christophe PLAGNIOL-VILLARD {0x000000ff, 0xffffffff, 0xffffffff},
279352d2591SJean-Christophe PLAGNIOL-VILLARD {0xffffff00, 0x00000000, 0x00000000},
280352d2591SJean-Christophe PLAGNIOL-VILLARD {0xffffff00, 0x00000000, 0x00ffffff},
281352d2591SJean-Christophe PLAGNIOL-VILLARD {0xffffff00, 0x0000ffff, 0xff000000},
282352d2591SJean-Christophe PLAGNIOL-VILLARD {0xffffff00, 0x0000ffff, 0xffffffff},
283352d2591SJean-Christophe PLAGNIOL-VILLARD {0xffffffff, 0xffff0000, 0x00000000},
284352d2591SJean-Christophe PLAGNIOL-VILLARD {0xffffffff, 0xffff0000, 0x00ffffff},
285352d2591SJean-Christophe PLAGNIOL-VILLARD {0xffffffff, 0xffffffff, 0xff000000},
28664e40d72SWolfgang Denk {0xffffffff, 0xffffffff, 0xffffffff}
28764e40d72SWolfgang Denk };
288352d2591SJean-Christophe PLAGNIOL-VILLARD
289352d2591SJean-Christophe PLAGNIOL-VILLARD static const int video_font_draw_table32[16][4] = {
290352d2591SJean-Christophe PLAGNIOL-VILLARD {0x00000000, 0x00000000, 0x00000000, 0x00000000},
291352d2591SJean-Christophe PLAGNIOL-VILLARD {0x00000000, 0x00000000, 0x00000000, 0x00ffffff},
292352d2591SJean-Christophe PLAGNIOL-VILLARD {0x00000000, 0x00000000, 0x00ffffff, 0x00000000},
293352d2591SJean-Christophe PLAGNIOL-VILLARD {0x00000000, 0x00000000, 0x00ffffff, 0x00ffffff},
294352d2591SJean-Christophe PLAGNIOL-VILLARD {0x00000000, 0x00ffffff, 0x00000000, 0x00000000},
295352d2591SJean-Christophe PLAGNIOL-VILLARD {0x00000000, 0x00ffffff, 0x00000000, 0x00ffffff},
296352d2591SJean-Christophe PLAGNIOL-VILLARD {0x00000000, 0x00ffffff, 0x00ffffff, 0x00000000},
297352d2591SJean-Christophe PLAGNIOL-VILLARD {0x00000000, 0x00ffffff, 0x00ffffff, 0x00ffffff},
298352d2591SJean-Christophe PLAGNIOL-VILLARD {0x00ffffff, 0x00000000, 0x00000000, 0x00000000},
299352d2591SJean-Christophe PLAGNIOL-VILLARD {0x00ffffff, 0x00000000, 0x00000000, 0x00ffffff},
300352d2591SJean-Christophe PLAGNIOL-VILLARD {0x00ffffff, 0x00000000, 0x00ffffff, 0x00000000},
301352d2591SJean-Christophe PLAGNIOL-VILLARD {0x00ffffff, 0x00000000, 0x00ffffff, 0x00ffffff},
302352d2591SJean-Christophe PLAGNIOL-VILLARD {0x00ffffff, 0x00ffffff, 0x00000000, 0x00000000},
303352d2591SJean-Christophe PLAGNIOL-VILLARD {0x00ffffff, 0x00ffffff, 0x00000000, 0x00ffffff},
304352d2591SJean-Christophe PLAGNIOL-VILLARD {0x00ffffff, 0x00ffffff, 0x00ffffff, 0x00000000},
30564e40d72SWolfgang Denk {0x00ffffff, 0x00ffffff, 0x00ffffff, 0x00ffffff}
30664e40d72SWolfgang Denk };
307352d2591SJean-Christophe PLAGNIOL-VILLARD
3082bc4aa52SHeiko Schocher /*
3092bc4aa52SHeiko Schocher * Implement a weak default function for boards that optionally
3102bc4aa52SHeiko Schocher * need to skip the cfb initialization.
3112bc4aa52SHeiko Schocher */
board_cfb_skip(void)3122bc4aa52SHeiko Schocher __weak int board_cfb_skip(void)
3132bc4aa52SHeiko Schocher {
3142bc4aa52SHeiko Schocher /* As default, don't skip cfb init */
3152bc4aa52SHeiko Schocher return 0;
3162bc4aa52SHeiko Schocher }
3172bc4aa52SHeiko Schocher
video_drawchars(int xx,int yy,unsigned char * s,int count)318352d2591SJean-Christophe PLAGNIOL-VILLARD static void video_drawchars(int xx, int yy, unsigned char *s, int count)
319352d2591SJean-Christophe PLAGNIOL-VILLARD {
320352d2591SJean-Christophe PLAGNIOL-VILLARD u8 *cdat, *dest, *dest0;
321352d2591SJean-Christophe PLAGNIOL-VILLARD int rows, offset, c;
322352d2591SJean-Christophe PLAGNIOL-VILLARD
323352d2591SJean-Christophe PLAGNIOL-VILLARD offset = yy * VIDEO_LINE_LEN + xx * VIDEO_PIXEL_SIZE;
324352d2591SJean-Christophe PLAGNIOL-VILLARD dest0 = video_fb_address + offset;
325352d2591SJean-Christophe PLAGNIOL-VILLARD
326352d2591SJean-Christophe PLAGNIOL-VILLARD switch (VIDEO_DATA_FORMAT) {
327352d2591SJean-Christophe PLAGNIOL-VILLARD case GDF__8BIT_INDEX:
328352d2591SJean-Christophe PLAGNIOL-VILLARD case GDF__8BIT_332RGB:
329352d2591SJean-Christophe PLAGNIOL-VILLARD while (count--) {
330352d2591SJean-Christophe PLAGNIOL-VILLARD c = *s;
331352d2591SJean-Christophe PLAGNIOL-VILLARD cdat = video_fontdata + c * VIDEO_FONT_HEIGHT;
332352d2591SJean-Christophe PLAGNIOL-VILLARD for (rows = VIDEO_FONT_HEIGHT, dest = dest0;
33364e40d72SWolfgang Denk rows--; dest += VIDEO_LINE_LEN) {
334352d2591SJean-Christophe PLAGNIOL-VILLARD u8 bits = *cdat++;
335352d2591SJean-Christophe PLAGNIOL-VILLARD
33664e40d72SWolfgang Denk ((u32 *) dest)[0] =
33764e40d72SWolfgang Denk (video_font_draw_table8[bits >> 4] &
33864e40d72SWolfgang Denk eorx) ^ bgx;
339fd8cf994SMarek Vasut
340fd8cf994SMarek Vasut if (VIDEO_FONT_WIDTH == 4)
341fd8cf994SMarek Vasut continue;
342fd8cf994SMarek Vasut
34364e40d72SWolfgang Denk ((u32 *) dest)[1] =
34464e40d72SWolfgang Denk (video_font_draw_table8[bits & 15] &
34564e40d72SWolfgang Denk eorx) ^ bgx;
346352d2591SJean-Christophe PLAGNIOL-VILLARD }
347352d2591SJean-Christophe PLAGNIOL-VILLARD dest0 += VIDEO_FONT_WIDTH * VIDEO_PIXEL_SIZE;
348352d2591SJean-Christophe PLAGNIOL-VILLARD s++;
349352d2591SJean-Christophe PLAGNIOL-VILLARD }
350352d2591SJean-Christophe PLAGNIOL-VILLARD break;
351352d2591SJean-Christophe PLAGNIOL-VILLARD
352352d2591SJean-Christophe PLAGNIOL-VILLARD case GDF_15BIT_555RGB:
353352d2591SJean-Christophe PLAGNIOL-VILLARD while (count--) {
354352d2591SJean-Christophe PLAGNIOL-VILLARD c = *s;
355352d2591SJean-Christophe PLAGNIOL-VILLARD cdat = video_fontdata + c * VIDEO_FONT_HEIGHT;
356352d2591SJean-Christophe PLAGNIOL-VILLARD for (rows = VIDEO_FONT_HEIGHT, dest = dest0;
35764e40d72SWolfgang Denk rows--; dest += VIDEO_LINE_LEN) {
358352d2591SJean-Christophe PLAGNIOL-VILLARD u8 bits = *cdat++;
359352d2591SJean-Christophe PLAGNIOL-VILLARD
36064e40d72SWolfgang Denk ((u32 *) dest)[0] =
36164e40d72SWolfgang Denk SHORTSWAP32((video_font_draw_table15
36264e40d72SWolfgang Denk [bits >> 6] & eorx) ^
36364e40d72SWolfgang Denk bgx);
36464e40d72SWolfgang Denk ((u32 *) dest)[1] =
36564e40d72SWolfgang Denk SHORTSWAP32((video_font_draw_table15
36664e40d72SWolfgang Denk [bits >> 4 & 3] & eorx) ^
36764e40d72SWolfgang Denk bgx);
368fd8cf994SMarek Vasut
369fd8cf994SMarek Vasut if (VIDEO_FONT_WIDTH == 4)
370fd8cf994SMarek Vasut continue;
371fd8cf994SMarek Vasut
37264e40d72SWolfgang Denk ((u32 *) dest)[2] =
37364e40d72SWolfgang Denk SHORTSWAP32((video_font_draw_table15
37464e40d72SWolfgang Denk [bits >> 2 & 3] & eorx) ^
37564e40d72SWolfgang Denk bgx);
37664e40d72SWolfgang Denk ((u32 *) dest)[3] =
37764e40d72SWolfgang Denk SHORTSWAP32((video_font_draw_table15
37864e40d72SWolfgang Denk [bits & 3] & eorx) ^
37964e40d72SWolfgang Denk bgx);
380352d2591SJean-Christophe PLAGNIOL-VILLARD }
381352d2591SJean-Christophe PLAGNIOL-VILLARD dest0 += VIDEO_FONT_WIDTH * VIDEO_PIXEL_SIZE;
382352d2591SJean-Christophe PLAGNIOL-VILLARD s++;
383352d2591SJean-Christophe PLAGNIOL-VILLARD }
384352d2591SJean-Christophe PLAGNIOL-VILLARD break;
385352d2591SJean-Christophe PLAGNIOL-VILLARD
386352d2591SJean-Christophe PLAGNIOL-VILLARD case GDF_16BIT_565RGB:
387352d2591SJean-Christophe PLAGNIOL-VILLARD while (count--) {
388352d2591SJean-Christophe PLAGNIOL-VILLARD c = *s;
389352d2591SJean-Christophe PLAGNIOL-VILLARD cdat = video_fontdata + c * VIDEO_FONT_HEIGHT;
390352d2591SJean-Christophe PLAGNIOL-VILLARD for (rows = VIDEO_FONT_HEIGHT, dest = dest0;
39164e40d72SWolfgang Denk rows--; dest += VIDEO_LINE_LEN) {
392352d2591SJean-Christophe PLAGNIOL-VILLARD u8 bits = *cdat++;
393352d2591SJean-Christophe PLAGNIOL-VILLARD
39464e40d72SWolfgang Denk ((u32 *) dest)[0] =
39564e40d72SWolfgang Denk SHORTSWAP32((video_font_draw_table16
39664e40d72SWolfgang Denk [bits >> 6] & eorx) ^
39764e40d72SWolfgang Denk bgx);
39864e40d72SWolfgang Denk ((u32 *) dest)[1] =
39964e40d72SWolfgang Denk SHORTSWAP32((video_font_draw_table16
40064e40d72SWolfgang Denk [bits >> 4 & 3] & eorx) ^
40164e40d72SWolfgang Denk bgx);
402fd8cf994SMarek Vasut
403fd8cf994SMarek Vasut if (VIDEO_FONT_WIDTH == 4)
404fd8cf994SMarek Vasut continue;
405fd8cf994SMarek Vasut
40664e40d72SWolfgang Denk ((u32 *) dest)[2] =
40764e40d72SWolfgang Denk SHORTSWAP32((video_font_draw_table16
40864e40d72SWolfgang Denk [bits >> 2 & 3] & eorx) ^
40964e40d72SWolfgang Denk bgx);
41064e40d72SWolfgang Denk ((u32 *) dest)[3] =
41164e40d72SWolfgang Denk SHORTSWAP32((video_font_draw_table16
41264e40d72SWolfgang Denk [bits & 3] & eorx) ^
41364e40d72SWolfgang Denk bgx);
414352d2591SJean-Christophe PLAGNIOL-VILLARD }
415352d2591SJean-Christophe PLAGNIOL-VILLARD dest0 += VIDEO_FONT_WIDTH * VIDEO_PIXEL_SIZE;
416352d2591SJean-Christophe PLAGNIOL-VILLARD s++;
417352d2591SJean-Christophe PLAGNIOL-VILLARD }
418352d2591SJean-Christophe PLAGNIOL-VILLARD break;
419352d2591SJean-Christophe PLAGNIOL-VILLARD
420352d2591SJean-Christophe PLAGNIOL-VILLARD case GDF_32BIT_X888RGB:
421352d2591SJean-Christophe PLAGNIOL-VILLARD while (count--) {
422352d2591SJean-Christophe PLAGNIOL-VILLARD c = *s;
423352d2591SJean-Christophe PLAGNIOL-VILLARD cdat = video_fontdata + c * VIDEO_FONT_HEIGHT;
424352d2591SJean-Christophe PLAGNIOL-VILLARD for (rows = VIDEO_FONT_HEIGHT, dest = dest0;
42564e40d72SWolfgang Denk rows--; dest += VIDEO_LINE_LEN) {
426352d2591SJean-Christophe PLAGNIOL-VILLARD u8 bits = *cdat++;
427352d2591SJean-Christophe PLAGNIOL-VILLARD
42864e40d72SWolfgang Denk ((u32 *) dest)[0] =
42964e40d72SWolfgang Denk SWAP32((video_font_draw_table32
43064e40d72SWolfgang Denk [bits >> 4][0] & eorx) ^ bgx);
43164e40d72SWolfgang Denk ((u32 *) dest)[1] =
43264e40d72SWolfgang Denk SWAP32((video_font_draw_table32
43364e40d72SWolfgang Denk [bits >> 4][1] & eorx) ^ bgx);
43464e40d72SWolfgang Denk ((u32 *) dest)[2] =
43564e40d72SWolfgang Denk SWAP32((video_font_draw_table32
43664e40d72SWolfgang Denk [bits >> 4][2] & eorx) ^ bgx);
43764e40d72SWolfgang Denk ((u32 *) dest)[3] =
43864e40d72SWolfgang Denk SWAP32((video_font_draw_table32
43964e40d72SWolfgang Denk [bits >> 4][3] & eorx) ^ bgx);
440fd8cf994SMarek Vasut
441fd8cf994SMarek Vasut
442fd8cf994SMarek Vasut if (VIDEO_FONT_WIDTH == 4)
443fd8cf994SMarek Vasut continue;
444fd8cf994SMarek Vasut
44564e40d72SWolfgang Denk ((u32 *) dest)[4] =
44664e40d72SWolfgang Denk SWAP32((video_font_draw_table32
44764e40d72SWolfgang Denk [bits & 15][0] & eorx) ^ bgx);
44864e40d72SWolfgang Denk ((u32 *) dest)[5] =
44964e40d72SWolfgang Denk SWAP32((video_font_draw_table32
45064e40d72SWolfgang Denk [bits & 15][1] & eorx) ^ bgx);
45164e40d72SWolfgang Denk ((u32 *) dest)[6] =
45264e40d72SWolfgang Denk SWAP32((video_font_draw_table32
45364e40d72SWolfgang Denk [bits & 15][2] & eorx) ^ bgx);
45464e40d72SWolfgang Denk ((u32 *) dest)[7] =
45564e40d72SWolfgang Denk SWAP32((video_font_draw_table32
45664e40d72SWolfgang Denk [bits & 15][3] & eorx) ^ bgx);
457352d2591SJean-Christophe PLAGNIOL-VILLARD }
458352d2591SJean-Christophe PLAGNIOL-VILLARD dest0 += VIDEO_FONT_WIDTH * VIDEO_PIXEL_SIZE;
459352d2591SJean-Christophe PLAGNIOL-VILLARD s++;
460352d2591SJean-Christophe PLAGNIOL-VILLARD }
461352d2591SJean-Christophe PLAGNIOL-VILLARD break;
462352d2591SJean-Christophe PLAGNIOL-VILLARD
463352d2591SJean-Christophe PLAGNIOL-VILLARD case GDF_24BIT_888RGB:
464352d2591SJean-Christophe PLAGNIOL-VILLARD while (count--) {
465352d2591SJean-Christophe PLAGNIOL-VILLARD c = *s;
466352d2591SJean-Christophe PLAGNIOL-VILLARD cdat = video_fontdata + c * VIDEO_FONT_HEIGHT;
467352d2591SJean-Christophe PLAGNIOL-VILLARD for (rows = VIDEO_FONT_HEIGHT, dest = dest0;
46864e40d72SWolfgang Denk rows--; dest += VIDEO_LINE_LEN) {
469352d2591SJean-Christophe PLAGNIOL-VILLARD u8 bits = *cdat++;
470352d2591SJean-Christophe PLAGNIOL-VILLARD
47164e40d72SWolfgang Denk ((u32 *) dest)[0] =
47264e40d72SWolfgang Denk (video_font_draw_table24[bits >> 4][0]
47364e40d72SWolfgang Denk & eorx) ^ bgx;
47464e40d72SWolfgang Denk ((u32 *) dest)[1] =
47564e40d72SWolfgang Denk (video_font_draw_table24[bits >> 4][1]
47664e40d72SWolfgang Denk & eorx) ^ bgx;
47764e40d72SWolfgang Denk ((u32 *) dest)[2] =
47864e40d72SWolfgang Denk (video_font_draw_table24[bits >> 4][2]
47964e40d72SWolfgang Denk & eorx) ^ bgx;
480fd8cf994SMarek Vasut
481fd8cf994SMarek Vasut if (VIDEO_FONT_WIDTH == 4)
482fd8cf994SMarek Vasut continue;
483fd8cf994SMarek Vasut
48464e40d72SWolfgang Denk ((u32 *) dest)[3] =
48564e40d72SWolfgang Denk (video_font_draw_table24[bits & 15][0]
48664e40d72SWolfgang Denk & eorx) ^ bgx;
48764e40d72SWolfgang Denk ((u32 *) dest)[4] =
48864e40d72SWolfgang Denk (video_font_draw_table24[bits & 15][1]
48964e40d72SWolfgang Denk & eorx) ^ bgx;
49064e40d72SWolfgang Denk ((u32 *) dest)[5] =
49164e40d72SWolfgang Denk (video_font_draw_table24[bits & 15][2]
49264e40d72SWolfgang Denk & eorx) ^ bgx;
493352d2591SJean-Christophe PLAGNIOL-VILLARD }
494352d2591SJean-Christophe PLAGNIOL-VILLARD dest0 += VIDEO_FONT_WIDTH * VIDEO_PIXEL_SIZE;
495352d2591SJean-Christophe PLAGNIOL-VILLARD s++;
496352d2591SJean-Christophe PLAGNIOL-VILLARD }
497352d2591SJean-Christophe PLAGNIOL-VILLARD break;
498352d2591SJean-Christophe PLAGNIOL-VILLARD }
499352d2591SJean-Christophe PLAGNIOL-VILLARD }
500352d2591SJean-Christophe PLAGNIOL-VILLARD
video_drawstring(int xx,int yy,unsigned char * s)501352d2591SJean-Christophe PLAGNIOL-VILLARD static inline void video_drawstring(int xx, int yy, unsigned char *s)
502352d2591SJean-Christophe PLAGNIOL-VILLARD {
503352d2591SJean-Christophe PLAGNIOL-VILLARD video_drawchars(xx, yy, s, strlen((char *) s));
504352d2591SJean-Christophe PLAGNIOL-VILLARD }
505352d2591SJean-Christophe PLAGNIOL-VILLARD
video_putchar(int xx,int yy,unsigned char c)506352d2591SJean-Christophe PLAGNIOL-VILLARD static void video_putchar(int xx, int yy, unsigned char c)
507352d2591SJean-Christophe PLAGNIOL-VILLARD {
508be129aa7SMatthias Weisser video_drawchars(xx, yy + video_logo_height, &c, 1);
509352d2591SJean-Christophe PLAGNIOL-VILLARD }
510352d2591SJean-Christophe PLAGNIOL-VILLARD
5117fe0933cSSimon Glass #if defined(CONFIG_VIDEO_SW_CURSOR)
video_set_cursor(void)512352d2591SJean-Christophe PLAGNIOL-VILLARD static void video_set_cursor(void)
513352d2591SJean-Christophe PLAGNIOL-VILLARD {
51403d31fcfSGabe Black if (cursor_state)
51503d31fcfSGabe Black console_cursor(0);
51603d31fcfSGabe Black console_cursor(1);
517352d2591SJean-Christophe PLAGNIOL-VILLARD }
51864e40d72SWolfgang Denk
video_invertchar(int xx,int yy)519a45adde9SAnatolij Gustschin static void video_invertchar(int xx, int yy)
520a45adde9SAnatolij Gustschin {
521a45adde9SAnatolij Gustschin int firstx = xx * VIDEO_PIXEL_SIZE;
522a45adde9SAnatolij Gustschin int lastx = (xx + VIDEO_FONT_WIDTH) * VIDEO_PIXEL_SIZE;
523a45adde9SAnatolij Gustschin int firsty = yy * VIDEO_LINE_LEN;
524a45adde9SAnatolij Gustschin int lasty = (yy + VIDEO_FONT_HEIGHT) * VIDEO_LINE_LEN;
525a45adde9SAnatolij Gustschin int x, y;
526a45adde9SAnatolij Gustschin for (y = firsty; y < lasty; y += VIDEO_LINE_LEN) {
527a45adde9SAnatolij Gustschin for (x = firstx; x < lastx; x++) {
528a45adde9SAnatolij Gustschin u8 *dest = (u8 *)(video_fb_address) + x + y;
529a45adde9SAnatolij Gustschin *dest = ~*dest;
530a45adde9SAnatolij Gustschin }
531a45adde9SAnatolij Gustschin }
532a45adde9SAnatolij Gustschin }
53303d31fcfSGabe Black
console_cursor(int state)534352d2591SJean-Christophe PLAGNIOL-VILLARD void console_cursor(int state)
535352d2591SJean-Christophe PLAGNIOL-VILLARD {
53603d31fcfSGabe Black if (cursor_state != state) {
53703d31fcfSGabe Black if (cursor_state) {
53803d31fcfSGabe Black /* turn off the cursor */
53903d31fcfSGabe Black video_invertchar(old_col * VIDEO_FONT_WIDTH,
54003d31fcfSGabe Black old_row * VIDEO_FONT_HEIGHT +
54103d31fcfSGabe Black video_logo_height);
54203d31fcfSGabe Black } else {
54303d31fcfSGabe Black /* turn off the cursor and record where it is */
54403d31fcfSGabe Black video_invertchar(console_col * VIDEO_FONT_WIDTH,
54503d31fcfSGabe Black console_row * VIDEO_FONT_HEIGHT +
54603d31fcfSGabe Black video_logo_height);
54703d31fcfSGabe Black old_col = console_col;
54803d31fcfSGabe Black old_row = console_row;
549352d2591SJean-Christophe PLAGNIOL-VILLARD }
55003d31fcfSGabe Black cursor_state = state;
551352d2591SJean-Christophe PLAGNIOL-VILLARD }
552db0d47ddSEric Nelson if (cfb_do_flush_cache)
553db0d47ddSEric Nelson flush_cache(VIDEO_FB_ADRS, VIDEO_SIZE);
554352d2591SJean-Christophe PLAGNIOL-VILLARD }
555352d2591SJean-Christophe PLAGNIOL-VILLARD #endif
556352d2591SJean-Christophe PLAGNIOL-VILLARD
557352d2591SJean-Christophe PLAGNIOL-VILLARD #ifndef VIDEO_HW_RECTFILL
memsetl(int * p,int c,int v)558352d2591SJean-Christophe PLAGNIOL-VILLARD static void memsetl(int *p, int c, int v)
559352d2591SJean-Christophe PLAGNIOL-VILLARD {
560352d2591SJean-Christophe PLAGNIOL-VILLARD while (c--)
561352d2591SJean-Christophe PLAGNIOL-VILLARD *(p++) = v;
562352d2591SJean-Christophe PLAGNIOL-VILLARD }
563352d2591SJean-Christophe PLAGNIOL-VILLARD #endif
564352d2591SJean-Christophe PLAGNIOL-VILLARD
565352d2591SJean-Christophe PLAGNIOL-VILLARD #ifndef VIDEO_HW_BITBLT
memcpyl(int * d,int * s,int c)566352d2591SJean-Christophe PLAGNIOL-VILLARD static void memcpyl(int *d, int *s, int c)
567352d2591SJean-Christophe PLAGNIOL-VILLARD {
568352d2591SJean-Christophe PLAGNIOL-VILLARD while (c--)
569352d2591SJean-Christophe PLAGNIOL-VILLARD *(d++) = *(s++);
570352d2591SJean-Christophe PLAGNIOL-VILLARD }
571352d2591SJean-Christophe PLAGNIOL-VILLARD #endif
572352d2591SJean-Christophe PLAGNIOL-VILLARD
console_clear_line(int line,int begin,int end)57390f60a81SPali Rohár static void console_clear_line(int line, int begin, int end)
57490f60a81SPali Rohár {
57590f60a81SPali Rohár #ifdef VIDEO_HW_RECTFILL
57690f60a81SPali Rohár video_hw_rectfill(VIDEO_PIXEL_SIZE, /* bytes per pixel */
57790f60a81SPali Rohár VIDEO_FONT_WIDTH * begin, /* dest pos x */
57890f60a81SPali Rohár video_logo_height +
57990f60a81SPali Rohár VIDEO_FONT_HEIGHT * line, /* dest pos y */
58090f60a81SPali Rohár VIDEO_FONT_WIDTH * (end - begin + 1), /* fr. width */
58190f60a81SPali Rohár VIDEO_FONT_HEIGHT, /* frame height */
58290f60a81SPali Rohár bgx /* fill color */
58390f60a81SPali Rohár );
58490f60a81SPali Rohár #else
58590f60a81SPali Rohár if (begin == 0 && (end + 1) == CONSOLE_COLS) {
58690f60a81SPali Rohár memsetl(CONSOLE_ROW_FIRST +
58790f60a81SPali Rohár CONSOLE_ROW_SIZE * line, /* offset of row */
58890f60a81SPali Rohár CONSOLE_ROW_SIZE >> 2, /* length of row */
58990f60a81SPali Rohár bgx /* fill color */
59090f60a81SPali Rohár );
59190f60a81SPali Rohár } else {
59290f60a81SPali Rohár void *offset;
59390f60a81SPali Rohár int i, size;
59490f60a81SPali Rohár
59590f60a81SPali Rohár offset = CONSOLE_ROW_FIRST +
59690f60a81SPali Rohár CONSOLE_ROW_SIZE * line + /* offset of row */
59790f60a81SPali Rohár VIDEO_FONT_WIDTH *
59890f60a81SPali Rohár VIDEO_PIXEL_SIZE * begin; /* offset of col */
59990f60a81SPali Rohár size = VIDEO_FONT_WIDTH * VIDEO_PIXEL_SIZE * (end - begin + 1);
60090f60a81SPali Rohár size >>= 2; /* length to end for memsetl() */
60190f60a81SPali Rohár /* fill at col offset of i'th line using bgx as fill color */
60290f60a81SPali Rohár for (i = 0; i < VIDEO_FONT_HEIGHT; i++)
60390f60a81SPali Rohár memsetl(offset + i * VIDEO_LINE_LEN, size, bgx);
60490f60a81SPali Rohár }
60590f60a81SPali Rohár #endif
60690f60a81SPali Rohár }
60790f60a81SPali Rohár
console_scrollup(void)608352d2591SJean-Christophe PLAGNIOL-VILLARD static void console_scrollup(void)
609352d2591SJean-Christophe PLAGNIOL-VILLARD {
6103c0b668fSSimon Glass const int rows = CONFIG_CONSOLE_SCROLL_LINES;
6113c0b668fSSimon Glass int i;
6123c0b668fSSimon Glass
613352d2591SJean-Christophe PLAGNIOL-VILLARD /* copy up rows ignoring the first one */
614352d2591SJean-Christophe PLAGNIOL-VILLARD
615352d2591SJean-Christophe PLAGNIOL-VILLARD #ifdef VIDEO_HW_BITBLT
616352d2591SJean-Christophe PLAGNIOL-VILLARD video_hw_bitblt(VIDEO_PIXEL_SIZE, /* bytes per pixel */
617352d2591SJean-Christophe PLAGNIOL-VILLARD 0, /* source pos x */
61864e40d72SWolfgang Denk video_logo_height +
6193c0b668fSSimon Glass VIDEO_FONT_HEIGHT * rows, /* source pos y */
620352d2591SJean-Christophe PLAGNIOL-VILLARD 0, /* dest pos x */
621be129aa7SMatthias Weisser video_logo_height, /* dest pos y */
622352d2591SJean-Christophe PLAGNIOL-VILLARD VIDEO_VISIBLE_COLS, /* frame width */
62364e40d72SWolfgang Denk VIDEO_VISIBLE_ROWS
62464e40d72SWolfgang Denk - video_logo_height
6253c0b668fSSimon Glass - VIDEO_FONT_HEIGHT * rows /* frame height */
626352d2591SJean-Christophe PLAGNIOL-VILLARD );
627352d2591SJean-Christophe PLAGNIOL-VILLARD #else
6283c0b668fSSimon Glass memcpyl(CONSOLE_ROW_FIRST, CONSOLE_ROW_FIRST + rows * CONSOLE_ROW_SIZE,
6293c0b668fSSimon Glass (CONSOLE_SIZE - CONSOLE_ROW_SIZE * rows) >> 2);
630352d2591SJean-Christophe PLAGNIOL-VILLARD #endif
631352d2591SJean-Christophe PLAGNIOL-VILLARD /* clear the last one */
6323c0b668fSSimon Glass for (i = 1; i <= rows; i++)
6333c0b668fSSimon Glass console_clear_line(CONSOLE_ROWS - i, 0, CONSOLE_COLS - 1);
6343c0b668fSSimon Glass
6353c0b668fSSimon Glass /* Decrement row number */
6363c0b668fSSimon Glass console_row -= rows;
637352d2591SJean-Christophe PLAGNIOL-VILLARD }
638352d2591SJean-Christophe PLAGNIOL-VILLARD
console_back(void)639352d2591SJean-Christophe PLAGNIOL-VILLARD static void console_back(void)
640352d2591SJean-Christophe PLAGNIOL-VILLARD {
64165618636STimur Tabi console_col--;
642352d2591SJean-Christophe PLAGNIOL-VILLARD
643352d2591SJean-Christophe PLAGNIOL-VILLARD if (console_col < 0) {
644352d2591SJean-Christophe PLAGNIOL-VILLARD console_col = CONSOLE_COLS - 1;
645352d2591SJean-Christophe PLAGNIOL-VILLARD console_row--;
646352d2591SJean-Christophe PLAGNIOL-VILLARD if (console_row < 0)
647352d2591SJean-Christophe PLAGNIOL-VILLARD console_row = 0;
648352d2591SJean-Christophe PLAGNIOL-VILLARD }
649352d2591SJean-Christophe PLAGNIOL-VILLARD }
650352d2591SJean-Christophe PLAGNIOL-VILLARD
65133a35bbbSPali Rohár #ifdef CONFIG_CFB_CONSOLE_ANSI
65233a35bbbSPali Rohár
console_clear(void)65333a35bbbSPali Rohár static void console_clear(void)
654352d2591SJean-Christophe PLAGNIOL-VILLARD {
65533a35bbbSPali Rohár #ifdef VIDEO_HW_RECTFILL
65633a35bbbSPali Rohár video_hw_rectfill(VIDEO_PIXEL_SIZE, /* bytes per pixel */
65733a35bbbSPali Rohár 0, /* dest pos x */
65833a35bbbSPali Rohár video_logo_height, /* dest pos y */
65933a35bbbSPali Rohár VIDEO_VISIBLE_COLS, /* frame width */
66033a35bbbSPali Rohár VIDEO_VISIBLE_ROWS, /* frame height */
66133a35bbbSPali Rohár bgx /* fill color */
66233a35bbbSPali Rohár );
66333a35bbbSPali Rohár #else
66433a35bbbSPali Rohár memsetl(CONSOLE_ROW_FIRST, CONSOLE_SIZE, bgx);
66533a35bbbSPali Rohár #endif
66633a35bbbSPali Rohár }
66733a35bbbSPali Rohár
console_cursor_fix(void)66833a35bbbSPali Rohár static void console_cursor_fix(void)
66933a35bbbSPali Rohár {
67033a35bbbSPali Rohár if (console_row < 0)
67133a35bbbSPali Rohár console_row = 0;
67233a35bbbSPali Rohár if (console_row >= CONSOLE_ROWS)
67333a35bbbSPali Rohár console_row = CONSOLE_ROWS - 1;
67433a35bbbSPali Rohár if (console_col < 0)
67533a35bbbSPali Rohár console_col = 0;
67633a35bbbSPali Rohár if (console_col >= CONSOLE_COLS)
67733a35bbbSPali Rohár console_col = CONSOLE_COLS - 1;
67833a35bbbSPali Rohár }
67933a35bbbSPali Rohár
console_cursor_up(int n)68033a35bbbSPali Rohár static void console_cursor_up(int n)
68133a35bbbSPali Rohár {
68233a35bbbSPali Rohár console_row -= n;
68333a35bbbSPali Rohár console_cursor_fix();
68433a35bbbSPali Rohár }
68533a35bbbSPali Rohár
console_cursor_down(int n)68633a35bbbSPali Rohár static void console_cursor_down(int n)
68733a35bbbSPali Rohár {
68833a35bbbSPali Rohár console_row += n;
68933a35bbbSPali Rohár console_cursor_fix();
69033a35bbbSPali Rohár }
69133a35bbbSPali Rohár
console_cursor_left(int n)69233a35bbbSPali Rohár static void console_cursor_left(int n)
69333a35bbbSPali Rohár {
69433a35bbbSPali Rohár console_col -= n;
69533a35bbbSPali Rohár console_cursor_fix();
69633a35bbbSPali Rohár }
69733a35bbbSPali Rohár
console_cursor_right(int n)69833a35bbbSPali Rohár static void console_cursor_right(int n)
69933a35bbbSPali Rohár {
70033a35bbbSPali Rohár console_col += n;
70133a35bbbSPali Rohár console_cursor_fix();
70233a35bbbSPali Rohár }
70333a35bbbSPali Rohár
console_cursor_set_position(int row,int col)70433a35bbbSPali Rohár static void console_cursor_set_position(int row, int col)
70533a35bbbSPali Rohár {
70633a35bbbSPali Rohár if (console_row != -1)
70733a35bbbSPali Rohár console_row = row;
70833a35bbbSPali Rohár if (console_col != -1)
70933a35bbbSPali Rohár console_col = col;
71033a35bbbSPali Rohár console_cursor_fix();
71133a35bbbSPali Rohár }
71233a35bbbSPali Rohár
console_previousline(int n)71333a35bbbSPali Rohár static void console_previousline(int n)
71433a35bbbSPali Rohár {
71533a35bbbSPali Rohár /* FIXME: also scroll terminal ? */
71633a35bbbSPali Rohár console_row -= n;
71733a35bbbSPali Rohár console_cursor_fix();
71833a35bbbSPali Rohár }
71933a35bbbSPali Rohár
console_swap_colors(void)72033a35bbbSPali Rohár static void console_swap_colors(void)
72133a35bbbSPali Rohár {
72233a35bbbSPali Rohár eorx = fgx;
72333a35bbbSPali Rohár fgx = bgx;
72433a35bbbSPali Rohár bgx = eorx;
72533a35bbbSPali Rohár eorx = fgx ^ bgx;
72633a35bbbSPali Rohár }
72733a35bbbSPali Rohár
console_cursor_is_visible(void)72833a35bbbSPali Rohár static inline int console_cursor_is_visible(void)
72933a35bbbSPali Rohár {
73033a35bbbSPali Rohár return !ansi_cursor_hidden;
73133a35bbbSPali Rohár }
73233a35bbbSPali Rohár #else
console_cursor_is_visible(void)73333a35bbbSPali Rohár static inline int console_cursor_is_visible(void)
73433a35bbbSPali Rohár {
73533a35bbbSPali Rohár return 1;
73633a35bbbSPali Rohár }
73733a35bbbSPali Rohár #endif
73833a35bbbSPali Rohár
console_newline(int n)73933a35bbbSPali Rohár static void console_newline(int n)
74033a35bbbSPali Rohár {
74133a35bbbSPali Rohár console_row += n;
742352d2591SJean-Christophe PLAGNIOL-VILLARD console_col = 0;
743352d2591SJean-Christophe PLAGNIOL-VILLARD
744352d2591SJean-Christophe PLAGNIOL-VILLARD /* Check if we need to scroll the terminal */
745352d2591SJean-Christophe PLAGNIOL-VILLARD if (console_row >= CONSOLE_ROWS) {
746352d2591SJean-Christophe PLAGNIOL-VILLARD /* Scroll everything up */
747352d2591SJean-Christophe PLAGNIOL-VILLARD console_scrollup();
748352d2591SJean-Christophe PLAGNIOL-VILLARD }
749352d2591SJean-Christophe PLAGNIOL-VILLARD }
750352d2591SJean-Christophe PLAGNIOL-VILLARD
console_cr(void)75120c450efSAnatolij Gustschin static void console_cr(void)
75220c450efSAnatolij Gustschin {
75365618636STimur Tabi console_col = 0;
75420c450efSAnatolij Gustschin }
75520c450efSAnatolij Gustschin
parse_putc(const char c)75633a35bbbSPali Rohár static void parse_putc(const char c)
757352d2591SJean-Christophe PLAGNIOL-VILLARD {
75820c450efSAnatolij Gustschin static int nl = 1;
75920c450efSAnatolij Gustschin
76033a35bbbSPali Rohár if (console_cursor_is_visible())
76103d31fcfSGabe Black CURSOR_OFF;
76203d31fcfSGabe Black
763352d2591SJean-Christophe PLAGNIOL-VILLARD switch (c) {
76420c450efSAnatolij Gustschin case 13: /* back to first column */
76520c450efSAnatolij Gustschin console_cr();
766352d2591SJean-Christophe PLAGNIOL-VILLARD break;
767352d2591SJean-Christophe PLAGNIOL-VILLARD
768352d2591SJean-Christophe PLAGNIOL-VILLARD case '\n': /* next line */
76941ec1270SHeinrich Schuchardt if (console_col || nl)
77033a35bbbSPali Rohár console_newline(1);
77120c450efSAnatolij Gustschin nl = 1;
772352d2591SJean-Christophe PLAGNIOL-VILLARD break;
773352d2591SJean-Christophe PLAGNIOL-VILLARD
774352d2591SJean-Christophe PLAGNIOL-VILLARD case 9: /* tab 8 */
77565618636STimur Tabi console_col |= 0x0008;
776352d2591SJean-Christophe PLAGNIOL-VILLARD console_col &= ~0x0007;
777352d2591SJean-Christophe PLAGNIOL-VILLARD
778352d2591SJean-Christophe PLAGNIOL-VILLARD if (console_col >= CONSOLE_COLS)
77933a35bbbSPali Rohár console_newline(1);
780352d2591SJean-Christophe PLAGNIOL-VILLARD break;
781352d2591SJean-Christophe PLAGNIOL-VILLARD
782352d2591SJean-Christophe PLAGNIOL-VILLARD case 8: /* backspace */
783352d2591SJean-Christophe PLAGNIOL-VILLARD console_back();
784352d2591SJean-Christophe PLAGNIOL-VILLARD break;
785352d2591SJean-Christophe PLAGNIOL-VILLARD
78624fe06ccSPali Rohár case 7: /* bell */
78724fe06ccSPali Rohár break; /* ignored */
78824fe06ccSPali Rohár
789352d2591SJean-Christophe PLAGNIOL-VILLARD default: /* draw the char */
790352d2591SJean-Christophe PLAGNIOL-VILLARD video_putchar(console_col * VIDEO_FONT_WIDTH,
79164e40d72SWolfgang Denk console_row * VIDEO_FONT_HEIGHT, c);
792352d2591SJean-Christophe PLAGNIOL-VILLARD console_col++;
793352d2591SJean-Christophe PLAGNIOL-VILLARD
794352d2591SJean-Christophe PLAGNIOL-VILLARD /* check for newline */
79520c450efSAnatolij Gustschin if (console_col >= CONSOLE_COLS) {
79633a35bbbSPali Rohár console_newline(1);
79720c450efSAnatolij Gustschin nl = 0;
79820c450efSAnatolij Gustschin }
799352d2591SJean-Christophe PLAGNIOL-VILLARD }
80033a35bbbSPali Rohár
80133a35bbbSPali Rohár if (console_cursor_is_visible())
80265618636STimur Tabi CURSOR_SET;
80365618636STimur Tabi }
804352d2591SJean-Christophe PLAGNIOL-VILLARD
cfb_video_putc(struct stdio_dev * dev,const char c)8050a6eac84SSimon Glass static void cfb_video_putc(struct stdio_dev *dev, const char c)
80633a35bbbSPali Rohár {
80733a35bbbSPali Rohár #ifdef CONFIG_CFB_CONSOLE_ANSI
80833a35bbbSPali Rohár int i;
80933a35bbbSPali Rohár
81033a35bbbSPali Rohár if (c == 27) {
81133a35bbbSPali Rohár for (i = 0; i < ansi_buf_size; ++i)
81233a35bbbSPali Rohár parse_putc(ansi_buf[i]);
81333a35bbbSPali Rohár ansi_buf[0] = 27;
81433a35bbbSPali Rohár ansi_buf_size = 1;
81533a35bbbSPali Rohár return;
81633a35bbbSPali Rohár }
81733a35bbbSPali Rohár
81833a35bbbSPali Rohár if (ansi_buf_size > 0) {
81933a35bbbSPali Rohár /*
82033a35bbbSPali Rohár * 0 - ESC
82133a35bbbSPali Rohár * 1 - [
82233a35bbbSPali Rohár * 2 - num1
82333a35bbbSPali Rohár * 3 - ..
82433a35bbbSPali Rohár * 4 - ;
82533a35bbbSPali Rohár * 5 - num2
82633a35bbbSPali Rohár * 6 - ..
82733a35bbbSPali Rohár * - cchar
82833a35bbbSPali Rohár */
82933a35bbbSPali Rohár int next = 0;
83033a35bbbSPali Rohár
83133a35bbbSPali Rohár int flush = 0;
83233a35bbbSPali Rohár int fail = 0;
83333a35bbbSPali Rohár
83433a35bbbSPali Rohár int num1 = 0;
83533a35bbbSPali Rohár int num2 = 0;
83633a35bbbSPali Rohár int cchar = 0;
83733a35bbbSPali Rohár
83833a35bbbSPali Rohár ansi_buf[ansi_buf_size++] = c;
83933a35bbbSPali Rohár
84033a35bbbSPali Rohár if (ansi_buf_size >= sizeof(ansi_buf))
84133a35bbbSPali Rohár fail = 1;
84233a35bbbSPali Rohár
84333a35bbbSPali Rohár for (i = 0; i < ansi_buf_size; ++i) {
84433a35bbbSPali Rohár if (fail)
84533a35bbbSPali Rohár break;
84633a35bbbSPali Rohár
84733a35bbbSPali Rohár switch (next) {
84833a35bbbSPali Rohár case 0:
84933a35bbbSPali Rohár if (ansi_buf[i] == 27)
85033a35bbbSPali Rohár next = 1;
85133a35bbbSPali Rohár else
85233a35bbbSPali Rohár fail = 1;
85333a35bbbSPali Rohár break;
85433a35bbbSPali Rohár
85533a35bbbSPali Rohár case 1:
85633a35bbbSPali Rohár if (ansi_buf[i] == '[')
85733a35bbbSPali Rohár next = 2;
85833a35bbbSPali Rohár else
85933a35bbbSPali Rohár fail = 1;
86033a35bbbSPali Rohár break;
86133a35bbbSPali Rohár
86233a35bbbSPali Rohár case 2:
86333a35bbbSPali Rohár if (ansi_buf[i] >= '0' && ansi_buf[i] <= '9') {
86433a35bbbSPali Rohár num1 = ansi_buf[i]-'0';
86533a35bbbSPali Rohár next = 3;
86633a35bbbSPali Rohár } else if (ansi_buf[i] != '?') {
86733a35bbbSPali Rohár --i;
86833a35bbbSPali Rohár num1 = 1;
86933a35bbbSPali Rohár next = 4;
87033a35bbbSPali Rohár }
87133a35bbbSPali Rohár break;
87233a35bbbSPali Rohár
87333a35bbbSPali Rohár case 3:
87433a35bbbSPali Rohár if (ansi_buf[i] >= '0' && ansi_buf[i] <= '9') {
87533a35bbbSPali Rohár num1 *= 10;
87633a35bbbSPali Rohár num1 += ansi_buf[i]-'0';
87733a35bbbSPali Rohár } else {
87833a35bbbSPali Rohár --i;
87933a35bbbSPali Rohár next = 4;
88033a35bbbSPali Rohár }
88133a35bbbSPali Rohár break;
88233a35bbbSPali Rohár
88333a35bbbSPali Rohár case 4:
88433a35bbbSPali Rohár if (ansi_buf[i] != ';') {
88533a35bbbSPali Rohár --i;
88633a35bbbSPali Rohár next = 7;
88733a35bbbSPali Rohár } else
88833a35bbbSPali Rohár next = 5;
88933a35bbbSPali Rohár break;
89033a35bbbSPali Rohár
89133a35bbbSPali Rohár case 5:
89233a35bbbSPali Rohár if (ansi_buf[i] >= '0' && ansi_buf[i] <= '9') {
89333a35bbbSPali Rohár num2 = ansi_buf[i]-'0';
89433a35bbbSPali Rohár next = 6;
89533a35bbbSPali Rohár } else
89633a35bbbSPali Rohár fail = 1;
89733a35bbbSPali Rohár break;
89833a35bbbSPali Rohár
89933a35bbbSPali Rohár case 6:
90033a35bbbSPali Rohár if (ansi_buf[i] >= '0' && ansi_buf[i] <= '9') {
90133a35bbbSPali Rohár num2 *= 10;
90233a35bbbSPali Rohár num2 += ansi_buf[i]-'0';
90333a35bbbSPali Rohár } else {
90433a35bbbSPali Rohár --i;
90533a35bbbSPali Rohár next = 7;
90633a35bbbSPali Rohár }
90733a35bbbSPali Rohár break;
90833a35bbbSPali Rohár
90933a35bbbSPali Rohár case 7:
91033a35bbbSPali Rohár if ((ansi_buf[i] >= 'A' && ansi_buf[i] <= 'H')
91133a35bbbSPali Rohár || ansi_buf[i] == 'J'
91233a35bbbSPali Rohár || ansi_buf[i] == 'K'
91333a35bbbSPali Rohár || ansi_buf[i] == 'h'
91433a35bbbSPali Rohár || ansi_buf[i] == 'l'
91533a35bbbSPali Rohár || ansi_buf[i] == 'm') {
91633a35bbbSPali Rohár cchar = ansi_buf[i];
91733a35bbbSPali Rohár flush = 1;
91833a35bbbSPali Rohár } else
91933a35bbbSPali Rohár fail = 1;
92033a35bbbSPali Rohár break;
92133a35bbbSPali Rohár }
92233a35bbbSPali Rohár }
92333a35bbbSPali Rohár
92433a35bbbSPali Rohár if (fail) {
92533a35bbbSPali Rohár for (i = 0; i < ansi_buf_size; ++i)
92633a35bbbSPali Rohár parse_putc(ansi_buf[i]);
92733a35bbbSPali Rohár ansi_buf_size = 0;
92833a35bbbSPali Rohár return;
92933a35bbbSPali Rohár }
93033a35bbbSPali Rohár
93133a35bbbSPali Rohár if (flush) {
93233a35bbbSPali Rohár if (!ansi_cursor_hidden)
93333a35bbbSPali Rohár CURSOR_OFF;
93433a35bbbSPali Rohár ansi_buf_size = 0;
93533a35bbbSPali Rohár switch (cchar) {
93633a35bbbSPali Rohár case 'A':
93733a35bbbSPali Rohár /* move cursor num1 rows up */
93833a35bbbSPali Rohár console_cursor_up(num1);
93933a35bbbSPali Rohár break;
94033a35bbbSPali Rohár case 'B':
94133a35bbbSPali Rohár /* move cursor num1 rows down */
94233a35bbbSPali Rohár console_cursor_down(num1);
94333a35bbbSPali Rohár break;
94433a35bbbSPali Rohár case 'C':
94533a35bbbSPali Rohár /* move cursor num1 columns forward */
94633a35bbbSPali Rohár console_cursor_right(num1);
94733a35bbbSPali Rohár break;
94833a35bbbSPali Rohár case 'D':
94933a35bbbSPali Rohár /* move cursor num1 columns back */
95033a35bbbSPali Rohár console_cursor_left(num1);
95133a35bbbSPali Rohár break;
95233a35bbbSPali Rohár case 'E':
95333a35bbbSPali Rohár /* move cursor num1 rows up at begin of row */
95433a35bbbSPali Rohár console_previousline(num1);
95533a35bbbSPali Rohár break;
95633a35bbbSPali Rohár case 'F':
95733a35bbbSPali Rohár /* move cursor num1 rows down at begin of row */
95833a35bbbSPali Rohár console_newline(num1);
95933a35bbbSPali Rohár break;
96033a35bbbSPali Rohár case 'G':
96133a35bbbSPali Rohár /* move cursor to column num1 */
96233a35bbbSPali Rohár console_cursor_set_position(-1, num1-1);
96333a35bbbSPali Rohár break;
96433a35bbbSPali Rohár case 'H':
96533a35bbbSPali Rohár /* move cursor to row num1, column num2 */
96633a35bbbSPali Rohár console_cursor_set_position(num1-1, num2-1);
96733a35bbbSPali Rohár break;
96833a35bbbSPali Rohár case 'J':
96933a35bbbSPali Rohár /* clear console and move cursor to 0, 0 */
97033a35bbbSPali Rohár console_clear();
97133a35bbbSPali Rohár console_cursor_set_position(0, 0);
97233a35bbbSPali Rohár break;
97333a35bbbSPali Rohár case 'K':
97433a35bbbSPali Rohár /* clear line */
97533a35bbbSPali Rohár if (num1 == 0)
97633a35bbbSPali Rohár console_clear_line(console_row,
97733a35bbbSPali Rohár console_col,
97833a35bbbSPali Rohár CONSOLE_COLS-1);
97933a35bbbSPali Rohár else if (num1 == 1)
98033a35bbbSPali Rohár console_clear_line(console_row,
98133a35bbbSPali Rohár 0, console_col);
98233a35bbbSPali Rohár else
98333a35bbbSPali Rohár console_clear_line(console_row,
98433a35bbbSPali Rohár 0, CONSOLE_COLS-1);
98533a35bbbSPali Rohár break;
98633a35bbbSPali Rohár case 'h':
98733a35bbbSPali Rohár ansi_cursor_hidden = 0;
98833a35bbbSPali Rohár break;
98933a35bbbSPali Rohár case 'l':
99033a35bbbSPali Rohár ansi_cursor_hidden = 1;
99133a35bbbSPali Rohár break;
99233a35bbbSPali Rohár case 'm':
99333a35bbbSPali Rohár if (num1 == 0) { /* reset swapped colors */
99433a35bbbSPali Rohár if (ansi_colors_need_revert) {
99533a35bbbSPali Rohár console_swap_colors();
99633a35bbbSPali Rohár ansi_colors_need_revert = 0;
99733a35bbbSPali Rohár }
99833a35bbbSPali Rohár } else if (num1 == 7) { /* once swap colors */
99933a35bbbSPali Rohár if (!ansi_colors_need_revert) {
100033a35bbbSPali Rohár console_swap_colors();
100133a35bbbSPali Rohár ansi_colors_need_revert = 1;
100233a35bbbSPali Rohár }
100333a35bbbSPali Rohár }
100433a35bbbSPali Rohár break;
100533a35bbbSPali Rohár }
100633a35bbbSPali Rohár if (!ansi_cursor_hidden)
100733a35bbbSPali Rohár CURSOR_SET;
100833a35bbbSPali Rohár }
100933a35bbbSPali Rohár } else {
101033a35bbbSPali Rohár parse_putc(c);
101133a35bbbSPali Rohár }
101233a35bbbSPali Rohár #else
101333a35bbbSPali Rohár parse_putc(c);
101433a35bbbSPali Rohár #endif
1015db0d47ddSEric Nelson if (cfb_do_flush_cache)
1016db0d47ddSEric Nelson flush_cache(VIDEO_FB_ADRS, VIDEO_SIZE);
101733a35bbbSPali Rohár }
101833a35bbbSPali Rohár
cfb_video_puts(struct stdio_dev * dev,const char * s)10190a6eac84SSimon Glass static void cfb_video_puts(struct stdio_dev *dev, const char *s)
1020352d2591SJean-Christophe PLAGNIOL-VILLARD {
1021d37e96ecSSoeren Moch int flush = cfb_do_flush_cache;
1022352d2591SJean-Christophe PLAGNIOL-VILLARD int count = strlen(s);
1023352d2591SJean-Christophe PLAGNIOL-VILLARD
1024d37e96ecSSoeren Moch /* temporarily disable cache flush */
1025d37e96ecSSoeren Moch cfb_do_flush_cache = 0;
1026d37e96ecSSoeren Moch
1027352d2591SJean-Christophe PLAGNIOL-VILLARD while (count--)
10280a6eac84SSimon Glass cfb_video_putc(dev, *s++);
1029d37e96ecSSoeren Moch
1030d37e96ecSSoeren Moch if (flush) {
1031d37e96ecSSoeren Moch cfb_do_flush_cache = flush;
1032d37e96ecSSoeren Moch flush_cache(VIDEO_FB_ADRS, VIDEO_SIZE);
1033d37e96ecSSoeren Moch }
1034352d2591SJean-Christophe PLAGNIOL-VILLARD }
1035352d2591SJean-Christophe PLAGNIOL-VILLARD
103610543820SAnatolij Gustschin /*
103710543820SAnatolij Gustschin * Do not enforce drivers (or board code) to provide empty
103810543820SAnatolij Gustschin * video_set_lut() if they do not support 8 bpp format.
103910543820SAnatolij Gustschin * Implement weak default function instead.
104010543820SAnatolij Gustschin */
video_set_lut(unsigned int index,unsigned char r,unsigned char g,unsigned char b)104169d27545SJeroen Hofstee __weak void video_set_lut(unsigned int index, unsigned char r,
104210543820SAnatolij Gustschin unsigned char g, unsigned char b)
104310543820SAnatolij Gustschin {
104410543820SAnatolij Gustschin }
104564e40d72SWolfgang Denk
1046352d2591SJean-Christophe PLAGNIOL-VILLARD #if defined(CONFIG_CMD_BMP) || defined(CONFIG_SPLASH_SCREEN)
1047352d2591SJean-Christophe PLAGNIOL-VILLARD
1048352d2591SJean-Christophe PLAGNIOL-VILLARD #define FILL_8BIT_332RGB(r,g,b) { \
1049352d2591SJean-Christophe PLAGNIOL-VILLARD *fb = ((r>>5)<<5) | ((g>>5)<<2) | (b>>6); \
1050352d2591SJean-Christophe PLAGNIOL-VILLARD fb ++; \
1051352d2591SJean-Christophe PLAGNIOL-VILLARD }
1052352d2591SJean-Christophe PLAGNIOL-VILLARD
1053352d2591SJean-Christophe PLAGNIOL-VILLARD #define FILL_15BIT_555RGB(r,g,b) { \
105464e40d72SWolfgang Denk *(unsigned short *)fb = \
105564e40d72SWolfgang Denk SWAP16((unsigned short)(((r>>3)<<10) | \
105664e40d72SWolfgang Denk ((g>>3)<<5) | \
105764e40d72SWolfgang Denk (b>>3))); \
1058352d2591SJean-Christophe PLAGNIOL-VILLARD fb += 2; \
1059352d2591SJean-Christophe PLAGNIOL-VILLARD }
1060352d2591SJean-Christophe PLAGNIOL-VILLARD
1061352d2591SJean-Christophe PLAGNIOL-VILLARD #define FILL_16BIT_565RGB(r,g,b) { \
106264e40d72SWolfgang Denk *(unsigned short *)fb = \
106364e40d72SWolfgang Denk SWAP16((unsigned short)((((r)>>3)<<11)| \
106464e40d72SWolfgang Denk (((g)>>2)<<5) | \
106564e40d72SWolfgang Denk ((b)>>3))); \
1066352d2591SJean-Christophe PLAGNIOL-VILLARD fb += 2; \
1067352d2591SJean-Christophe PLAGNIOL-VILLARD }
1068352d2591SJean-Christophe PLAGNIOL-VILLARD
1069352d2591SJean-Christophe PLAGNIOL-VILLARD #define FILL_32BIT_X888RGB(r,g,b) { \
10701d4ed26fSAndre Przywara *(u32 *)fb = \
10711d4ed26fSAndre Przywara SWAP32((unsigned int)(((r<<16) | \
107264e40d72SWolfgang Denk (g<<8) | \
107364e40d72SWolfgang Denk b))); \
1074352d2591SJean-Christophe PLAGNIOL-VILLARD fb += 4; \
1075352d2591SJean-Christophe PLAGNIOL-VILLARD }
1076352d2591SJean-Christophe PLAGNIOL-VILLARD
1077352d2591SJean-Christophe PLAGNIOL-VILLARD #ifdef VIDEO_FB_LITTLE_ENDIAN
1078352d2591SJean-Christophe PLAGNIOL-VILLARD #define FILL_24BIT_888RGB(r,g,b) { \
1079352d2591SJean-Christophe PLAGNIOL-VILLARD fb[0] = b; \
1080352d2591SJean-Christophe PLAGNIOL-VILLARD fb[1] = g; \
1081352d2591SJean-Christophe PLAGNIOL-VILLARD fb[2] = r; \
1082352d2591SJean-Christophe PLAGNIOL-VILLARD fb += 3; \
1083352d2591SJean-Christophe PLAGNIOL-VILLARD }
1084352d2591SJean-Christophe PLAGNIOL-VILLARD #else
1085352d2591SJean-Christophe PLAGNIOL-VILLARD #define FILL_24BIT_888RGB(r,g,b) { \
1086352d2591SJean-Christophe PLAGNIOL-VILLARD fb[0] = r; \
1087352d2591SJean-Christophe PLAGNIOL-VILLARD fb[1] = g; \
1088352d2591SJean-Christophe PLAGNIOL-VILLARD fb[2] = b; \
1089352d2591SJean-Christophe PLAGNIOL-VILLARD fb += 3; \
1090352d2591SJean-Christophe PLAGNIOL-VILLARD }
1091352d2591SJean-Christophe PLAGNIOL-VILLARD #endif
1092352d2591SJean-Christophe PLAGNIOL-VILLARD
1093e84d568fSAnatolij Gustschin #if defined(VIDEO_FB_16BPP_PIXEL_SWAP)
fill_555rgb_pswap(uchar * fb,int x,u8 r,u8 g,u8 b)109464e40d72SWolfgang Denk static inline void fill_555rgb_pswap(uchar *fb, int x, u8 r, u8 g, u8 b)
1095e84d568fSAnatolij Gustschin {
1096e84d568fSAnatolij Gustschin ushort *dst = (ushort *) fb;
1097e84d568fSAnatolij Gustschin ushort color = (ushort) (((r >> 3) << 10) |
1098e84d568fSAnatolij Gustschin ((g >> 3) << 5) |
1099e84d568fSAnatolij Gustschin (b >> 3));
1100e84d568fSAnatolij Gustschin if (x & 1)
1101e84d568fSAnatolij Gustschin *(--dst) = color;
1102e84d568fSAnatolij Gustschin else
1103e84d568fSAnatolij Gustschin *(++dst) = color;
1104e84d568fSAnatolij Gustschin }
1105e84d568fSAnatolij Gustschin #endif
1106352d2591SJean-Christophe PLAGNIOL-VILLARD
1107352d2591SJean-Christophe PLAGNIOL-VILLARD /*
1108d5011762SAnatolij Gustschin * RLE8 bitmap support
1109d5011762SAnatolij Gustschin */
1110d5011762SAnatolij Gustschin
1111d5011762SAnatolij Gustschin #ifdef CONFIG_VIDEO_BMP_RLE8
1112d5011762SAnatolij Gustschin /* Pre-calculated color table entry */
1113d5011762SAnatolij Gustschin struct palette {
1114d5011762SAnatolij Gustschin union {
1115d5011762SAnatolij Gustschin unsigned short w; /* word */
1116d5011762SAnatolij Gustschin unsigned int dw; /* double word */
1117d5011762SAnatolij Gustschin } ce; /* color entry */
1118d5011762SAnatolij Gustschin };
1119d5011762SAnatolij Gustschin
1120d5011762SAnatolij Gustschin /*
1121d5011762SAnatolij Gustschin * Helper to draw encoded/unencoded run.
1122d5011762SAnatolij Gustschin */
draw_bitmap(uchar ** fb,uchar * bm,struct palette * p,int cnt,int enc)1123d5011762SAnatolij Gustschin static void draw_bitmap(uchar **fb, uchar *bm, struct palette *p,
1124d5011762SAnatolij Gustschin int cnt, int enc)
1125d5011762SAnatolij Gustschin {
1126d5011762SAnatolij Gustschin ulong addr = (ulong) *fb;
1127d5011762SAnatolij Gustschin int *off;
1128d5011762SAnatolij Gustschin int enc_off = 1;
1129d5011762SAnatolij Gustschin int i;
1130d5011762SAnatolij Gustschin
1131d5011762SAnatolij Gustschin /*
1132d5011762SAnatolij Gustschin * Setup offset of the color index in the bitmap.
1133d5011762SAnatolij Gustschin * Color index of encoded run is at offset 1.
1134d5011762SAnatolij Gustschin */
1135d5011762SAnatolij Gustschin off = enc ? &enc_off : &i;
1136d5011762SAnatolij Gustschin
1137d5011762SAnatolij Gustschin switch (VIDEO_DATA_FORMAT) {
1138d5011762SAnatolij Gustschin case GDF__8BIT_INDEX:
1139d5011762SAnatolij Gustschin for (i = 0; i < cnt; i++)
1140d5011762SAnatolij Gustschin *(unsigned char *) addr++ = bm[*off];
1141d5011762SAnatolij Gustschin break;
1142d5011762SAnatolij Gustschin case GDF_15BIT_555RGB:
1143d5011762SAnatolij Gustschin case GDF_16BIT_565RGB:
1144d5011762SAnatolij Gustschin /* differences handled while pre-calculating palette */
1145d5011762SAnatolij Gustschin for (i = 0; i < cnt; i++) {
1146d5011762SAnatolij Gustschin *(unsigned short *) addr = p[bm[*off]].ce.w;
1147d5011762SAnatolij Gustschin addr += 2;
1148d5011762SAnatolij Gustschin }
1149d5011762SAnatolij Gustschin break;
1150d5011762SAnatolij Gustschin case GDF_32BIT_X888RGB:
1151d5011762SAnatolij Gustschin for (i = 0; i < cnt; i++) {
11521d4ed26fSAndre Przywara *(u32 *) addr = p[bm[*off]].ce.dw;
1153d5011762SAnatolij Gustschin addr += 4;
1154d5011762SAnatolij Gustschin }
1155d5011762SAnatolij Gustschin break;
1156d5011762SAnatolij Gustschin }
1157d5011762SAnatolij Gustschin *fb = (uchar *) addr; /* return modified address */
1158d5011762SAnatolij Gustschin }
1159d5011762SAnatolij Gustschin
display_rle8_bitmap(struct bmp_image * img,int xoff,int yoff,int width,int height)11601c3dbe56SSimon Glass static int display_rle8_bitmap(struct bmp_image *img, int xoff, int yoff,
1161d5011762SAnatolij Gustschin int width, int height)
1162d5011762SAnatolij Gustschin {
1163d5011762SAnatolij Gustschin unsigned char *bm;
1164d5011762SAnatolij Gustschin unsigned char *fbp;
1165d5011762SAnatolij Gustschin unsigned int cnt, runlen;
1166d5011762SAnatolij Gustschin int decode = 1;
1167d5011762SAnatolij Gustschin int x, y, bpp, i, ncolors;
1168d5011762SAnatolij Gustschin struct palette p[256];
11691c3dbe56SSimon Glass struct bmp_color_table_entry cte;
1170d5011762SAnatolij Gustschin int green_shift, red_off;
1171c67a8767SHans de Goede int limit = (VIDEO_LINE_LEN / VIDEO_PIXEL_SIZE) * VIDEO_ROWS;
117274446b63SAnatolij Gustschin int pixels = 0;
1173d5011762SAnatolij Gustschin
1174d5011762SAnatolij Gustschin x = 0;
1175d5011762SAnatolij Gustschin y = __le32_to_cpu(img->header.height) - 1;
1176d5011762SAnatolij Gustschin ncolors = __le32_to_cpu(img->header.colors_used);
1177d5011762SAnatolij Gustschin bpp = VIDEO_PIXEL_SIZE;
1178d5011762SAnatolij Gustschin fbp = (unsigned char *) ((unsigned int) video_fb_address +
1179c67a8767SHans de Goede (y + yoff) * VIDEO_LINE_LEN +
1180c67a8767SHans de Goede xoff * bpp);
1181d5011762SAnatolij Gustschin
1182d5011762SAnatolij Gustschin bm = (uchar *) img + __le32_to_cpu(img->header.data_offset);
1183d5011762SAnatolij Gustschin
1184d5011762SAnatolij Gustschin /* pre-calculate and setup palette */
1185d5011762SAnatolij Gustschin switch (VIDEO_DATA_FORMAT) {
1186d5011762SAnatolij Gustschin case GDF__8BIT_INDEX:
1187d5011762SAnatolij Gustschin for (i = 0; i < ncolors; i++) {
1188d5011762SAnatolij Gustschin cte = img->color_table[i];
1189d5011762SAnatolij Gustschin video_set_lut(i, cte.red, cte.green, cte.blue);
1190d5011762SAnatolij Gustschin }
1191d5011762SAnatolij Gustschin break;
1192d5011762SAnatolij Gustschin case GDF_15BIT_555RGB:
1193d5011762SAnatolij Gustschin case GDF_16BIT_565RGB:
1194d5011762SAnatolij Gustschin if (VIDEO_DATA_FORMAT == GDF_15BIT_555RGB) {
1195d5011762SAnatolij Gustschin green_shift = 3;
1196d5011762SAnatolij Gustschin red_off = 10;
1197d5011762SAnatolij Gustschin } else {
1198d5011762SAnatolij Gustschin green_shift = 2;
1199d5011762SAnatolij Gustschin red_off = 11;
1200d5011762SAnatolij Gustschin }
1201d5011762SAnatolij Gustschin for (i = 0; i < ncolors; i++) {
1202d5011762SAnatolij Gustschin cte = img->color_table[i];
1203d5011762SAnatolij Gustschin p[i].ce.w = SWAP16((unsigned short)
1204d5011762SAnatolij Gustschin (((cte.red >> 3) << red_off) |
1205d5011762SAnatolij Gustschin ((cte.green >> green_shift) << 5) |
1206d5011762SAnatolij Gustschin cte.blue >> 3));
1207d5011762SAnatolij Gustschin }
1208d5011762SAnatolij Gustschin break;
1209d5011762SAnatolij Gustschin case GDF_32BIT_X888RGB:
1210d5011762SAnatolij Gustschin for (i = 0; i < ncolors; i++) {
1211d5011762SAnatolij Gustschin cte = img->color_table[i];
121264e40d72SWolfgang Denk p[i].ce.dw = SWAP32((cte.red << 16) |
121364e40d72SWolfgang Denk (cte.green << 8) |
1214d5011762SAnatolij Gustschin cte.blue);
1215d5011762SAnatolij Gustschin }
1216d5011762SAnatolij Gustschin break;
1217d5011762SAnatolij Gustschin default:
1218d5011762SAnatolij Gustschin printf("RLE Bitmap unsupported in video mode 0x%x\n",
1219d5011762SAnatolij Gustschin VIDEO_DATA_FORMAT);
1220d5011762SAnatolij Gustschin return -1;
1221d5011762SAnatolij Gustschin }
1222d5011762SAnatolij Gustschin
1223d5011762SAnatolij Gustschin while (decode) {
1224d5011762SAnatolij Gustschin switch (bm[0]) {
1225d5011762SAnatolij Gustschin case 0:
1226d5011762SAnatolij Gustschin switch (bm[1]) {
1227d5011762SAnatolij Gustschin case 0:
1228d5011762SAnatolij Gustschin /* scan line end marker */
1229d5011762SAnatolij Gustschin bm += 2;
1230d5011762SAnatolij Gustschin x = 0;
1231d5011762SAnatolij Gustschin y--;
1232d5011762SAnatolij Gustschin fbp = (unsigned char *)
1233d5011762SAnatolij Gustschin ((unsigned int) video_fb_address +
1234c67a8767SHans de Goede (y + yoff) * VIDEO_LINE_LEN +
1235c67a8767SHans de Goede xoff * bpp);
1236d5011762SAnatolij Gustschin continue;
1237d5011762SAnatolij Gustschin case 1:
1238d5011762SAnatolij Gustschin /* end of bitmap data marker */
1239d5011762SAnatolij Gustschin decode = 0;
1240d5011762SAnatolij Gustschin break;
1241d5011762SAnatolij Gustschin case 2:
1242d5011762SAnatolij Gustschin /* run offset marker */
1243d5011762SAnatolij Gustschin x += bm[2];
1244d5011762SAnatolij Gustschin y -= bm[3];
1245d5011762SAnatolij Gustschin fbp = (unsigned char *)
1246d5011762SAnatolij Gustschin ((unsigned int) video_fb_address +
1247c67a8767SHans de Goede (y + yoff) * VIDEO_LINE_LEN +
1248c67a8767SHans de Goede xoff * bpp);
1249d5011762SAnatolij Gustschin bm += 4;
1250d5011762SAnatolij Gustschin break;
1251d5011762SAnatolij Gustschin default:
1252d5011762SAnatolij Gustschin /* unencoded run */
1253d5011762SAnatolij Gustschin cnt = bm[1];
1254d5011762SAnatolij Gustschin runlen = cnt;
125574446b63SAnatolij Gustschin pixels += cnt;
125674446b63SAnatolij Gustschin if (pixels > limit)
125774446b63SAnatolij Gustschin goto error;
125874446b63SAnatolij Gustschin
1259d5011762SAnatolij Gustschin bm += 2;
1260d5011762SAnatolij Gustschin if (y < height) {
1261d5011762SAnatolij Gustschin if (x >= width) {
1262d5011762SAnatolij Gustschin x += runlen;
1263d5011762SAnatolij Gustschin goto next_run;
1264d5011762SAnatolij Gustschin }
1265d5011762SAnatolij Gustschin if (x + runlen > width)
1266d5011762SAnatolij Gustschin cnt = width - x;
1267d5011762SAnatolij Gustschin draw_bitmap(&fbp, bm, p, cnt, 0);
1268d5011762SAnatolij Gustschin x += runlen;
1269d5011762SAnatolij Gustschin }
1270d5011762SAnatolij Gustschin next_run:
1271d5011762SAnatolij Gustschin bm += runlen;
1272d5011762SAnatolij Gustschin if (runlen & 1)
1273d5011762SAnatolij Gustschin bm++; /* 0 padding if length is odd */
1274d5011762SAnatolij Gustschin }
1275d5011762SAnatolij Gustschin break;
1276d5011762SAnatolij Gustschin default:
1277d5011762SAnatolij Gustschin /* encoded run */
1278d5011762SAnatolij Gustschin cnt = bm[0];
1279d5011762SAnatolij Gustschin runlen = cnt;
128074446b63SAnatolij Gustschin pixels += cnt;
128174446b63SAnatolij Gustschin if (pixels > limit)
128274446b63SAnatolij Gustschin goto error;
128374446b63SAnatolij Gustschin
128474446b63SAnatolij Gustschin if (y < height) { /* only draw into visible area */
1285d5011762SAnatolij Gustschin if (x >= width) {
1286d5011762SAnatolij Gustschin x += runlen;
1287d5011762SAnatolij Gustschin bm += 2;
1288d5011762SAnatolij Gustschin continue;
1289d5011762SAnatolij Gustschin }
1290d5011762SAnatolij Gustschin if (x + runlen > width)
1291d5011762SAnatolij Gustschin cnt = width - x;
1292d5011762SAnatolij Gustschin draw_bitmap(&fbp, bm, p, cnt, 1);
1293d5011762SAnatolij Gustschin x += runlen;
1294d5011762SAnatolij Gustschin }
1295d5011762SAnatolij Gustschin bm += 2;
1296d5011762SAnatolij Gustschin break;
1297d5011762SAnatolij Gustschin }
1298d5011762SAnatolij Gustschin }
129947b11c81SSébastien Szymanski
130047b11c81SSébastien Szymanski if (cfb_do_flush_cache)
130147b11c81SSébastien Szymanski flush_cache(VIDEO_FB_ADRS, VIDEO_SIZE);
130247b11c81SSébastien Szymanski
1303d5011762SAnatolij Gustschin return 0;
130474446b63SAnatolij Gustschin error:
130574446b63SAnatolij Gustschin printf("Error: Too much encoded pixel data, validate your bitmap\n");
130674446b63SAnatolij Gustschin return -1;
1307d5011762SAnatolij Gustschin }
1308d5011762SAnatolij Gustschin #endif
1309d5011762SAnatolij Gustschin
1310d5011762SAnatolij Gustschin /*
1311352d2591SJean-Christophe PLAGNIOL-VILLARD * Display the BMP file located at address bmp_image.
1312352d2591SJean-Christophe PLAGNIOL-VILLARD */
video_display_bitmap(ulong bmp_image,int x,int y)1313352d2591SJean-Christophe PLAGNIOL-VILLARD int video_display_bitmap(ulong bmp_image, int x, int y)
1314352d2591SJean-Christophe PLAGNIOL-VILLARD {
1315352d2591SJean-Christophe PLAGNIOL-VILLARD ushort xcount, ycount;
1316352d2591SJean-Christophe PLAGNIOL-VILLARD uchar *fb;
13171c3dbe56SSimon Glass struct bmp_image *bmp = (struct bmp_image *)bmp_image;
1318352d2591SJean-Christophe PLAGNIOL-VILLARD uchar *bmap;
1319352d2591SJean-Christophe PLAGNIOL-VILLARD ushort padded_line;
1320352d2591SJean-Christophe PLAGNIOL-VILLARD unsigned long width, height, bpp;
1321352d2591SJean-Christophe PLAGNIOL-VILLARD unsigned colors;
1322352d2591SJean-Christophe PLAGNIOL-VILLARD unsigned long compression;
13231c3dbe56SSimon Glass struct bmp_color_table_entry cte;
132464e40d72SWolfgang Denk
1325352d2591SJean-Christophe PLAGNIOL-VILLARD #ifdef CONFIG_VIDEO_BMP_GZIP
1326352d2591SJean-Christophe PLAGNIOL-VILLARD unsigned char *dst = NULL;
1327352d2591SJean-Christophe PLAGNIOL-VILLARD ulong len;
1328352d2591SJean-Christophe PLAGNIOL-VILLARD #endif
1329352d2591SJean-Christophe PLAGNIOL-VILLARD
1330352d2591SJean-Christophe PLAGNIOL-VILLARD WATCHDOG_RESET();
1331352d2591SJean-Christophe PLAGNIOL-VILLARD
1332352d2591SJean-Christophe PLAGNIOL-VILLARD if (!((bmp->header.signature[0] == 'B') &&
1333352d2591SJean-Christophe PLAGNIOL-VILLARD (bmp->header.signature[1] == 'M'))) {
1334352d2591SJean-Christophe PLAGNIOL-VILLARD
1335352d2591SJean-Christophe PLAGNIOL-VILLARD #ifdef CONFIG_VIDEO_BMP_GZIP
1336352d2591SJean-Christophe PLAGNIOL-VILLARD /*
1337352d2591SJean-Christophe PLAGNIOL-VILLARD * Could be a gzipped bmp image, try to decrompress...
1338352d2591SJean-Christophe PLAGNIOL-VILLARD */
13396d0f6bcfSJean-Christophe PLAGNIOL-VILLARD len = CONFIG_SYS_VIDEO_LOGO_MAX_SIZE;
13406d0f6bcfSJean-Christophe PLAGNIOL-VILLARD dst = malloc(CONFIG_SYS_VIDEO_LOGO_MAX_SIZE);
1341352d2591SJean-Christophe PLAGNIOL-VILLARD if (dst == NULL) {
1342352d2591SJean-Christophe PLAGNIOL-VILLARD printf("Error: malloc in gunzip failed!\n");
134364e40d72SWolfgang Denk return 1;
1344352d2591SJean-Christophe PLAGNIOL-VILLARD }
13455ca05c8bSEric Nelson /*
13465ca05c8bSEric Nelson * NB: we need to force offset of +2
13475ca05c8bSEric Nelson * See doc/README.displaying-bmps
13485ca05c8bSEric Nelson */
13495ca05c8bSEric Nelson if (gunzip(dst+2, CONFIG_SYS_VIDEO_LOGO_MAX_SIZE-2,
135064e40d72SWolfgang Denk (uchar *) bmp_image,
135164e40d72SWolfgang Denk &len) != 0) {
135264e40d72SWolfgang Denk printf("Error: no valid bmp or bmp.gz image at %lx\n",
135364e40d72SWolfgang Denk bmp_image);
1354352d2591SJean-Christophe PLAGNIOL-VILLARD free(dst);
1355352d2591SJean-Christophe PLAGNIOL-VILLARD return 1;
1356352d2591SJean-Christophe PLAGNIOL-VILLARD }
13576d0f6bcfSJean-Christophe PLAGNIOL-VILLARD if (len == CONFIG_SYS_VIDEO_LOGO_MAX_SIZE) {
135864e40d72SWolfgang Denk printf("Image could be truncated "
135964e40d72SWolfgang Denk "(increase CONFIG_SYS_VIDEO_LOGO_MAX_SIZE)!\n");
1360352d2591SJean-Christophe PLAGNIOL-VILLARD }
1361352d2591SJean-Christophe PLAGNIOL-VILLARD
1362352d2591SJean-Christophe PLAGNIOL-VILLARD /*
1363352d2591SJean-Christophe PLAGNIOL-VILLARD * Set addr to decompressed image
1364352d2591SJean-Christophe PLAGNIOL-VILLARD */
13651c3dbe56SSimon Glass bmp = (struct bmp_image *)(dst+2);
1366352d2591SJean-Christophe PLAGNIOL-VILLARD
1367352d2591SJean-Christophe PLAGNIOL-VILLARD if (!((bmp->header.signature[0] == 'B') &&
1368352d2591SJean-Christophe PLAGNIOL-VILLARD (bmp->header.signature[1] == 'M'))) {
136964e40d72SWolfgang Denk printf("Error: no valid bmp.gz image at %lx\n",
137064e40d72SWolfgang Denk bmp_image);
1371a49e0d17SMatthias Fuchs free(dst);
1372352d2591SJean-Christophe PLAGNIOL-VILLARD return 1;
1373352d2591SJean-Christophe PLAGNIOL-VILLARD }
1374352d2591SJean-Christophe PLAGNIOL-VILLARD #else
1375352d2591SJean-Christophe PLAGNIOL-VILLARD printf("Error: no valid bmp image at %lx\n", bmp_image);
1376352d2591SJean-Christophe PLAGNIOL-VILLARD return 1;
1377352d2591SJean-Christophe PLAGNIOL-VILLARD #endif /* CONFIG_VIDEO_BMP_GZIP */
1378352d2591SJean-Christophe PLAGNIOL-VILLARD }
1379352d2591SJean-Christophe PLAGNIOL-VILLARD
1380352d2591SJean-Christophe PLAGNIOL-VILLARD width = le32_to_cpu(bmp->header.width);
1381352d2591SJean-Christophe PLAGNIOL-VILLARD height = le32_to_cpu(bmp->header.height);
1382352d2591SJean-Christophe PLAGNIOL-VILLARD bpp = le16_to_cpu(bmp->header.bit_count);
1383352d2591SJean-Christophe PLAGNIOL-VILLARD colors = le32_to_cpu(bmp->header.colors_used);
1384352d2591SJean-Christophe PLAGNIOL-VILLARD compression = le32_to_cpu(bmp->header.compression);
1385352d2591SJean-Christophe PLAGNIOL-VILLARD
138668da5b19SMarek Vasut debug("Display-bmp: %ld x %ld with %d colors\n",
1387352d2591SJean-Christophe PLAGNIOL-VILLARD width, height, colors);
1388352d2591SJean-Christophe PLAGNIOL-VILLARD
1389d5011762SAnatolij Gustschin if (compression != BMP_BI_RGB
1390d5011762SAnatolij Gustschin #ifdef CONFIG_VIDEO_BMP_RLE8
1391d5011762SAnatolij Gustschin && compression != BMP_BI_RLE8
1392d5011762SAnatolij Gustschin #endif
1393d5011762SAnatolij Gustschin ) {
1394352d2591SJean-Christophe PLAGNIOL-VILLARD printf("Error: compression type %ld not supported\n",
1395352d2591SJean-Christophe PLAGNIOL-VILLARD compression);
1396a49e0d17SMatthias Fuchs #ifdef CONFIG_VIDEO_BMP_GZIP
1397a49e0d17SMatthias Fuchs if (dst)
1398a49e0d17SMatthias Fuchs free(dst);
1399a49e0d17SMatthias Fuchs #endif
1400352d2591SJean-Christophe PLAGNIOL-VILLARD return 1;
1401352d2591SJean-Christophe PLAGNIOL-VILLARD }
1402352d2591SJean-Christophe PLAGNIOL-VILLARD
1403352d2591SJean-Christophe PLAGNIOL-VILLARD padded_line = (((width * bpp + 7) / 8) + 3) & ~0x3;
1404352d2591SJean-Christophe PLAGNIOL-VILLARD
14051ca298ceSMatthias Weisser #ifdef CONFIG_SPLASH_SCREEN_ALIGN
14061ca298ceSMatthias Weisser if (x == BMP_ALIGN_CENTER)
1407b4141195SMasahiro Yamada x = max(0, (int)(VIDEO_VISIBLE_COLS - width) / 2);
14081ca298ceSMatthias Weisser else if (x < 0)
1409b4141195SMasahiro Yamada x = max(0, (int)(VIDEO_VISIBLE_COLS - width + x + 1));
14101ca298ceSMatthias Weisser
14111ca298ceSMatthias Weisser if (y == BMP_ALIGN_CENTER)
1412b4141195SMasahiro Yamada y = max(0, (int)(VIDEO_VISIBLE_ROWS - height) / 2);
14131ca298ceSMatthias Weisser else if (y < 0)
1414b4141195SMasahiro Yamada y = max(0, (int)(VIDEO_VISIBLE_ROWS - height + y + 1));
14151ca298ceSMatthias Weisser #endif /* CONFIG_SPLASH_SCREEN_ALIGN */
14161ca298ceSMatthias Weisser
1417acf3baadSMatthias Weisser /*
1418acf3baadSMatthias Weisser * Just ignore elements which are completely beyond screen
1419acf3baadSMatthias Weisser * dimensions.
1420acf3baadSMatthias Weisser */
1421acf3baadSMatthias Weisser if ((x >= VIDEO_VISIBLE_COLS) || (y >= VIDEO_VISIBLE_ROWS))
1422acf3baadSMatthias Weisser return 0;
1423acf3baadSMatthias Weisser
1424352d2591SJean-Christophe PLAGNIOL-VILLARD if ((x + width) > VIDEO_VISIBLE_COLS)
1425352d2591SJean-Christophe PLAGNIOL-VILLARD width = VIDEO_VISIBLE_COLS - x;
1426352d2591SJean-Christophe PLAGNIOL-VILLARD if ((y + height) > VIDEO_VISIBLE_ROWS)
1427352d2591SJean-Christophe PLAGNIOL-VILLARD height = VIDEO_VISIBLE_ROWS - y;
1428352d2591SJean-Christophe PLAGNIOL-VILLARD
1429352d2591SJean-Christophe PLAGNIOL-VILLARD bmap = (uchar *) bmp + le32_to_cpu(bmp->header.data_offset);
1430352d2591SJean-Christophe PLAGNIOL-VILLARD fb = (uchar *) (video_fb_address +
1431c67a8767SHans de Goede ((y + height - 1) * VIDEO_LINE_LEN) +
1432352d2591SJean-Christophe PLAGNIOL-VILLARD x * VIDEO_PIXEL_SIZE);
1433352d2591SJean-Christophe PLAGNIOL-VILLARD
1434d5011762SAnatolij Gustschin #ifdef CONFIG_VIDEO_BMP_RLE8
1435d5011762SAnatolij Gustschin if (compression == BMP_BI_RLE8) {
143664e40d72SWolfgang Denk return display_rle8_bitmap(bmp, x, y, width, height);
1437d5011762SAnatolij Gustschin }
1438d5011762SAnatolij Gustschin #endif
1439d5011762SAnatolij Gustschin
144068f6618bSTimur Tabi /* We handle only 4, 8, or 24 bpp bitmaps */
1441352d2591SJean-Christophe PLAGNIOL-VILLARD switch (le16_to_cpu(bmp->header.bit_count)) {
144268f6618bSTimur Tabi case 4:
144368f6618bSTimur Tabi padded_line -= width / 2;
144468f6618bSTimur Tabi ycount = height;
144568f6618bSTimur Tabi
144668f6618bSTimur Tabi switch (VIDEO_DATA_FORMAT) {
144768f6618bSTimur Tabi case GDF_32BIT_X888RGB:
144868f6618bSTimur Tabi while (ycount--) {
144968f6618bSTimur Tabi WATCHDOG_RESET();
145068f6618bSTimur Tabi /*
145168f6618bSTimur Tabi * Don't assume that 'width' is an
145268f6618bSTimur Tabi * even number
145368f6618bSTimur Tabi */
145468f6618bSTimur Tabi for (xcount = 0; xcount < width; xcount++) {
145568f6618bSTimur Tabi uchar idx;
145668f6618bSTimur Tabi
145768f6618bSTimur Tabi if (xcount & 1) {
145868f6618bSTimur Tabi idx = *bmap & 0xF;
145968f6618bSTimur Tabi bmap++;
146068f6618bSTimur Tabi } else
146168f6618bSTimur Tabi idx = *bmap >> 4;
146268f6618bSTimur Tabi cte = bmp->color_table[idx];
146368f6618bSTimur Tabi FILL_32BIT_X888RGB(cte.red, cte.green,
146468f6618bSTimur Tabi cte.blue);
146568f6618bSTimur Tabi }
146668f6618bSTimur Tabi bmap += padded_line;
1467c67a8767SHans de Goede fb -= VIDEO_LINE_LEN + width *
146868f6618bSTimur Tabi VIDEO_PIXEL_SIZE;
146968f6618bSTimur Tabi }
147068f6618bSTimur Tabi break;
147168f6618bSTimur Tabi default:
147268f6618bSTimur Tabi puts("4bpp bitmap unsupported with current "
147368f6618bSTimur Tabi "video mode\n");
147468f6618bSTimur Tabi break;
147568f6618bSTimur Tabi }
147668f6618bSTimur Tabi break;
147768f6618bSTimur Tabi
1478352d2591SJean-Christophe PLAGNIOL-VILLARD case 8:
1479352d2591SJean-Christophe PLAGNIOL-VILLARD padded_line -= width;
1480352d2591SJean-Christophe PLAGNIOL-VILLARD if (VIDEO_DATA_FORMAT == GDF__8BIT_INDEX) {
1481352d2591SJean-Christophe PLAGNIOL-VILLARD /* Copy colormap */
1482352d2591SJean-Christophe PLAGNIOL-VILLARD for (xcount = 0; xcount < colors; ++xcount) {
1483352d2591SJean-Christophe PLAGNIOL-VILLARD cte = bmp->color_table[xcount];
148464e40d72SWolfgang Denk video_set_lut(xcount, cte.red, cte.green,
148564e40d72SWolfgang Denk cte.blue);
1486352d2591SJean-Christophe PLAGNIOL-VILLARD }
1487352d2591SJean-Christophe PLAGNIOL-VILLARD }
1488352d2591SJean-Christophe PLAGNIOL-VILLARD ycount = height;
1489352d2591SJean-Christophe PLAGNIOL-VILLARD switch (VIDEO_DATA_FORMAT) {
1490352d2591SJean-Christophe PLAGNIOL-VILLARD case GDF__8BIT_INDEX:
1491352d2591SJean-Christophe PLAGNIOL-VILLARD while (ycount--) {
1492352d2591SJean-Christophe PLAGNIOL-VILLARD WATCHDOG_RESET();
1493352d2591SJean-Christophe PLAGNIOL-VILLARD xcount = width;
1494352d2591SJean-Christophe PLAGNIOL-VILLARD while (xcount--) {
1495352d2591SJean-Christophe PLAGNIOL-VILLARD *fb++ = *bmap++;
1496352d2591SJean-Christophe PLAGNIOL-VILLARD }
1497352d2591SJean-Christophe PLAGNIOL-VILLARD bmap += padded_line;
1498c67a8767SHans de Goede fb -= VIDEO_LINE_LEN + width *
149964e40d72SWolfgang Denk VIDEO_PIXEL_SIZE;
1500352d2591SJean-Christophe PLAGNIOL-VILLARD }
1501352d2591SJean-Christophe PLAGNIOL-VILLARD break;
1502352d2591SJean-Christophe PLAGNIOL-VILLARD case GDF__8BIT_332RGB:
1503352d2591SJean-Christophe PLAGNIOL-VILLARD while (ycount--) {
1504352d2591SJean-Christophe PLAGNIOL-VILLARD WATCHDOG_RESET();
1505352d2591SJean-Christophe PLAGNIOL-VILLARD xcount = width;
1506352d2591SJean-Christophe PLAGNIOL-VILLARD while (xcount--) {
1507352d2591SJean-Christophe PLAGNIOL-VILLARD cte = bmp->color_table[*bmap++];
150864e40d72SWolfgang Denk FILL_8BIT_332RGB(cte.red, cte.green,
150964e40d72SWolfgang Denk cte.blue);
1510352d2591SJean-Christophe PLAGNIOL-VILLARD }
1511352d2591SJean-Christophe PLAGNIOL-VILLARD bmap += padded_line;
1512c67a8767SHans de Goede fb -= VIDEO_LINE_LEN + width *
151364e40d72SWolfgang Denk VIDEO_PIXEL_SIZE;
1514352d2591SJean-Christophe PLAGNIOL-VILLARD }
1515352d2591SJean-Christophe PLAGNIOL-VILLARD break;
1516352d2591SJean-Christophe PLAGNIOL-VILLARD case GDF_15BIT_555RGB:
1517352d2591SJean-Christophe PLAGNIOL-VILLARD while (ycount--) {
1518e84d568fSAnatolij Gustschin #if defined(VIDEO_FB_16BPP_PIXEL_SWAP)
1519e84d568fSAnatolij Gustschin int xpos = x;
1520e84d568fSAnatolij Gustschin #endif
1521352d2591SJean-Christophe PLAGNIOL-VILLARD WATCHDOG_RESET();
1522352d2591SJean-Christophe PLAGNIOL-VILLARD xcount = width;
1523352d2591SJean-Christophe PLAGNIOL-VILLARD while (xcount--) {
1524352d2591SJean-Christophe PLAGNIOL-VILLARD cte = bmp->color_table[*bmap++];
1525cc347801SAndrew Dyer #if defined(VIDEO_FB_16BPP_PIXEL_SWAP)
1526e84d568fSAnatolij Gustschin fill_555rgb_pswap(fb, xpos++, cte.red,
152764e40d72SWolfgang Denk cte.green,
152864e40d72SWolfgang Denk cte.blue);
1529e84d568fSAnatolij Gustschin fb += 2;
1530cc347801SAndrew Dyer #else
153164e40d72SWolfgang Denk FILL_15BIT_555RGB(cte.red, cte.green,
153264e40d72SWolfgang Denk cte.blue);
1533e84d568fSAnatolij Gustschin #endif
1534352d2591SJean-Christophe PLAGNIOL-VILLARD }
1535352d2591SJean-Christophe PLAGNIOL-VILLARD bmap += padded_line;
1536c67a8767SHans de Goede fb -= VIDEO_LINE_LEN + width *
153764e40d72SWolfgang Denk VIDEO_PIXEL_SIZE;
1538352d2591SJean-Christophe PLAGNIOL-VILLARD }
1539352d2591SJean-Christophe PLAGNIOL-VILLARD break;
1540352d2591SJean-Christophe PLAGNIOL-VILLARD case GDF_16BIT_565RGB:
1541352d2591SJean-Christophe PLAGNIOL-VILLARD while (ycount--) {
1542352d2591SJean-Christophe PLAGNIOL-VILLARD WATCHDOG_RESET();
1543352d2591SJean-Christophe PLAGNIOL-VILLARD xcount = width;
1544352d2591SJean-Christophe PLAGNIOL-VILLARD while (xcount--) {
1545352d2591SJean-Christophe PLAGNIOL-VILLARD cte = bmp->color_table[*bmap++];
154664e40d72SWolfgang Denk FILL_16BIT_565RGB(cte.red, cte.green,
154764e40d72SWolfgang Denk cte.blue);
1548352d2591SJean-Christophe PLAGNIOL-VILLARD }
1549352d2591SJean-Christophe PLAGNIOL-VILLARD bmap += padded_line;
1550c67a8767SHans de Goede fb -= VIDEO_LINE_LEN + width *
155164e40d72SWolfgang Denk VIDEO_PIXEL_SIZE;
1552352d2591SJean-Christophe PLAGNIOL-VILLARD }
1553352d2591SJean-Christophe PLAGNIOL-VILLARD break;
1554352d2591SJean-Christophe PLAGNIOL-VILLARD case GDF_32BIT_X888RGB:
1555352d2591SJean-Christophe PLAGNIOL-VILLARD while (ycount--) {
1556352d2591SJean-Christophe PLAGNIOL-VILLARD WATCHDOG_RESET();
1557352d2591SJean-Christophe PLAGNIOL-VILLARD xcount = width;
1558352d2591SJean-Christophe PLAGNIOL-VILLARD while (xcount--) {
1559352d2591SJean-Christophe PLAGNIOL-VILLARD cte = bmp->color_table[*bmap++];
156064e40d72SWolfgang Denk FILL_32BIT_X888RGB(cte.red, cte.green,
156164e40d72SWolfgang Denk cte.blue);
1562352d2591SJean-Christophe PLAGNIOL-VILLARD }
1563352d2591SJean-Christophe PLAGNIOL-VILLARD bmap += padded_line;
1564c67a8767SHans de Goede fb -= VIDEO_LINE_LEN + width *
156564e40d72SWolfgang Denk VIDEO_PIXEL_SIZE;
1566352d2591SJean-Christophe PLAGNIOL-VILLARD }
1567352d2591SJean-Christophe PLAGNIOL-VILLARD break;
1568352d2591SJean-Christophe PLAGNIOL-VILLARD case GDF_24BIT_888RGB:
1569352d2591SJean-Christophe PLAGNIOL-VILLARD while (ycount--) {
1570352d2591SJean-Christophe PLAGNIOL-VILLARD WATCHDOG_RESET();
1571352d2591SJean-Christophe PLAGNIOL-VILLARD xcount = width;
1572352d2591SJean-Christophe PLAGNIOL-VILLARD while (xcount--) {
1573352d2591SJean-Christophe PLAGNIOL-VILLARD cte = bmp->color_table[*bmap++];
157464e40d72SWolfgang Denk FILL_24BIT_888RGB(cte.red, cte.green,
157564e40d72SWolfgang Denk cte.blue);
1576352d2591SJean-Christophe PLAGNIOL-VILLARD }
1577352d2591SJean-Christophe PLAGNIOL-VILLARD bmap += padded_line;
1578c67a8767SHans de Goede fb -= VIDEO_LINE_LEN + width *
157964e40d72SWolfgang Denk VIDEO_PIXEL_SIZE;
1580352d2591SJean-Christophe PLAGNIOL-VILLARD }
1581352d2591SJean-Christophe PLAGNIOL-VILLARD break;
1582352d2591SJean-Christophe PLAGNIOL-VILLARD }
1583352d2591SJean-Christophe PLAGNIOL-VILLARD break;
1584352d2591SJean-Christophe PLAGNIOL-VILLARD case 24:
1585352d2591SJean-Christophe PLAGNIOL-VILLARD padded_line -= 3 * width;
1586352d2591SJean-Christophe PLAGNIOL-VILLARD ycount = height;
1587352d2591SJean-Christophe PLAGNIOL-VILLARD switch (VIDEO_DATA_FORMAT) {
1588352d2591SJean-Christophe PLAGNIOL-VILLARD case GDF__8BIT_332RGB:
1589352d2591SJean-Christophe PLAGNIOL-VILLARD while (ycount--) {
1590352d2591SJean-Christophe PLAGNIOL-VILLARD WATCHDOG_RESET();
1591352d2591SJean-Christophe PLAGNIOL-VILLARD xcount = width;
1592352d2591SJean-Christophe PLAGNIOL-VILLARD while (xcount--) {
159364e40d72SWolfgang Denk FILL_8BIT_332RGB(bmap[2], bmap[1],
159464e40d72SWolfgang Denk bmap[0]);
1595352d2591SJean-Christophe PLAGNIOL-VILLARD bmap += 3;
1596352d2591SJean-Christophe PLAGNIOL-VILLARD }
1597352d2591SJean-Christophe PLAGNIOL-VILLARD bmap += padded_line;
1598c67a8767SHans de Goede fb -= VIDEO_LINE_LEN + width *
159964e40d72SWolfgang Denk VIDEO_PIXEL_SIZE;
1600352d2591SJean-Christophe PLAGNIOL-VILLARD }
1601352d2591SJean-Christophe PLAGNIOL-VILLARD break;
1602352d2591SJean-Christophe PLAGNIOL-VILLARD case GDF_15BIT_555RGB:
1603352d2591SJean-Christophe PLAGNIOL-VILLARD while (ycount--) {
1604e84d568fSAnatolij Gustschin #if defined(VIDEO_FB_16BPP_PIXEL_SWAP)
1605e84d568fSAnatolij Gustschin int xpos = x;
1606e84d568fSAnatolij Gustschin #endif
1607352d2591SJean-Christophe PLAGNIOL-VILLARD WATCHDOG_RESET();
1608352d2591SJean-Christophe PLAGNIOL-VILLARD xcount = width;
1609352d2591SJean-Christophe PLAGNIOL-VILLARD while (xcount--) {
1610cc347801SAndrew Dyer #if defined(VIDEO_FB_16BPP_PIXEL_SWAP)
1611e84d568fSAnatolij Gustschin fill_555rgb_pswap(fb, xpos++, bmap[2],
1612e84d568fSAnatolij Gustschin bmap[1], bmap[0]);
1613e84d568fSAnatolij Gustschin fb += 2;
1614cc347801SAndrew Dyer #else
161564e40d72SWolfgang Denk FILL_15BIT_555RGB(bmap[2], bmap[1],
161664e40d72SWolfgang Denk bmap[0]);
1617e84d568fSAnatolij Gustschin #endif
1618352d2591SJean-Christophe PLAGNIOL-VILLARD bmap += 3;
1619352d2591SJean-Christophe PLAGNIOL-VILLARD }
1620352d2591SJean-Christophe PLAGNIOL-VILLARD bmap += padded_line;
1621c67a8767SHans de Goede fb -= VIDEO_LINE_LEN + width *
162264e40d72SWolfgang Denk VIDEO_PIXEL_SIZE;
1623352d2591SJean-Christophe PLAGNIOL-VILLARD }
1624352d2591SJean-Christophe PLAGNIOL-VILLARD break;
1625352d2591SJean-Christophe PLAGNIOL-VILLARD case GDF_16BIT_565RGB:
1626352d2591SJean-Christophe PLAGNIOL-VILLARD while (ycount--) {
1627352d2591SJean-Christophe PLAGNIOL-VILLARD WATCHDOG_RESET();
1628352d2591SJean-Christophe PLAGNIOL-VILLARD xcount = width;
1629352d2591SJean-Christophe PLAGNIOL-VILLARD while (xcount--) {
163064e40d72SWolfgang Denk FILL_16BIT_565RGB(bmap[2], bmap[1],
163164e40d72SWolfgang Denk bmap[0]);
1632352d2591SJean-Christophe PLAGNIOL-VILLARD bmap += 3;
1633352d2591SJean-Christophe PLAGNIOL-VILLARD }
1634352d2591SJean-Christophe PLAGNIOL-VILLARD bmap += padded_line;
1635c67a8767SHans de Goede fb -= VIDEO_LINE_LEN + width *
163664e40d72SWolfgang Denk VIDEO_PIXEL_SIZE;
1637352d2591SJean-Christophe PLAGNIOL-VILLARD }
1638352d2591SJean-Christophe PLAGNIOL-VILLARD break;
1639352d2591SJean-Christophe PLAGNIOL-VILLARD case GDF_32BIT_X888RGB:
1640352d2591SJean-Christophe PLAGNIOL-VILLARD while (ycount--) {
1641352d2591SJean-Christophe PLAGNIOL-VILLARD WATCHDOG_RESET();
1642352d2591SJean-Christophe PLAGNIOL-VILLARD xcount = width;
1643352d2591SJean-Christophe PLAGNIOL-VILLARD while (xcount--) {
164464e40d72SWolfgang Denk FILL_32BIT_X888RGB(bmap[2], bmap[1],
164564e40d72SWolfgang Denk bmap[0]);
1646352d2591SJean-Christophe PLAGNIOL-VILLARD bmap += 3;
1647352d2591SJean-Christophe PLAGNIOL-VILLARD }
1648352d2591SJean-Christophe PLAGNIOL-VILLARD bmap += padded_line;
1649c67a8767SHans de Goede fb -= VIDEO_LINE_LEN + width *
165064e40d72SWolfgang Denk VIDEO_PIXEL_SIZE;
1651352d2591SJean-Christophe PLAGNIOL-VILLARD }
1652352d2591SJean-Christophe PLAGNIOL-VILLARD break;
1653352d2591SJean-Christophe PLAGNIOL-VILLARD case GDF_24BIT_888RGB:
1654352d2591SJean-Christophe PLAGNIOL-VILLARD while (ycount--) {
1655352d2591SJean-Christophe PLAGNIOL-VILLARD WATCHDOG_RESET();
1656352d2591SJean-Christophe PLAGNIOL-VILLARD xcount = width;
1657352d2591SJean-Christophe PLAGNIOL-VILLARD while (xcount--) {
165864e40d72SWolfgang Denk FILL_24BIT_888RGB(bmap[2], bmap[1],
165964e40d72SWolfgang Denk bmap[0]);
1660352d2591SJean-Christophe PLAGNIOL-VILLARD bmap += 3;
1661352d2591SJean-Christophe PLAGNIOL-VILLARD }
1662352d2591SJean-Christophe PLAGNIOL-VILLARD bmap += padded_line;
1663c67a8767SHans de Goede fb -= VIDEO_LINE_LEN + width *
166464e40d72SWolfgang Denk VIDEO_PIXEL_SIZE;
1665352d2591SJean-Christophe PLAGNIOL-VILLARD }
1666352d2591SJean-Christophe PLAGNIOL-VILLARD break;
1667352d2591SJean-Christophe PLAGNIOL-VILLARD default:
166864e40d72SWolfgang Denk printf("Error: 24 bits/pixel bitmap incompatible "
166964e40d72SWolfgang Denk "with current video mode\n");
1670352d2591SJean-Christophe PLAGNIOL-VILLARD break;
1671352d2591SJean-Christophe PLAGNIOL-VILLARD }
1672352d2591SJean-Christophe PLAGNIOL-VILLARD break;
1673352d2591SJean-Christophe PLAGNIOL-VILLARD default:
1674352d2591SJean-Christophe PLAGNIOL-VILLARD printf("Error: %d bit/pixel bitmaps not supported by U-Boot\n",
1675352d2591SJean-Christophe PLAGNIOL-VILLARD le16_to_cpu(bmp->header.bit_count));
1676352d2591SJean-Christophe PLAGNIOL-VILLARD break;
1677352d2591SJean-Christophe PLAGNIOL-VILLARD }
1678352d2591SJean-Christophe PLAGNIOL-VILLARD
1679352d2591SJean-Christophe PLAGNIOL-VILLARD #ifdef CONFIG_VIDEO_BMP_GZIP
1680352d2591SJean-Christophe PLAGNIOL-VILLARD if (dst) {
1681352d2591SJean-Christophe PLAGNIOL-VILLARD free(dst);
1682352d2591SJean-Christophe PLAGNIOL-VILLARD }
1683352d2591SJean-Christophe PLAGNIOL-VILLARD #endif
1684352d2591SJean-Christophe PLAGNIOL-VILLARD
1685db0d47ddSEric Nelson if (cfb_do_flush_cache)
1686db0d47ddSEric Nelson flush_cache(VIDEO_FB_ADRS, VIDEO_SIZE);
1687352d2591SJean-Christophe PLAGNIOL-VILLARD return (0);
1688352d2591SJean-Christophe PLAGNIOL-VILLARD }
1689352d2591SJean-Christophe PLAGNIOL-VILLARD #endif
1690352d2591SJean-Christophe PLAGNIOL-VILLARD
1691352d2591SJean-Christophe PLAGNIOL-VILLARD
1692352d2591SJean-Christophe PLAGNIOL-VILLARD #ifdef CONFIG_VIDEO_LOGO
16931e681f9aSBastian Ruppert static int video_logo_xpos;
16941e681f9aSBastian Ruppert static int video_logo_ypos;
16951e681f9aSBastian Ruppert
1696c4c9e81fSHans de Goede static void plot_logo_or_black(void *screen, int x, int y, int black);
16974b7d3a0eSBastian Ruppert
logo_plot(void * screen,int x,int y)1698c4c9e81fSHans de Goede static void logo_plot(void *screen, int x, int y)
16994b7d3a0eSBastian Ruppert {
1700c4c9e81fSHans de Goede plot_logo_or_black(screen, x, y, 0);
17014b7d3a0eSBastian Ruppert }
17024b7d3a0eSBastian Ruppert
logo_black(void)17034b7d3a0eSBastian Ruppert static void logo_black(void)
17044b7d3a0eSBastian Ruppert {
1705c4c9e81fSHans de Goede plot_logo_or_black(video_fb_address, video_logo_xpos, video_logo_ypos,
17064b7d3a0eSBastian Ruppert 1);
17074b7d3a0eSBastian Ruppert }
17084b7d3a0eSBastian Ruppert
do_clrlogo(cmd_tbl_t * cmdtp,int flag,int argc,char * const argv[])17094b7d3a0eSBastian Ruppert static int do_clrlogo(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
17104b7d3a0eSBastian Ruppert {
17114b7d3a0eSBastian Ruppert if (argc != 1)
17124b7d3a0eSBastian Ruppert return cmd_usage(cmdtp);
17134b7d3a0eSBastian Ruppert
17144b7d3a0eSBastian Ruppert logo_black();
17154b7d3a0eSBastian Ruppert return 0;
17164b7d3a0eSBastian Ruppert }
17174b7d3a0eSBastian Ruppert
17184b7d3a0eSBastian Ruppert U_BOOT_CMD(
17194b7d3a0eSBastian Ruppert clrlogo, 1, 0, do_clrlogo,
17204b7d3a0eSBastian Ruppert "fill the boot logo area with black",
17214b7d3a0eSBastian Ruppert " "
17224b7d3a0eSBastian Ruppert );
17234b7d3a0eSBastian Ruppert
plot_logo_or_black(void * screen,int x,int y,int black)1724c4c9e81fSHans de Goede static void plot_logo_or_black(void *screen, int x, int y, int black)
1725352d2591SJean-Christophe PLAGNIOL-VILLARD {
1726352d2591SJean-Christophe PLAGNIOL-VILLARD
1727352d2591SJean-Christophe PLAGNIOL-VILLARD int xcount, i;
1728c67a8767SHans de Goede int skip = VIDEO_LINE_LEN - VIDEO_LOGO_WIDTH * VIDEO_PIXEL_SIZE;
1729be129aa7SMatthias Weisser int ycount = video_logo_height;
1730352d2591SJean-Christophe PLAGNIOL-VILLARD unsigned char r, g, b, *logo_red, *logo_blue, *logo_green;
1731352d2591SJean-Christophe PLAGNIOL-VILLARD unsigned char *source;
17321e681f9aSBastian Ruppert unsigned char *dest;
17331e681f9aSBastian Ruppert
17341e681f9aSBastian Ruppert #ifdef CONFIG_SPLASH_SCREEN_ALIGN
17351e681f9aSBastian Ruppert if (x == BMP_ALIGN_CENTER)
1736b4141195SMasahiro Yamada x = max(0, (int)(VIDEO_VISIBLE_COLS - VIDEO_LOGO_WIDTH) / 2);
17371e681f9aSBastian Ruppert else if (x < 0)
1738b4141195SMasahiro Yamada x = max(0, (int)(VIDEO_VISIBLE_COLS - VIDEO_LOGO_WIDTH + x + 1));
17391e681f9aSBastian Ruppert
17401e681f9aSBastian Ruppert if (y == BMP_ALIGN_CENTER)
1741b4141195SMasahiro Yamada y = max(0, (int)(VIDEO_VISIBLE_ROWS - VIDEO_LOGO_HEIGHT) / 2);
17421e681f9aSBastian Ruppert else if (y < 0)
1743b4141195SMasahiro Yamada y = max(0, (int)(VIDEO_VISIBLE_ROWS - VIDEO_LOGO_HEIGHT + y + 1));
17441e681f9aSBastian Ruppert #endif /* CONFIG_SPLASH_SCREEN_ALIGN */
17451e681f9aSBastian Ruppert
1746c67a8767SHans de Goede dest = (unsigned char *)screen + y * VIDEO_LINE_LEN + x * VIDEO_PIXEL_SIZE;
1747352d2591SJean-Christophe PLAGNIOL-VILLARD
1748352d2591SJean-Christophe PLAGNIOL-VILLARD #ifdef CONFIG_VIDEO_BMP_LOGO
1749352d2591SJean-Christophe PLAGNIOL-VILLARD source = bmp_logo_bitmap;
1750352d2591SJean-Christophe PLAGNIOL-VILLARD
1751352d2591SJean-Christophe PLAGNIOL-VILLARD /* Allocate temporary space for computing colormap */
1752352d2591SJean-Christophe PLAGNIOL-VILLARD logo_red = malloc(BMP_LOGO_COLORS);
1753352d2591SJean-Christophe PLAGNIOL-VILLARD logo_green = malloc(BMP_LOGO_COLORS);
1754352d2591SJean-Christophe PLAGNIOL-VILLARD logo_blue = malloc(BMP_LOGO_COLORS);
1755352d2591SJean-Christophe PLAGNIOL-VILLARD /* Compute color map */
1756352d2591SJean-Christophe PLAGNIOL-VILLARD for (i = 0; i < VIDEO_LOGO_COLORS; i++) {
1757352d2591SJean-Christophe PLAGNIOL-VILLARD logo_red[i] = (bmp_logo_palette[i] & 0x0f00) >> 4;
1758352d2591SJean-Christophe PLAGNIOL-VILLARD logo_green[i] = (bmp_logo_palette[i] & 0x00f0);
1759352d2591SJean-Christophe PLAGNIOL-VILLARD logo_blue[i] = (bmp_logo_palette[i] & 0x000f) << 4;
1760352d2591SJean-Christophe PLAGNIOL-VILLARD }
1761352d2591SJean-Christophe PLAGNIOL-VILLARD #else
1762352d2591SJean-Christophe PLAGNIOL-VILLARD source = linux_logo;
1763352d2591SJean-Christophe PLAGNIOL-VILLARD logo_red = linux_logo_red;
1764352d2591SJean-Christophe PLAGNIOL-VILLARD logo_green = linux_logo_green;
1765352d2591SJean-Christophe PLAGNIOL-VILLARD logo_blue = linux_logo_blue;
1766352d2591SJean-Christophe PLAGNIOL-VILLARD #endif
1767352d2591SJean-Christophe PLAGNIOL-VILLARD
1768352d2591SJean-Christophe PLAGNIOL-VILLARD if (VIDEO_DATA_FORMAT == GDF__8BIT_INDEX) {
1769352d2591SJean-Christophe PLAGNIOL-VILLARD for (i = 0; i < VIDEO_LOGO_COLORS; i++) {
1770352d2591SJean-Christophe PLAGNIOL-VILLARD video_set_lut(i + VIDEO_LOGO_LUT_OFFSET,
177164e40d72SWolfgang Denk logo_red[i], logo_green[i],
177264e40d72SWolfgang Denk logo_blue[i]);
1773352d2591SJean-Christophe PLAGNIOL-VILLARD }
1774352d2591SJean-Christophe PLAGNIOL-VILLARD }
1775352d2591SJean-Christophe PLAGNIOL-VILLARD
1776352d2591SJean-Christophe PLAGNIOL-VILLARD while (ycount--) {
1777e84d568fSAnatolij Gustschin #if defined(VIDEO_FB_16BPP_PIXEL_SWAP)
1778e84d568fSAnatolij Gustschin int xpos = x;
1779e84d568fSAnatolij Gustschin #endif
1780352d2591SJean-Christophe PLAGNIOL-VILLARD xcount = VIDEO_LOGO_WIDTH;
1781352d2591SJean-Christophe PLAGNIOL-VILLARD while (xcount--) {
17824b7d3a0eSBastian Ruppert if (black) {
17834b7d3a0eSBastian Ruppert r = 0x00;
17844b7d3a0eSBastian Ruppert g = 0x00;
17854b7d3a0eSBastian Ruppert b = 0x00;
17864b7d3a0eSBastian Ruppert } else {
1787352d2591SJean-Christophe PLAGNIOL-VILLARD r = logo_red[*source - VIDEO_LOGO_LUT_OFFSET];
1788352d2591SJean-Christophe PLAGNIOL-VILLARD g = logo_green[*source - VIDEO_LOGO_LUT_OFFSET];
1789352d2591SJean-Christophe PLAGNIOL-VILLARD b = logo_blue[*source - VIDEO_LOGO_LUT_OFFSET];
17904b7d3a0eSBastian Ruppert }
1791352d2591SJean-Christophe PLAGNIOL-VILLARD
1792352d2591SJean-Christophe PLAGNIOL-VILLARD switch (VIDEO_DATA_FORMAT) {
1793352d2591SJean-Christophe PLAGNIOL-VILLARD case GDF__8BIT_INDEX:
1794352d2591SJean-Christophe PLAGNIOL-VILLARD *dest = *source;
1795352d2591SJean-Christophe PLAGNIOL-VILLARD break;
1796352d2591SJean-Christophe PLAGNIOL-VILLARD case GDF__8BIT_332RGB:
179764e40d72SWolfgang Denk *dest = ((r >> 5) << 5) |
179864e40d72SWolfgang Denk ((g >> 5) << 2) |
179964e40d72SWolfgang Denk (b >> 6);
1800352d2591SJean-Christophe PLAGNIOL-VILLARD break;
1801352d2591SJean-Christophe PLAGNIOL-VILLARD case GDF_15BIT_555RGB:
1802cc347801SAndrew Dyer #if defined(VIDEO_FB_16BPP_PIXEL_SWAP)
1803cc347801SAndrew Dyer fill_555rgb_pswap(dest, xpos++, r, g, b);
1804cc347801SAndrew Dyer #else
1805352d2591SJean-Christophe PLAGNIOL-VILLARD *(unsigned short *) dest =
180664e40d72SWolfgang Denk SWAP16((unsigned short) (
180764e40d72SWolfgang Denk ((r >> 3) << 10) |
180864e40d72SWolfgang Denk ((g >> 3) << 5) |
180964e40d72SWolfgang Denk (b >> 3)));
1810bed53753SAnatolij Gustschin #endif
1811352d2591SJean-Christophe PLAGNIOL-VILLARD break;
1812352d2591SJean-Christophe PLAGNIOL-VILLARD case GDF_16BIT_565RGB:
1813352d2591SJean-Christophe PLAGNIOL-VILLARD *(unsigned short *) dest =
181464e40d72SWolfgang Denk SWAP16((unsigned short) (
181564e40d72SWolfgang Denk ((r >> 3) << 11) |
181664e40d72SWolfgang Denk ((g >> 2) << 5) |
181764e40d72SWolfgang Denk (b >> 3)));
1818352d2591SJean-Christophe PLAGNIOL-VILLARD break;
1819352d2591SJean-Christophe PLAGNIOL-VILLARD case GDF_32BIT_X888RGB:
18201d4ed26fSAndre Przywara *(u32 *) dest =
18211d4ed26fSAndre Przywara SWAP32((u32) (
182264e40d72SWolfgang Denk (r << 16) |
182364e40d72SWolfgang Denk (g << 8) |
182464e40d72SWolfgang Denk b));
1825352d2591SJean-Christophe PLAGNIOL-VILLARD break;
1826352d2591SJean-Christophe PLAGNIOL-VILLARD case GDF_24BIT_888RGB:
1827352d2591SJean-Christophe PLAGNIOL-VILLARD #ifdef VIDEO_FB_LITTLE_ENDIAN
1828352d2591SJean-Christophe PLAGNIOL-VILLARD dest[0] = b;
1829352d2591SJean-Christophe PLAGNIOL-VILLARD dest[1] = g;
1830352d2591SJean-Christophe PLAGNIOL-VILLARD dest[2] = r;
1831352d2591SJean-Christophe PLAGNIOL-VILLARD #else
1832352d2591SJean-Christophe PLAGNIOL-VILLARD dest[0] = r;
1833352d2591SJean-Christophe PLAGNIOL-VILLARD dest[1] = g;
1834352d2591SJean-Christophe PLAGNIOL-VILLARD dest[2] = b;
1835352d2591SJean-Christophe PLAGNIOL-VILLARD #endif
1836352d2591SJean-Christophe PLAGNIOL-VILLARD break;
1837352d2591SJean-Christophe PLAGNIOL-VILLARD }
1838352d2591SJean-Christophe PLAGNIOL-VILLARD source++;
1839352d2591SJean-Christophe PLAGNIOL-VILLARD dest += VIDEO_PIXEL_SIZE;
1840352d2591SJean-Christophe PLAGNIOL-VILLARD }
1841352d2591SJean-Christophe PLAGNIOL-VILLARD dest += skip;
1842352d2591SJean-Christophe PLAGNIOL-VILLARD }
1843352d2591SJean-Christophe PLAGNIOL-VILLARD #ifdef CONFIG_VIDEO_BMP_LOGO
1844352d2591SJean-Christophe PLAGNIOL-VILLARD free(logo_red);
1845352d2591SJean-Christophe PLAGNIOL-VILLARD free(logo_green);
1846352d2591SJean-Christophe PLAGNIOL-VILLARD free(logo_blue);
1847352d2591SJean-Christophe PLAGNIOL-VILLARD #endif
1848352d2591SJean-Christophe PLAGNIOL-VILLARD }
1849352d2591SJean-Christophe PLAGNIOL-VILLARD
video_logo(void)1850352d2591SJean-Christophe PLAGNIOL-VILLARD static void *video_logo(void)
1851352d2591SJean-Christophe PLAGNIOL-VILLARD {
1852352d2591SJean-Christophe PLAGNIOL-VILLARD char info[128];
1853a9a62af1SWolfgang Denk __maybe_unused int y_off = 0;
18541e681f9aSBastian Ruppert __maybe_unused ulong addr;
18551e681f9aSBastian Ruppert __maybe_unused char *s;
1856b4fc6f22SAnatolij Gustschin __maybe_unused int len, ret, space;
1857352d2591SJean-Christophe PLAGNIOL-VILLARD
1858ff8fb56bSAnatolij Gustschin splash_get_pos(&video_logo_xpos, &video_logo_ypos);
18591ca298ceSMatthias Weisser
18601e681f9aSBastian Ruppert #ifdef CONFIG_SPLASH_SCREEN
186100caae6dSSimon Glass s = env_get("splashimage");
18621e681f9aSBastian Ruppert if (s != NULL) {
1863b4fc6f22SAnatolij Gustschin ret = splash_screen_prepare();
1864b4fc6f22SAnatolij Gustschin if (ret < 0)
1865b4fc6f22SAnatolij Gustschin return video_fb_address;
18661e681f9aSBastian Ruppert addr = simple_strtoul(s, NULL, 16);
18671e681f9aSBastian Ruppert
18681e681f9aSBastian Ruppert if (video_display_bitmap(addr,
18691e681f9aSBastian Ruppert video_logo_xpos,
18701e681f9aSBastian Ruppert video_logo_ypos) == 0) {
1871be129aa7SMatthias Weisser video_logo_height = 0;
1872352d2591SJean-Christophe PLAGNIOL-VILLARD return ((void *) (video_fb_address));
1873352d2591SJean-Christophe PLAGNIOL-VILLARD }
1874352d2591SJean-Christophe PLAGNIOL-VILLARD }
1875352d2591SJean-Christophe PLAGNIOL-VILLARD #endif /* CONFIG_SPLASH_SCREEN */
1876352d2591SJean-Christophe PLAGNIOL-VILLARD
1877c4c9e81fSHans de Goede logo_plot(video_fb_address, video_logo_xpos, video_logo_ypos);
18781e681f9aSBastian Ruppert
18791e681f9aSBastian Ruppert #ifdef CONFIG_SPLASH_SCREEN_ALIGN
18801e681f9aSBastian Ruppert /*
18811e681f9aSBastian Ruppert * when using splashpos for video_logo, skip any info
18821e681f9aSBastian Ruppert * output on video console if the logo is not at 0,0
18831e681f9aSBastian Ruppert */
18841e681f9aSBastian Ruppert if (video_logo_xpos || video_logo_ypos) {
18851e681f9aSBastian Ruppert /*
18861e681f9aSBastian Ruppert * video_logo_height is used in text and cursor offset
18871e681f9aSBastian Ruppert * calculations. Since the console is below the logo,
18881e681f9aSBastian Ruppert * we need to adjust the logo height
18891e681f9aSBastian Ruppert */
18901e681f9aSBastian Ruppert if (video_logo_ypos == BMP_ALIGN_CENTER)
1891b4141195SMasahiro Yamada video_logo_height += max(0, (int)(VIDEO_VISIBLE_ROWS -
18921e681f9aSBastian Ruppert VIDEO_LOGO_HEIGHT) / 2);
18931e681f9aSBastian Ruppert else if (video_logo_ypos > 0)
18941e681f9aSBastian Ruppert video_logo_height += video_logo_ypos;
18951e681f9aSBastian Ruppert
18961e681f9aSBastian Ruppert return video_fb_address + video_logo_height * VIDEO_LINE_LEN;
18971e681f9aSBastian Ruppert }
18981e681f9aSBastian Ruppert #endif
18992bc4aa52SHeiko Schocher if (board_cfb_skip())
19002bc4aa52SHeiko Schocher return 0;
1901352d2591SJean-Christophe PLAGNIOL-VILLARD
1902ce0f709bSAndreas Bießmann sprintf(info, " %s", version_string);
19033dcbe628SAnatolij Gustschin
1904adde435fSTim Harvey #ifndef CONFIG_HIDE_LOGO_VERSION
1905f9d891f0SPeng Fan space = (VIDEO_COLS - VIDEO_INFO_X) / VIDEO_FONT_WIDTH;
19063dcbe628SAnatolij Gustschin len = strlen(info);
19073dcbe628SAnatolij Gustschin
19083dcbe628SAnatolij Gustschin if (len > space) {
1909f9d891f0SPeng Fan int xx = VIDEO_INFO_X, yy = VIDEO_INFO_Y;
1910f9d891f0SPeng Fan uchar *p = (uchar *) info;
1911f9d891f0SPeng Fan
1912f9d891f0SPeng Fan while (len) {
1913f9d891f0SPeng Fan if (len > space) {
1914f9d891f0SPeng Fan video_drawchars(xx, yy, p, space);
1915f9d891f0SPeng Fan len -= space;
1916f9d891f0SPeng Fan
1917f9d891f0SPeng Fan p = (uchar *)p + space;
1918f9d891f0SPeng Fan
1919f9d891f0SPeng Fan if (!y_off) {
1920f9d891f0SPeng Fan xx += VIDEO_FONT_WIDTH;
1921f9d891f0SPeng Fan space--;
1922f9d891f0SPeng Fan }
1923f9d891f0SPeng Fan yy += VIDEO_FONT_HEIGHT;
1924f9d891f0SPeng Fan
1925f9d891f0SPeng Fan y_off++;
1926f9d891f0SPeng Fan } else {
1927f9d891f0SPeng Fan video_drawchars(xx, yy, p, len);
1928f9d891f0SPeng Fan len = 0;
1929f9d891f0SPeng Fan }
1930f9d891f0SPeng Fan }
19313dcbe628SAnatolij Gustschin } else
1932352d2591SJean-Christophe PLAGNIOL-VILLARD video_drawstring(VIDEO_INFO_X, VIDEO_INFO_Y, (uchar *) info);
1933352d2591SJean-Christophe PLAGNIOL-VILLARD
1934352d2591SJean-Christophe PLAGNIOL-VILLARD #ifdef CONFIG_CONSOLE_EXTRA_INFO
1935352d2591SJean-Christophe PLAGNIOL-VILLARD {
193664e40d72SWolfgang Denk int i, n =
193764e40d72SWolfgang Denk ((video_logo_height -
193864e40d72SWolfgang Denk VIDEO_FONT_HEIGHT) / VIDEO_FONT_HEIGHT);
1939352d2591SJean-Christophe PLAGNIOL-VILLARD
1940352d2591SJean-Christophe PLAGNIOL-VILLARD for (i = 1; i < n; i++) {
1941352d2591SJean-Christophe PLAGNIOL-VILLARD video_get_info_str(i, info);
19423dcbe628SAnatolij Gustschin if (!*info)
19433dcbe628SAnatolij Gustschin continue;
19443dcbe628SAnatolij Gustschin
19453dcbe628SAnatolij Gustschin len = strlen(info);
19463dcbe628SAnatolij Gustschin if (len > space) {
19473dcbe628SAnatolij Gustschin video_drawchars(VIDEO_INFO_X,
19483dcbe628SAnatolij Gustschin VIDEO_INFO_Y +
194964e40d72SWolfgang Denk (i + y_off) *
195064e40d72SWolfgang Denk VIDEO_FONT_HEIGHT,
19513dcbe628SAnatolij Gustschin (uchar *) info, space);
19523dcbe628SAnatolij Gustschin y_off++;
195364e40d72SWolfgang Denk video_drawchars(VIDEO_INFO_X +
195464e40d72SWolfgang Denk VIDEO_FONT_WIDTH,
19553dcbe628SAnatolij Gustschin VIDEO_INFO_Y +
195664e40d72SWolfgang Denk (i + y_off) *
195764e40d72SWolfgang Denk VIDEO_FONT_HEIGHT,
19583dcbe628SAnatolij Gustschin (uchar *) info + space,
19593dcbe628SAnatolij Gustschin len - space);
19603dcbe628SAnatolij Gustschin } else {
1961352d2591SJean-Christophe PLAGNIOL-VILLARD video_drawstring(VIDEO_INFO_X,
19623dcbe628SAnatolij Gustschin VIDEO_INFO_Y +
196364e40d72SWolfgang Denk (i + y_off) *
196464e40d72SWolfgang Denk VIDEO_FONT_HEIGHT,
1965352d2591SJean-Christophe PLAGNIOL-VILLARD (uchar *) info);
1966352d2591SJean-Christophe PLAGNIOL-VILLARD }
1967352d2591SJean-Christophe PLAGNIOL-VILLARD }
19683dcbe628SAnatolij Gustschin }
1969352d2591SJean-Christophe PLAGNIOL-VILLARD #endif
1970adde435fSTim Harvey #endif
1971352d2591SJean-Christophe PLAGNIOL-VILLARD
1972be129aa7SMatthias Weisser return (video_fb_address + video_logo_height * VIDEO_LINE_LEN);
1973352d2591SJean-Christophe PLAGNIOL-VILLARD }
1974352d2591SJean-Christophe PLAGNIOL-VILLARD #endif
1975352d2591SJean-Christophe PLAGNIOL-VILLARD
cfb_fb_is_in_dram(void)1976bfd4be80SAnatolij Gustschin static int cfb_fb_is_in_dram(void)
1977bfd4be80SAnatolij Gustschin {
1978bfd4be80SAnatolij Gustschin bd_t *bd = gd->bd;
1979daab59acSAndy Shevchenko #if defined(CONFIG_ARM) || defined(CONFIG_NDS32) || \
1980bfd4be80SAnatolij Gustschin defined(CONFIG_SANDBOX) || defined(CONFIG_X86)
1981bfd4be80SAnatolij Gustschin ulong start, end;
1982bfd4be80SAnatolij Gustschin int i;
1983bfd4be80SAnatolij Gustschin
1984bfd4be80SAnatolij Gustschin for (i = 0; i < CONFIG_NR_DRAM_BANKS; ++i) {
1985bfd4be80SAnatolij Gustschin start = bd->bi_dram[i].start;
1986bfd4be80SAnatolij Gustschin end = bd->bi_dram[i].start + bd->bi_dram[i].size - 1;
1987bfd4be80SAnatolij Gustschin if ((ulong)video_fb_address >= start &&
1988bfd4be80SAnatolij Gustschin (ulong)video_fb_address < end)
1989bfd4be80SAnatolij Gustschin return 1;
1990bfd4be80SAnatolij Gustschin }
1991bfd4be80SAnatolij Gustschin #else
1992bfd4be80SAnatolij Gustschin if ((ulong)video_fb_address >= bd->bi_memstart &&
1993bfd4be80SAnatolij Gustschin (ulong)video_fb_address < bd->bi_memstart + bd->bi_memsize)
1994bfd4be80SAnatolij Gustschin return 1;
1995bfd4be80SAnatolij Gustschin #endif
1996bfd4be80SAnatolij Gustschin return 0;
1997bfd4be80SAnatolij Gustschin }
1998bfd4be80SAnatolij Gustschin
video_clear(void)199945ae2546SHeiko Schocher void video_clear(void)
200045ae2546SHeiko Schocher {
200145ae2546SHeiko Schocher if (!video_fb_address)
200245ae2546SHeiko Schocher return;
200345ae2546SHeiko Schocher #ifdef VIDEO_HW_RECTFILL
200445ae2546SHeiko Schocher video_hw_rectfill(VIDEO_PIXEL_SIZE, /* bytes per pixel */
200545ae2546SHeiko Schocher 0, /* dest pos x */
200645ae2546SHeiko Schocher 0, /* dest pos y */
200745ae2546SHeiko Schocher VIDEO_VISIBLE_COLS, /* frame width */
200845ae2546SHeiko Schocher VIDEO_VISIBLE_ROWS, /* frame height */
200945ae2546SHeiko Schocher bgx /* fill color */
201045ae2546SHeiko Schocher );
201145ae2546SHeiko Schocher #else
201245ae2546SHeiko Schocher memsetl(video_fb_address,
201345ae2546SHeiko Schocher (VIDEO_VISIBLE_ROWS * VIDEO_LINE_LEN) / sizeof(int), bgx);
201445ae2546SHeiko Schocher #endif
201545ae2546SHeiko Schocher }
201645ae2546SHeiko Schocher
cfg_video_init(void)20170a6eac84SSimon Glass static int cfg_video_init(void)
2018352d2591SJean-Christophe PLAGNIOL-VILLARD {
2019352d2591SJean-Christophe PLAGNIOL-VILLARD unsigned char color8;
2020352d2591SJean-Christophe PLAGNIOL-VILLARD
202157912939SWolfgang Denk pGD = video_hw_init();
202257912939SWolfgang Denk if (pGD == NULL)
2023352d2591SJean-Christophe PLAGNIOL-VILLARD return -1;
2024352d2591SJean-Christophe PLAGNIOL-VILLARD
2025352d2591SJean-Christophe PLAGNIOL-VILLARD video_fb_address = (void *) VIDEO_FB_ADRS;
2026352d2591SJean-Christophe PLAGNIOL-VILLARD
2027bfd4be80SAnatolij Gustschin cfb_do_flush_cache = cfb_fb_is_in_dram() && dcache_status();
2028bfd4be80SAnatolij Gustschin
2029352d2591SJean-Christophe PLAGNIOL-VILLARD /* Init drawing pats */
2030352d2591SJean-Christophe PLAGNIOL-VILLARD switch (VIDEO_DATA_FORMAT) {
2031352d2591SJean-Christophe PLAGNIOL-VILLARD case GDF__8BIT_INDEX:
2032002f967cSSimon Glass video_set_lut(0x01, CONFIG_SYS_CONSOLE_FG_COL,
2033002f967cSSimon Glass CONFIG_SYS_CONSOLE_FG_COL,
2034002f967cSSimon Glass CONFIG_SYS_CONSOLE_FG_COL);
2035002f967cSSimon Glass video_set_lut(0x00, CONFIG_SYS_CONSOLE_BG_COL,
2036002f967cSSimon Glass CONFIG_SYS_CONSOLE_BG_COL,
2037002f967cSSimon Glass CONFIG_SYS_CONSOLE_BG_COL);
2038352d2591SJean-Christophe PLAGNIOL-VILLARD fgx = 0x01010101;
2039352d2591SJean-Christophe PLAGNIOL-VILLARD bgx = 0x00000000;
2040352d2591SJean-Christophe PLAGNIOL-VILLARD break;
2041352d2591SJean-Christophe PLAGNIOL-VILLARD case GDF__8BIT_332RGB:
2042002f967cSSimon Glass color8 = ((CONFIG_SYS_CONSOLE_FG_COL & 0xe0) |
2043002f967cSSimon Glass ((CONFIG_SYS_CONSOLE_FG_COL >> 3) & 0x1c) |
2044002f967cSSimon Glass CONFIG_SYS_CONSOLE_FG_COL >> 6);
204564e40d72SWolfgang Denk fgx = (color8 << 24) | (color8 << 16) | (color8 << 8) |
204664e40d72SWolfgang Denk color8;
2047002f967cSSimon Glass color8 = ((CONFIG_SYS_CONSOLE_BG_COL & 0xe0) |
2048002f967cSSimon Glass ((CONFIG_SYS_CONSOLE_BG_COL >> 3) & 0x1c) |
2049002f967cSSimon Glass CONFIG_SYS_CONSOLE_BG_COL >> 6);
205064e40d72SWolfgang Denk bgx = (color8 << 24) | (color8 << 16) | (color8 << 8) |
205164e40d72SWolfgang Denk color8;
2052352d2591SJean-Christophe PLAGNIOL-VILLARD break;
2053352d2591SJean-Christophe PLAGNIOL-VILLARD case GDF_15BIT_555RGB:
2054002f967cSSimon Glass fgx = (((CONFIG_SYS_CONSOLE_FG_COL >> 3) << 26) |
2055002f967cSSimon Glass ((CONFIG_SYS_CONSOLE_FG_COL >> 3) << 21) |
2056002f967cSSimon Glass ((CONFIG_SYS_CONSOLE_FG_COL >> 3) << 16) |
2057002f967cSSimon Glass ((CONFIG_SYS_CONSOLE_FG_COL >> 3) << 10) |
2058002f967cSSimon Glass ((CONFIG_SYS_CONSOLE_FG_COL >> 3) << 5) |
2059002f967cSSimon Glass (CONFIG_SYS_CONSOLE_FG_COL >> 3));
2060002f967cSSimon Glass bgx = (((CONFIG_SYS_CONSOLE_BG_COL >> 3) << 26) |
2061002f967cSSimon Glass ((CONFIG_SYS_CONSOLE_BG_COL >> 3) << 21) |
2062002f967cSSimon Glass ((CONFIG_SYS_CONSOLE_BG_COL >> 3) << 16) |
2063002f967cSSimon Glass ((CONFIG_SYS_CONSOLE_BG_COL >> 3) << 10) |
2064002f967cSSimon Glass ((CONFIG_SYS_CONSOLE_BG_COL >> 3) << 5) |
2065002f967cSSimon Glass (CONFIG_SYS_CONSOLE_BG_COL >> 3));
2066352d2591SJean-Christophe PLAGNIOL-VILLARD break;
2067352d2591SJean-Christophe PLAGNIOL-VILLARD case GDF_16BIT_565RGB:
2068002f967cSSimon Glass fgx = (((CONFIG_SYS_CONSOLE_FG_COL >> 3) << 27) |
2069002f967cSSimon Glass ((CONFIG_SYS_CONSOLE_FG_COL >> 2) << 21) |
2070002f967cSSimon Glass ((CONFIG_SYS_CONSOLE_FG_COL >> 3) << 16) |
2071002f967cSSimon Glass ((CONFIG_SYS_CONSOLE_FG_COL >> 3) << 11) |
2072002f967cSSimon Glass ((CONFIG_SYS_CONSOLE_FG_COL >> 2) << 5) |
2073002f967cSSimon Glass (CONFIG_SYS_CONSOLE_FG_COL >> 3));
2074002f967cSSimon Glass bgx = (((CONFIG_SYS_CONSOLE_BG_COL >> 3) << 27) |
2075002f967cSSimon Glass ((CONFIG_SYS_CONSOLE_BG_COL >> 2) << 21) |
2076002f967cSSimon Glass ((CONFIG_SYS_CONSOLE_BG_COL >> 3) << 16) |
2077002f967cSSimon Glass ((CONFIG_SYS_CONSOLE_BG_COL >> 3) << 11) |
2078002f967cSSimon Glass ((CONFIG_SYS_CONSOLE_BG_COL >> 2) << 5) |
2079002f967cSSimon Glass (CONFIG_SYS_CONSOLE_BG_COL >> 3));
2080352d2591SJean-Christophe PLAGNIOL-VILLARD break;
2081352d2591SJean-Christophe PLAGNIOL-VILLARD case GDF_32BIT_X888RGB:
2082002f967cSSimon Glass fgx = (CONFIG_SYS_CONSOLE_FG_COL << 16) |
2083002f967cSSimon Glass (CONFIG_SYS_CONSOLE_FG_COL << 8) |
2084002f967cSSimon Glass CONFIG_SYS_CONSOLE_FG_COL;
2085002f967cSSimon Glass bgx = (CONFIG_SYS_CONSOLE_BG_COL << 16) |
2086002f967cSSimon Glass (CONFIG_SYS_CONSOLE_BG_COL << 8) |
2087002f967cSSimon Glass CONFIG_SYS_CONSOLE_BG_COL;
2088352d2591SJean-Christophe PLAGNIOL-VILLARD break;
2089352d2591SJean-Christophe PLAGNIOL-VILLARD case GDF_24BIT_888RGB:
2090002f967cSSimon Glass fgx = (CONFIG_SYS_CONSOLE_FG_COL << 24) |
2091002f967cSSimon Glass (CONFIG_SYS_CONSOLE_FG_COL << 16) |
2092002f967cSSimon Glass (CONFIG_SYS_CONSOLE_FG_COL << 8) |
2093002f967cSSimon Glass CONFIG_SYS_CONSOLE_FG_COL;
2094002f967cSSimon Glass bgx = (CONFIG_SYS_CONSOLE_BG_COL << 24) |
2095002f967cSSimon Glass (CONFIG_SYS_CONSOLE_BG_COL << 16) |
2096002f967cSSimon Glass (CONFIG_SYS_CONSOLE_BG_COL << 8) |
2097002f967cSSimon Glass CONFIG_SYS_CONSOLE_BG_COL;
2098352d2591SJean-Christophe PLAGNIOL-VILLARD break;
2099352d2591SJean-Christophe PLAGNIOL-VILLARD }
2100352d2591SJean-Christophe PLAGNIOL-VILLARD eorx = fgx ^ bgx;
2101352d2591SJean-Christophe PLAGNIOL-VILLARD
21028ef05352SRob Clark if (!CONFIG_IS_ENABLED(NO_FB_CLEAR))
210345ae2546SHeiko Schocher video_clear();
210445ae2546SHeiko Schocher
2105352d2591SJean-Christophe PLAGNIOL-VILLARD #ifdef CONFIG_VIDEO_LOGO
2106352d2591SJean-Christophe PLAGNIOL-VILLARD /* Plot the logo and get start point of console */
210772c65f6fSWolfgang Denk debug("Video: Drawing the logo ...\n");
2108352d2591SJean-Christophe PLAGNIOL-VILLARD video_console_address = video_logo();
2109352d2591SJean-Christophe PLAGNIOL-VILLARD #else
2110352d2591SJean-Christophe PLAGNIOL-VILLARD video_console_address = video_fb_address;
2111352d2591SJean-Christophe PLAGNIOL-VILLARD #endif
2112352d2591SJean-Christophe PLAGNIOL-VILLARD
2113352d2591SJean-Christophe PLAGNIOL-VILLARD /* Initialize the console */
2114352d2591SJean-Christophe PLAGNIOL-VILLARD console_col = 0;
2115352d2591SJean-Christophe PLAGNIOL-VILLARD console_row = 0;
2116352d2591SJean-Christophe PLAGNIOL-VILLARD
2117db0d47ddSEric Nelson if (cfb_do_flush_cache)
2118db0d47ddSEric Nelson flush_cache(VIDEO_FB_ADRS, VIDEO_SIZE);
2119db0d47ddSEric Nelson
2120352d2591SJean-Christophe PLAGNIOL-VILLARD return 0;
2121352d2591SJean-Christophe PLAGNIOL-VILLARD }
2122352d2591SJean-Christophe PLAGNIOL-VILLARD
21236cc7ba9eSWolfgang Denk /*
21246cc7ba9eSWolfgang Denk * Implement a weak default function for boards that optionally
21256cc7ba9eSWolfgang Denk * need to skip the video initialization.
21266cc7ba9eSWolfgang Denk */
board_video_skip(void)212769d27545SJeroen Hofstee __weak int board_video_skip(void)
21286cc7ba9eSWolfgang Denk {
21296cc7ba9eSWolfgang Denk /* As default, don't skip test */
21306cc7ba9eSWolfgang Denk return 0;
21316cc7ba9eSWolfgang Denk }
213264e40d72SWolfgang Denk
drv_video_init(void)2133352d2591SJean-Christophe PLAGNIOL-VILLARD int drv_video_init(void)
2134352d2591SJean-Christophe PLAGNIOL-VILLARD {
213552cb4d4fSJean-Christophe PLAGNIOL-VILLARD struct stdio_dev console_dev;
21365692ccfaSSimon Glass bool have_keyboard;
21378ceb2429SBin Meng bool __maybe_unused keyboard_ok = false;
2138352d2591SJean-Christophe PLAGNIOL-VILLARD
21396cc7ba9eSWolfgang Denk /* Check if video initialization should be skipped */
21406cc7ba9eSWolfgang Denk if (board_video_skip())
21416cc7ba9eSWolfgang Denk return 0;
21426cc7ba9eSWolfgang Denk
2143352d2591SJean-Christophe PLAGNIOL-VILLARD /* Init video chip - returns with framebuffer cleared */
21440a6eac84SSimon Glass if (cfg_video_init() == -1)
21458ceb2429SBin Meng return 0;
2146352d2591SJean-Christophe PLAGNIOL-VILLARD
21472bc4aa52SHeiko Schocher if (board_cfb_skip())
21482bc4aa52SHeiko Schocher return 0;
21492bc4aa52SHeiko Schocher
21505692ccfaSSimon Glass #if defined(CONFIG_VGA_AS_SINGLE_DEVICE)
21515692ccfaSSimon Glass have_keyboard = false;
21525692ccfaSSimon Glass #elif defined(CONFIG_OF_CONTROL)
21535692ccfaSSimon Glass have_keyboard = !fdtdec_get_config_bool(gd->fdt_blob,
21545692ccfaSSimon Glass "u-boot,no-keyboard");
21555692ccfaSSimon Glass #else
21565692ccfaSSimon Glass have_keyboard = true;
21575692ccfaSSimon Glass #endif
21585692ccfaSSimon Glass if (have_keyboard) {
215972c65f6fSWolfgang Denk debug("KBD: Keyboard init ...\n");
21605692ccfaSSimon Glass #if !defined(CONFIG_VGA_AS_SINGLE_DEVICE)
21618ceb2429SBin Meng keyboard_ok = !(VIDEO_KBD_INIT_FCT == -1);
2162f62f6469SWolfgang Denk #endif
21635692ccfaSSimon Glass }
2164f62f6469SWolfgang Denk
2165352d2591SJean-Christophe PLAGNIOL-VILLARD /* Init vga device */
2166352d2591SJean-Christophe PLAGNIOL-VILLARD memset(&console_dev, 0, sizeof(console_dev));
2167352d2591SJean-Christophe PLAGNIOL-VILLARD strcpy(console_dev.name, "vga");
21681caf934aSBin Meng console_dev.flags = DEV_FLAGS_OUTPUT;
21690a6eac84SSimon Glass console_dev.putc = cfb_video_putc; /* 'putc' function */
21700a6eac84SSimon Glass console_dev.puts = cfb_video_puts; /* 'puts' function */
2171352d2591SJean-Christophe PLAGNIOL-VILLARD
2172f62f6469SWolfgang Denk #if !defined(CONFIG_VGA_AS_SINGLE_DEVICE)
21738ceb2429SBin Meng if (have_keyboard && keyboard_ok) {
2174f62f6469SWolfgang Denk /* Also init console device */
2175f62f6469SWolfgang Denk console_dev.flags |= DEV_FLAGS_INPUT;
2176352d2591SJean-Christophe PLAGNIOL-VILLARD console_dev.tstc = VIDEO_TSTC_FCT; /* 'tstc' function */
2177352d2591SJean-Christophe PLAGNIOL-VILLARD console_dev.getc = VIDEO_GETC_FCT; /* 'getc' function */
21785692ccfaSSimon Glass }
21795692ccfaSSimon Glass #endif
2180f62f6469SWolfgang Denk
218152cb4d4fSJean-Christophe PLAGNIOL-VILLARD if (stdio_register(&console_dev) != 0)
2182352d2591SJean-Christophe PLAGNIOL-VILLARD return 0;
2183f62f6469SWolfgang Denk
2184f62f6469SWolfgang Denk /* Return success */
2185f62f6469SWolfgang Denk return 1;
2186352d2591SJean-Christophe PLAGNIOL-VILLARD }
2187c20ee073SStefan Reinauer
video_position_cursor(unsigned col,unsigned row)2188c20ee073SStefan Reinauer void video_position_cursor(unsigned col, unsigned row)
2189c20ee073SStefan Reinauer {
2190c20ee073SStefan Reinauer console_col = min(col, CONSOLE_COLS - 1);
2191c20ee073SStefan Reinauer console_row = min(row, CONSOLE_ROWS - 1);
2192c20ee073SStefan Reinauer }
2193c20ee073SStefan Reinauer
video_get_pixel_width(void)2194c20ee073SStefan Reinauer int video_get_pixel_width(void)
2195c20ee073SStefan Reinauer {
2196c20ee073SStefan Reinauer return VIDEO_VISIBLE_COLS;
2197c20ee073SStefan Reinauer }
2198c20ee073SStefan Reinauer
video_get_pixel_height(void)2199c20ee073SStefan Reinauer int video_get_pixel_height(void)
2200c20ee073SStefan Reinauer {
2201c20ee073SStefan Reinauer return VIDEO_VISIBLE_ROWS;
2202c20ee073SStefan Reinauer }
2203c20ee073SStefan Reinauer
video_get_screen_rows(void)2204c20ee073SStefan Reinauer int video_get_screen_rows(void)
2205c20ee073SStefan Reinauer {
2206c20ee073SStefan Reinauer return CONSOLE_ROWS;
2207c20ee073SStefan Reinauer }
2208c20ee073SStefan Reinauer
video_get_screen_columns(void)2209c20ee073SStefan Reinauer int video_get_screen_columns(void)
2210c20ee073SStefan Reinauer {
2211c20ee073SStefan Reinauer return CONSOLE_COLS;
2212c20ee073SStefan Reinauer }
2213