xref: /openbmc/u-boot/common/console.c (revision 28522678)
1 /*
2  * (C) Copyright 2000
3  * Paolo Scaffardi, AIRVENT SAM s.p.a - RIMINI(ITALY), arsenio@tin.it
4  *
5  * SPDX-License-Identifier:	GPL-2.0+
6  */
7 
8 #include <common.h>
9 #include <console.h>
10 #include <debug_uart.h>
11 #include <stdarg.h>
12 #include <iomux.h>
13 #include <malloc.h>
14 #include <os.h>
15 #include <serial.h>
16 #include <stdio_dev.h>
17 #include <exports.h>
18 #include <environment.h>
19 #include <watchdog.h>
20 
21 DECLARE_GLOBAL_DATA_PTR;
22 
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 #if CONFIG_IS_ENABLED(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
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 
65 #ifdef CONFIG_SILENT_CONSOLE
66 static int on_silent(const char *name, const char *value, enum env_op op,
67 	int flags)
68 {
69 #if !CONFIG_IS_ENABLED(CONFIG_SILENT_CONSOLE_UPDATE_ON_SET)
70 	if (flags & H_INTERACTIVE)
71 		return 0;
72 #endif
73 #if !CONFIG_IS_ENABLED(CONFIG_SILENT_CONSOLE_UPDATE_ON_RELOC)
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 
88 #if CONFIG_IS_ENABLED(SYS_CONSOLE_IS_IN_ENV)
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  */
94 #ifdef CONFIG_SYS_CONSOLE_OVERWRITE_ROUTINE
95 extern int overwrite_console(void);
96 #define OVERWRITE_CONSOLE overwrite_console()
97 #else
98 #define OVERWRITE_CONSOLE 0
99 #endif /* CONFIG_SYS_CONSOLE_OVERWRITE_ROUTINE */
100 
101 #endif /* CONFIG_IS_ENABLED(SYS_CONSOLE_IS_IN_ENV) */
102 
103 static int console_setfile(int file, struct stdio_dev * dev)
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) {
116 			error = dev->start(dev);
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:
131 			gd->jt->getc = getc;
132 			gd->jt->tstc = tstc;
133 			break;
134 		case stdout:
135 			gd->jt->putc  = putc;
136 			gd->jt->puts  = puts;
137 			gd->jt->printf = printf;
138 			break;
139 		}
140 		break;
141 
142 	default:		/* Invalid file ID */
143 		error = -1;
144 	}
145 	return error;
146 }
147 
148 #if CONFIG_IS_ENABLED(CONSOLE_MUX)
149 /** Console I/O multiplexing *******************************************/
150 
151 static struct stdio_dev *tstcdev;
152 struct stdio_dev **console_devices[MAX_FILES];
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  */
161 static int console_getc(int file)
162 {
163 	unsigned char ret;
164 
165 	/* This is never called with testcdev == NULL */
166 	ret = tstcdev->getc(tstcdev);
167 	tstcdev = NULL;
168 	return ret;
169 }
170 
171 static int console_tstc(int file)
172 {
173 	int i, ret;
174 	struct stdio_dev *dev;
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) {
180 			ret = dev->tstc(dev);
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 
193 static void console_putc(int file, const char c)
194 {
195 	int i;
196 	struct stdio_dev *dev;
197 
198 	for (i = 0; i < cd_count[file]; i++) {
199 		dev = console_devices[file][i];
200 		if (dev->putc != NULL)
201 			dev->putc(dev, c);
202 	}
203 }
204 
205 #if CONFIG_IS_ENABLED(PRE_CONSOLE_BUFFER)
206 static void console_puts_noserial(int file, const char *s)
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];
213 		if (dev->puts != NULL && strcmp(dev->name, "serial") != 0)
214 			dev->puts(dev, s);
215 	}
216 }
217 #endif
218 
219 static void console_puts(int file, const char *s)
220 {
221 	int i;
222 	struct stdio_dev *dev;
223 
224 	for (i = 0; i < cd_count[file]; i++) {
225 		dev = console_devices[file][i];
226 		if (dev->puts != NULL)
227 			dev->puts(dev, s);
228 	}
229 }
230 
231 static inline void console_doenv(int file, struct stdio_dev *dev)
232 {
233 	iomux_doenv(file, dev->name);
234 }
235 #else
236 static inline int console_getc(int file)
237 {
238 	return stdio_devices[file]->getc(stdio_devices[file]);
239 }
240 
241 static inline int console_tstc(int file)
242 {
243 	return stdio_devices[file]->tstc(stdio_devices[file]);
244 }
245 
246 static inline void console_putc(int file, const char c)
247 {
248 	stdio_devices[file]->putc(stdio_devices[file], c);
249 }
250 
251 #if CONFIG_IS_ENABLED(PRE_CONSOLE_BUFFER)
252 static inline void console_puts_noserial(int file, const char *s)
253 {
254 	if (strcmp(stdio_devices[file]->name, "serial") != 0)
255 		stdio_devices[file]->puts(stdio_devices[file], s);
256 }
257 #endif
258 
259 static inline void console_puts(int file, const char *s)
260 {
261 	stdio_devices[file]->puts(stdio_devices[file], s);
262 }
263 
264 static inline void console_doenv(int file, struct stdio_dev *dev)
265 {
266 	console_setfile(file, dev);
267 }
268 #endif /* CONIFIG_IS_ENABLED(CONSOLE_MUX) */
269 
270 /** U-Boot INITIAL CONSOLE-NOT COMPATIBLE FUNCTIONS *************************/
271 
272 int serial_printf(const char *fmt, ...)
273 {
274 	va_list args;
275 	uint i;
276 	char printbuffer[CONFIG_SYS_PBSIZE];
277 
278 	va_start(args, fmt);
279 
280 	/* For this to work, printbuffer must be larger than
281 	 * anything we ever want to print.
282 	 */
283 	i = vscnprintf(printbuffer, sizeof(printbuffer), fmt, args);
284 	va_end(args);
285 
286 	serial_puts(printbuffer);
287 	return i;
288 }
289 
290 int fgetc(int file)
291 {
292 	if (file < MAX_FILES) {
293 #if CONFIG_IS_ENABLED(CONSOLE_MUX)
294 		/*
295 		 * Effectively poll for input wherever it may be available.
296 		 */
297 		for (;;) {
298 			WATCHDOG_RESET();
299 			/*
300 			 * Upper layer may have already called tstc() so
301 			 * check for that first.
302 			 */
303 			if (tstcdev != NULL)
304 				return console_getc(file);
305 			console_tstc(file);
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
315 		return console_getc(file);
316 #endif
317 	}
318 
319 	return -1;
320 }
321 
322 int ftstc(int file)
323 {
324 	if (file < MAX_FILES)
325 		return console_tstc(file);
326 
327 	return -1;
328 }
329 
330 void fputc(int file, const char c)
331 {
332 	if (file < MAX_FILES)
333 		console_putc(file, c);
334 }
335 
336 void fputs(int file, const char *s)
337 {
338 	if (file < MAX_FILES)
339 		console_puts(file, s);
340 }
341 
342 int fprintf(int file, const char *fmt, ...)
343 {
344 	va_list args;
345 	uint i;
346 	char printbuffer[CONFIG_SYS_PBSIZE];
347 
348 	va_start(args, fmt);
349 
350 	/* For this to work, printbuffer must be larger than
351 	 * anything we ever want to print.
352 	 */
353 	i = vscnprintf(printbuffer, sizeof(printbuffer), fmt, args);
354 	va_end(args);
355 
356 	/* Send to desired file */
357 	fputs(file, printbuffer);
358 	return i;
359 }
360 
361 /** U-Boot INITIAL CONSOLE-COMPATIBLE FUNCTION *****************************/
362 
363 int getc(void)
364 {
365 #ifdef CONFIG_DISABLE_CONSOLE
366 	if (gd->flags & GD_FLG_DISABLE_CONSOLE)
367 		return 0;
368 #endif
369 
370 	if (!gd->have_console)
371 		return 0;
372 
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
382 	if (gd->flags & GD_FLG_DEVINIT) {
383 		/* Get from the standard input */
384 		return fgetc(stdin);
385 	}
386 
387 	/* Send directly to the handler */
388 	return serial_getc();
389 }
390 
391 int tstc(void)
392 {
393 #ifdef CONFIG_DISABLE_CONSOLE
394 	if (gd->flags & GD_FLG_DISABLE_CONSOLE)
395 		return 0;
396 #endif
397 
398 	if (!gd->have_console)
399 		return 0;
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
406 	if (gd->flags & GD_FLG_DEVINIT) {
407 		/* Test the standard input */
408 		return ftstc(stdin);
409 	}
410 
411 	/* Send directly to the handler */
412 	return serial_tstc();
413 }
414 
415 #define PRE_CONSOLE_FLUSHPOINT1_SERIAL			0
416 #define PRE_CONSOLE_FLUSHPOINT2_EVERYTHING_BUT_SERIAL	1
417 
418 #if CONFIG_IS_ENABLED(PRE_CONSOLE_BUFFER)
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 
434 static void print_pre_console_buffer(int flushpoint)
435 {
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];
439 
440 	if (gd->precon_buf_idx > CONFIG_PRE_CON_BUF_SZ)
441 		in = gd->precon_buf_idx - CONFIG_PRE_CON_BUF_SZ;
442 
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 	}
456 }
457 #else
458 static inline void pre_console_putc(const char c) {}
459 static inline void pre_console_puts(const char *s) {}
460 static inline void print_pre_console_buffer(int flushpoint) {}
461 #endif
462 
463 void putc(const char c)
464 {
465 #ifdef CONFIG_SANDBOX
466 	/* sandbox can send characters to stdout before it has a console */
467 	if (!gd || !(gd->flags & GD_FLG_SERIAL_READY)) {
468 		os_putc(c);
469 		return;
470 	}
471 #endif
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
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
483 #ifdef CONFIG_SILENT_CONSOLE
484 	if (gd->flags & GD_FLG_SILENT)
485 		return;
486 #endif
487 
488 #ifdef CONFIG_DISABLE_CONSOLE
489 	if (gd->flags & GD_FLG_DISABLE_CONSOLE)
490 		return;
491 #endif
492 
493 	if (!gd->have_console)
494 		return pre_console_putc(c);
495 
496 	if (gd->flags & GD_FLG_DEVINIT) {
497 		/* Send to the standard output */
498 		fputc(stdout, c);
499 	} else {
500 		/* Send directly to the handler */
501 		pre_console_putc(c);
502 		serial_putc(c);
503 	}
504 }
505 
506 void puts(const char *s)
507 {
508 #ifdef CONFIG_SANDBOX
509 	if (!gd || !(gd->flags & GD_FLG_SERIAL_READY)) {
510 		os_puts(s);
511 		return;
512 	}
513 #endif
514 #ifdef CONFIG_DEBUG_UART
515 	if (!gd || !(gd->flags & GD_FLG_SERIAL_READY)) {
516 		while (*s) {
517 			int ch = *s++;
518 
519 			printch(ch);
520 		}
521 		return;
522 	}
523 #endif
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
528 #ifdef CONFIG_SILENT_CONSOLE
529 	if (gd->flags & GD_FLG_SILENT)
530 		return;
531 #endif
532 
533 #ifdef CONFIG_DISABLE_CONSOLE
534 	if (gd->flags & GD_FLG_DISABLE_CONSOLE)
535 		return;
536 #endif
537 
538 	if (!gd->have_console)
539 		return pre_console_puts(s);
540 
541 	if (gd->flags & GD_FLG_DEVINIT) {
542 		/* Send to the standard output */
543 		fputs(stdout, s);
544 	} else {
545 		/* Send directly to the handler */
546 		pre_console_puts(s);
547 		serial_puts(s);
548 	}
549 }
550 
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 
577 /* test if ctrl-c was pressed */
578 static int ctrlc_disabled = 0;	/* see disable_ctrl() */
579 static int ctrlc_was_pressed = 0;
580 int ctrlc(void)
581 {
582 #ifndef CONFIG_SANDBOX
583 	if (!ctrlc_disabled && gd->have_console) {
584 		if (tstc()) {
585 			switch (getc()) {
586 			case 0x03:		/* ^C - Control C */
587 				ctrlc_was_pressed = 1;
588 				return 1;
589 			default:
590 				break;
591 			}
592 		}
593 	}
594 #endif
595 
596 	return 0;
597 }
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 }
625 /* pass 1 to disable ctrlc() checking, 0 to enable.
626  * returns previous state
627  */
628 int disable_ctrlc(int disable)
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 
641 void clear_ctrlc(void)
642 {
643 	ctrlc_was_pressed = 0;
644 }
645 
646 /** U-Boot INIT FUNCTIONS *************************************************/
647 
648 struct stdio_dev *search_device(int flags, const char *name)
649 {
650 	struct stdio_dev *dev;
651 
652 	dev = stdio_get_by_name(name);
653 #ifdef CONFIG_VIDCONSOLE_AS_LCD
654 	if (!dev && !strcmp(name, "lcd"))
655 		dev = stdio_get_by_name("vidconsole");
656 #endif
657 
658 	if (dev && (dev->flags & flags))
659 		return dev;
660 
661 	return NULL;
662 }
663 
664 int console_assign(int file, const char *devname)
665 {
666 	int flag;
667 	struct stdio_dev *dev;
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 
684 	dev = search_device(flag, devname);
685 
686 	if (dev)
687 		return console_setfile(file, dev);
688 
689 	return -1;
690 }
691 
692 static void console_update_silent(void)
693 {
694 #ifdef CONFIG_SILENT_CONSOLE
695 	if (getenv("silent") != NULL)
696 		gd->flags |= GD_FLG_SILENT;
697 	else
698 		gd->flags &= ~GD_FLG_SILENT;
699 #endif
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();
708 
709 	print_pre_console_buffer(PRE_CONSOLE_FLUSHPOINT1_SERIAL);
710 
711 	return 0;
712 }
713 
714 void stdio_print_current_devices(void)
715 {
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 	}
737 }
738 
739 #if CONFIG_IS_ENABLED(SYS_CONSOLE_IS_IN_ENV)
740 /* Called after the relocation - use desired console functions */
741 int console_init_r(void)
742 {
743 	char *stdinname, *stdoutname, *stderrname;
744 	struct stdio_dev *inputdev = NULL, *outputdev = NULL, *errdev = NULL;
745 #ifdef CONFIG_SYS_CONSOLE_ENV_OVERWRITE
746 	int i;
747 #endif /* CONFIG_SYS_CONSOLE_ENV_OVERWRITE */
748 #if CONFIG_IS_ENABLED(CONSOLE_MUX)
749 	int iomux_err = 0;
750 #endif
751 
752 	/* set default handlers at first */
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;
758 
759 	/* stdin stdout and stderr are in environment */
760 	/* scan for it */
761 	stdinname  = getenv("stdin");
762 	stdoutname = getenv("stdout");
763 	stderrname = getenv("stderr");
764 
765 	if (OVERWRITE_CONSOLE == 0) {	/* if not overwritten by config switch */
766 		inputdev  = search_device(DEV_FLAGS_INPUT,  stdinname);
767 		outputdev = search_device(DEV_FLAGS_OUTPUT, stdoutname);
768 		errdev    = search_device(DEV_FLAGS_OUTPUT, stderrname);
769 #if CONFIG_IS_ENABLED(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
777 	}
778 	/* if the devices are overwritten or not found, use default device */
779 	if (inputdev == NULL) {
780 		inputdev  = search_device(DEV_FLAGS_INPUT,  "serial");
781 	}
782 	if (outputdev == NULL) {
783 		outputdev = search_device(DEV_FLAGS_OUTPUT, "serial");
784 	}
785 	if (errdev == NULL) {
786 		errdev    = search_device(DEV_FLAGS_OUTPUT, "serial");
787 	}
788 	/* Initializes output console first */
789 	if (outputdev != NULL) {
790 		/* need to set a console if not done above. */
791 		console_doenv(stdout, outputdev);
792 	}
793 	if (errdev != NULL) {
794 		/* need to set a console if not done above. */
795 		console_doenv(stderr, errdev);
796 	}
797 	if (inputdev != NULL) {
798 		/* need to set a console if not done above. */
799 		console_doenv(stdin, inputdev);
800 	}
801 
802 #if CONFIG_IS_ENABLED(CONSOLE_MUX)
803 done:
804 #endif
805 
806 #ifndef CONFIG_SYS_CONSOLE_INFO_QUIET
807 	stdio_print_current_devices();
808 #endif /* CONFIG_SYS_CONSOLE_INFO_QUIET */
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
813 
814 #ifdef CONFIG_SYS_CONSOLE_ENV_OVERWRITE
815 	/* set the environment variables (will overwrite previous env settings) */
816 	for (i = 0; i < 3; i++) {
817 		setenv(stdio_names[i], stdio_devices[i]->name);
818 	}
819 #endif /* CONFIG_SYS_CONSOLE_ENV_OVERWRITE */
820 
821 	gd->flags |= GD_FLG_DEVINIT;	/* device initialization completed */
822 
823 #if 0
824 	/* If nothing usable installed, use only the initial console */
825 	if ((stdio_devices[stdin] == NULL) && (stdio_devices[stdout] == NULL))
826 		return 0;
827 #endif
828 	print_pre_console_buffer(PRE_CONSOLE_FLUSHPOINT2_EVERYTHING_BUT_SERIAL);
829 	return 0;
830 }
831 
832 #else /* !CONFIG_IS_ENABLED(SYS_CONSOLE_IS_IN_ENV) */
833 
834 /* Called after the relocation - use desired console functions */
835 int console_init_r(void)
836 {
837 	struct stdio_dev *inputdev = NULL, *outputdev = NULL;
838 	int i;
839 	struct list_head *list = stdio_get_list();
840 	struct list_head *pos;
841 	struct stdio_dev *dev;
842 
843 	console_update_silent();
844 
845 #ifdef CONFIG_SPLASH_SCREEN
846 	/*
847 	 * suppress all output if splash screen is enabled and we have
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.
851 	 */
852 	if (getenv("splashimage") != NULL) {
853 		if (!(gd->flags & GD_FLG_SILENT))
854 			outputdev = search_device (DEV_FLAGS_OUTPUT, "serial");
855 	}
856 #endif
857 
858 	/* Scan devices looking for input and output devices */
859 	list_for_each(pos, list) {
860 		dev = list_entry(pos, struct stdio_dev, list);
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 		}
868 		if(inputdev && outputdev)
869 			break;
870 	}
871 
872 	/* Initializes output console first */
873 	if (outputdev != NULL) {
874 		console_setfile(stdout, outputdev);
875 		console_setfile(stderr, outputdev);
876 #if CONFIG_IS_ENABLED(CONSOLE_MUX)
877 		console_devices[stdout][0] = outputdev;
878 		console_devices[stderr][0] = outputdev;
879 #endif
880 	}
881 
882 	/* Initializes input console */
883 	if (inputdev != NULL) {
884 		console_setfile(stdin, inputdev);
885 #if CONFIG_IS_ENABLED(CONSOLE_MUX)
886 		console_devices[stdin][0] = inputdev;
887 #endif
888 	}
889 
890 #ifndef CONFIG_SYS_CONSOLE_INFO_QUIET
891 	stdio_print_current_devices();
892 #endif /* CONFIG_SYS_CONSOLE_INFO_QUIET */
893 
894 	/* Setting environment variables */
895 	for (i = 0; i < 3; i++) {
896 		setenv(stdio_names[i], stdio_devices[i]->name);
897 	}
898 
899 	gd->flags |= GD_FLG_DEVINIT;	/* device initialization completed */
900 
901 #if 0
902 	/* If nothing usable installed, use only the initial console */
903 	if ((stdio_devices[stdin] == NULL) && (stdio_devices[stdout] == NULL))
904 		return 0;
905 #endif
906 	print_pre_console_buffer(PRE_CONSOLE_FLUSHPOINT2_EVERYTHING_BUT_SERIAL);
907 	return 0;
908 }
909 
910 #endif /* CONFIG_IS_ENABLED(SYS_CONSOLE_IS_IN_ENV) */
911