• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3  * (C) Copyright 2001-2015
4  * DENX Software Engineering -- wd@denx.de
5  * Compulab Ltd - http://compulab.co.il/
6  * Bernecker & Rainer Industrieelektronik GmbH - http://www.br-automation.com
7  */
8 
9 #include <common.h>
10 #include <lcd.h>
11 #include <video_font.h>		/* Get font data, width and height */
12 #if defined(CONFIG_LCD_LOGO)
13 #include <bmp_logo.h>
14 #endif
15 
16 static struct console_t cons;
17 
lcd_set_col(short col)18 void lcd_set_col(short col)
19 {
20 	cons.curr_col = col;
21 }
22 
lcd_set_row(short row)23 void lcd_set_row(short row)
24 {
25 	cons.curr_row = row;
26 }
27 
lcd_position_cursor(unsigned col,unsigned row)28 void lcd_position_cursor(unsigned col, unsigned row)
29 {
30 	cons.curr_col = min_t(short, col, cons.cols - 1);
31 	cons.curr_row = min_t(short, row, cons.rows - 1);
32 }
33 
lcd_get_screen_rows(void)34 int lcd_get_screen_rows(void)
35 {
36 	return cons.rows;
37 }
38 
lcd_get_screen_columns(void)39 int lcd_get_screen_columns(void)
40 {
41 	return cons.cols;
42 }
43 
lcd_putc_xy0(struct console_t * pcons,ushort x,ushort y,char c)44 static void lcd_putc_xy0(struct console_t *pcons, ushort x, ushort y, char c)
45 {
46 	int fg_color = lcd_getfgcolor();
47 	int bg_color = lcd_getbgcolor();
48 	int i, row;
49 	fbptr_t *dst = (fbptr_t *)pcons->fbbase +
50 				  y * pcons->lcdsizex +
51 				  x;
52 
53 	for (row = 0; row < VIDEO_FONT_HEIGHT; row++) {
54 		uchar bits = video_fontdata[c * VIDEO_FONT_HEIGHT + row];
55 		for (i = 0; i < VIDEO_FONT_WIDTH; ++i) {
56 			*dst++ = (bits & 0x80) ? fg_color : bg_color;
57 			bits <<= 1;
58 		}
59 		dst += (pcons->lcdsizex - VIDEO_FONT_WIDTH);
60 	}
61 }
62 
console_setrow0(struct console_t * pcons,u32 row,int clr)63 static inline void console_setrow0(struct console_t *pcons, u32 row, int clr)
64 {
65 	int i;
66 	fbptr_t *dst = (fbptr_t *)pcons->fbbase +
67 				  row * VIDEO_FONT_HEIGHT *
68 				  pcons->lcdsizex;
69 
70 	for (i = 0; i < (VIDEO_FONT_HEIGHT * pcons->lcdsizex); i++)
71 		*dst++ = clr;
72 }
73 
console_moverow0(struct console_t * pcons,u32 rowdst,u32 rowsrc)74 static inline void console_moverow0(struct console_t *pcons,
75 				    u32 rowdst, u32 rowsrc)
76 {
77 	int i;
78 	fbptr_t *dst = (fbptr_t *)pcons->fbbase +
79 				  rowdst * VIDEO_FONT_HEIGHT *
80 				  pcons->lcdsizex;
81 
82 	fbptr_t *src = (fbptr_t *)pcons->fbbase +
83 				  rowsrc * VIDEO_FONT_HEIGHT *
84 				  pcons->lcdsizex;
85 
86 	for (i = 0; i < (VIDEO_FONT_HEIGHT * pcons->lcdsizex); i++)
87 		*dst++ = *src++;
88 }
89 
console_back(void)90 static inline void console_back(void)
91 {
92 	if (--cons.curr_col < 0) {
93 		cons.curr_col = cons.cols - 1;
94 		if (--cons.curr_row < 0)
95 			cons.curr_row = 0;
96 	}
97 
98 	cons.fp_putc_xy(&cons,
99 			cons.curr_col * VIDEO_FONT_WIDTH,
100 			cons.curr_row * VIDEO_FONT_HEIGHT, ' ');
101 }
102 
console_newline(void)103 static inline void console_newline(void)
104 {
105 	const int rows = CONFIG_CONSOLE_SCROLL_LINES;
106 	int bg_color = lcd_getbgcolor();
107 	int i;
108 
109 	cons.curr_col = 0;
110 
111 	/* Check if we need to scroll the terminal */
112 	if (++cons.curr_row >= cons.rows) {
113 		for (i = 0; i < cons.rows-rows; i++)
114 			cons.fp_console_moverow(&cons, i, i+rows);
115 		for (i = 0; i < rows; i++)
116 			cons.fp_console_setrow(&cons, cons.rows-i-1, bg_color);
117 		cons.curr_row -= rows;
118 	}
119 	lcd_sync();
120 }
121 
console_calc_rowcol(struct console_t * pcons,u32 sizex,u32 sizey)122 void console_calc_rowcol(struct console_t *pcons, u32 sizex, u32 sizey)
123 {
124 	pcons->cols = sizex / VIDEO_FONT_WIDTH;
125 #if defined(CONFIG_LCD_LOGO) && !defined(CONFIG_LCD_INFO_BELOW_LOGO)
126 	pcons->rows = (pcons->lcdsizey - BMP_LOGO_HEIGHT);
127 	pcons->rows /= VIDEO_FONT_HEIGHT;
128 #else
129 	pcons->rows = sizey / VIDEO_FONT_HEIGHT;
130 #endif
131 }
132 
lcd_init_console_rot(struct console_t * pcons)133 void __weak lcd_init_console_rot(struct console_t *pcons)
134 {
135 	return;
136 }
137 
lcd_init_console(void * address,int vl_cols,int vl_rows,int vl_rot)138 void lcd_init_console(void *address, int vl_cols, int vl_rows, int vl_rot)
139 {
140 	memset(&cons, 0, sizeof(cons));
141 	cons.fbbase = address;
142 
143 	cons.lcdsizex = vl_cols;
144 	cons.lcdsizey = vl_rows;
145 	cons.lcdrot = vl_rot;
146 
147 	cons.fp_putc_xy = &lcd_putc_xy0;
148 	cons.fp_console_moverow = &console_moverow0;
149 	cons.fp_console_setrow = &console_setrow0;
150 	console_calc_rowcol(&cons, cons.lcdsizex, cons.lcdsizey);
151 
152 	lcd_init_console_rot(&cons);
153 
154 	debug("lcd_console: have %d/%d col/rws on scr %dx%d (%d deg rotated)\n",
155 	      cons.cols, cons.rows, cons.lcdsizex, cons.lcdsizey, vl_rot);
156 }
157 
lcd_putc(const char c)158 void lcd_putc(const char c)
159 {
160 	if (!lcd_is_enabled) {
161 		serial_putc(c);
162 
163 		return;
164 	}
165 
166 	switch (c) {
167 	case '\r':
168 		cons.curr_col = 0;
169 		return;
170 	case '\n':
171 		console_newline();
172 
173 		return;
174 	case '\t':	/* Tab (8 chars alignment) */
175 		cons.curr_col +=  8;
176 		cons.curr_col &= ~7;
177 
178 		if (cons.curr_col >= cons.cols)
179 			console_newline();
180 
181 		return;
182 	case '\b':
183 		console_back();
184 
185 		return;
186 	default:
187 		cons.fp_putc_xy(&cons,
188 				cons.curr_col * VIDEO_FONT_WIDTH,
189 				cons.curr_row * VIDEO_FONT_HEIGHT, c);
190 		if (++cons.curr_col >= cons.cols)
191 			console_newline();
192 	}
193 }
194 
lcd_puts(const char * s)195 void lcd_puts(const char *s)
196 {
197 	if (!lcd_is_enabled) {
198 		serial_puts(s);
199 
200 		return;
201 	}
202 
203 	while (*s)
204 		lcd_putc(*s++);
205 
206 	lcd_sync();
207 }
208 
lcd_printf(const char * fmt,...)209 void lcd_printf(const char *fmt, ...)
210 {
211 	va_list args;
212 	char buf[CONFIG_SYS_PBSIZE];
213 
214 	va_start(args, fmt);
215 	vsprintf(buf, fmt, args);
216 	va_end(args);
217 
218 	lcd_puts(buf);
219 }
220 
do_lcd_setcursor(cmd_tbl_t * cmdtp,int flag,int argc,char * const argv[])221 static int do_lcd_setcursor(cmd_tbl_t *cmdtp, int flag, int argc,
222 			    char *const argv[])
223 {
224 	unsigned int col, row;
225 
226 	if (argc != 3)
227 		return CMD_RET_USAGE;
228 
229 	col = simple_strtoul(argv[1], NULL, 10);
230 	row = simple_strtoul(argv[2], NULL, 10);
231 	lcd_position_cursor(col, row);
232 
233 	return 0;
234 }
235 
do_lcd_puts(cmd_tbl_t * cmdtp,int flag,int argc,char * const argv[])236 static int do_lcd_puts(cmd_tbl_t *cmdtp, int flag, int argc,
237 		       char *const argv[])
238 {
239 	if (argc != 2)
240 		return CMD_RET_USAGE;
241 
242 	lcd_puts(argv[1]);
243 
244 	return 0;
245 }
246 
247 U_BOOT_CMD(
248 	setcurs, 3,	1,	do_lcd_setcursor,
249 	"set cursor position within screen",
250 	"    <col> <row> in character"
251 );
252 
253 U_BOOT_CMD(
254 	lcdputs, 2,	1,	do_lcd_puts,
255 	"print string on lcd-framebuffer",
256 	"    <string>"
257 );
258 
259