lib_ppc/board.c

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