blob: 74c388a0cadccb06a4e9ba935310b78d2206ec3a [file] [log] [blame]
Nikita Kiryanov904672e2014-12-08 17:14:45 +02001/*
2 * (C) Copyright 2001-2014
3 * DENX Software Engineering -- wd@denx.de
4 * Compulab Ltd - http://compulab.co.il/
5 *
6 * SPDX-License-Identifier: GPL-2.0+
7 */
8
9#include <common.h>
10#include <lcd.h>
11#include <video_font.h> /* Get font data, width and height */
12
13#define CONSOLE_ROW_SIZE (VIDEO_FONT_HEIGHT * lcd_line_length)
14#define CONSOLE_ROW_FIRST lcd_console_address
Nikita Kiryanov904672e2014-12-08 17:14:45 +020015#define CONSOLE_SIZE (CONSOLE_ROW_SIZE * console_rows)
Nikita Kiryanov904672e2014-12-08 17:14:45 +020016
17static short console_curr_col;
18static short console_curr_row;
19static short console_cols;
20static short console_rows;
21static void *lcd_console_address;
22
23void lcd_init_console(void *address, int rows, int cols)
24{
25 console_curr_col = 0;
26 console_curr_row = 0;
27 console_cols = cols;
28 console_rows = rows;
29 lcd_console_address = address;
30}
31
32void lcd_set_col(short col)
33{
34 console_curr_col = col;
35}
36
37void lcd_set_row(short row)
38{
39 console_curr_row = row;
40}
41
42void lcd_position_cursor(unsigned col, unsigned row)
43{
44 console_curr_col = min_t(short, col, console_cols - 1);
45 console_curr_row = min_t(short, row, console_rows - 1);
46}
47
48int lcd_get_screen_rows(void)
49{
50 return console_rows;
51}
52
53int lcd_get_screen_columns(void)
54{
55 return console_cols;
56}
57
58static void lcd_drawchars(ushort x, ushort y, uchar *str, int count)
59{
60 uchar *dest;
61 ushort row;
62 int fg_color, bg_color;
63
64 dest = (uchar *)(lcd_console_address +
65 y * lcd_line_length + x * NBITS(LCD_BPP) / 8);
66
67 for (row = 0; row < VIDEO_FONT_HEIGHT; ++row, dest += lcd_line_length) {
68 uchar *s = str;
69 int i;
70#if LCD_BPP == LCD_COLOR16
71 ushort *d = (ushort *)dest;
72#elif LCD_BPP == LCD_COLOR32
73 u32 *d = (u32 *)dest;
74#else
75 uchar *d = dest;
76#endif
77
78 fg_color = lcd_getfgcolor();
79 bg_color = lcd_getbgcolor();
80 for (i = 0; i < count; ++i) {
81 uchar c, bits;
82
83 c = *s++;
84 bits = video_fontdata[c * VIDEO_FONT_HEIGHT + row];
85
86 for (c = 0; c < 8; ++c) {
87 *d++ = (bits & 0x80) ? fg_color : bg_color;
88 bits <<= 1;
89 }
90 }
91 }
92}
93
94static inline void lcd_putc_xy(ushort x, ushort y, uchar c)
95{
96 lcd_drawchars(x, y, &c, 1);
97}
98
99static void console_scrollup(void)
100{
101 const int rows = CONFIG_CONSOLE_SCROLL_LINES;
102 int bg_color = lcd_getbgcolor();
103
104 /* Copy up rows ignoring those that will be overwritten */
105 memcpy(CONSOLE_ROW_FIRST,
106 lcd_console_address + CONSOLE_ROW_SIZE * rows,
107 CONSOLE_SIZE - CONSOLE_ROW_SIZE * rows);
108
109 /* Clear the last rows */
110#if (LCD_BPP != LCD_COLOR32)
111 memset(lcd_console_address + CONSOLE_SIZE - CONSOLE_ROW_SIZE * rows,
112 bg_color, CONSOLE_ROW_SIZE * rows);
113#else
114 u32 *ppix = lcd_console_address +
115 CONSOLE_SIZE - CONSOLE_ROW_SIZE * rows;
116 u32 i;
117 for (i = 0;
118 i < (CONSOLE_ROW_SIZE * rows) / NBYTES(panel_info.vl_bpix);
119 i++) {
120 *ppix++ = bg_color;
121 }
122#endif
123 lcd_sync();
124 console_curr_row -= rows;
125}
126
127static inline void console_back(void)
128{
129 if (--console_curr_col < 0) {
130 console_curr_col = console_cols - 1;
131 if (--console_curr_row < 0)
132 console_curr_row = 0;
133 }
134
135 lcd_putc_xy(console_curr_col * VIDEO_FONT_WIDTH,
136 console_curr_row * VIDEO_FONT_HEIGHT, ' ');
137}
138
139static inline void console_newline(void)
140{
141 console_curr_col = 0;
142
143 /* Check if we need to scroll the terminal */
144 if (++console_curr_row >= console_rows)
145 console_scrollup();
146 else
147 lcd_sync();
148}
149
150void lcd_putc(const char c)
151{
152 if (!lcd_is_enabled) {
153 serial_putc(c);
154
155 return;
156 }
157
158 switch (c) {
159 case '\r':
160 console_curr_col = 0;
161
162 return;
163 case '\n':
164 console_newline();
165
166 return;
167 case '\t': /* Tab (8 chars alignment) */
168 console_curr_col += 8;
169 console_curr_col &= ~7;
170
171 if (console_curr_col >= console_cols)
172 console_newline();
173
174 return;
175 case '\b':
176 console_back();
177
178 return;
179 default:
180 lcd_putc_xy(console_curr_col * VIDEO_FONT_WIDTH,
181 console_curr_row * VIDEO_FONT_HEIGHT, c);
182 if (++console_curr_col >= console_cols)
183 console_newline();
184 }
185}
186
187void lcd_puts(const char *s)
188{
189 if (!lcd_is_enabled) {
190 serial_puts(s);
191
192 return;
193 }
194
195 while (*s)
196 lcd_putc(*s++);
197
198 lcd_sync();
199}
200
201void lcd_printf(const char *fmt, ...)
202{
203 va_list args;
204 char buf[CONFIG_SYS_PBSIZE];
205
206 va_start(args, fmt);
207 vsprintf(buf, fmt, args);
208 va_end(args);
209
210 lcd_puts(buf);
211}