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