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