lib_ppc/board.c

   1 /*
   2  * (C) Copyright 2000-2006
   3  * Wolfgang Denk, DENX Software Engineering, [email protected].
   4  *
   5  * See file CREDITS for list of people who contributed to this
   6  * project.
   7  *
   8  * This program is free software; you can redistribute it and/or
   9  * modify it under the terms of the GNU General Public License as
  10  * published by the Free Software Foundation; either version 2 of
  11  * the License, or (at your option) any later version.
  12  *
  13  * This program is distributed in the hope that it will be useful,
  14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16  * GNU General Public License for more details.
  17  *
  18  * You should have received a copy of the GNU General Public License
  19  * along with this program; if not, write to the Free Software
  20  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  21  * MA 02111-1307 USA
  22  */
  23
  24 #include <common.h>
  25 #include <watchdog.h>
  26 #include <command.h>
  27 #include <malloc.h>
  28 #include <devices.h>
  29 #ifdef CONFIG_8xx
  30 #include <mpc8xx.h>
  31 #endif
  32 #ifdef CONFIG_5xx
  33 #include <mpc5xx.h>
  34 #endif
  35 #ifdef CONFIG_MPC5xxx
  36 #include <mpc5xxx.h>
  37 #endif
  38 #if defined(CONFIG_CMD_IDE)
  39 #include <ide.h>
  40 #endif
  41 #if defined(CONFIG_CMD_SATA)
  42 #include <sata.h>
  43 #endif
  44 #if defined(CONFIG_CMD_SCSI)
  45 #include <scsi.h>
  46 #endif
  47 #if defined(CONFIG_CMD_KGDB)
  48 #include <kgdb.h>
  49 #endif
  50 #ifdef CONFIG_STATUS_LED
  51 #include <status_led.h>
  52 #endif
  53 #include <net.h>
  54 #include <serial.h>
  55 #ifdef CONFIG_SYS_ALLOC_DPRAM
  56 #if !defined(CONFIG_CPM2)
  57 #include <commproc.h>
  58 #endif
  59 #endif
  60 #include <version.h>
  61 #if defined(CONFIG_BAB7xx)
  62 #include <w83c553f.h>
  63 #endif
  64 #include <dtt.h>
  65 #if defined(CONFIG_POST)
  66 #include <post.h>
  67 #endif
  68 #if defined(CONFIG_LOGBUFFER)
  69 #include <logbuff.h>
  70 #endif
  71 #if defined(CONFIG_SYS_INIT_RAM_LOCK) && defined(CONFIG_E500)
  72 #include <asm/cache.h>
  73 #endif
  74 #ifdef CONFIG_PS2KBD
  75 #include <keyboard.h>
  76 #endif
  77
  78 #ifdef CONFIG_ADDR_MAP
  79 #include <asm/mmu.h>
  80 #endif
  81
  82 #ifdef CONFIG_SYS_UPDATE_FLASH_SIZE
  83 extern int update_flash_size (int flash_size);
  84 #endif
  85
  86 #if defined(CONFIG_SC3)
  87 extern void sc3_read_eeprom(void);
  88 #endif
  89
  90 #if defined(CONFIG_CMD_DOC)
  91 void doc_init (void);
  92 #endif
  93 #if defined(CONFIG_HARD_I2C) || \
  94     defined(CONFIG_SOFT_I2C)
  95 #include <i2c.h>
  96 #endif
  97 #include <spi.h>
  98 #include <nand.h>
  99
 100 static char *failed = "*** failed ***\n";
 101
 102 #if defined(CONFIG_OXC) || defined(CONFIG_PCU_E) || defined(CONFIG_RMU)
 103 extern flash_info_t flash_info[];
 104 #endif
 105
 106 #if defined(CONFIG_START_IDE)
 107 extern int board_start_ide(void);
 108 #endif
 109 #include <environment.h>
 110
 111 DECLARE_GLOBAL_DATA_PTR;
 112
 113 #if defined(CONFIG_ENV_IS_EMBEDDED)
 114 #define TOTAL_MALLOC_LEN        CONFIG_SYS_MALLOC_LEN
 115 #elif ( ((CONFIG_ENV_ADDR+CONFIG_ENV_SIZE) < CONFIG_SYS_MONITOR_BASE) || \
 116         (CONFIG_ENV_ADDR >= (CONFIG_SYS_MONITOR_BASE + CONFIG_SYS_MONITOR_LEN)) ) || \
 117       defined(CONFIG_ENV_IS_IN_NVRAM)
 118 #define TOTAL_MALLOC_LEN        (CONFIG_SYS_MALLOC_LEN + CONFIG_ENV_SIZE)
 119 #else
 120 #define TOTAL_MALLOC_LEN        CONFIG_SYS_MALLOC_LEN
 121 #endif
 122
 123 #if !defined(CONFIG_SYS_MEM_TOP_HIDE)
 124 #define CONFIG_SYS_MEM_TOP_HIDE 0
 125 #endif
 126
 127 extern ulong __init_end;
 128 extern ulong _end;
 129 ulong monitor_flash_len;
 130
 131 #if defined(CONFIG_CMD_BEDBUG)
 132 #include <bedbug/type.h>
 133 #endif
 134
 135 /*
 136  * Begin and End of memory area for malloc(), and current "brk"
 137  */
 138 static  ulong   mem_malloc_start = 0;
 139 static  ulong   mem_malloc_end   = 0;
 140 static  ulong   mem_malloc_brk   = 0;
 141
 142 /************************************************************************
 143  * Utilities                                                            *
 144  ************************************************************************
 145  */
 146
 147 /*
 148  * The Malloc area is immediately below the monitor copy in DRAM
 149  */
 150 static void mem_malloc_init (void)
 151 {
 152 #if !defined(CONFIG_RELOC_FIXUP_WORKS)
 153         mem_malloc_end = CONFIG_SYS_MONITOR_BASE + gd->reloc_off;
 154 #endif
 155         mem_malloc_start = mem_malloc_end - TOTAL_MALLOC_LEN;
 156         mem_malloc_brk = mem_malloc_start;
 157
 158         memset ((void *) mem_malloc_start,
 159                 0,
 160                 mem_malloc_end - mem_malloc_start);
 161 }
 162
 163 void *sbrk (ptrdiff_t increment)
 164 {
 165         ulong old = mem_malloc_brk;
 166         ulong new = old + increment;
 167
 168         if ((new < mem_malloc_start) || (new > mem_malloc_end)) {
 169                 return (NULL);
 170         }
 171         mem_malloc_brk = new;
 172         return ((void *) old);
 173 }
 174
 175 /*
 176  * All attempts to come up with a "common" initialization sequence
 177  * that works for all boards and architectures failed: some of the
 178  * requirements are just _too_ different. To get rid of the resulting
 179  * mess of board dependend #ifdef'ed code we now make the whole
 180  * initialization sequence configurable to the user.
 181  *
 182  * The requirements for any new initalization function is simple: it
 183  * receives a pointer to the "global data" structure as it's only
 184  * argument, and returns an integer return code, where 0 means
 185  * "continue" and != 0 means "fatal error, hang the system".
 186  */
 187 typedef int (init_fnc_t) (void);
 188
 189 /************************************************************************
 190  * Init Utilities                                                       *
 191  ************************************************************************
 192  * Some of this code should be moved into the core functions,
 193  * but let's get it working (again) first...
 194  */
 195
 196 static int init_baudrate (void)
 197 {
 198         char tmp[64];   /* long enough for environment variables */
 199         int i = getenv_r ("baudrate", tmp, sizeof (tmp));
 200
 201         gd->baudrate = (i > 0)
 202                         ? (int) simple_strtoul (tmp, NULL, 10)
 203                         : CONFIG_BAUDRATE;
 204         return (0);
 205 }
 206
 207 /***********************************************************************/
 208
 209 void __board_add_ram_info(int use_default)
 210 {
 211         /* please define platform specific board_add_ram_info() */
 212 }
 213 void board_add_ram_info(int) __attribute__((weak, alias("__board_add_ram_info")));
 214
 215
 216 static int init_func_ram (void)
 217 {
 218 #ifdef  CONFIG_BOARD_TYPES
 219         int board_type = gd->board_type;
 220 #else
 221         int board_type = 0;     /* use dummy arg */
 222 #endif
 223         puts ("DRAM:  ");
 224
 225         if ((gd->ram_size = initdram (board_type)) > 0) {
 226                 print_size (gd->ram_size, "");
 227                 board_add_ram_info(0);
 228                 putc('\n');
 229                 return (0);
 230         }
 231         puts (failed);
 232         return (1);
 233 }
 234
 235 /***********************************************************************/
 236
 237 #if defined(CONFIG_HARD_I2C) || defined(CONFIG_SOFT_I2C)
 238 static int init_func_i2c (void)
 239 {
 240         puts ("I2C:   ");
 241         i2c_init (CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE);
 242         puts ("ready\n");
 243         return (0);
 244 }
 245 #endif
 246
 247 #if defined(CONFIG_HARD_SPI)
 248 static int init_func_spi (void)
 249 {
 250         puts ("SPI:   ");
 251         spi_init ();
 252         puts ("ready\n");
 253         return (0);
 254 }
 255 #endif
 256
 257 /***********************************************************************/
 258
 259 #if defined(CONFIG_WATCHDOG)
 260 static int init_func_watchdog_init (void)
 261 {
 262         puts ("       Watchdog enabled\n");
 263         WATCHDOG_RESET ();
 264         return (0);
 265 }
 266 # define INIT_FUNC_WATCHDOG_INIT        init_func_watchdog_init,
 267
 268 static int init_func_watchdog_reset (void)
 269 {
 270         WATCHDOG_RESET ();
 271         return (0);
 272 }
 273 # define INIT_FUNC_WATCHDOG_RESET       init_func_watchdog_reset,
 274 #else
 275 # define INIT_FUNC_WATCHDOG_INIT        /* undef */
 276 # define INIT_FUNC_WATCHDOG_RESET       /* undef */
 277 #endif /* CONFIG_WATCHDOG */
 278
 279 /************************************************************************
 280  * Initialization sequence                                              *
 281  ************************************************************************
 282  */
 283
 284 init_fnc_t *init_sequence[] = {
 285
 286 #if defined(CONFIG_BOARD_EARLY_INIT_F)
 287         board_early_init_f,
 288 #endif
 289
 290 #if !defined(CONFIG_8xx_CPUCLK_DEFAULT)
 291         get_clocks,             /* get CPU and bus clocks (etc.) */
 292 #if defined(CONFIG_TQM8xxL) && !defined(CONFIG_TQM866M) \
 293     && !defined(CONFIG_TQM885D)
 294         adjust_sdram_tbs_8xx,
 295 #endif
 296         init_timebase,
 297 #endif
 298 #ifdef CONFIG_SYS_ALLOC_DPRAM
 299 #if !defined(CONFIG_CPM2)
 300         dpram_init,
 301 #endif
 302 #endif
 303 #if defined(CONFIG_BOARD_POSTCLK_INIT)
 304         board_postclk_init,
 305 #endif
 306         env_init,
 307 #if defined(CONFIG_8xx_CPUCLK_DEFAULT)
 308         get_clocks_866,         /* get CPU and bus clocks according to the environment variable */
 309         sdram_adjust_866,       /* adjust sdram refresh rate according to the new clock */
 310         init_timebase,
 311 #endif
 312         init_baudrate,
 313         serial_init,
 314         console_init_f,
 315         display_options,
 316 #if defined(CONFIG_8260)
 317         prt_8260_rsr,
 318         prt_8260_clks,
 319 #endif /* CONFIG_8260 */
 320 #if defined(CONFIG_MPC83XX)
 321         prt_83xx_rsr,
 322 #endif
 323         checkcpu,
 324 #if defined(CONFIG_MPC5xxx)
 325         prt_mpc5xxx_clks,
 326 #endif /* CONFIG_MPC5xxx */
 327 #if defined(CONFIG_MPC8220)
 328         prt_mpc8220_clks,
 329 #endif
 330         checkboard,
 331         INIT_FUNC_WATCHDOG_INIT
 332 #if defined(CONFIG_MISC_INIT_F)
 333         misc_init_f,
 334 #endif
 335         INIT_FUNC_WATCHDOG_RESET
 336 #if defined(CONFIG_HARD_I2C) || defined(CONFIG_SOFT_I2C)
 337         init_func_i2c,
 338 #endif
 339 #if defined(CONFIG_HARD_SPI)
 340         init_func_spi,
 341 #endif
 342 #if defined(CONFIG_DTT)         /* Digital Thermometers and Thermostats */
 343         dtt_init,
 344 #endif
 345 #ifdef CONFIG_POST
 346         post_init_f,
 347 #endif
 348         INIT_FUNC_WATCHDOG_RESET
 349         init_func_ram,
 350 #if defined(CONFIG_SYS_DRAM_TEST)
 351         testdram,
 352 #endif /* CONFIG_SYS_DRAM_TEST */
 353         INIT_FUNC_WATCHDOG_RESET
 354
 355         NULL,                   /* Terminate this list */
 356 };
 357
 358 #ifndef CONFIG_MAX_MEM_MAPPED
 359 #define CONFIG_MAX_MEM_MAPPED (256 << 20)
 360 #endif
 361 ulong get_effective_memsize(void)
 362 {
 363 #ifndef CONFIG_VERY_BIG_RAM
 364         return gd->ram_size;
 365 #else
 366         /* limit stack to what we can reasonable map */
 367         return ((gd->ram_size > CONFIG_MAX_MEM_MAPPED) ?
 368                  CONFIG_MAX_MEM_MAPPED : gd->ram_size);
 369 #endif
 370 }
 371
 372 /************************************************************************
 373  *
 374  * This is the first part of the initialization sequence that is
 375  * implemented in C, but still running from ROM.
 376  *
 377  * The main purpose is to provide a (serial) console interface as
 378  * soon as possible (so we can see any error messages), and to
 379  * initialize the RAM so that we can relocate the monitor code to
 380  * RAM.
 381  *
 382  * Be aware of the restrictions: global data is read-only, BSS is not
 383  * initialized, and stack space is limited to a few kB.
 384  *
 385  ************************************************************************
 386  */
 387
 388 #ifdef CONFIG_LOGBUFFER
 389 unsigned long logbuffer_base(void)
 390 {
 391         return CONFIG_SYS_SDRAM_BASE + get_effective_memsize() - LOGBUFF_LEN;
 392 }
 393 #endif
 394
 395 void board_init_f (ulong bootflag)
 396 {
 397         bd_t *bd;
 398         ulong len, addr, addr_sp;
 399         ulong *s;
 400         gd_t *id;
 401         init_fnc_t **init_fnc_ptr;
 402 #ifdef CONFIG_PRAM
 403         int i;
 404         ulong reg;
 405         uchar tmp[64];          /* long enough for environment variables */
 406 #endif
 407
 408         /* Pointer is writable since we allocated a register for it */
 409         gd = (gd_t *) (CONFIG_SYS_INIT_RAM_ADDR + CONFIG_SYS_GBL_DATA_OFFSET);
 410         /* compiler optimization barrier needed for GCC >= 3.4 */
 411         __asm__ __volatile__("": : :"memory");
 412
 413 #if !defined(CONFIG_CPM2) && !defined(CONFIG_MPC83XX) && \
 414     !defined(CONFIG_MPC85xx) && !defined(CONFIG_MPC86xx)
 415         /* Clear initial global data */
 416         memset ((void *) gd, 0, sizeof (gd_t));
 417 #endif
 418
 419         for (init_fnc_ptr = init_sequence; *init_fnc_ptr; ++init_fnc_ptr) {
 420                 if ((*init_fnc_ptr) () != 0) {
 421                         hang ();
 422                 }
 423         }
 424
 425         /*
 426          * Now that we have DRAM mapped and working, we can
 427          * relocate the code and continue running from DRAM.
 428          *
 429          * Reserve memory at end of RAM for (top down in that order):
 430          *  - area that won't get touched by U-Boot and Linux (optional)
 431          *  - kernel log buffer
 432          *  - protected RAM
 433          *  - LCD framebuffer
 434          *  - monitor code
 435          *  - board info struct
 436          */
 437         len = (ulong)&_end - CONFIG_SYS_MONITOR_BASE;
 438
 439         /*
 440          * Subtract specified amount of memory to hide so that it won't
 441          * get "touched" at all by U-Boot. By fixing up gd->ram_size
 442          * the Linux kernel should now get passed the now "corrected"
 443          * memory size and won't touch it either. This should work
 444          * for arch/ppc and arch/powerpc. Only Linux board ports in
 445          * arch/powerpc with bootwrapper support, that recalculate the
 446          * memory size from the SDRAM controller setup will have to
 447          * get fixed.
 448          */
 449         gd->ram_size -= CONFIG_SYS_MEM_TOP_HIDE;
 450
 451         addr = CONFIG_SYS_SDRAM_BASE + get_effective_memsize();
 452
 453 #ifdef CONFIG_LOGBUFFER
 454 #ifndef CONFIG_ALT_LB_ADDR
 455         /* reserve kernel log buffer */
 456         addr -= (LOGBUFF_RESERVE);
 457         debug ("Reserving %dk for kernel logbuffer at %08lx\n", LOGBUFF_LEN, addr);
 458 #endif
 459 #endif
 460
 461 #ifdef CONFIG_PRAM
 462         /*
 463          * reserve protected RAM
 464          */
 465         i = getenv_r ("pram", (char *)tmp, sizeof (tmp));
 466         reg = (i > 0) ? simple_strtoul ((const char *)tmp, NULL, 10) : CONFIG_PRAM;
 467         addr -= (reg << 10);            /* size is in kB */
 468         debug ("Reserving %ldk for protected RAM at %08lx\n", reg, addr);
 469 #endif /* CONFIG_PRAM */
 470
 471         /* round down to next 4 kB limit */
 472         addr &= ~(4096 - 1);
 473         debug ("Top of RAM usable for U-Boot at: %08lx\n", addr);
 474
 475 #ifdef CONFIG_LCD
 476         /* reserve memory for LCD display (always full pages) */
 477         addr = lcd_setmem (addr);
 478         gd->fb_base = addr;
 479 #endif /* CONFIG_LCD */
 480
 481 #if defined(CONFIG_VIDEO) && defined(CONFIG_8xx)
 482         /* reserve memory for video display (always full pages) */
 483         addr = video_setmem (addr);
 484         gd->fb_base = addr;
 485 #endif /* CONFIG_VIDEO  */
 486
 487         /*
 488          * reserve memory for U-Boot code, data & bss
 489          * round down to next 4 kB limit
 490          */
 491         addr -= len;
 492         addr &= ~(4096 - 1);
 493 #ifdef CONFIG_E500
 494         /* round down to next 64 kB limit so that IVPR stays aligned */
 495         addr &= ~(65536 - 1);
 496 #endif
 497
 498         debug ("Reserving %ldk for U-Boot at: %08lx\n", len >> 10, addr);
 499
 500 #ifdef CONFIG_AMIGAONEG3SE
 501         gd->relocaddr = addr;
 502 #endif
 503
 504         /*
 505          * reserve memory for malloc() arena
 506          */
 507         addr_sp = addr - TOTAL_MALLOC_LEN;
 508         debug ("Reserving %dk for malloc() at: %08lx\n",
 509                         TOTAL_MALLOC_LEN >> 10, addr_sp);
 510
 511         /*
 512          * (permanently) allocate a Board Info struct
 513          * and a permanent copy of the "global" data
 514          */
 515         addr_sp -= sizeof (bd_t);
 516         bd = (bd_t *) addr_sp;
 517         gd->bd = bd;
 518         debug ("Reserving %zu Bytes for Board Info at: %08lx\n",
 519                         sizeof (bd_t), addr_sp);
 520         addr_sp -= sizeof (gd_t);
 521         id = (gd_t *) addr_sp;
 522         debug ("Reserving %zu Bytes for Global Data at: %08lx\n",
 523                         sizeof (gd_t), addr_sp);
 524
 525         /*
 526          * Finally, we set up a new (bigger) stack.
 527          *
 528          * Leave some safety gap for SP, force alignment on 16 byte boundary
 529          * Clear initial stack frame
 530          */
 531         addr_sp -= 16;
 532         addr_sp &= ~0xF;
 533         s = (ulong *)addr_sp;
 534         *s-- = 0;
 535         *s-- = 0;
 536         addr_sp = (ulong)s;
 537         debug ("Stack Pointer at: %08lx\n", addr_sp);
 538
 539         /*
 540          * Save local variables to board info struct
 541          */
 542
 543         bd->bi_memstart  = CONFIG_SYS_SDRAM_BASE;       /* start of  DRAM memory        */
 544         bd->bi_memsize   = gd->ram_size;        /* size  of  DRAM memory in bytes */
 545
 546 #ifdef CONFIG_IP860
 547         bd->bi_sramstart = SRAM_BASE;   /* start of  SRAM memory        */
 548         bd->bi_sramsize  = SRAM_SIZE;   /* size  of  SRAM memory        */
 549 #elif defined CONFIG_MPC8220
 550         bd->bi_sramstart = CONFIG_SYS_SRAM_BASE;        /* start of  SRAM memory        */
 551         bd->bi_sramsize  = CONFIG_SYS_SRAM_SIZE;        /* size  of  SRAM memory        */
 552 #else
 553         bd->bi_sramstart = 0;           /* FIXME */ /* start of  SRAM memory    */
 554         bd->bi_sramsize  = 0;           /* FIXME */ /* size  of  SRAM memory    */
 555 #endif
 556
 557 #if defined(CONFIG_8xx) || defined(CONFIG_8260) || defined(CONFIG_5xx) || \
 558     defined(CONFIG_E500) || defined(CONFIG_MPC86xx)
 559         bd->bi_immr_base = CONFIG_SYS_IMMR;     /* base  of IMMR register     */
 560 #endif
 561 #if defined(CONFIG_MPC5xxx)
 562         bd->bi_mbar_base = CONFIG_SYS_MBAR;     /* base of internal registers */
 563 #endif
 564 #if defined(CONFIG_MPC83XX)
 565         bd->bi_immrbar = CONFIG_SYS_IMMR;
 566 #endif
 567 #if defined(CONFIG_MPC8220)
 568         bd->bi_mbar_base = CONFIG_SYS_MBAR;     /* base of internal registers */
 569         bd->bi_inpfreq   = gd->inp_clk;
 570         bd->bi_pcifreq   = gd->pci_clk;
 571         bd->bi_vcofreq   = gd->vco_clk;
 572         bd->bi_pevfreq   = gd->pev_clk;
 573         bd->bi_flbfreq   = gd->flb_clk;
 574
 575         /* store bootparam to sram (backward compatible), here? */
 576         {
 577                 u32 *sram = (u32 *)CONFIG_SYS_SRAM_BASE;
 578                 *sram++ = gd->ram_size;
 579                 *sram++ = gd->bus_clk;
 580                 *sram++ = gd->inp_clk;
 581                 *sram++ = gd->cpu_clk;
 582                 *sram++ = gd->vco_clk;
 583                 *sram++ = gd->flb_clk;
 584                 *sram++ = 0xb8c3ba11;  /* boot signature */
 585         }
 586 #endif
 587
 588         bd->bi_bootflags = bootflag;    /* boot / reboot flag (for LynxOS)    */
 589
 590         WATCHDOG_RESET ();
 591         bd->bi_intfreq = gd->cpu_clk;   /* Internal Freq, in Hz */
 592         bd->bi_busfreq = gd->bus_clk;   /* Bus Freq,      in Hz */
 593 #if defined(CONFIG_CPM2)
 594         bd->bi_cpmfreq = gd->cpm_clk;
 595         bd->bi_brgfreq = gd->brg_clk;
 596         bd->bi_sccfreq = gd->scc_clk;
 597         bd->bi_vco     = gd->vco_out;
 598 #endif /* CONFIG_CPM2 */
 599 #if defined(CONFIG_MPC512X)
 600         bd->bi_ipsfreq = gd->ips_clk;
 601 #endif /* CONFIG_MPC512X */
 602 #if defined(CONFIG_MPC5xxx)
 603         bd->bi_ipbfreq = gd->ipb_clk;
 604         bd->bi_pcifreq = gd->pci_clk;
 605 #endif /* CONFIG_MPC5xxx */
 606         bd->bi_baudrate = gd->baudrate; /* Console Baudrate     */
 607
 608 #ifdef CONFIG_SYS_EXTBDINFO
 609         strncpy ((char *)bd->bi_s_version, "1.2", sizeof (bd->bi_s_version));
 610         strncpy ((char *)bd->bi_r_version, U_BOOT_VERSION, sizeof (bd->bi_r_version));
 611
 612         bd->bi_procfreq = gd->cpu_clk;  /* Processor Speed, In Hz */
 613         bd->bi_plb_busfreq = gd->bus_clk;
 614 #if defined(CONFIG_405GP) || defined(CONFIG_405EP) || \
 615     defined(CONFIG_440EP) || defined(CONFIG_440GR) || \
 616     defined(CONFIG_440EPX) || defined(CONFIG_440GRX)
 617         bd->bi_pci_busfreq = get_PCI_freq ();
 618         bd->bi_opbfreq = get_OPB_freq ();
 619 #elif defined(CONFIG_XILINX_405)
 620         bd->bi_pci_busfreq = get_PCI_freq ();
 621 #endif
 622 #endif
 623
 624         debug ("New Stack Pointer is: %08lx\n", addr_sp);
 625
 626         WATCHDOG_RESET ();
 627
 628 #ifdef CONFIG_POST
 629         post_bootmode_init();
 630         post_run (NULL, POST_ROM | post_bootmode_get(0));
 631 #endif
 632
 633         WATCHDOG_RESET();
 634
 635         memcpy (id, (void *)gd, sizeof (gd_t));
 636
 637         relocate_code (addr_sp, id, addr);
 638
 639         /* NOTREACHED - relocate_code() does not return */
 640 }
 641
 642 int __is_sata_supported(void)
 643 {
 644         /* For some boards, when sata disabled by the switch, and the
 645          * driver still access the sata registers, the cpu will hangup.
 646          * please define platform specific is_sata_supported() if your
 647          * board have such issue.*/
 648         return 1;
 649 }
 650 int is_sata_supported(void) __attribute__((weak, alias("__is_sata_supported")));
 651
 652 /************************************************************************
 653  *
 654  * This is the next part if the initialization sequence: we are now
 655  * running from RAM and have a "normal" C environment, i. e. global
 656  * data can be written, BSS has been cleared, the stack size in not
 657  * that critical any more, etc.
 658  *
 659  ************************************************************************
 660  */
 661 void board_init_r (gd_t *id, ulong dest_addr)
 662 {
 663         cmd_tbl_t *cmdtp;
 664         char *s, *e;
 665         bd_t *bd;
 666         int i;
 667         extern void malloc_bin_reloc (void);
 668 #ifndef CONFIG_ENV_IS_NOWHERE
 669         extern char * env_name_spec;
 670 #endif
 671
 672 #ifndef CONFIG_SYS_NO_FLASH
 673         ulong flash_size;
 674 #endif
 675
 676         gd = id;                /* initialize RAM version of global data */
 677         bd = gd->bd;
 678
 679         gd->flags |= GD_FLG_RELOC;      /* tell others: relocation done */
 680
 681 #if defined(CONFIG_RELOC_FIXUP_WORKS)
 682         gd->reloc_off = 0;
 683         mem_malloc_end = dest_addr;
 684 #else
 685         gd->reloc_off = dest_addr - CONFIG_SYS_MONITOR_BASE;
 686 #endif
 687
 688 #ifdef CONFIG_SERIAL_MULTI
 689         serial_initialize();
 690 #endif
 691
 692         debug ("Now running in RAM - U-Boot at: %08lx\n", dest_addr);
 693
 694         WATCHDOG_RESET ();
 695
 696         /*
 697          * Setup trap handlers
 698          */
 699         trap_init (dest_addr);
 700
 701 #if defined(CONFIG_ADDR_MAP) && defined(CONFIG_E500)
 702         init_addr_map();
 703 #endif
 704
 705 #if defined(CONFIG_BOARD_EARLY_INIT_R)
 706         board_early_init_r ();
 707 #endif
 708
 709         monitor_flash_len = (ulong)&__init_end - dest_addr;
 710
 711         /*
 712          * We have to relocate the command table manually
 713          */
 714         for (cmdtp = &__u_boot_cmd_start; cmdtp !=  &__u_boot_cmd_end; cmdtp++) {
 715                 ulong addr;
 716                 addr = (ulong) (cmdtp->cmd) + gd->reloc_off;
 717 #if 0
 718                 printf ("Command \"%s\": 0x%08lx => 0x%08lx\n",
 719                                 cmdtp->name, (ulong) (cmdtp->cmd), addr);
 720 #endif
 721                 cmdtp->cmd =
 722                         (int (*)(struct cmd_tbl_s *, int, int, char *[]))addr;
 723
 724                 addr = (ulong)(cmdtp->name) + gd->reloc_off;
 725                 cmdtp->name = (char *)addr;
 726
 727                 if (cmdtp->usage) {
 728                         addr = (ulong)(cmdtp->usage) + gd->reloc_off;
 729                         cmdtp->usage = (char *)addr;
 730                 }
 731 #ifdef  CONFIG_SYS_LONGHELP
 732                 if (cmdtp->help) {
 733                         addr = (ulong)(cmdtp->help) + gd->reloc_off;
 734                         cmdtp->help = (char *)addr;
 735                 }
 736 #endif
 737         }
 738         /* there are some other pointer constants we must deal with */
 739 #ifndef CONFIG_ENV_IS_NOWHERE
 740         env_name_spec += gd->reloc_off;
 741 #endif
 742
 743         WATCHDOG_RESET ();
 744
 745 #ifdef CONFIG_LOGBUFFER
 746         logbuff_init_ptrs ();
 747 #endif
 748 #ifdef CONFIG_POST
 749         post_output_backlog ();
 750         post_reloc ();
 751 #endif
 752
 753         WATCHDOG_RESET();
 754
 755 #if defined(CONFIG_IP860) || defined(CONFIG_PCU_E) || \
 756         defined (CONFIG_FLAGADM) || defined(CONFIG_MPC83XX)
 757         icache_enable ();       /* it's time to enable the instruction cache */
 758 #endif
 759
 760 #if defined(CONFIG_SYS_INIT_RAM_LOCK) && defined(CONFIG_E500)
 761         unlock_ram_in_cache();  /* it's time to unlock D-cache in e500 */
 762 #endif
 763
 764 #if defined(CONFIG_BAB7xx) || defined(CONFIG_CPC45)
 765         /*
 766          * Do PCI configuration on BAB7xx and CPC45 _before_ the flash
 767          * gets initialised, because we need the ISA resp. PCI_to_LOCAL bus
 768          * bridge there.
 769          */
 770         pci_init ();
 771 #endif
 772 #if defined(CONFIG_BAB7xx)
 773         /*
 774          * Initialise the ISA bridge
 775          */
 776         initialise_w83c553f ();
 777 #endif
 778
 779         asm ("sync ; isync");
 780
 781 #if !defined(CONFIG_SYS_NO_FLASH)
 782         puts ("FLASH: ");
 783
 784         if ((flash_size = flash_init ()) > 0) {
 785 # ifdef CONFIG_SYS_FLASH_CHECKSUM
 786                 print_size (flash_size, "");
 787                 /*
 788                  * Compute and print flash CRC if flashchecksum is set to 'y'
 789                  *
 790                  * NOTE: Maybe we should add some WATCHDOG_RESET()? XXX
 791                  */
 792                 s = getenv ("flashchecksum");
 793                 if (s && (*s == 'y')) {
 794                         printf ("  CRC: %08X",
 795                                 crc32 (0, (const unsigned char *) CONFIG_SYS_FLASH_BASE, flash_size)
 796                         );
 797                 }
 798                 putc ('\n');
 799 # else  /* !CONFIG_SYS_FLASH_CHECKSUM */
 800                 print_size (flash_size, "\n");
 801 # endif /* CONFIG_SYS_FLASH_CHECKSUM */
 802         } else {
 803                 puts (failed);
 804                 hang ();
 805         }
 806
 807         bd->bi_flashstart = CONFIG_SYS_FLASH_BASE;      /* update start of FLASH memory    */
 808         bd->bi_flashsize = flash_size;  /* size of FLASH memory (final value) */
 809
 810 #if defined(CONFIG_SYS_UPDATE_FLASH_SIZE)
 811         /* Make a update of the Memctrl. */
 812         update_flash_size (flash_size);
 813 #endif
 814
 815
 816 # if defined(CONFIG_PCU_E) || defined(CONFIG_OXC) || defined(CONFIG_RMU)
 817         /* flash mapped at end of memory map */
 818         bd->bi_flashoffset = TEXT_BASE + flash_size;
 819 # elif CONFIG_SYS_MONITOR_BASE == CONFIG_SYS_FLASH_BASE
 820         bd->bi_flashoffset = monitor_flash_len; /* reserved area for startup monitor  */
 821 # else
 822         bd->bi_flashoffset = 0;
 823 # endif
 824 #else   /* CONFIG_SYS_NO_FLASH */
 825
 826         bd->bi_flashsize = 0;
 827         bd->bi_flashstart = 0;
 828         bd->bi_flashoffset = 0;
 829 #endif /* !CONFIG_SYS_NO_FLASH */
 830
 831         WATCHDOG_RESET ();
 832
 833         /* initialize higher level parts of CPU like time base and timers */
 834         cpu_init_r ();
 835
 836         WATCHDOG_RESET ();
 837
 838         /* initialize malloc() area */
 839         mem_malloc_init ();
 840         malloc_bin_reloc ();
 841
 842 #ifdef CONFIG_SPI
 843 # if !defined(CONFIG_ENV_IS_IN_EEPROM)
 844         spi_init_f ();
 845 # endif
 846         spi_init_r ();
 847 #endif
 848
 849 #if defined(CONFIG_CMD_NAND)
 850         WATCHDOG_RESET ();
 851         puts ("NAND:  ");
 852         nand_init();            /* go init the NAND */
 853 #endif
 854
 855         /* relocate environment function pointers etc. */
 856         env_relocate ();
 857
 858         /*
 859          * Fill in missing fields of bd_info.
 860          * We do this here, where we have "normal" access to the
 861          * environment; we used to do this still running from ROM,
 862          * where had to use getenv_r(), which can be pretty slow when
 863          * the environment is in EEPROM.
 864          */
 865
 866 #if defined(CONFIG_SYS_EXTBDINFO)
 867 #if defined(CONFIG_405GP) || defined(CONFIG_405EP)
 868 #if defined(CONFIG_I2CFAST)
 869         /*
 870          * set bi_iic_fast for linux taking environment variable
 871          * "i2cfast" into account
 872          */
 873         {
 874                 char *s = getenv ("i2cfast");
 875                 if (s && ((*s == 'y') || (*s == 'Y'))) {
 876                         bd->bi_iic_fast[0] = 1;
 877                         bd->bi_iic_fast[1] = 1;
 878                 } else {
 879                         bd->bi_iic_fast[0] = 0;
 880                         bd->bi_iic_fast[1] = 0;
 881                 }
 882         }
 883 #else
 884         bd->bi_iic_fast[0] = 0;
 885         bd->bi_iic_fast[1] = 0;
 886 #endif  /* CONFIG_I2CFAST */
 887 #endif  /* CONFIG_405GP, CONFIG_405EP */
 888 #endif  /* CONFIG_SYS_EXTBDINFO */
 889
 890 #if defined(CONFIG_SC3)
 891         sc3_read_eeprom();
 892 #endif
 893
 894 #if defined (CONFIG_ID_EEPROM) || defined (CONFIG_SYS_I2C_MAC_OFFSET)
 895         mac_read_from_eeprom();
 896 #endif
 897
 898         s = getenv ("ethaddr");
 899 #if defined (CONFIG_MBX) || \
 900     defined (CONFIG_RPXCLASSIC) || \
 901     defined(CONFIG_IAD210) || \
 902     defined(CONFIG_V38B)
 903         if (s == NULL)
 904                 board_get_enetaddr (bd->bi_enetaddr);
 905         else
 906 #endif
 907                 for (i = 0; i < 6; ++i) {
 908                         bd->bi_enetaddr[i] = s ? simple_strtoul (s, &e, 16) : 0;
 909                         if (s)
 910                                 s = (*e) ? e + 1 : e;
 911                 }
 912 #ifdef  CONFIG_HERMES
 913         if ((gd->board_type >> 16) == 2)
 914                 bd->bi_ethspeed = gd->board_type & 0xFFFF;
 915         else
 916                 bd->bi_ethspeed = 0xFFFF;
 917 #endif
 918
 919 #ifdef CONFIG_NX823
 920         load_sernum_ethaddr ();
 921 #endif
 922
 923 #ifdef CONFIG_HAS_ETH1
 924         /* handle the 2nd ethernet address */
 925
 926         s = getenv ("eth1addr");
 927
 928         for (i = 0; i < 6; ++i) {
 929                 bd->bi_enet1addr[i] = s ? simple_strtoul (s, &e, 16) : 0;
 930                 if (s)
 931                         s = (*e) ? e + 1 : e;
 932         }
 933 #endif
 934 #ifdef CONFIG_HAS_ETH2
 935         /* handle the 3rd ethernet address */
 936
 937         s = getenv ("eth2addr");
 938 #if defined(CONFIG_XPEDITE1K) || defined(CONFIG_METROBOX) || defined(CONFIG_KAREF)
 939         if (s == NULL)
 940                 board_get_enetaddr(bd->bi_enet2addr);
 941         else
 942 #endif
 943         for (i = 0; i < 6; ++i) {
 944                 bd->bi_enet2addr[i] = s ? simple_strtoul (s, &e, 16) : 0;
 945                 if (s)
 946                         s = (*e) ? e + 1 : e;
 947         }
 948 #endif
 949
 950 #ifdef CONFIG_HAS_ETH3
 951         /* handle 4th ethernet address */
 952         s = getenv("eth3addr");
 953 #if defined(CONFIG_XPEDITE1K) || defined(CONFIG_METROBOX) || defined(CONFIG_KAREF)
 954         if (s == NULL)
 955                 board_get_enetaddr(bd->bi_enet3addr);
 956         else
 957 #endif
 958         for (i = 0; i < 6; ++i) {
 959                 bd->bi_enet3addr[i] = s ? simple_strtoul (s, &e, 16) : 0;
 960                 if (s)
 961                         s = (*e) ? e + 1 : e;
 962         }
 963 #endif
 964
 965 #ifdef CONFIG_HAS_ETH4
 966         /* handle 5th ethernet address */
 967         s = getenv("eth4addr");
 968 #if defined(CONFIG_XPEDITE1K) || defined(CONFIG_METROBOX) || defined(CONFIG_KAREF)
 969         if (s == NULL)
 970                 board_get_enetaddr(bd->bi_enet4addr);
 971         else
 972 #endif
 973         for (i = 0; i < 6; ++i) {
 974                 bd->bi_enet4addr[i] = s ? simple_strtoul (s, &e, 16) : 0;
 975                 if (s)
 976                         s = (*e) ? e + 1 : e;
 977         }
 978 #endif
 979
 980 #ifdef CONFIG_HAS_ETH5
 981         /* handle 6th ethernet address */
 982         s = getenv("eth5addr");
 983 #if defined(CONFIG_XPEDITE1K) || defined(CONFIG_METROBOX) || defined(CONFIG_KAREF)
 984         if (s == NULL)
 985                 board_get_enetaddr(bd->bi_enet5addr);
 986         else
 987 #endif
 988         for (i = 0; i < 6; ++i) {
 989                 bd->bi_enet5addr[i] = s ? simple_strtoul (s, &e, 16) : 0;
 990                 if (s)
 991                         s = (*e) ? e + 1 : e;
 992         }
 993 #endif
 994
 995 #if defined(CONFIG_TQM8xxL) || defined(CONFIG_TQM8260) || \
 996     defined(CONFIG_TQM8272) || \
 997     defined(CONFIG_CCM) || defined(CONFIG_KUP4K) || \
 998     defined(CONFIG_KUP4X) || defined(CONFIG_PCS440EP)
 999         load_sernum_ethaddr ();
1000 #endif
1001         /* IP Address */
1002         bd->bi_ip_addr = getenv_IPaddr ("ipaddr");
1003
1004         WATCHDOG_RESET ();
1005
1006 #if defined(CONFIG_PCI) && !defined(CONFIG_BAB7xx) && !defined(CONFIG_CPC45)
1007         /*
1008          * Do pci configuration
1009          */
1010         pci_init ();
1011 #endif
1012
1013 /** leave this here (after malloc(), environment and PCI are working) **/
1014         /* Initialize devices */
1015         devices_init ();
1016
1017         /* Initialize the jump table for applications */
1018         jumptable_init ();
1019
1020 #if defined(CONFIG_API)
1021         /* Initialize API */
1022         api_init ();
1023 #endif
1024
1025         /* Initialize the console (after the relocation and devices init) */
1026         console_init_r ();
1027
1028 #if defined(CONFIG_CCM)         || \
1029     defined(CONFIG_COGENT)      || \
1030     defined(CONFIG_CPCI405)     || \
1031     defined(CONFIG_EVB64260)    || \
1032     defined(CONFIG_KUP4K)       || \
1033     defined(CONFIG_KUP4X)       || \
1034     defined(CONFIG_LWMON)       || \
1035     defined(CONFIG_PCU_E)       || \
1036     defined(CONFIG_SC3)         || \
1037     defined(CONFIG_W7O)         || \
1038     defined(CONFIG_MISC_INIT_R)
1039         /* miscellaneous platform dependent initialisations */
1040         misc_init_r ();
1041 #endif
1042
1043 #ifdef  CONFIG_HERMES
1044         if (bd->bi_ethspeed != 0xFFFF)
1045                 hermes_start_lxt980 ((int) bd->bi_ethspeed);
1046 #endif
1047
1048 #if defined(CONFIG_CMD_KGDB)
1049         WATCHDOG_RESET ();
1050         puts ("KGDB:  ");
1051         kgdb_init ();
1052 #endif
1053
1054         debug ("U-Boot relocated to %08lx\n", dest_addr);
1055
1056         /*
1057          * Enable Interrupts
1058          */
1059         interrupt_init ();
1060
1061         /* Must happen after interrupts are initialized since
1062          * an irq handler gets installed
1063          */
1064 #ifdef CONFIG_SERIAL_SOFTWARE_FIFO
1065         serial_buffered_init();
1066 #endif
1067
1068 #if defined(CONFIG_STATUS_LED) && defined(STATUS_LED_BOOT)
1069         status_led_set (STATUS_LED_BOOT, STATUS_LED_BLINKING);
1070 #endif
1071
1072         udelay (20);
1073
1074         set_timer (0);
1075
1076         /* Initialize from environment */
1077         if ((s = getenv ("loadaddr")) != NULL) {
1078                 load_addr = simple_strtoul (s, NULL, 16);
1079         }
1080 #if defined(CONFIG_CMD_NET)
1081         if ((s = getenv ("bootfile")) != NULL) {
1082                 copy_filename (BootFile, s, sizeof (BootFile));
1083         }
1084 #endif
1085
1086         WATCHDOG_RESET ();
1087
1088 #if defined(CONFIG_CMD_SCSI)
1089         WATCHDOG_RESET ();
1090         puts ("SCSI:  ");
1091         scsi_init ();
1092 #endif
1093
1094 #if defined(CONFIG_CMD_DOC)
1095         WATCHDOG_RESET ();
1096         puts ("DOC:   ");
1097         doc_init ();
1098 #endif
1099
1100 #if defined(CONFIG_CMD_NET)
1101 #if defined(CONFIG_NET_MULTI)
1102         WATCHDOG_RESET ();
1103         puts ("Net:   ");
1104 #endif
1105         eth_initialize (bd);
1106 #endif
1107
1108 #if defined(CONFIG_CMD_NET) && ( \
1109     defined(CONFIG_CCM)         || \
1110     defined(CONFIG_ELPT860)     || \
1111     defined(CONFIG_EP8260)      || \
1112     defined(CONFIG_IP860)       || \
1113     defined(CONFIG_IVML24)      || \
1114     defined(CONFIG_IVMS8)       || \
1115     defined(CONFIG_MPC8260ADS)  || \
1116     defined(CONFIG_MPC8266ADS)  || \
1117     defined(CONFIG_MPC8560ADS)  || \
1118     defined(CONFIG_PCU_E)       || \
1119     defined(CONFIG_RPXSUPER)    || \
1120     defined(CONFIG_STXGP3)      || \
1121     defined(CONFIG_SPD823TS)    || \
1122     defined(CONFIG_RESET_PHY_R) )
1123
1124         WATCHDOG_RESET ();
1125         debug ("Reset Ethernet PHY\n");
1126         reset_phy ();
1127 #endif
1128
1129 #ifdef CONFIG_POST
1130         post_run (NULL, POST_RAM | post_bootmode_get(0));
1131 #endif
1132
1133 #if defined(CONFIG_CMD_PCMCIA) \
1134     && !defined(CONFIG_CMD_IDE)
1135         WATCHDOG_RESET ();
1136         puts ("PCMCIA:");
1137         pcmcia_init ();
1138 #endif
1139
1140 #if defined(CONFIG_CMD_IDE)
1141         WATCHDOG_RESET ();
1142 # ifdef CONFIG_IDE_8xx_PCCARD
1143         puts ("PCMCIA:");
1144 # else
1145         puts ("IDE:   ");
1146 #endif
1147 #if defined(CONFIG_START_IDE)
1148         if (board_start_ide())
1149                 ide_init ();
1150 #else
1151         ide_init ();
1152 #endif
1153 #endif
1154
1155 #if defined(CONFIG_CMD_SATA)
1156         if (is_sata_supported()) {
1157                 puts("SATA:  ");
1158                 sata_initialize();
1159         }
1160 #endif
1161
1162 #ifdef CONFIG_LAST_STAGE_INIT
1163         WATCHDOG_RESET ();
1164         /*
1165          * Some parts can be only initialized if all others (like
1166          * Interrupts) are up and running (i.e. the PC-style ISA
1167          * keyboard).
1168          */
1169         last_stage_init ();
1170 #endif
1171
1172 #if defined(CONFIG_CMD_BEDBUG)
1173         WATCHDOG_RESET ();
1174         bedbug_init ();
1175 #endif
1176
1177 #if defined(CONFIG_PRAM) || defined(CONFIG_LOGBUFFER)
1178         /*
1179          * Export available size of memory for Linux,
1180          * taking into account the protected RAM at top of memory
1181          */
1182         {
1183                 ulong pram;
1184                 uchar memsz[32];
1185 #ifdef CONFIG_PRAM
1186                 char *s;
1187
1188                 if ((s = getenv ("pram")) != NULL) {
1189                         pram = simple_strtoul (s, NULL, 10);
1190                 } else {
1191                         pram = CONFIG_PRAM;
1192                 }
1193 #else
1194                 pram=0;
1195 #endif
1196 #ifdef CONFIG_LOGBUFFER
1197 #ifndef CONFIG_ALT_LB_ADDR
1198                 /* Also take the logbuffer into account (pram is in kB) */
1199                 pram += (LOGBUFF_LEN+LOGBUFF_OVERHEAD)/1024;
1200 #endif
1201 #endif
1202                 sprintf ((char *)memsz, "%ldk", (bd->bi_memsize / 1024) - pram);
1203                 setenv ("mem", (char *)memsz);
1204         }
1205 #endif
1206
1207 #ifdef CONFIG_PS2KBD
1208         puts ("PS/2:  ");
1209         kbd_init();
1210 #endif
1211
1212 #ifdef CONFIG_MODEM_SUPPORT
1213  {
1214          extern int do_mdm_init;
1215          do_mdm_init = gd->do_mdm_init;
1216  }
1217 #endif
1218
1219         /* Initialization complete - start the monitor */
1220
1221         /* main_loop() can return to retry autoboot, if so just run it again. */
1222         for (;;) {
1223                 WATCHDOG_RESET ();
1224                 main_loop ();
1225         }
1226
1227         /* NOTREACHED - no way out of command loop except booting */
1228 }
1229
1230 void hang (void)
1231 {
1232         puts ("### ERROR ### Please RESET the board ###\n");
1233         show_boot_progress(-30);
1234         for (;;);
1235 }
1236
1237 #ifdef CONFIG_MODEM_SUPPORT
1238 /* called from main loop (common/main.c) */
1239 /* 'inline' - We have to do it fast */
1240 static inline void mdm_readline(char *buf, int bufsiz)
1241 {
1242         char c;
1243         char *p;
1244         int n;
1245
1246         n = 0;
1247         p = buf;
1248         for(;;) {
1249                 c = serial_getc();
1250
1251                 /*              dbg("(%c)", c); */
1252
1253                 switch(c) {
1254                 case '\r':
1255                         break;
1256                 case '\n':
1257                         *p = '\0';
1258                         return;
1259
1260                 default:
1261                         if(n++ > bufsiz) {
1262                                 *p = '\0';
1263                                 return; /* sanity check */
1264                         }
1265                         *p = c;
1266                         p++;
1267                         break;
1268                 }
1269         }
1270 }
1271
1272 extern void  dbg(const char *fmt, ...);
1273 int mdm_init (void)
1274 {
1275         char env_str[16];
1276         char *init_str;
1277         int i;
1278         extern char console_buffer[];
1279         extern void enable_putc(void);
1280         extern int hwflow_onoff(int);
1281
1282         enable_putc(); /* enable serial_putc() */
1283
1284 #ifdef CONFIG_HWFLOW
1285         init_str = getenv("mdm_flow_control");
1286         if (init_str && (strcmp(init_str, "rts/cts") == 0))
1287                 hwflow_onoff (1);
1288         else
1289                 hwflow_onoff(-1);
1290 #endif
1291
1292         for (i = 1;;i++) {
1293                 sprintf(env_str, "mdm_init%d", i);
1294                 if ((init_str = getenv(env_str)) != NULL) {
1295                         serial_puts(init_str);
1296                         serial_puts("\n");
1297                         for(;;) {
1298                                 mdm_readline(console_buffer, CONFIG_SYS_CBSIZE);
1299                                 dbg("ini%d: [%s]", i, console_buffer);
1300
1301                                 if ((strcmp(console_buffer, "OK") == 0) ||
1302                                         (strcmp(console_buffer, "ERROR") == 0)) {
1303                                         dbg("ini%d: cmd done", i);
1304                                         break;
1305                                 } else /* in case we are originating call ... */
1306                                         if (strncmp(console_buffer, "CONNECT", 7) == 0) {
1307                                                 dbg("ini%d: connect", i);
1308                                                 return 0;
1309                                         }
1310                         }
1311                 } else
1312                         break; /* no init string - stop modem init */
1313
1314                 udelay(100000);
1315         }
1316
1317         udelay(100000);
1318
1319         /* final stage - wait for connect */
1320         for(;i > 1;) { /* if 'i' > 1 - wait for connection
1321                                   message from modem */
1322                 mdm_readline(console_buffer, CONFIG_SYS_CBSIZE);
1323                 dbg("ini_f: [%s]", console_buffer);
1324                 if (strncmp(console_buffer, "CONNECT", 7) == 0) {
1325                         dbg("ini_f: connected");
1326                         return 0;
1327                 }
1328         }
1329
1330         return 0;
1331 }
1332
1333 #endif
1334
1335 #if 0 /* We could use plain global data, but the resulting code is bigger */
1336 /*
1337  * Pointer to initial global data area
1338  *
1339  * Here we initialize it.
1340  */
1341 #undef  XTRN_DECLARE_GLOBAL_DATA_PTR
1342 #define XTRN_DECLARE_GLOBAL_DATA_PTR    /* empty = allocate here */
1343 DECLARE_GLOBAL_DATA_PTR = (gd_t *) (CONFIG_SYS_INIT_RAM_ADDR + CONFIG_SYS_GBL_DATA_OFFSET);
1344 #endif  /* 0 */
1345
1346 /************************************************************************/