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