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