arch/m68k/lib/board.c

   1 /*
   2  * (C) Copyright 2003
   3  * Josef Baumgartner <josef.baumgartner@telex.de>
   4  *
   5  * (C) Copyright 2000-2002
   6  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
   7  *
   8  * See file CREDITS for list of people who contributed to this
   9  * project.
  10  *
  11  * This program is free software; you can redistribute it and/or
  12  * modify it under the terms of the GNU General Public License as
  13  * published by the Free Software Foundation; either version 2 of
  14  * the License, or (at your option) any later version.
  15  *
  16  * This program is distributed in the hope that it will be useful,
  17  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  18  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  19  * GNU General Public License for more details.
  20  *
  21  * You should have received a copy of the GNU General Public License
  22  * along with this program; if not, write to the Free Software
  23  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  24  * MA 02111-1307 USA
  25  */
  26
  27 #include <common.h>
  28 #include <watchdog.h>
  29 #include <command.h>
  30 #include <malloc.h>
  31 #include <stdio_dev.h>
  32
  33 #include <asm/immap.h>
  34
  35 #if defined(CONFIG_CMD_IDE)
  36 #include <ide.h>
  37 #endif
  38 #if defined(CONFIG_CMD_SCSI)
  39 #include <scsi.h>
  40 #endif
  41 #if defined(CONFIG_CMD_KGDB)
  42 #include <kgdb.h>
  43 #endif
  44 #ifdef CONFIG_STATUS_LED
  45 #include <status_led.h>
  46 #endif
  47 #include <net.h>
  48 #include <serial.h>
  49 #if defined(CONFIG_CMD_BEDBUG)
  50 #include <cmd_bedbug.h>
  51 #endif
  52 #ifdef CONFIG_SYS_ALLOC_DPRAM
  53 #include <commproc.h>
  54 #endif
  55 #include <version.h>
  56
  57 #if defined(CONFIG_HARD_I2C) || \
  58     defined(CONFIG_SOFT_I2C)
  59 #include <i2c.h>
  60 #endif
  61
  62 #ifdef CONFIG_CMD_SPI
  63 #include <spi.h>
  64 #endif
  65
  66 #ifdef CONFIG_BITBANGMII
  67 #include <miiphy.h>
  68 #endif
  69
  70 #include <nand.h>
  71
  72 DECLARE_GLOBAL_DATA_PTR;
  73
  74 static char *failed = "*** failed ***\n";
  75
  76 #include <environment.h>
  77
  78 extern ulong __init_end;
  79 extern ulong __bss_end__;
  80
  81 #if defined(CONFIG_WATCHDOG)
  82 # define INIT_FUNC_WATCHDOG_INIT        watchdog_init,
  83 # define WATCHDOG_DISABLE               watchdog_disable
  84
  85 extern int watchdog_init(void);
  86 extern int watchdog_disable(void);
  87 #else
  88 # define INIT_FUNC_WATCHDOG_INIT        /* undef */
  89 # define WATCHDOG_DISABLE               /* undef */
  90 #endif /* CONFIG_WATCHDOG */
  91
  92 ulong monitor_flash_len;
  93
  94 /************************************************************************
  95  * Utilities                                                            *
  96  ************************************************************************
  97  */
  98
  99 /*
 100  * All attempts to come up with a "common" initialization sequence
 101  * that works for all boards and architectures failed: some of the
 102  * requirements are just _too_ different. To get rid of the resulting
 103  * mess of board dependend #ifdef'ed code we now make the whole
 104  * initialization sequence configurable to the user.
 105  *
 106  * The requirements for any new initalization function is simple: it
 107  * receives a pointer to the "global data" structure as it's only
 108  * argument, and returns an integer return code, where 0 means
 109  * "continue" and != 0 means "fatal error, hang the system".
 110  */
 111 typedef int (init_fnc_t) (void);
 112
 113 /************************************************************************
 114  * Init Utilities
 115  ************************************************************************
 116  * Some of this code should be moved into the core functions,
 117  * but let's get it working (again) first...
 118  */
 119
 120 static int init_baudrate (void)
 121 {
 122         char tmp[64];   /* long enough for environment variables */
 123         int i = getenv_f("baudrate", tmp, sizeof (tmp));
 124
 125         gd->baudrate = (i > 0)
 126                         ? (int) simple_strtoul (tmp, NULL, 10)
 127                         : CONFIG_BAUDRATE;
 128         return (0);
 129 }
 130
 131 /***********************************************************************/
 132
 133 static int init_func_ram (void)
 134 {
 135         int board_type = 0;     /* use dummy arg */
 136         puts ("DRAM:  ");
 137
 138         if ((gd->ram_size = initdram (board_type)) > 0) {
 139                 print_size (gd->ram_size, "\n");
 140                 return (0);
 141         }
 142         puts (failed);
 143         return (1);
 144 }
 145
 146 /***********************************************************************/
 147
 148 #if defined(CONFIG_HARD_I2C) || defined(CONFIG_SOFT_I2C)
 149 static int init_func_i2c (void)
 150 {
 151         puts ("I2C:   ");
 152         i2c_init (CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE);
 153         puts ("ready\n");
 154         return (0);
 155 }
 156 #endif
 157
 158 #if defined(CONFIG_HARD_SPI)
 159 static int init_func_spi (void)
 160 {
 161         puts ("SPI:   ");
 162         spi_init ();
 163         puts ("ready\n");
 164         return (0);
 165 }
 166 #endif
 167
 168 /***********************************************************************/
 169
 170 /************************************************************************
 171  * Initialization sequence                                              *
 172  ************************************************************************
 173  */
 174
 175 init_fnc_t *init_sequence[] = {
 176         get_clocks,
 177         env_init,
 178         init_baudrate,
 179         serial_init,
 180         console_init_f,
 181         display_options,
 182         checkcpu,
 183         checkboard,
 184 #if defined(CONFIG_HARD_I2C) || defined(CONFIG_SOFT_I2C)
 185         init_func_i2c,
 186 #endif
 187 #if defined(CONFIG_HARD_SPI)
 188         init_func_spi,
 189 #endif
 190         init_func_ram,
 191 #if defined(CONFIG_SYS_DRAM_TEST)
 192         testdram,
 193 #endif /* CONFIG_SYS_DRAM_TEST */
 194         INIT_FUNC_WATCHDOG_INIT
 195         NULL,                   /* Terminate this list */
 196 };
 197
 198
 199 /************************************************************************
 200  *
 201  * This is the first part of the initialization sequence that is
 202  * implemented in C, but still running from ROM.
 203  *
 204  * The main purpose is to provide a (serial) console interface as
 205  * soon as possible (so we can see any error messages), and to
 206  * initialize the RAM so that we can relocate the monitor code to
 207  * RAM.
 208  *
 209  * Be aware of the restrictions: global data is read-only, BSS is not
 210  * initialized, and stack space is limited to a few kB.
 211  *
 212  ************************************************************************
 213  */
 214
 215 void
 216 board_init_f (ulong bootflag)
 217 {
 218         bd_t *bd;
 219         ulong len, addr, addr_sp;
 220         ulong *paddr;
 221         gd_t *id;
 222         init_fnc_t **init_fnc_ptr;
 223 #ifdef CONFIG_PRAM
 224         int i;
 225         ulong reg;
 226         char tmp[64];           /* long enough for environment variables */
 227 #endif
 228
 229         /* Pointer is writable since we allocated a register for it */
 230         gd = (gd_t *) (CONFIG_SYS_INIT_RAM_ADDR + CONFIG_SYS_GBL_DATA_OFFSET);
 231         /* compiler optimization barrier needed for GCC >= 3.4 */
 232         __asm__ __volatile__("": : :"memory");
 233
 234         /* Clear initial global data */
 235         memset ((void *) gd, 0, sizeof (gd_t));
 236
 237         for (init_fnc_ptr = init_sequence; *init_fnc_ptr; ++init_fnc_ptr) {
 238                 if ((*init_fnc_ptr)() != 0) {
 239                         hang ();
 240                 }
 241         }
 242
 243         /*
 244          * Now that we have DRAM mapped and working, we can
 245          * relocate the code and continue running from DRAM.
 246          *
 247          * Reserve memory at end of RAM for (top down in that order):
 248          *      - protected RAM
 249          *      - LCD framebuffer
 250          *      - monitor code
 251          *      - board info struct
 252          */
 253         len = (ulong)&__bss_end__ - CONFIG_SYS_MONITOR_BASE;
 254
 255         addr = CONFIG_SYS_SDRAM_BASE + gd->ram_size;
 256
 257 #ifdef CONFIG_LOGBUFFER
 258         /* reserve kernel log buffer */
 259         addr -= (LOGBUFF_RESERVE);
 260         debug ("Reserving %dk for kernel logbuffer at %08lx\n", LOGBUFF_LEN, addr);
 261 #endif
 262
 263 #ifdef CONFIG_PRAM
 264         /*
 265          * reserve protected RAM
 266          */
 267         i = getenv_f("pram", tmp, sizeof (tmp));
 268         reg = (i > 0) ? simple_strtoul (tmp, NULL, 10) : CONFIG_PRAM;
 269         addr -= (reg << 10);            /* size is in kB */
 270         debug ("Reserving %ldk for protected RAM at %08lx\n", reg, addr);
 271 #endif /* CONFIG_PRAM */
 272
 273         /* round down to next 4 kB limit */
 274         addr &= ~(4096 - 1);
 275         debug ("Top of RAM usable for U-Boot at: %08lx\n", addr);
 276
 277 #ifdef CONFIG_LCD
 278 #ifdef CONFIG_FB_ADDR
 279         gd->fb_base = CONFIG_FB_ADDR;
 280 #else
 281         /* reserve memory for LCD display (always full pages) */
 282         addr = lcd_setmem (addr);
 283         gd->fb_base = addr;
 284 #endif /* CONFIG_FB_ADDR */
 285 #endif /* CONFIG_LCD */
 286
 287         /*
 288          * reserve memory for U-Boot code, data & bss
 289          * round down to next 4 kB limit
 290          */
 291         addr -= len;
 292         addr &= ~(4096 - 1);
 293
 294         debug ("Reserving %ldk for U-Boot at: %08lx\n", len >> 10, addr);
 295
 296         /*
 297          * reserve memory for malloc() arena
 298          */
 299         addr_sp = addr - TOTAL_MALLOC_LEN;
 300         debug ("Reserving %dk for malloc() at: %08lx\n",
 301                         TOTAL_MALLOC_LEN >> 10, addr_sp);
 302
 303         /*
 304          * (permanently) allocate a Board Info struct
 305          * and a permanent copy of the "global" data
 306          */
 307         addr_sp -= sizeof (bd_t);
 308         bd = (bd_t *) addr_sp;
 309         gd->bd = bd;
 310         debug ("Reserving %zu Bytes for Board Info at: %08lx\n",
 311                         sizeof (bd_t), addr_sp);
 312         addr_sp -= sizeof (gd_t);
 313         id = (gd_t *) addr_sp;
 314         debug ("Reserving %zu Bytes for Global Data at: %08lx\n",
 315                         sizeof (gd_t), addr_sp);
 316
 317         /* Reserve memory for boot params. */
 318         addr_sp -= CONFIG_SYS_BOOTPARAMS_LEN;
 319         bd->bi_boot_params = addr_sp;
 320         debug ("Reserving %dk for boot parameters at: %08lx\n",
 321                         CONFIG_SYS_BOOTPARAMS_LEN >> 10, addr_sp);
 322
 323         /*
 324          * Finally, we set up a new (bigger) stack.
 325          *
 326          * Leave some safety gap for SP, force alignment on 16 byte boundary
 327          * Clear initial stack frame
 328          */
 329         addr_sp -= 16;
 330         addr_sp &= ~0xF;
 331
 332         paddr = (ulong *)addr_sp;
 333         *paddr-- = 0;
 334         *paddr-- = 0;
 335         addr_sp = (ulong)paddr;
 336
 337         debug ("Stack Pointer at: %08lx\n", addr_sp);
 338
 339         /*
 340          * Save local variables to board info struct
 341          */
 342         bd->bi_memstart  = CONFIG_SYS_SDRAM_BASE;       /* start of  DRAM memory      */
 343         bd->bi_memsize   = gd->ram_size;        /* size  of  DRAM memory in bytes */
 344 #ifdef CONFIG_SYS_INIT_RAM_ADDR
 345         bd->bi_sramstart = CONFIG_SYS_INIT_RAM_ADDR;    /* start of  SRAM memory        */
 346         bd->bi_sramsize  = CONFIG_SYS_INIT_RAM_SIZE;    /* size  of  SRAM memory        */
 347 #endif
 348         bd->bi_mbar_base = CONFIG_SYS_MBAR;             /* base of internal registers */
 349
 350         bd->bi_bootflags = bootflag;            /* boot / reboot flag (for LynxOS)    */
 351
 352         WATCHDOG_RESET ();
 353         bd->bi_intfreq = gd->cpu_clk;   /* Internal Freq, in Hz */
 354         bd->bi_busfreq = gd->bus_clk;   /* Bus Freq,      in Hz */
 355 #ifdef CONFIG_PCI
 356         bd->bi_pcifreq = gd->pci_clk;           /* PCI Freq in Hz */
 357 #endif
 358 #ifdef CONFIG_EXTRA_CLOCK
 359         bd->bi_inpfreq = gd->inp_clk;           /* input Freq in Hz */
 360         bd->bi_vcofreq = gd->vco_clk;           /* vco Freq in Hz */
 361         bd->bi_flbfreq = gd->flb_clk;           /* flexbus Freq in Hz */
 362 #endif
 363         bd->bi_baudrate = gd->baudrate; /* Console Baudrate     */
 364
 365 #ifdef CONFIG_SYS_EXTBDINFO
 366         strncpy (bd->bi_s_version, "1.2", sizeof (bd->bi_s_version));
 367         strncpy (bd->bi_r_version, U_BOOT_VERSION, sizeof (bd->bi_r_version));
 368 #endif
 369
 370         WATCHDOG_RESET ();
 371
 372 #ifdef CONFIG_POST
 373         post_bootmode_init();
 374         post_run (NULL, POST_ROM | post_bootmode_get(0));
 375 #endif
 376
 377         WATCHDOG_RESET();
 378
 379         memcpy (id, (void *)gd, sizeof (gd_t));
 380
 381         debug ("Start relocate of code from %08x to %08lx\n", CONFIG_SYS_MONITOR_BASE, addr);
 382         relocate_code (addr_sp, id, addr);
 383
 384         /* NOTREACHED - jump_to_ram() does not return */
 385 }
 386
 387 /************************************************************************
 388  *
 389  * This is the next part if the initialization sequence: we are now
 390  * running from RAM and have a "normal" C environment, i. e. global
 391  * data can be written, BSS has been cleared, the stack size in not
 392  * that critical any more, etc.
 393  *
 394  ************************************************************************
 395  */
 396 void board_init_r (gd_t *id, ulong dest_addr)
 397 {
 398         char *s;
 399         bd_t *bd;
 400         extern void malloc_bin_reloc (void);
 401
 402 #ifndef CONFIG_ENV_IS_NOWHERE
 403         extern char * env_name_spec;
 404 #endif
 405 #ifndef CONFIG_SYS_NO_FLASH
 406         ulong flash_size;
 407 #endif
 408         gd = id;                /* initialize RAM version of global data */
 409         bd = gd->bd;
 410
 411         gd->flags |= GD_FLG_RELOC;      /* tell others: relocation done */
 412
 413 #ifdef CONFIG_SERIAL_MULTI
 414         serial_initialize();
 415 #endif
 416
 417         debug ("Now running in RAM - U-Boot at: %08lx\n", dest_addr);
 418
 419         WATCHDOG_RESET ();
 420
 421         gd->reloc_off =  dest_addr - CONFIG_SYS_MONITOR_BASE;
 422
 423         monitor_flash_len = (ulong)&__init_end - dest_addr;
 424
 425 #if defined(CONFIG_NEEDS_MANUAL_RELOC)
 426         /*
 427          * We have to relocate the command table manually
 428          */
 429         fixup_cmdtable(&__u_boot_cmd_start,
 430                 (ulong)(&__u_boot_cmd_end - &__u_boot_cmd_start));
 431 #endif /* defined(CONFIG_NEEDS_MANUAL_RELOC) */
 432
 433         /* there are some other pointer constants we must deal with */
 434 #ifndef CONFIG_ENV_IS_NOWHERE
 435         env_name_spec += gd->reloc_off;
 436 #endif
 437
 438         WATCHDOG_RESET ();
 439
 440 #ifdef CONFIG_LOGBUFFER
 441         logbuff_init_ptrs ();
 442 #endif
 443 #ifdef CONFIG_POST
 444         post_output_backlog ();
 445         post_reloc ();
 446 #endif
 447         WATCHDOG_RESET();
 448
 449 #if 0
 450         /* instruction cache enabled in cpu_init_f() for faster relocation */
 451         icache_enable ();       /* it's time to enable the instruction cache */
 452 #endif
 453
 454         /*
 455          * Setup trap handlers
 456          */
 457         trap_init (CONFIG_SYS_SDRAM_BASE);
 458
 459         /* The Malloc area is immediately below the monitor copy in DRAM */
 460         mem_malloc_init (CONFIG_SYS_MONITOR_BASE + gd->reloc_off -
 461                         TOTAL_MALLOC_LEN, TOTAL_MALLOC_LEN);
 462         malloc_bin_reloc ();
 463
 464 #if !defined(CONFIG_SYS_NO_FLASH)
 465         puts ("Flash: ");
 466
 467         if ((flash_size = flash_init ()) > 0) {
 468 # ifdef CONFIG_SYS_FLASH_CHECKSUM
 469                 print_size (flash_size, "");
 470                 /*
 471                  * Compute and print flash CRC if flashchecksum is set to 'y'
 472                  *
 473                  * NOTE: Maybe we should add some WATCHDOG_RESET()? XXX
 474                  */
 475                 s = getenv ("flashchecksum");
 476                 if (s && (*s == 'y')) {
 477                         printf ("  CRC: %08X",
 478                                         crc32 (0,
 479                                                    (const unsigned char *) CONFIG_SYS_FLASH_BASE,
 480                                                    flash_size)
 481                                         );
 482                 }
 483                 putc ('\n');
 484 # else  /* !CONFIG_SYS_FLASH_CHECKSUM */
 485                 print_size (flash_size, "\n");
 486 # endif /* CONFIG_SYS_FLASH_CHECKSUM */
 487         } else {
 488                 puts (failed);
 489                 hang ();
 490         }
 491
 492         bd->bi_flashstart = CONFIG_SYS_FLASH_BASE;      /* update start of FLASH memory    */
 493         bd->bi_flashsize = flash_size;  /* size of FLASH memory (final value) */
 494         bd->bi_flashoffset = 0;
 495 #else   /* CONFIG_SYS_NO_FLASH */
 496         bd->bi_flashsize = 0;
 497         bd->bi_flashstart = 0;
 498         bd->bi_flashoffset = 0;
 499 #endif /* !CONFIG_SYS_NO_FLASH */
 500
 501         WATCHDOG_RESET ();
 502
 503         /* initialize higher level parts of CPU like time base and timers */
 504         cpu_init_r ();
 505
 506         WATCHDOG_RESET ();
 507
 508 #ifdef CONFIG_SPI
 509 # if !defined(CONFIG_ENV_IS_IN_EEPROM)
 510         spi_init_f ();
 511 # endif
 512         spi_init_r ();
 513 #endif
 514
 515         /* relocate environment function pointers etc. */
 516         env_relocate ();
 517
 518         /*
 519          * Fill in missing fields of bd_info.
 520          * We do this here, where we have "normal" access to the
 521          * environment; we used to do this still running from ROM,
 522          * where had to use getenv_f(), which can be pretty slow when
 523          * the environment is in EEPROM.
 524          */
 525         bd->bi_ip_addr = getenv_IPaddr ("ipaddr");
 526
 527         WATCHDOG_RESET ();
 528
 529 #if defined(CONFIG_PCI)
 530         /*
 531          * Do pci configuration
 532          */
 533         pci_init ();
 534 #endif
 535
 536         /** leave this here (after malloc(), environment and PCI are working) **/
 537         /* Initialize stdio devices */
 538         stdio_init ();
 539
 540         /* Initialize the jump table for applications */
 541         jumptable_init ();
 542
 543         /* Initialize the console (after the relocation and devices init) */
 544         console_init_r ();
 545
 546 #if defined(CONFIG_MISC_INIT_R)
 547         /* miscellaneous platform dependent initialisations */
 548         misc_init_r ();
 549 #endif
 550
 551 #if defined(CONFIG_CMD_KGDB)
 552         WATCHDOG_RESET ();
 553         puts ("KGDB:  ");
 554         kgdb_init ();
 555 #endif
 556
 557         debug ("U-Boot relocated to %08lx\n", dest_addr);
 558
 559         /*
 560          * Enable Interrupts
 561          */
 562         interrupt_init ();
 563
 564         /* Must happen after interrupts are initialized since
 565          * an irq handler gets installed
 566          */
 567         timer_init();
 568
 569 #ifdef CONFIG_STATUS_LED
 570         status_led_set (STATUS_LED_BOOT, STATUS_LED_BLINKING);
 571 #endif
 572
 573         udelay (20);
 574
 575         /* Insert function pointers now that we have relocated the code */
 576
 577         /* Initialize from environment */
 578         if ((s = getenv ("loadaddr")) != NULL) {
 579                 load_addr = simple_strtoul (s, NULL, 16);
 580         }
 581 #if defined(CONFIG_CMD_NET)
 582         if ((s = getenv ("bootfile")) != NULL) {
 583                 copy_filename (BootFile, s, sizeof (BootFile));
 584         }
 585 #endif
 586
 587         WATCHDOG_RESET ();
 588
 589 #if defined(CONFIG_CMD_DOC)
 590         WATCHDOG_RESET ();
 591         puts ("DOC:   ");
 592         doc_init ();
 593 #endif
 594
 595 #if defined(CONFIG_CMD_NAND)
 596         WATCHDOG_RESET ();
 597         puts ("NAND:  ");
 598         nand_init();            /* go init the NAND */
 599 #endif
 600
 601 #ifdef CONFIG_BITBANGMII
 602         bb_miiphy_init();
 603 #endif
 604 #if defined(CONFIG_CMD_NET)
 605         WATCHDOG_RESET();
 606 #if defined(FEC_ENET)
 607         eth_init(bd);
 608 #endif
 609         puts ("Net:   ");
 610         eth_initialize (bd);
 611 #endif
 612
 613 #ifdef CONFIG_POST
 614         post_run (NULL, POST_RAM | post_bootmode_get(0));
 615 #endif
 616
 617 #if defined(CONFIG_CMD_PCMCIA) \
 618     && !defined(CONFIG_CMD_IDE)
 619         WATCHDOG_RESET ();
 620         puts ("PCMCIA:");
 621         pcmcia_init ();
 622 #endif
 623
 624 #if defined(CONFIG_CMD_IDE)
 625         WATCHDOG_RESET ();
 626         puts ("IDE:   ");
 627         ide_init ();
 628 #endif
 629
 630 #ifdef CONFIG_LAST_STAGE_INIT
 631         WATCHDOG_RESET ();
 632         /*
 633          * Some parts can be only initialized if all others (like
 634          * Interrupts) are up and running (i.e. the PC-style ISA
 635          * keyboard).
 636          */
 637         last_stage_init ();
 638 #endif
 639
 640 #if defined(CONFIG_CMD_BEDBUG)
 641         WATCHDOG_RESET ();
 642         bedbug_init ();
 643 #endif
 644
 645 #if defined(CONFIG_PRAM) || defined(CONFIG_LOGBUFFER)
 646         /*
 647          * Export available size of memory for Linux,
 648          * taking into account the protected RAM at top of memory
 649          */
 650         {
 651                 ulong pram;
 652                 char memsz[32];
 653 #ifdef CONFIG_PRAM
 654                 char *s;
 655
 656                 if ((s = getenv ("pram")) != NULL) {
 657                         pram = simple_strtoul (s, NULL, 10);
 658                 } else {
 659                         pram = CONFIG_PRAM;
 660                 }
 661 #else
 662                 pram=0;
 663 #endif
 664 #ifdef CONFIG_LOGBUFFER
 665                 /* Also take the logbuffer into account (pram is in kB) */
 666                 pram += (LOGBUFF_LEN+LOGBUFF_OVERHEAD)/1024;
 667 #endif
 668                 sprintf (memsz, "%ldk", (bd->bi_memsize / 1024) - pram);
 669                 setenv ("mem", memsz);
 670         }
 671 #endif
 672
 673 #ifdef CONFIG_MODEM_SUPPORT
 674  {
 675          extern int do_mdm_init;
 676          do_mdm_init = gd->do_mdm_init;
 677  }
 678 #endif
 679
 680 #ifdef CONFIG_WATCHDOG
 681         /* disable watchdog if environment is set */
 682         if ((s = getenv ("watchdog")) != NULL) {
 683                 if (strncmp (s, "off", 3) == 0) {
 684                         WATCHDOG_DISABLE ();
 685                 }
 686         }
 687 #endif /* CONFIG_WATCHDOG*/
 688
 689
 690         /* Initialization complete - start the monitor */
 691
 692         /* main_loop() can return to retry autoboot, if so just run it again. */
 693         for (;;) {
 694                 WATCHDOG_RESET ();
 695                 main_loop ();
 696         }
 697
 698         /* NOTREACHED - no way out of command loop except booting */
 699 }
 700
 701
 702 void hang(void)
 703 {
 704         puts ("### ERROR ### Please RESET the board ###\n");
 705         for (;;);
 706 }