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_BOOTSTAGE_PRINTF_TIMESTAMP)) 558 static void vspfunc(char *buf, size_t size, char *format, ...) 559 { 560 va_list ap; 561 562 va_start(ap, format); 563 vsnprintf(buf, size, format, ap); 564 va_end(ap); 565 } 566 567 void puts(const char *s) 568 { 569 unsigned long ts_sec, ts_msec, ticks; 570 char pr_timestamp[32], *p; 571 572 while (*s) { 573 if (*s == '\n') { 574 gd->new_line = 1; 575 putc(*s++); 576 continue; 577 } 578 579 if (gd->new_line) { 580 gd->new_line = 0; 581 ticks = (get_ticks() / 24ULL); 582 ts_sec = ticks / 1000000; 583 ts_msec = ticks % 1000000; 584 vspfunc(pr_timestamp, sizeof(pr_timestamp), 585 "[%5lu.%06lu] ", ts_sec, ts_msec); 586 p = pr_timestamp; 587 while (*p) 588 putc(*p++); 589 } 590 591 putc(*s++); 592 } 593 } 594 #else 595 void puts(const char *s) 596 { 597 while (*s) 598 putc(*s++); 599 } 600 #endif 601 602 603 #ifdef CONFIG_CONSOLE_RECORD 604 int console_record_init(void) 605 { 606 int ret; 607 608 ret = membuff_new((struct membuff *)&gd->console_out, 609 CONFIG_CONSOLE_RECORD_OUT_SIZE); 610 if (ret) 611 return ret; 612 ret = membuff_new((struct membuff *)&gd->console_in, 613 CONFIG_CONSOLE_RECORD_IN_SIZE); 614 615 return ret; 616 } 617 618 void console_record_reset(void) 619 { 620 membuff_purge((struct membuff *)&gd->console_out); 621 membuff_purge((struct membuff *)&gd->console_in); 622 } 623 624 void console_record_reset_enable(void) 625 { 626 console_record_reset(); 627 gd->flags |= GD_FLG_RECORD; 628 } 629 630 /* Print and remove data from buffer */ 631 void console_record_print_purge(void) 632 { 633 unsigned long flags; 634 char c; 635 636 if (!gd || !(gd->flags & GD_FLG_RECORD)) 637 return; 638 639 /* Remove some bits to avoid running unexpected branch in putc() */ 640 flags = gd->flags; 641 gd->flags &= ~(GD_FLG_RECORD | GD_FLG_SILENT | GD_FLG_DISABLE_CONSOLE); 642 643 printf("\n\n## Console Record: \n"); 644 while (!membuff_isempty((struct membuff *)&gd->console_out)) { 645 c = membuff_getbyte((struct membuff *)&gd->console_out); 646 putc(c); 647 } 648 649 gd->flags = flags; 650 } 651 #endif 652 653 /* test if ctrl-c was pressed */ 654 static int ctrlc_disabled = 0; /* see disable_ctrl() */ 655 static int ctrlc_was_pressed = 0; 656 int ctrlc(void) 657 { 658 #if defined(CONFIG_CONSOLE_DISABLE_CTRLC) && \ 659 defined(CONFIG_BOOTDELAY) && (CONFIG_BOOTDELAY <= 0) 660 return 0; 661 #endif 662 663 #ifndef CONFIG_SANDBOX 664 if (!ctrlc_disabled && gd->have_console) { 665 if (tstc()) { 666 switch (getc()) { 667 case 0x03: /* ^C - Control C */ 668 ctrlc_was_pressed = 1; 669 return 1; 670 default: 671 break; 672 } 673 } 674 } 675 #endif 676 677 return 0; 678 } 679 /* Reads user's confirmation. 680 Returns 1 if user's input is "y", "Y", "yes" or "YES" 681 */ 682 int confirm_yesno(void) 683 { 684 int i; 685 char str_input[5]; 686 687 /* Flush input */ 688 while (tstc()) 689 getc(); 690 i = 0; 691 while (i < sizeof(str_input)) { 692 str_input[i] = getc(); 693 putc(str_input[i]); 694 if (str_input[i] == '\r') 695 break; 696 i++; 697 } 698 putc('\n'); 699 if (strncmp(str_input, "y\r", 2) == 0 || 700 strncmp(str_input, "Y\r", 2) == 0 || 701 strncmp(str_input, "yes\r", 4) == 0 || 702 strncmp(str_input, "YES\r", 4) == 0) 703 return 1; 704 return 0; 705 } 706 /* pass 1 to disable ctrlc() checking, 0 to enable. 707 * returns previous state 708 */ 709 int disable_ctrlc(int disable) 710 { 711 int prev = ctrlc_disabled; /* save previous state */ 712 713 ctrlc_disabled = disable; 714 return prev; 715 } 716 717 int had_ctrlc (void) 718 { 719 return ctrlc_was_pressed; 720 } 721 722 void clear_ctrlc(void) 723 { 724 ctrlc_was_pressed = 0; 725 } 726 727 /** U-Boot INIT FUNCTIONS *************************************************/ 728 729 struct stdio_dev *search_device(int flags, const char *name) 730 { 731 struct stdio_dev *dev; 732 733 dev = stdio_get_by_name(name); 734 #ifdef CONFIG_VIDCONSOLE_AS_LCD 735 if (!dev && !strcmp(name, "lcd")) 736 dev = stdio_get_by_name("vidconsole"); 737 #endif 738 739 if (dev && (dev->flags & flags)) 740 return dev; 741 742 return NULL; 743 } 744 745 int console_assign(int file, const char *devname) 746 { 747 int flag; 748 struct stdio_dev *dev; 749 750 /* Check for valid file */ 751 switch (file) { 752 case stdin: 753 flag = DEV_FLAGS_INPUT; 754 break; 755 case stdout: 756 case stderr: 757 flag = DEV_FLAGS_OUTPUT; 758 break; 759 default: 760 return -1; 761 } 762 763 /* Check for valid device name */ 764 765 dev = search_device(flag, devname); 766 767 if (dev) 768 return console_setfile(file, dev); 769 770 return -1; 771 } 772 773 static void console_update_silent(void) 774 { 775 #ifdef CONFIG_SILENT_CONSOLE 776 if (env_get("silent") != NULL) { 777 printf("U-Boot: enable silent console\n"); 778 gd->flags |= GD_FLG_SILENT; 779 } else { 780 gd->flags &= ~GD_FLG_SILENT; 781 } 782 #endif 783 } 784 785 int console_announce_r(void) 786 { 787 #if !CONFIG_IS_ENABLED(PRE_CONSOLE_BUFFER) 788 char buf[DISPLAY_OPTIONS_BANNER_LENGTH]; 789 790 display_options_get_banner(false, buf, sizeof(buf)); 791 792 console_puts_noserial(stdout, buf); 793 #endif 794 795 return 0; 796 } 797 798 /* Called before relocation - use serial functions */ 799 int console_init_f(void) 800 { 801 gd->have_console = 1; 802 803 console_update_silent(); 804 805 print_pre_console_buffer(PRE_CONSOLE_FLUSHPOINT1_SERIAL); 806 807 return 0; 808 } 809 810 void stdio_print_current_devices(void) 811 { 812 /* Print information */ 813 puts("In: "); 814 if (stdio_devices[stdin] == NULL) { 815 puts("No input devices available!\n"); 816 } else { 817 printf ("%s\n", stdio_devices[stdin]->name); 818 } 819 820 puts("Out: "); 821 if (stdio_devices[stdout] == NULL) { 822 puts("No output devices available!\n"); 823 } else { 824 printf ("%s\n", stdio_devices[stdout]->name); 825 } 826 827 puts("Err: "); 828 if (stdio_devices[stderr] == NULL) { 829 puts("No error devices available!\n"); 830 } else { 831 printf ("%s\n", stdio_devices[stderr]->name); 832 } 833 } 834 835 #if CONFIG_IS_ENABLED(SYS_CONSOLE_IS_IN_ENV) 836 /* Called after the relocation - use desired console functions */ 837 int console_init_r(void) 838 { 839 char *stdinname, *stdoutname, *stderrname; 840 struct stdio_dev *inputdev = NULL, *outputdev = NULL, *errdev = NULL; 841 #ifdef CONFIG_SYS_CONSOLE_ENV_OVERWRITE 842 int i; 843 #endif /* CONFIG_SYS_CONSOLE_ENV_OVERWRITE */ 844 #if CONFIG_IS_ENABLED(CONSOLE_MUX) 845 int iomux_err = 0; 846 #endif 847 848 /* set default handlers at first */ 849 gd->jt->getc = serial_getc; 850 gd->jt->tstc = serial_tstc; 851 gd->jt->putc = serial_putc; 852 gd->jt->puts = serial_puts; 853 gd->jt->printf = serial_printf; 854 855 /* stdin stdout and stderr are in environment */ 856 /* scan for it */ 857 stdinname = env_get("stdin"); 858 stdoutname = env_get("stdout"); 859 stderrname = env_get("stderr"); 860 861 if (OVERWRITE_CONSOLE == 0) { /* if not overwritten by config switch */ 862 inputdev = search_device(DEV_FLAGS_INPUT, stdinname); 863 outputdev = search_device(DEV_FLAGS_OUTPUT, stdoutname); 864 errdev = search_device(DEV_FLAGS_OUTPUT, stderrname); 865 #if CONFIG_IS_ENABLED(CONSOLE_MUX) 866 iomux_err = iomux_doenv(stdin, stdinname); 867 iomux_err += iomux_doenv(stdout, stdoutname); 868 iomux_err += iomux_doenv(stderr, stderrname); 869 if (!iomux_err) 870 /* Successful, so skip all the code below. */ 871 goto done; 872 #endif 873 } 874 /* if the devices are overwritten or not found, use default device */ 875 if (inputdev == NULL) { 876 inputdev = search_device(DEV_FLAGS_INPUT, "serial"); 877 } 878 if (outputdev == NULL) { 879 outputdev = search_device(DEV_FLAGS_OUTPUT, "serial"); 880 } 881 if (errdev == NULL) { 882 errdev = search_device(DEV_FLAGS_OUTPUT, "serial"); 883 } 884 /* Initializes output console first */ 885 if (outputdev != NULL) { 886 /* need to set a console if not done above. */ 887 console_doenv(stdout, outputdev); 888 } 889 if (errdev != NULL) { 890 /* need to set a console if not done above. */ 891 console_doenv(stderr, errdev); 892 } 893 if (inputdev != NULL) { 894 /* need to set a console if not done above. */ 895 console_doenv(stdin, inputdev); 896 } 897 898 #if CONFIG_IS_ENABLED(CONSOLE_MUX) 899 done: 900 #endif 901 902 #ifndef CONFIG_SYS_CONSOLE_INFO_QUIET 903 stdio_print_current_devices(); 904 #endif /* CONFIG_SYS_CONSOLE_INFO_QUIET */ 905 #ifdef CONFIG_VIDCONSOLE_AS_LCD 906 if (strstr(stdoutname, "lcd")) 907 printf("Warning: Please change 'lcd' to 'vidconsole' in stdout/stderr environment vars\n"); 908 #endif 909 910 #ifdef CONFIG_SYS_CONSOLE_ENV_OVERWRITE 911 /* set the environment variables (will overwrite previous env settings) */ 912 for (i = 0; i < 3; i++) { 913 env_set(stdio_names[i], stdio_devices[i]->name); 914 } 915 #endif /* CONFIG_SYS_CONSOLE_ENV_OVERWRITE */ 916 917 gd->flags |= GD_FLG_DEVINIT; /* device initialization completed */ 918 919 #if 0 920 /* If nothing usable installed, use only the initial console */ 921 if ((stdio_devices[stdin] == NULL) && (stdio_devices[stdout] == NULL)) 922 return 0; 923 #endif 924 print_pre_console_buffer(PRE_CONSOLE_FLUSHPOINT2_EVERYTHING_BUT_SERIAL); 925 return 0; 926 } 927 928 #else /* !CONFIG_IS_ENABLED(SYS_CONSOLE_IS_IN_ENV) */ 929 930 /* Called after the relocation - use desired console functions */ 931 int console_init_r(void) 932 { 933 struct stdio_dev *inputdev = NULL, *outputdev = NULL; 934 int i; 935 struct list_head *list = stdio_get_list(); 936 struct list_head *pos; 937 struct stdio_dev *dev; 938 939 console_update_silent(); 940 941 #ifdef CONFIG_SPLASH_SCREEN 942 /* 943 * suppress all output if splash screen is enabled and we have 944 * a bmp to display. We redirect the output from frame buffer 945 * console to serial console in this case or suppress it if 946 * "silent" mode was requested. 947 */ 948 if (env_get("splashimage") != NULL) { 949 if (!(gd->flags & GD_FLG_SILENT)) 950 outputdev = search_device (DEV_FLAGS_OUTPUT, "serial"); 951 } 952 #endif 953 954 /* Scan devices looking for input and output devices */ 955 list_for_each(pos, list) { 956 dev = list_entry(pos, struct stdio_dev, list); 957 958 if ((dev->flags & DEV_FLAGS_INPUT) && (inputdev == NULL)) { 959 inputdev = dev; 960 } 961 if ((dev->flags & DEV_FLAGS_OUTPUT) && (outputdev == NULL)) { 962 outputdev = dev; 963 } 964 if(inputdev && outputdev) 965 break; 966 } 967 968 /* Initializes output console first */ 969 if (outputdev != NULL) { 970 console_setfile(stdout, outputdev); 971 console_setfile(stderr, outputdev); 972 #if CONFIG_IS_ENABLED(CONSOLE_MUX) 973 console_devices[stdout][0] = outputdev; 974 console_devices[stderr][0] = outputdev; 975 #endif 976 } 977 978 /* Initializes input console */ 979 if (inputdev != NULL) { 980 console_setfile(stdin, inputdev); 981 #if CONFIG_IS_ENABLED(CONSOLE_MUX) 982 console_devices[stdin][0] = inputdev; 983 #endif 984 } 985 986 #ifndef CONFIG_SYS_CONSOLE_INFO_QUIET 987 stdio_print_current_devices(); 988 #endif /* CONFIG_SYS_CONSOLE_INFO_QUIET */ 989 990 /* Setting environment variables */ 991 for (i = 0; i < 3; i++) { 992 env_set(stdio_names[i], stdio_devices[i]->name); 993 } 994 995 gd->flags |= GD_FLG_DEVINIT; /* device initialization completed */ 996 997 #if 0 998 /* If nothing usable installed, use only the initial console */ 999 if ((stdio_devices[stdin] == NULL) && (stdio_devices[stdout] == NULL)) 1000 return 0; 1001 #endif 1002 print_pre_console_buffer(PRE_CONSOLE_FLUSHPOINT2_EVERYTHING_BUT_SERIAL); 1003 return 0; 1004 } 1005 1006 #endif /* CONFIG_IS_ENABLED(SYS_CONSOLE_IS_IN_ENV) */ 1007