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 20 DECLARE_GLOBAL_DATA_PTR; 21 22 static int on_console(const char *name, const char *value, enum env_op op, 23 int flags) 24 { 25 int console = -1; 26 27 /* Check for console redirection */ 28 if (strcmp(name, "stdin") == 0) 29 console = stdin; 30 else if (strcmp(name, "stdout") == 0) 31 console = stdout; 32 else if (strcmp(name, "stderr") == 0) 33 console = stderr; 34 35 /* if not actually setting a console variable, we don't care */ 36 if (console == -1 || (gd->flags & GD_FLG_DEVINIT) == 0) 37 return 0; 38 39 switch (op) { 40 case env_op_create: 41 case env_op_overwrite: 42 43 #ifdef CONFIG_CONSOLE_MUX 44 if (iomux_doenv(console, value)) 45 return 1; 46 #else 47 /* Try assigning specified device */ 48 if (console_assign(console, value) < 0) 49 return 1; 50 #endif /* CONFIG_CONSOLE_MUX */ 51 return 0; 52 53 case env_op_delete: 54 if ((flags & H_FORCE) == 0) 55 printf("Can't delete \"%s\"\n", name); 56 return 1; 57 58 default: 59 return 0; 60 } 61 } 62 U_BOOT_ENV_CALLBACK(console, on_console); 63 64 #ifdef CONFIG_SILENT_CONSOLE 65 static int on_silent(const char *name, const char *value, enum env_op op, 66 int flags) 67 { 68 #ifndef CONFIG_SILENT_CONSOLE_UPDATE_ON_SET 69 if (flags & H_INTERACTIVE) 70 return 0; 71 #endif 72 #ifndef CONFIG_SILENT_CONSOLE_UPDATE_ON_RELOC 73 if ((flags & H_INTERACTIVE) == 0) 74 return 0; 75 #endif 76 77 if (value != NULL) 78 gd->flags |= GD_FLG_SILENT; 79 else 80 gd->flags &= ~GD_FLG_SILENT; 81 82 return 0; 83 } 84 U_BOOT_ENV_CALLBACK(silent, on_silent); 85 #endif 86 87 #ifdef CONFIG_SYS_CONSOLE_IS_IN_ENV 88 /* 89 * if overwrite_console returns 1, the stdin, stderr and stdout 90 * are switched to the serial port, else the settings in the 91 * environment are used 92 */ 93 #ifdef CONFIG_SYS_CONSOLE_OVERWRITE_ROUTINE 94 extern int overwrite_console(void); 95 #define OVERWRITE_CONSOLE overwrite_console() 96 #else 97 #define OVERWRITE_CONSOLE 0 98 #endif /* CONFIG_SYS_CONSOLE_OVERWRITE_ROUTINE */ 99 100 #endif /* CONFIG_SYS_CONSOLE_IS_IN_ENV */ 101 102 static int console_setfile(int file, struct stdio_dev * dev) 103 { 104 int error = 0; 105 106 if (dev == NULL) 107 return -1; 108 109 switch (file) { 110 case stdin: 111 case stdout: 112 case stderr: 113 /* Start new device */ 114 if (dev->start) { 115 error = dev->start(dev); 116 /* If it's not started dont use it */ 117 if (error < 0) 118 break; 119 } 120 121 /* Assign the new device (leaving the existing one started) */ 122 stdio_devices[file] = dev; 123 124 /* 125 * Update monitor functions 126 * (to use the console stuff by other applications) 127 */ 128 switch (file) { 129 case stdin: 130 gd->jt->getc = getc; 131 gd->jt->tstc = tstc; 132 break; 133 case stdout: 134 gd->jt->putc = putc; 135 gd->jt->puts = puts; 136 gd->jt->printf = printf; 137 break; 138 } 139 break; 140 141 default: /* Invalid file ID */ 142 error = -1; 143 } 144 return error; 145 } 146 147 #if defined(CONFIG_CONSOLE_MUX) 148 /** Console I/O multiplexing *******************************************/ 149 150 static struct stdio_dev *tstcdev; 151 struct stdio_dev **console_devices[MAX_FILES]; 152 int cd_count[MAX_FILES]; 153 154 /* 155 * This depends on tstc() always being called before getc(). 156 * This is guaranteed to be true because this routine is called 157 * only from fgetc() which assures it. 158 * No attempt is made to demultiplex multiple input sources. 159 */ 160 static int console_getc(int file) 161 { 162 unsigned char ret; 163 164 /* This is never called with testcdev == NULL */ 165 ret = tstcdev->getc(tstcdev); 166 tstcdev = NULL; 167 return ret; 168 } 169 170 static int console_tstc(int file) 171 { 172 int i, ret; 173 struct stdio_dev *dev; 174 175 disable_ctrlc(1); 176 for (i = 0; i < cd_count[file]; i++) { 177 dev = console_devices[file][i]; 178 if (dev->tstc != NULL) { 179 ret = dev->tstc(dev); 180 if (ret > 0) { 181 tstcdev = dev; 182 disable_ctrlc(0); 183 return ret; 184 } 185 } 186 } 187 disable_ctrlc(0); 188 189 return 0; 190 } 191 192 static void console_putc(int file, const char c) 193 { 194 int i; 195 struct stdio_dev *dev; 196 197 for (i = 0; i < cd_count[file]; i++) { 198 dev = console_devices[file][i]; 199 if (dev->putc != NULL) 200 dev->putc(dev, c); 201 } 202 } 203 204 #ifdef CONFIG_PRE_CONSOLE_BUFFER 205 static void console_puts_noserial(int file, const char *s) 206 { 207 int i; 208 struct stdio_dev *dev; 209 210 for (i = 0; i < cd_count[file]; i++) { 211 dev = console_devices[file][i]; 212 if (dev->puts != NULL && strcmp(dev->name, "serial") != 0) 213 dev->puts(dev, s); 214 } 215 } 216 #endif 217 218 static void console_puts(int file, const char *s) 219 { 220 int i; 221 struct stdio_dev *dev; 222 223 for (i = 0; i < cd_count[file]; i++) { 224 dev = console_devices[file][i]; 225 if (dev->puts != NULL) 226 dev->puts(dev, s); 227 } 228 } 229 230 static inline void console_doenv(int file, struct stdio_dev *dev) 231 { 232 iomux_doenv(file, dev->name); 233 } 234 #else 235 static inline int console_getc(int file) 236 { 237 return stdio_devices[file]->getc(stdio_devices[file]); 238 } 239 240 static inline int console_tstc(int file) 241 { 242 return stdio_devices[file]->tstc(stdio_devices[file]); 243 } 244 245 static inline void console_putc(int file, const char c) 246 { 247 stdio_devices[file]->putc(stdio_devices[file], c); 248 } 249 250 #ifdef CONFIG_PRE_CONSOLE_BUFFER 251 static inline void console_puts_noserial(int file, const char *s) 252 { 253 if (strcmp(stdio_devices[file]->name, "serial") != 0) 254 stdio_devices[file]->puts(stdio_devices[file], s); 255 } 256 #endif 257 258 static inline void console_puts(int file, const char *s) 259 { 260 stdio_devices[file]->puts(stdio_devices[file], s); 261 } 262 263 static inline void console_doenv(int file, struct stdio_dev *dev) 264 { 265 console_setfile(file, dev); 266 } 267 #endif /* defined(CONFIG_CONSOLE_MUX) */ 268 269 /** U-Boot INITIAL CONSOLE-NOT COMPATIBLE FUNCTIONS *************************/ 270 271 int serial_printf(const char *fmt, ...) 272 { 273 va_list args; 274 uint i; 275 char printbuffer[CONFIG_SYS_PBSIZE]; 276 277 va_start(args, fmt); 278 279 /* For this to work, printbuffer must be larger than 280 * anything we ever want to print. 281 */ 282 i = vscnprintf(printbuffer, sizeof(printbuffer), fmt, args); 283 va_end(args); 284 285 serial_puts(printbuffer); 286 return i; 287 } 288 289 int fgetc(int file) 290 { 291 if (file < MAX_FILES) { 292 #if defined(CONFIG_CONSOLE_MUX) 293 /* 294 * Effectively poll for input wherever it may be available. 295 */ 296 for (;;) { 297 /* 298 * Upper layer may have already called tstc() so 299 * check for that first. 300 */ 301 if (tstcdev != NULL) 302 return console_getc(file); 303 console_tstc(file); 304 #ifdef CONFIG_WATCHDOG 305 /* 306 * If the watchdog must be rate-limited then it should 307 * already be handled in board-specific code. 308 */ 309 udelay(1); 310 #endif 311 } 312 #else 313 return console_getc(file); 314 #endif 315 } 316 317 return -1; 318 } 319 320 int ftstc(int file) 321 { 322 if (file < MAX_FILES) 323 return console_tstc(file); 324 325 return -1; 326 } 327 328 void fputc(int file, const char c) 329 { 330 if (file < MAX_FILES) 331 console_putc(file, c); 332 } 333 334 void fputs(int file, const char *s) 335 { 336 if (file < MAX_FILES) 337 console_puts(file, s); 338 } 339 340 int fprintf(int file, const char *fmt, ...) 341 { 342 va_list args; 343 uint i; 344 char printbuffer[CONFIG_SYS_PBSIZE]; 345 346 va_start(args, fmt); 347 348 /* For this to work, printbuffer must be larger than 349 * anything we ever want to print. 350 */ 351 i = vscnprintf(printbuffer, sizeof(printbuffer), fmt, args); 352 va_end(args); 353 354 /* Send to desired file */ 355 fputs(file, printbuffer); 356 return i; 357 } 358 359 /** U-Boot INITIAL CONSOLE-COMPATIBLE FUNCTION *****************************/ 360 361 int getc(void) 362 { 363 #ifdef CONFIG_DISABLE_CONSOLE 364 if (gd->flags & GD_FLG_DISABLE_CONSOLE) 365 return 0; 366 #endif 367 368 if (!gd->have_console) 369 return 0; 370 371 #ifdef CONFIG_CONSOLE_RECORD 372 if (gd->console_in.start) { 373 int ch; 374 375 ch = membuff_getbyte(&gd->console_in); 376 if (ch != -1) 377 return 1; 378 } 379 #endif 380 if (gd->flags & GD_FLG_DEVINIT) { 381 /* Get from the standard input */ 382 return fgetc(stdin); 383 } 384 385 /* Send directly to the handler */ 386 return serial_getc(); 387 } 388 389 int tstc(void) 390 { 391 #ifdef CONFIG_DISABLE_CONSOLE 392 if (gd->flags & GD_FLG_DISABLE_CONSOLE) 393 return 0; 394 #endif 395 396 if (!gd->have_console) 397 return 0; 398 #ifdef CONFIG_CONSOLE_RECORD 399 if (gd->console_in.start) { 400 if (membuff_peekbyte(&gd->console_in) != -1) 401 return 1; 402 } 403 #endif 404 if (gd->flags & GD_FLG_DEVINIT) { 405 /* Test the standard input */ 406 return ftstc(stdin); 407 } 408 409 /* Send directly to the handler */ 410 return serial_tstc(); 411 } 412 413 #define PRE_CONSOLE_FLUSHPOINT1_SERIAL 0 414 #define PRE_CONSOLE_FLUSHPOINT2_EVERYTHING_BUT_SERIAL 1 415 416 #ifdef CONFIG_PRE_CONSOLE_BUFFER 417 #define CIRC_BUF_IDX(idx) ((idx) % (unsigned long)CONFIG_PRE_CON_BUF_SZ) 418 419 static void pre_console_putc(const char c) 420 { 421 char *buffer = (char *)CONFIG_PRE_CON_BUF_ADDR; 422 423 buffer[CIRC_BUF_IDX(gd->precon_buf_idx++)] = c; 424 } 425 426 static void pre_console_puts(const char *s) 427 { 428 while (*s) 429 pre_console_putc(*s++); 430 } 431 432 static void print_pre_console_buffer(int flushpoint) 433 { 434 unsigned long in = 0, out = 0; 435 char *buf_in = (char *)CONFIG_PRE_CON_BUF_ADDR; 436 char buf_out[CONFIG_PRE_CON_BUF_SZ + 1]; 437 438 if (gd->precon_buf_idx > CONFIG_PRE_CON_BUF_SZ) 439 in = gd->precon_buf_idx - CONFIG_PRE_CON_BUF_SZ; 440 441 while (in < gd->precon_buf_idx) 442 buf_out[out++] = buf_in[CIRC_BUF_IDX(in++)]; 443 444 buf_out[out] = 0; 445 446 switch (flushpoint) { 447 case PRE_CONSOLE_FLUSHPOINT1_SERIAL: 448 puts(buf_out); 449 break; 450 case PRE_CONSOLE_FLUSHPOINT2_EVERYTHING_BUT_SERIAL: 451 console_puts_noserial(stdout, buf_out); 452 break; 453 } 454 } 455 #else 456 static inline void pre_console_putc(const char c) {} 457 static inline void pre_console_puts(const char *s) {} 458 static inline void print_pre_console_buffer(int flushpoint) {} 459 #endif 460 461 void putc(const char c) 462 { 463 #ifdef CONFIG_SANDBOX 464 /* sandbox can send characters to stdout before it has a console */ 465 if (!gd || !(gd->flags & GD_FLG_SERIAL_READY)) { 466 os_putc(c); 467 return; 468 } 469 #endif 470 #ifdef CONFIG_DEBUG_UART 471 /* if we don't have a console yet, use the debug UART */ 472 if (!gd || !(gd->flags & GD_FLG_SERIAL_READY)) { 473 printch(c); 474 return; 475 } 476 #endif 477 #ifdef CONFIG_CONSOLE_RECORD 478 if (gd && (gd->flags & GD_FLG_RECORD) && gd->console_out.start) 479 membuff_putbyte(&gd->console_out, c); 480 #endif 481 #ifdef CONFIG_SILENT_CONSOLE 482 if (gd->flags & GD_FLG_SILENT) 483 return; 484 #endif 485 486 #ifdef CONFIG_DISABLE_CONSOLE 487 if (gd->flags & GD_FLG_DISABLE_CONSOLE) 488 return; 489 #endif 490 491 if (!gd->have_console) 492 return pre_console_putc(c); 493 494 if (gd->flags & GD_FLG_DEVINIT) { 495 /* Send to the standard output */ 496 fputc(stdout, c); 497 } else { 498 /* Send directly to the handler */ 499 pre_console_putc(c); 500 serial_putc(c); 501 } 502 } 503 504 void puts(const char *s) 505 { 506 #ifdef CONFIG_SANDBOX 507 if (!gd || !(gd->flags & GD_FLG_SERIAL_READY)) { 508 os_puts(s); 509 return; 510 } 511 #endif 512 #ifdef CONFIG_DEBUG_UART 513 if (!gd || !(gd->flags & GD_FLG_SERIAL_READY)) { 514 while (*s) { 515 int ch = *s++; 516 517 printch(ch); 518 if (ch == '\n') 519 printch('\r'); 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 654 if (dev && (dev->flags & flags)) 655 return dev; 656 657 return NULL; 658 } 659 660 int console_assign(int file, const char *devname) 661 { 662 int flag; 663 struct stdio_dev *dev; 664 665 /* Check for valid file */ 666 switch (file) { 667 case stdin: 668 flag = DEV_FLAGS_INPUT; 669 break; 670 case stdout: 671 case stderr: 672 flag = DEV_FLAGS_OUTPUT; 673 break; 674 default: 675 return -1; 676 } 677 678 /* Check for valid device name */ 679 680 dev = search_device(flag, devname); 681 682 if (dev) 683 return console_setfile(file, dev); 684 685 return -1; 686 } 687 688 /* Called before relocation - use serial functions */ 689 int console_init_f(void) 690 { 691 gd->have_console = 1; 692 693 #ifdef CONFIG_SILENT_CONSOLE 694 if (getenv("silent") != NULL) 695 gd->flags |= GD_FLG_SILENT; 696 #endif 697 698 print_pre_console_buffer(PRE_CONSOLE_FLUSHPOINT1_SERIAL); 699 700 return 0; 701 } 702 703 void stdio_print_current_devices(void) 704 { 705 /* Print information */ 706 puts("In: "); 707 if (stdio_devices[stdin] == NULL) { 708 puts("No input devices available!\n"); 709 } else { 710 printf ("%s\n", stdio_devices[stdin]->name); 711 } 712 713 puts("Out: "); 714 if (stdio_devices[stdout] == NULL) { 715 puts("No output devices available!\n"); 716 } else { 717 printf ("%s\n", stdio_devices[stdout]->name); 718 } 719 720 puts("Err: "); 721 if (stdio_devices[stderr] == NULL) { 722 puts("No error devices available!\n"); 723 } else { 724 printf ("%s\n", stdio_devices[stderr]->name); 725 } 726 } 727 728 #ifdef CONFIG_SYS_CONSOLE_IS_IN_ENV 729 /* Called after the relocation - use desired console functions */ 730 int console_init_r(void) 731 { 732 char *stdinname, *stdoutname, *stderrname; 733 struct stdio_dev *inputdev = NULL, *outputdev = NULL, *errdev = NULL; 734 #ifdef CONFIG_SYS_CONSOLE_ENV_OVERWRITE 735 int i; 736 #endif /* CONFIG_SYS_CONSOLE_ENV_OVERWRITE */ 737 #ifdef CONFIG_CONSOLE_MUX 738 int iomux_err = 0; 739 #endif 740 741 /* set default handlers at first */ 742 gd->jt->getc = serial_getc; 743 gd->jt->tstc = serial_tstc; 744 gd->jt->putc = serial_putc; 745 gd->jt->puts = serial_puts; 746 gd->jt->printf = serial_printf; 747 748 /* stdin stdout and stderr are in environment */ 749 /* scan for it */ 750 stdinname = getenv("stdin"); 751 stdoutname = getenv("stdout"); 752 stderrname = getenv("stderr"); 753 754 if (OVERWRITE_CONSOLE == 0) { /* if not overwritten by config switch */ 755 inputdev = search_device(DEV_FLAGS_INPUT, stdinname); 756 outputdev = search_device(DEV_FLAGS_OUTPUT, stdoutname); 757 errdev = search_device(DEV_FLAGS_OUTPUT, stderrname); 758 #ifdef CONFIG_CONSOLE_MUX 759 iomux_err = iomux_doenv(stdin, stdinname); 760 iomux_err += iomux_doenv(stdout, stdoutname); 761 iomux_err += iomux_doenv(stderr, stderrname); 762 if (!iomux_err) 763 /* Successful, so skip all the code below. */ 764 goto done; 765 #endif 766 } 767 /* if the devices are overwritten or not found, use default device */ 768 if (inputdev == NULL) { 769 inputdev = search_device(DEV_FLAGS_INPUT, "serial"); 770 } 771 if (outputdev == NULL) { 772 outputdev = search_device(DEV_FLAGS_OUTPUT, "serial"); 773 } 774 if (errdev == NULL) { 775 errdev = search_device(DEV_FLAGS_OUTPUT, "serial"); 776 } 777 /* Initializes output console first */ 778 if (outputdev != NULL) { 779 /* need to set a console if not done above. */ 780 console_doenv(stdout, outputdev); 781 } 782 if (errdev != NULL) { 783 /* need to set a console if not done above. */ 784 console_doenv(stderr, errdev); 785 } 786 if (inputdev != NULL) { 787 /* need to set a console if not done above. */ 788 console_doenv(stdin, inputdev); 789 } 790 791 #ifdef CONFIG_CONSOLE_MUX 792 done: 793 #endif 794 795 #ifndef CONFIG_SYS_CONSOLE_INFO_QUIET 796 stdio_print_current_devices(); 797 #endif /* CONFIG_SYS_CONSOLE_INFO_QUIET */ 798 799 #ifdef CONFIG_SYS_CONSOLE_ENV_OVERWRITE 800 /* set the environment variables (will overwrite previous env settings) */ 801 for (i = 0; i < 3; i++) { 802 setenv(stdio_names[i], stdio_devices[i]->name); 803 } 804 #endif /* CONFIG_SYS_CONSOLE_ENV_OVERWRITE */ 805 806 gd->flags |= GD_FLG_DEVINIT; /* device initialization completed */ 807 808 #if 0 809 /* If nothing usable installed, use only the initial console */ 810 if ((stdio_devices[stdin] == NULL) && (stdio_devices[stdout] == NULL)) 811 return 0; 812 #endif 813 print_pre_console_buffer(PRE_CONSOLE_FLUSHPOINT2_EVERYTHING_BUT_SERIAL); 814 return 0; 815 } 816 817 #else /* CONFIG_SYS_CONSOLE_IS_IN_ENV */ 818 819 /* Called after the relocation - use desired console functions */ 820 int console_init_r(void) 821 { 822 struct stdio_dev *inputdev = NULL, *outputdev = NULL; 823 int i; 824 struct list_head *list = stdio_get_list(); 825 struct list_head *pos; 826 struct stdio_dev *dev; 827 828 #ifdef CONFIG_SPLASH_SCREEN 829 /* 830 * suppress all output if splash screen is enabled and we have 831 * a bmp to display. We redirect the output from frame buffer 832 * console to serial console in this case or suppress it if 833 * "silent" mode was requested. 834 */ 835 if (getenv("splashimage") != NULL) { 836 if (!(gd->flags & GD_FLG_SILENT)) 837 outputdev = search_device (DEV_FLAGS_OUTPUT, "serial"); 838 } 839 #endif 840 841 /* Scan devices looking for input and output devices */ 842 list_for_each(pos, list) { 843 dev = list_entry(pos, struct stdio_dev, list); 844 845 if ((dev->flags & DEV_FLAGS_INPUT) && (inputdev == NULL)) { 846 inputdev = dev; 847 } 848 if ((dev->flags & DEV_FLAGS_OUTPUT) && (outputdev == NULL)) { 849 outputdev = dev; 850 } 851 if(inputdev && outputdev) 852 break; 853 } 854 855 /* Initializes output console first */ 856 if (outputdev != NULL) { 857 console_setfile(stdout, outputdev); 858 console_setfile(stderr, outputdev); 859 #ifdef CONFIG_CONSOLE_MUX 860 console_devices[stdout][0] = outputdev; 861 console_devices[stderr][0] = outputdev; 862 #endif 863 } 864 865 /* Initializes input console */ 866 if (inputdev != NULL) { 867 console_setfile(stdin, inputdev); 868 #ifdef CONFIG_CONSOLE_MUX 869 console_devices[stdin][0] = inputdev; 870 #endif 871 } 872 873 #ifndef CONFIG_SYS_CONSOLE_INFO_QUIET 874 stdio_print_current_devices(); 875 #endif /* CONFIG_SYS_CONSOLE_INFO_QUIET */ 876 877 /* Setting environment variables */ 878 for (i = 0; i < 3; i++) { 879 setenv(stdio_names[i], stdio_devices[i]->name); 880 } 881 882 gd->flags |= GD_FLG_DEVINIT; /* device initialization completed */ 883 884 #if 0 885 /* If nothing usable installed, use only the initial console */ 886 if ((stdio_devices[stdin] == NULL) && (stdio_devices[stdout] == NULL)) 887 return 0; 888 #endif 889 print_pre_console_buffer(PRE_CONSOLE_FLUSHPOINT2_EVERYTHING_BUT_SERIAL); 890 return 0; 891 } 892 893 #endif /* CONFIG_SYS_CONSOLE_IS_IN_ENV */ 894