]>
Commit | Line | Data |
---|---|---|
47d1a6e1 WD |
1 | /* |
2 | * (C) Copyright 2000 | |
3 | * Paolo Scaffardi, AIRVENT SAM s.p.a - RIMINI(ITALY), arsenio@tin.it | |
4 | * | |
1a459660 | 5 | * SPDX-License-Identifier: GPL-2.0+ |
47d1a6e1 WD |
6 | */ |
7 | ||
8 | #include <common.h> | |
24b852a7 | 9 | #include <console.h> |
d6ea5307 | 10 | #include <debug_uart.h> |
47d1a6e1 | 11 | #include <stdarg.h> |
482f4691 | 12 | #include <iomux.h> |
47d1a6e1 | 13 | #include <malloc.h> |
4e6bafa5 | 14 | #include <mapmem.h> |
91b136c7 | 15 | #include <os.h> |
849d5d9c | 16 | #include <serial.h> |
52cb4d4f | 17 | #include <stdio_dev.h> |
27b207fd | 18 | #include <exports.h> |
849d5d9c | 19 | #include <environment.h> |
64407467 | 20 | #include <watchdog.h> |
47d1a6e1 | 21 | |
d87080b7 WD |
22 | DECLARE_GLOBAL_DATA_PTR; |
23 | ||
849d5d9c JH |
24 | static int on_console(const char *name, const char *value, enum env_op op, |
25 | int flags) | |
26 | { | |
27 | int console = -1; | |
28 | ||
29 | /* Check for console redirection */ | |
30 | if (strcmp(name, "stdin") == 0) | |
31 | console = stdin; | |
32 | else if (strcmp(name, "stdout") == 0) | |
33 | console = stdout; | |
34 | else if (strcmp(name, "stderr") == 0) | |
35 | console = stderr; | |
36 | ||
37 | /* if not actually setting a console variable, we don't care */ | |
38 | if (console == -1 || (gd->flags & GD_FLG_DEVINIT) == 0) | |
39 | return 0; | |
40 | ||
41 | switch (op) { | |
42 | case env_op_create: | |
43 | case env_op_overwrite: | |
44 | ||
b0265429 | 45 | #if CONFIG_IS_ENABLED(CONSOLE_MUX) |
849d5d9c JH |
46 | if (iomux_doenv(console, value)) |
47 | return 1; | |
48 | #else | |
49 | /* Try assigning specified device */ | |
50 | if (console_assign(console, value) < 0) | |
51 | return 1; | |
b0265429 | 52 | #endif |
849d5d9c JH |
53 | return 0; |
54 | ||
55 | case env_op_delete: | |
56 | if ((flags & H_FORCE) == 0) | |
57 | printf("Can't delete \"%s\"\n", name); | |
58 | return 1; | |
59 | ||
60 | default: | |
61 | return 0; | |
62 | } | |
63 | } | |
64 | U_BOOT_ENV_CALLBACK(console, on_console); | |
65 | ||
e080d545 JH |
66 | #ifdef CONFIG_SILENT_CONSOLE |
67 | static int on_silent(const char *name, const char *value, enum env_op op, | |
68 | int flags) | |
69 | { | |
98af8799 | 70 | #if !CONFIG_IS_ENABLED(CONFIG_SILENT_CONSOLE_UPDATE_ON_SET) |
e080d545 JH |
71 | if (flags & H_INTERACTIVE) |
72 | return 0; | |
73 | #endif | |
98af8799 | 74 | #if !CONFIG_IS_ENABLED(CONFIG_SILENT_CONSOLE_UPDATE_ON_RELOC) |
e080d545 JH |
75 | if ((flags & H_INTERACTIVE) == 0) |
76 | return 0; | |
77 | #endif | |
78 | ||
79 | if (value != NULL) | |
80 | gd->flags |= GD_FLG_SILENT; | |
81 | else | |
82 | gd->flags &= ~GD_FLG_SILENT; | |
83 | ||
84 | return 0; | |
85 | } | |
86 | U_BOOT_ENV_CALLBACK(silent, on_silent); | |
87 | #endif | |
88 | ||
b0265429 | 89 | #if CONFIG_IS_ENABLED(SYS_CONSOLE_IS_IN_ENV) |
47d1a6e1 WD |
90 | /* |
91 | * if overwrite_console returns 1, the stdin, stderr and stdout | |
92 | * are switched to the serial port, else the settings in the | |
93 | * environment are used | |
94 | */ | |
6d0f6bcf | 95 | #ifdef CONFIG_SYS_CONSOLE_OVERWRITE_ROUTINE |
ec6f1499 JCPV |
96 | extern int overwrite_console(void); |
97 | #define OVERWRITE_CONSOLE overwrite_console() | |
47d1a6e1 | 98 | #else |
83e40ba7 | 99 | #define OVERWRITE_CONSOLE 0 |
6d0f6bcf | 100 | #endif /* CONFIG_SYS_CONSOLE_OVERWRITE_ROUTINE */ |
47d1a6e1 | 101 | |
b0265429 | 102 | #endif /* CONFIG_IS_ENABLED(SYS_CONSOLE_IS_IN_ENV) */ |
47d1a6e1 | 103 | |
52cb4d4f | 104 | static int console_setfile(int file, struct stdio_dev * dev) |
47d1a6e1 WD |
105 | { |
106 | int error = 0; | |
107 | ||
108 | if (dev == NULL) | |
109 | return -1; | |
110 | ||
111 | switch (file) { | |
112 | case stdin: | |
113 | case stdout: | |
114 | case stderr: | |
115 | /* Start new device */ | |
116 | if (dev->start) { | |
709ea543 | 117 | error = dev->start(dev); |
47d1a6e1 WD |
118 | /* If it's not started dont use it */ |
119 | if (error < 0) | |
120 | break; | |
121 | } | |
122 | ||
123 | /* Assign the new device (leaving the existing one started) */ | |
124 | stdio_devices[file] = dev; | |
125 | ||
126 | /* | |
127 | * Update monitor functions | |
128 | * (to use the console stuff by other applications) | |
129 | */ | |
130 | switch (file) { | |
131 | case stdin: | |
49cad547 MD |
132 | gd->jt->getc = getc; |
133 | gd->jt->tstc = tstc; | |
47d1a6e1 WD |
134 | break; |
135 | case stdout: | |
49cad547 MD |
136 | gd->jt->putc = putc; |
137 | gd->jt->puts = puts; | |
138 | gd->jt->printf = printf; | |
47d1a6e1 WD |
139 | break; |
140 | } | |
141 | break; | |
142 | ||
143 | default: /* Invalid file ID */ | |
144 | error = -1; | |
145 | } | |
146 | return error; | |
147 | } | |
148 | ||
b0265429 | 149 | #if CONFIG_IS_ENABLED(CONSOLE_MUX) |
16a28ef2 GJ |
150 | /** Console I/O multiplexing *******************************************/ |
151 | ||
52cb4d4f JCPV |
152 | static struct stdio_dev *tstcdev; |
153 | struct stdio_dev **console_devices[MAX_FILES]; | |
16a28ef2 GJ |
154 | int cd_count[MAX_FILES]; |
155 | ||
156 | /* | |
157 | * This depends on tstc() always being called before getc(). | |
158 | * This is guaranteed to be true because this routine is called | |
159 | * only from fgetc() which assures it. | |
160 | * No attempt is made to demultiplex multiple input sources. | |
161 | */ | |
5f032010 | 162 | static int console_getc(int file) |
16a28ef2 GJ |
163 | { |
164 | unsigned char ret; | |
165 | ||
166 | /* This is never called with testcdev == NULL */ | |
709ea543 | 167 | ret = tstcdev->getc(tstcdev); |
16a28ef2 GJ |
168 | tstcdev = NULL; |
169 | return ret; | |
170 | } | |
171 | ||
5f032010 | 172 | static int console_tstc(int file) |
16a28ef2 GJ |
173 | { |
174 | int i, ret; | |
52cb4d4f | 175 | struct stdio_dev *dev; |
16a28ef2 GJ |
176 | |
177 | disable_ctrlc(1); | |
178 | for (i = 0; i < cd_count[file]; i++) { | |
179 | dev = console_devices[file][i]; | |
180 | if (dev->tstc != NULL) { | |
709ea543 | 181 | ret = dev->tstc(dev); |
16a28ef2 GJ |
182 | if (ret > 0) { |
183 | tstcdev = dev; | |
184 | disable_ctrlc(0); | |
185 | return ret; | |
186 | } | |
187 | } | |
188 | } | |
189 | disable_ctrlc(0); | |
190 | ||
191 | return 0; | |
192 | } | |
193 | ||
5f032010 | 194 | static void console_putc(int file, const char c) |
16a28ef2 GJ |
195 | { |
196 | int i; | |
52cb4d4f | 197 | struct stdio_dev *dev; |
16a28ef2 GJ |
198 | |
199 | for (i = 0; i < cd_count[file]; i++) { | |
200 | dev = console_devices[file][i]; | |
201 | if (dev->putc != NULL) | |
709ea543 | 202 | dev->putc(dev, c); |
16a28ef2 GJ |
203 | } |
204 | } | |
205 | ||
a8552c7c | 206 | static void console_puts_noserial(int file, const char *s) |
27669667 SS |
207 | { |
208 | int i; | |
209 | struct stdio_dev *dev; | |
210 | ||
211 | for (i = 0; i < cd_count[file]; i++) { | |
212 | dev = console_devices[file][i]; | |
a8552c7c HG |
213 | if (dev->puts != NULL && strcmp(dev->name, "serial") != 0) |
214 | dev->puts(dev, s); | |
27669667 SS |
215 | } |
216 | } | |
27669667 | 217 | |
5f032010 | 218 | static void console_puts(int file, const char *s) |
16a28ef2 GJ |
219 | { |
220 | int i; | |
52cb4d4f | 221 | struct stdio_dev *dev; |
16a28ef2 GJ |
222 | |
223 | for (i = 0; i < cd_count[file]; i++) { | |
224 | dev = console_devices[file][i]; | |
225 | if (dev->puts != NULL) | |
709ea543 | 226 | dev->puts(dev, s); |
16a28ef2 GJ |
227 | } |
228 | } | |
5f032010 | 229 | |
52cb4d4f | 230 | static inline void console_doenv(int file, struct stdio_dev *dev) |
5f032010 JCPV |
231 | { |
232 | iomux_doenv(file, dev->name); | |
233 | } | |
234 | #else | |
235 | static inline int console_getc(int file) | |
236 | { | |
709ea543 | 237 | return stdio_devices[file]->getc(stdio_devices[file]); |
5f032010 JCPV |
238 | } |
239 | ||
240 | static inline int console_tstc(int file) | |
241 | { | |
709ea543 | 242 | return stdio_devices[file]->tstc(stdio_devices[file]); |
5f032010 JCPV |
243 | } |
244 | ||
245 | static inline void console_putc(int file, const char c) | |
246 | { | |
709ea543 | 247 | stdio_devices[file]->putc(stdio_devices[file], c); |
5f032010 JCPV |
248 | } |
249 | ||
a8552c7c | 250 | static inline void console_puts_noserial(int file, const char *s) |
27669667 SS |
251 | { |
252 | if (strcmp(stdio_devices[file]->name, "serial") != 0) | |
a8552c7c | 253 | stdio_devices[file]->puts(stdio_devices[file], s); |
27669667 | 254 | } |
27669667 | 255 | |
5f032010 JCPV |
256 | static inline void console_puts(int file, const char *s) |
257 | { | |
709ea543 | 258 | stdio_devices[file]->puts(stdio_devices[file], s); |
5f032010 JCPV |
259 | } |
260 | ||
52cb4d4f | 261 | static inline void console_doenv(int file, struct stdio_dev *dev) |
5f032010 JCPV |
262 | { |
263 | console_setfile(file, dev); | |
264 | } | |
b0265429 | 265 | #endif /* CONIFIG_IS_ENABLED(CONSOLE_MUX) */ |
16a28ef2 | 266 | |
47d1a6e1 WD |
267 | /** U-Boot INITIAL CONSOLE-NOT COMPATIBLE FUNCTIONS *************************/ |
268 | ||
d9c27253 | 269 | int serial_printf(const char *fmt, ...) |
47d1a6e1 WD |
270 | { |
271 | va_list args; | |
272 | uint i; | |
6d0f6bcf | 273 | char printbuffer[CONFIG_SYS_PBSIZE]; |
47d1a6e1 | 274 | |
ec6f1499 | 275 | va_start(args, fmt); |
47d1a6e1 WD |
276 | |
277 | /* For this to work, printbuffer must be larger than | |
278 | * anything we ever want to print. | |
279 | */ | |
068af6f8 | 280 | i = vscnprintf(printbuffer, sizeof(printbuffer), fmt, args); |
ec6f1499 | 281 | va_end(args); |
47d1a6e1 | 282 | |
ec6f1499 | 283 | serial_puts(printbuffer); |
d9c27253 | 284 | return i; |
47d1a6e1 WD |
285 | } |
286 | ||
ec6f1499 | 287 | int fgetc(int file) |
47d1a6e1 | 288 | { |
16a28ef2 | 289 | if (file < MAX_FILES) { |
b0265429 | 290 | #if CONFIG_IS_ENABLED(CONSOLE_MUX) |
16a28ef2 GJ |
291 | /* |
292 | * Effectively poll for input wherever it may be available. | |
293 | */ | |
294 | for (;;) { | |
64407467 | 295 | WATCHDOG_RESET(); |
16a28ef2 GJ |
296 | /* |
297 | * Upper layer may have already called tstc() so | |
298 | * check for that first. | |
299 | */ | |
300 | if (tstcdev != NULL) | |
5f032010 JCPV |
301 | return console_getc(file); |
302 | console_tstc(file); | |
16a28ef2 GJ |
303 | #ifdef CONFIG_WATCHDOG |
304 | /* | |
305 | * If the watchdog must be rate-limited then it should | |
306 | * already be handled in board-specific code. | |
307 | */ | |
308 | udelay(1); | |
309 | #endif | |
310 | } | |
311 | #else | |
5f032010 | 312 | return console_getc(file); |
16a28ef2 GJ |
313 | #endif |
314 | } | |
47d1a6e1 WD |
315 | |
316 | return -1; | |
317 | } | |
318 | ||
ec6f1499 | 319 | int ftstc(int file) |
47d1a6e1 WD |
320 | { |
321 | if (file < MAX_FILES) | |
5f032010 | 322 | return console_tstc(file); |
47d1a6e1 WD |
323 | |
324 | return -1; | |
325 | } | |
326 | ||
ec6f1499 | 327 | void fputc(int file, const char c) |
47d1a6e1 WD |
328 | { |
329 | if (file < MAX_FILES) | |
5f032010 | 330 | console_putc(file, c); |
47d1a6e1 WD |
331 | } |
332 | ||
ec6f1499 | 333 | void fputs(int file, const char *s) |
47d1a6e1 WD |
334 | { |
335 | if (file < MAX_FILES) | |
5f032010 | 336 | console_puts(file, s); |
47d1a6e1 WD |
337 | } |
338 | ||
d9c27253 | 339 | int fprintf(int file, const char *fmt, ...) |
47d1a6e1 WD |
340 | { |
341 | va_list args; | |
342 | uint i; | |
6d0f6bcf | 343 | char printbuffer[CONFIG_SYS_PBSIZE]; |
47d1a6e1 | 344 | |
ec6f1499 | 345 | va_start(args, fmt); |
47d1a6e1 WD |
346 | |
347 | /* For this to work, printbuffer must be larger than | |
348 | * anything we ever want to print. | |
349 | */ | |
068af6f8 | 350 | i = vscnprintf(printbuffer, sizeof(printbuffer), fmt, args); |
ec6f1499 | 351 | va_end(args); |
47d1a6e1 WD |
352 | |
353 | /* Send to desired file */ | |
ec6f1499 | 354 | fputs(file, printbuffer); |
d9c27253 | 355 | return i; |
47d1a6e1 WD |
356 | } |
357 | ||
358 | /** U-Boot INITIAL CONSOLE-COMPATIBLE FUNCTION *****************************/ | |
359 | ||
ec6f1499 | 360 | int getc(void) |
47d1a6e1 | 361 | { |
f5c3ba79 MJ |
362 | #ifdef CONFIG_DISABLE_CONSOLE |
363 | if (gd->flags & GD_FLG_DISABLE_CONSOLE) | |
364 | return 0; | |
365 | #endif | |
366 | ||
e3e454cd GR |
367 | if (!gd->have_console) |
368 | return 0; | |
369 | ||
9854a874 SG |
370 | #ifdef CONFIG_CONSOLE_RECORD |
371 | if (gd->console_in.start) { | |
372 | int ch; | |
373 | ||
374 | ch = membuff_getbyte(&gd->console_in); | |
375 | if (ch != -1) | |
376 | return 1; | |
377 | } | |
378 | #endif | |
47d1a6e1 WD |
379 | if (gd->flags & GD_FLG_DEVINIT) { |
380 | /* Get from the standard input */ | |
ec6f1499 | 381 | return fgetc(stdin); |
47d1a6e1 WD |
382 | } |
383 | ||
384 | /* Send directly to the handler */ | |
ec6f1499 | 385 | return serial_getc(); |
47d1a6e1 WD |
386 | } |
387 | ||
ec6f1499 | 388 | int tstc(void) |
47d1a6e1 | 389 | { |
f5c3ba79 MJ |
390 | #ifdef CONFIG_DISABLE_CONSOLE |
391 | if (gd->flags & GD_FLG_DISABLE_CONSOLE) | |
392 | return 0; | |
393 | #endif | |
394 | ||
e3e454cd GR |
395 | if (!gd->have_console) |
396 | return 0; | |
9854a874 SG |
397 | #ifdef CONFIG_CONSOLE_RECORD |
398 | if (gd->console_in.start) { | |
399 | if (membuff_peekbyte(&gd->console_in) != -1) | |
400 | return 1; | |
401 | } | |
402 | #endif | |
47d1a6e1 WD |
403 | if (gd->flags & GD_FLG_DEVINIT) { |
404 | /* Test the standard input */ | |
ec6f1499 | 405 | return ftstc(stdin); |
47d1a6e1 WD |
406 | } |
407 | ||
408 | /* Send directly to the handler */ | |
ec6f1499 | 409 | return serial_tstc(); |
47d1a6e1 WD |
410 | } |
411 | ||
27669667 SS |
412 | #define PRE_CONSOLE_FLUSHPOINT1_SERIAL 0 |
413 | #define PRE_CONSOLE_FLUSHPOINT2_EVERYTHING_BUT_SERIAL 1 | |
414 | ||
8f925584 | 415 | #if CONFIG_IS_ENABLED(PRE_CONSOLE_BUFFER) |
9558b48a GR |
416 | #define CIRC_BUF_IDX(idx) ((idx) % (unsigned long)CONFIG_PRE_CON_BUF_SZ) |
417 | ||
418 | static void pre_console_putc(const char c) | |
419 | { | |
4e6bafa5 SG |
420 | char *buffer; |
421 | ||
422 | buffer = map_sysmem(CONFIG_PRE_CON_BUF_ADDR, CONFIG_PRE_CON_BUF_SZ); | |
9558b48a GR |
423 | |
424 | buffer[CIRC_BUF_IDX(gd->precon_buf_idx++)] = c; | |
4e6bafa5 SG |
425 | |
426 | unmap_sysmem(buffer); | |
9558b48a GR |
427 | } |
428 | ||
429 | static void pre_console_puts(const char *s) | |
430 | { | |
431 | while (*s) | |
432 | pre_console_putc(*s++); | |
433 | } | |
434 | ||
27669667 | 435 | static void print_pre_console_buffer(int flushpoint) |
9558b48a | 436 | { |
a8552c7c | 437 | unsigned long in = 0, out = 0; |
a8552c7c | 438 | char buf_out[CONFIG_PRE_CON_BUF_SZ + 1]; |
4e6bafa5 | 439 | char *buf_in; |
9558b48a | 440 | |
4e6bafa5 | 441 | buf_in = map_sysmem(CONFIG_PRE_CON_BUF_ADDR, CONFIG_PRE_CON_BUF_SZ); |
9558b48a | 442 | if (gd->precon_buf_idx > CONFIG_PRE_CON_BUF_SZ) |
a8552c7c | 443 | in = gd->precon_buf_idx - CONFIG_PRE_CON_BUF_SZ; |
9558b48a | 444 | |
a8552c7c HG |
445 | while (in < gd->precon_buf_idx) |
446 | buf_out[out++] = buf_in[CIRC_BUF_IDX(in++)]; | |
4e6bafa5 | 447 | unmap_sysmem(buf_in); |
a8552c7c HG |
448 | |
449 | buf_out[out] = 0; | |
450 | ||
451 | switch (flushpoint) { | |
452 | case PRE_CONSOLE_FLUSHPOINT1_SERIAL: | |
453 | puts(buf_out); | |
454 | break; | |
455 | case PRE_CONSOLE_FLUSHPOINT2_EVERYTHING_BUT_SERIAL: | |
456 | console_puts_noserial(stdout, buf_out); | |
457 | break; | |
458 | } | |
9558b48a GR |
459 | } |
460 | #else | |
461 | static inline void pre_console_putc(const char c) {} | |
462 | static inline void pre_console_puts(const char *s) {} | |
27669667 | 463 | static inline void print_pre_console_buffer(int flushpoint) {} |
9558b48a GR |
464 | #endif |
465 | ||
ec6f1499 | 466 | void putc(const char c) |
47d1a6e1 | 467 | { |
91b136c7 | 468 | #ifdef CONFIG_SANDBOX |
da229e4e | 469 | /* sandbox can send characters to stdout before it has a console */ |
093f79ab | 470 | if (!gd || !(gd->flags & GD_FLG_SERIAL_READY)) { |
91b136c7 SG |
471 | os_putc(c); |
472 | return; | |
473 | } | |
474 | #endif | |
d6ea5307 SG |
475 | #ifdef CONFIG_DEBUG_UART |
476 | /* if we don't have a console yet, use the debug UART */ | |
477 | if (!gd || !(gd->flags & GD_FLG_SERIAL_READY)) { | |
478 | printch(c); | |
479 | return; | |
480 | } | |
481 | #endif | |
9854a874 SG |
482 | #ifdef CONFIG_CONSOLE_RECORD |
483 | if (gd && (gd->flags & GD_FLG_RECORD) && gd->console_out.start) | |
484 | membuff_putbyte(&gd->console_out, c); | |
485 | #endif | |
a6cccaea WD |
486 | #ifdef CONFIG_SILENT_CONSOLE |
487 | if (gd->flags & GD_FLG_SILENT) | |
f6e20fc6 | 488 | return; |
a6cccaea WD |
489 | #endif |
490 | ||
f5c3ba79 MJ |
491 | #ifdef CONFIG_DISABLE_CONSOLE |
492 | if (gd->flags & GD_FLG_DISABLE_CONSOLE) | |
493 | return; | |
494 | #endif | |
495 | ||
e3e454cd | 496 | if (!gd->have_console) |
9558b48a | 497 | return pre_console_putc(c); |
e3e454cd | 498 | |
47d1a6e1 WD |
499 | if (gd->flags & GD_FLG_DEVINIT) { |
500 | /* Send to the standard output */ | |
ec6f1499 | 501 | fputc(stdout, c); |
47d1a6e1 WD |
502 | } else { |
503 | /* Send directly to the handler */ | |
27669667 | 504 | pre_console_putc(c); |
ec6f1499 | 505 | serial_putc(c); |
47d1a6e1 WD |
506 | } |
507 | } | |
508 | ||
ec6f1499 | 509 | void puts(const char *s) |
47d1a6e1 | 510 | { |
91b136c7 | 511 | #ifdef CONFIG_SANDBOX |
093f79ab | 512 | if (!gd || !(gd->flags & GD_FLG_SERIAL_READY)) { |
91b136c7 SG |
513 | os_puts(s); |
514 | return; | |
515 | } | |
516 | #endif | |
d6ea5307 SG |
517 | #ifdef CONFIG_DEBUG_UART |
518 | if (!gd || !(gd->flags & GD_FLG_SERIAL_READY)) { | |
519 | while (*s) { | |
520 | int ch = *s++; | |
91b136c7 | 521 | |
d6ea5307 | 522 | printch(ch); |
d6ea5307 SG |
523 | } |
524 | return; | |
525 | } | |
526 | #endif | |
9854a874 SG |
527 | #ifdef CONFIG_CONSOLE_RECORD |
528 | if (gd && (gd->flags & GD_FLG_RECORD) && gd->console_out.start) | |
529 | membuff_put(&gd->console_out, s, strlen(s)); | |
530 | #endif | |
a6cccaea WD |
531 | #ifdef CONFIG_SILENT_CONSOLE |
532 | if (gd->flags & GD_FLG_SILENT) | |
533 | return; | |
534 | #endif | |
535 | ||
f5c3ba79 MJ |
536 | #ifdef CONFIG_DISABLE_CONSOLE |
537 | if (gd->flags & GD_FLG_DISABLE_CONSOLE) | |
538 | return; | |
539 | #endif | |
540 | ||
e3e454cd | 541 | if (!gd->have_console) |
9558b48a | 542 | return pre_console_puts(s); |
e3e454cd | 543 | |
47d1a6e1 WD |
544 | if (gd->flags & GD_FLG_DEVINIT) { |
545 | /* Send to the standard output */ | |
ec6f1499 | 546 | fputs(stdout, s); |
47d1a6e1 WD |
547 | } else { |
548 | /* Send directly to the handler */ | |
27669667 | 549 | pre_console_puts(s); |
ec6f1499 | 550 | serial_puts(s); |
47d1a6e1 WD |
551 | } |
552 | } | |
553 | ||
9854a874 SG |
554 | #ifdef CONFIG_CONSOLE_RECORD |
555 | int console_record_init(void) | |
556 | { | |
557 | int ret; | |
558 | ||
559 | ret = membuff_new(&gd->console_out, CONFIG_CONSOLE_RECORD_OUT_SIZE); | |
560 | if (ret) | |
561 | return ret; | |
562 | ret = membuff_new(&gd->console_in, CONFIG_CONSOLE_RECORD_IN_SIZE); | |
563 | ||
564 | return ret; | |
565 | } | |
566 | ||
567 | void console_record_reset(void) | |
568 | { | |
569 | membuff_purge(&gd->console_out); | |
570 | membuff_purge(&gd->console_in); | |
571 | } | |
572 | ||
573 | void console_record_reset_enable(void) | |
574 | { | |
575 | console_record_reset(); | |
576 | gd->flags |= GD_FLG_RECORD; | |
577 | } | |
578 | #endif | |
579 | ||
47d1a6e1 WD |
580 | /* test if ctrl-c was pressed */ |
581 | static int ctrlc_disabled = 0; /* see disable_ctrl() */ | |
582 | static int ctrlc_was_pressed = 0; | |
ec6f1499 | 583 | int ctrlc(void) |
47d1a6e1 | 584 | { |
8969ea3e | 585 | #ifndef CONFIG_SANDBOX |
47d1a6e1 | 586 | if (!ctrlc_disabled && gd->have_console) { |
ec6f1499 JCPV |
587 | if (tstc()) { |
588 | switch (getc()) { | |
47d1a6e1 WD |
589 | case 0x03: /* ^C - Control C */ |
590 | ctrlc_was_pressed = 1; | |
591 | return 1; | |
592 | default: | |
593 | break; | |
594 | } | |
595 | } | |
596 | } | |
8969ea3e SG |
597 | #endif |
598 | ||
47d1a6e1 WD |
599 | return 0; |
600 | } | |
a5dffa4b PA |
601 | /* Reads user's confirmation. |
602 | Returns 1 if user's input is "y", "Y", "yes" or "YES" | |
603 | */ | |
604 | int confirm_yesno(void) | |
605 | { | |
606 | int i; | |
607 | char str_input[5]; | |
608 | ||
609 | /* Flush input */ | |
610 | while (tstc()) | |
611 | getc(); | |
612 | i = 0; | |
613 | while (i < sizeof(str_input)) { | |
614 | str_input[i] = getc(); | |
615 | putc(str_input[i]); | |
616 | if (str_input[i] == '\r') | |
617 | break; | |
618 | i++; | |
619 | } | |
620 | putc('\n'); | |
621 | if (strncmp(str_input, "y\r", 2) == 0 || | |
622 | strncmp(str_input, "Y\r", 2) == 0 || | |
623 | strncmp(str_input, "yes\r", 4) == 0 || | |
624 | strncmp(str_input, "YES\r", 4) == 0) | |
625 | return 1; | |
626 | return 0; | |
627 | } | |
47d1a6e1 WD |
628 | /* pass 1 to disable ctrlc() checking, 0 to enable. |
629 | * returns previous state | |
630 | */ | |
ec6f1499 | 631 | int disable_ctrlc(int disable) |
47d1a6e1 WD |
632 | { |
633 | int prev = ctrlc_disabled; /* save previous state */ | |
634 | ||
635 | ctrlc_disabled = disable; | |
636 | return prev; | |
637 | } | |
638 | ||
639 | int had_ctrlc (void) | |
640 | { | |
641 | return ctrlc_was_pressed; | |
642 | } | |
643 | ||
ec6f1499 | 644 | void clear_ctrlc(void) |
47d1a6e1 WD |
645 | { |
646 | ctrlc_was_pressed = 0; | |
647 | } | |
648 | ||
47d1a6e1 WD |
649 | /** U-Boot INIT FUNCTIONS *************************************************/ |
650 | ||
d7be3056 | 651 | struct stdio_dev *search_device(int flags, const char *name) |
c1de7a6d | 652 | { |
52cb4d4f | 653 | struct stdio_dev *dev; |
c1de7a6d | 654 | |
52cb4d4f | 655 | dev = stdio_get_by_name(name); |
a2931b30 SG |
656 | #ifdef CONFIG_VIDCONSOLE_AS_LCD |
657 | if (!dev && !strcmp(name, "lcd")) | |
658 | dev = stdio_get_by_name("vidconsole"); | |
659 | #endif | |
c1de7a6d | 660 | |
ec6f1499 | 661 | if (dev && (dev->flags & flags)) |
c1de7a6d JCPV |
662 | return dev; |
663 | ||
664 | return NULL; | |
665 | } | |
666 | ||
d7be3056 | 667 | int console_assign(int file, const char *devname) |
47d1a6e1 | 668 | { |
c1de7a6d | 669 | int flag; |
52cb4d4f | 670 | struct stdio_dev *dev; |
47d1a6e1 WD |
671 | |
672 | /* Check for valid file */ | |
673 | switch (file) { | |
674 | case stdin: | |
675 | flag = DEV_FLAGS_INPUT; | |
676 | break; | |
677 | case stdout: | |
678 | case stderr: | |
679 | flag = DEV_FLAGS_OUTPUT; | |
680 | break; | |
681 | default: | |
682 | return -1; | |
683 | } | |
684 | ||
685 | /* Check for valid device name */ | |
686 | ||
c1de7a6d | 687 | dev = search_device(flag, devname); |
47d1a6e1 | 688 | |
ec6f1499 JCPV |
689 | if (dev) |
690 | return console_setfile(file, dev); | |
47d1a6e1 WD |
691 | |
692 | return -1; | |
693 | } | |
694 | ||
43e0a3de | 695 | static void console_update_silent(void) |
47d1a6e1 | 696 | { |
f72da340 WD |
697 | #ifdef CONFIG_SILENT_CONSOLE |
698 | if (getenv("silent") != NULL) | |
699 | gd->flags |= GD_FLG_SILENT; | |
43e0a3de CP |
700 | else |
701 | gd->flags &= ~GD_FLG_SILENT; | |
f72da340 | 702 | #endif |
43e0a3de CP |
703 | } |
704 | ||
b0895384 SG |
705 | int console_announce_r(void) |
706 | { | |
707 | #if !CONFIG_IS_ENABLED(PRE_CONSOLE_BUFFER) | |
708 | char buf[DISPLAY_OPTIONS_BANNER_LENGTH]; | |
709 | ||
710 | display_options_get_banner(false, buf, sizeof(buf)); | |
711 | ||
712 | console_puts_noserial(stdout, buf); | |
713 | #endif | |
714 | ||
715 | return 0; | |
716 | } | |
717 | ||
43e0a3de CP |
718 | /* Called before relocation - use serial functions */ |
719 | int console_init_f(void) | |
720 | { | |
721 | gd->have_console = 1; | |
722 | ||
723 | console_update_silent(); | |
f72da340 | 724 | |
27669667 | 725 | print_pre_console_buffer(PRE_CONSOLE_FLUSHPOINT1_SERIAL); |
9558b48a | 726 | |
ec6f1499 | 727 | return 0; |
47d1a6e1 WD |
728 | } |
729 | ||
7e3be7cf JCPV |
730 | void stdio_print_current_devices(void) |
731 | { | |
7e3be7cf JCPV |
732 | /* Print information */ |
733 | puts("In: "); | |
734 | if (stdio_devices[stdin] == NULL) { | |
735 | puts("No input devices available!\n"); | |
736 | } else { | |
737 | printf ("%s\n", stdio_devices[stdin]->name); | |
738 | } | |
739 | ||
740 | puts("Out: "); | |
741 | if (stdio_devices[stdout] == NULL) { | |
742 | puts("No output devices available!\n"); | |
743 | } else { | |
744 | printf ("%s\n", stdio_devices[stdout]->name); | |
745 | } | |
746 | ||
747 | puts("Err: "); | |
748 | if (stdio_devices[stderr] == NULL) { | |
749 | puts("No error devices available!\n"); | |
750 | } else { | |
751 | printf ("%s\n", stdio_devices[stderr]->name); | |
752 | } | |
7e3be7cf JCPV |
753 | } |
754 | ||
b0265429 | 755 | #if CONFIG_IS_ENABLED(SYS_CONSOLE_IS_IN_ENV) |
47d1a6e1 | 756 | /* Called after the relocation - use desired console functions */ |
ec6f1499 | 757 | int console_init_r(void) |
47d1a6e1 WD |
758 | { |
759 | char *stdinname, *stdoutname, *stderrname; | |
52cb4d4f | 760 | struct stdio_dev *inputdev = NULL, *outputdev = NULL, *errdev = NULL; |
6d0f6bcf | 761 | #ifdef CONFIG_SYS_CONSOLE_ENV_OVERWRITE |
6e592385 | 762 | int i; |
6d0f6bcf | 763 | #endif /* CONFIG_SYS_CONSOLE_ENV_OVERWRITE */ |
b0265429 | 764 | #if CONFIG_IS_ENABLED(CONSOLE_MUX) |
16a28ef2 GJ |
765 | int iomux_err = 0; |
766 | #endif | |
47d1a6e1 WD |
767 | |
768 | /* set default handlers at first */ | |
49cad547 MD |
769 | gd->jt->getc = serial_getc; |
770 | gd->jt->tstc = serial_tstc; | |
771 | gd->jt->putc = serial_putc; | |
772 | gd->jt->puts = serial_puts; | |
773 | gd->jt->printf = serial_printf; | |
47d1a6e1 WD |
774 | |
775 | /* stdin stdout and stderr are in environment */ | |
776 | /* scan for it */ | |
ec6f1499 JCPV |
777 | stdinname = getenv("stdin"); |
778 | stdoutname = getenv("stdout"); | |
779 | stderrname = getenv("stderr"); | |
47d1a6e1 | 780 | |
53677ef1 | 781 | if (OVERWRITE_CONSOLE == 0) { /* if not overwritten by config switch */ |
ec6f1499 JCPV |
782 | inputdev = search_device(DEV_FLAGS_INPUT, stdinname); |
783 | outputdev = search_device(DEV_FLAGS_OUTPUT, stdoutname); | |
784 | errdev = search_device(DEV_FLAGS_OUTPUT, stderrname); | |
b0265429 | 785 | #if CONFIG_IS_ENABLED(CONSOLE_MUX) |
16a28ef2 GJ |
786 | iomux_err = iomux_doenv(stdin, stdinname); |
787 | iomux_err += iomux_doenv(stdout, stdoutname); | |
788 | iomux_err += iomux_doenv(stderr, stderrname); | |
789 | if (!iomux_err) | |
790 | /* Successful, so skip all the code below. */ | |
791 | goto done; | |
792 | #endif | |
47d1a6e1 WD |
793 | } |
794 | /* if the devices are overwritten or not found, use default device */ | |
795 | if (inputdev == NULL) { | |
ec6f1499 | 796 | inputdev = search_device(DEV_FLAGS_INPUT, "serial"); |
47d1a6e1 WD |
797 | } |
798 | if (outputdev == NULL) { | |
ec6f1499 | 799 | outputdev = search_device(DEV_FLAGS_OUTPUT, "serial"); |
47d1a6e1 WD |
800 | } |
801 | if (errdev == NULL) { | |
ec6f1499 | 802 | errdev = search_device(DEV_FLAGS_OUTPUT, "serial"); |
47d1a6e1 WD |
803 | } |
804 | /* Initializes output console first */ | |
805 | if (outputdev != NULL) { | |
16a28ef2 | 806 | /* need to set a console if not done above. */ |
5f032010 | 807 | console_doenv(stdout, outputdev); |
47d1a6e1 WD |
808 | } |
809 | if (errdev != NULL) { | |
16a28ef2 | 810 | /* need to set a console if not done above. */ |
5f032010 | 811 | console_doenv(stderr, errdev); |
47d1a6e1 WD |
812 | } |
813 | if (inputdev != NULL) { | |
16a28ef2 | 814 | /* need to set a console if not done above. */ |
5f032010 | 815 | console_doenv(stdin, inputdev); |
47d1a6e1 WD |
816 | } |
817 | ||
b0265429 | 818 | #if CONFIG_IS_ENABLED(CONSOLE_MUX) |
16a28ef2 GJ |
819 | done: |
820 | #endif | |
821 | ||
78c112c9 | 822 | #ifndef CONFIG_SYS_CONSOLE_INFO_QUIET |
7e3be7cf | 823 | stdio_print_current_devices(); |
78c112c9 | 824 | #endif /* CONFIG_SYS_CONSOLE_INFO_QUIET */ |
a2931b30 SG |
825 | #ifdef CONFIG_VIDCONSOLE_AS_LCD |
826 | if (strstr(stdoutname, "lcd")) | |
827 | printf("Warning: Please change 'lcd' to 'vidconsole' in stdout/stderr environment vars\n"); | |
828 | #endif | |
47d1a6e1 | 829 | |
6d0f6bcf | 830 | #ifdef CONFIG_SYS_CONSOLE_ENV_OVERWRITE |
47d1a6e1 WD |
831 | /* set the environment variables (will overwrite previous env settings) */ |
832 | for (i = 0; i < 3; i++) { | |
ec6f1499 | 833 | setenv(stdio_names[i], stdio_devices[i]->name); |
47d1a6e1 | 834 | } |
6d0f6bcf | 835 | #endif /* CONFIG_SYS_CONSOLE_ENV_OVERWRITE */ |
47d1a6e1 | 836 | |
c4e0057f JH |
837 | gd->flags |= GD_FLG_DEVINIT; /* device initialization completed */ |
838 | ||
47d1a6e1 WD |
839 | #if 0 |
840 | /* If nothing usable installed, use only the initial console */ | |
841 | if ((stdio_devices[stdin] == NULL) && (stdio_devices[stdout] == NULL)) | |
ec6f1499 | 842 | return 0; |
47d1a6e1 | 843 | #endif |
27669667 | 844 | print_pre_console_buffer(PRE_CONSOLE_FLUSHPOINT2_EVERYTHING_BUT_SERIAL); |
ec6f1499 | 845 | return 0; |
47d1a6e1 WD |
846 | } |
847 | ||
b0265429 | 848 | #else /* !CONFIG_IS_ENABLED(SYS_CONSOLE_IS_IN_ENV) */ |
47d1a6e1 WD |
849 | |
850 | /* Called after the relocation - use desired console functions */ | |
ec6f1499 | 851 | int console_init_r(void) |
47d1a6e1 | 852 | { |
52cb4d4f | 853 | struct stdio_dev *inputdev = NULL, *outputdev = NULL; |
c1de7a6d | 854 | int i; |
52cb4d4f | 855 | struct list_head *list = stdio_get_list(); |
c1de7a6d | 856 | struct list_head *pos; |
52cb4d4f | 857 | struct stdio_dev *dev; |
47d1a6e1 | 858 | |
43e0a3de CP |
859 | console_update_silent(); |
860 | ||
d791b1dc | 861 | #ifdef CONFIG_SPLASH_SCREEN |
ec6f1499 JCPV |
862 | /* |
863 | * suppress all output if splash screen is enabled and we have | |
a7490816 AG |
864 | * a bmp to display. We redirect the output from frame buffer |
865 | * console to serial console in this case or suppress it if | |
866 | * "silent" mode was requested. | |
ec6f1499 | 867 | */ |
a7490816 AG |
868 | if (getenv("splashimage") != NULL) { |
869 | if (!(gd->flags & GD_FLG_SILENT)) | |
870 | outputdev = search_device (DEV_FLAGS_OUTPUT, "serial"); | |
871 | } | |
f72da340 WD |
872 | #endif |
873 | ||
47d1a6e1 | 874 | /* Scan devices looking for input and output devices */ |
c1de7a6d | 875 | list_for_each(pos, list) { |
52cb4d4f | 876 | dev = list_entry(pos, struct stdio_dev, list); |
47d1a6e1 WD |
877 | |
878 | if ((dev->flags & DEV_FLAGS_INPUT) && (inputdev == NULL)) { | |
879 | inputdev = dev; | |
880 | } | |
881 | if ((dev->flags & DEV_FLAGS_OUTPUT) && (outputdev == NULL)) { | |
882 | outputdev = dev; | |
883 | } | |
c1de7a6d JCPV |
884 | if(inputdev && outputdev) |
885 | break; | |
47d1a6e1 WD |
886 | } |
887 | ||
888 | /* Initializes output console first */ | |
889 | if (outputdev != NULL) { | |
ec6f1499 JCPV |
890 | console_setfile(stdout, outputdev); |
891 | console_setfile(stderr, outputdev); | |
b0265429 | 892 | #if CONFIG_IS_ENABLED(CONSOLE_MUX) |
16a28ef2 GJ |
893 | console_devices[stdout][0] = outputdev; |
894 | console_devices[stderr][0] = outputdev; | |
895 | #endif | |
47d1a6e1 WD |
896 | } |
897 | ||
898 | /* Initializes input console */ | |
899 | if (inputdev != NULL) { | |
ec6f1499 | 900 | console_setfile(stdin, inputdev); |
b0265429 | 901 | #if CONFIG_IS_ENABLED(CONSOLE_MUX) |
16a28ef2 GJ |
902 | console_devices[stdin][0] = inputdev; |
903 | #endif | |
47d1a6e1 WD |
904 | } |
905 | ||
78c112c9 | 906 | #ifndef CONFIG_SYS_CONSOLE_INFO_QUIET |
7e3be7cf | 907 | stdio_print_current_devices(); |
78c112c9 | 908 | #endif /* CONFIG_SYS_CONSOLE_INFO_QUIET */ |
47d1a6e1 WD |
909 | |
910 | /* Setting environment variables */ | |
911 | for (i = 0; i < 3; i++) { | |
ec6f1499 | 912 | setenv(stdio_names[i], stdio_devices[i]->name); |
47d1a6e1 WD |
913 | } |
914 | ||
c4e0057f JH |
915 | gd->flags |= GD_FLG_DEVINIT; /* device initialization completed */ |
916 | ||
47d1a6e1 WD |
917 | #if 0 |
918 | /* If nothing usable installed, use only the initial console */ | |
919 | if ((stdio_devices[stdin] == NULL) && (stdio_devices[stdout] == NULL)) | |
ec6f1499 | 920 | return 0; |
47d1a6e1 | 921 | #endif |
27669667 | 922 | print_pre_console_buffer(PRE_CONSOLE_FLUSHPOINT2_EVERYTHING_BUT_SERIAL); |
ec6f1499 | 923 | return 0; |
47d1a6e1 WD |
924 | } |
925 | ||
b0265429 | 926 | #endif /* CONFIG_IS_ENABLED(SYS_CONSOLE_IS_IN_ENV) */ |