blob: ae0ecb29ebf1f54b91f35ea6bcf79f3b2e002633 [file] [log] [blame]
wdenkfe8c2802002-11-03 00:38:21 +00001/*
wdenkd4ca31c2004-01-02 14:00:00 +00002 * (C) Copyright 2000-2004
wdenkfe8c2802002-11-03 00:38:21 +00003 * 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>
wdenkfe8c2802002-11-03 00:38:21 +000029#ifdef CONFIG_8xx
30#include <mpc8xx.h>
31#endif
wdenk0db5bca2003-03-31 17:27:09 +000032#ifdef CONFIG_5xx
33#include <mpc5xx.h>
34#endif
wdenkcbd8a352004-02-24 02:00:03 +000035#ifdef CONFIG_MPC5xxx
wdenk945af8d2003-07-16 21:53:01 +000036#include <mpc5xxx.h>
37#endif
wdenkfe8c2802002-11-03 00:38:21 +000038#if (CONFIG_COMMANDS & CFG_CMD_IDE)
39#include <ide.h>
40#endif
41#if (CONFIG_COMMANDS & CFG_CMD_SCSI)
42#include <scsi.h>
43#endif
44#if (CONFIG_COMMANDS & CFG_CMD_KGDB)
45#include <kgdb.h>
46#endif
47#ifdef CONFIG_STATUS_LED
48#include <status_led.h>
49#endif
50#include <net.h>
wdenkfe8c2802002-11-03 00:38:21 +000051#ifdef CFG_ALLOC_DPRAM
wdenk42d1f032003-10-15 23:53:47 +000052#if !(defined(CONFIG_8260)||defined(CONFIG_MPC8560))
wdenkfe8c2802002-11-03 00:38:21 +000053#include <commproc.h>
54#endif
wdenk7aa78612003-05-03 15:50:43 +000055#endif
wdenkfe8c2802002-11-03 00:38:21 +000056#include <version.h>
57#if defined(CONFIG_BAB7xx)
58#include <w83c553f.h>
59#endif
60#include <dtt.h>
61#if defined(CONFIG_POST)
62#include <post.h>
63#endif
wdenk56f94be2002-11-05 16:35:14 +000064#if defined(CONFIG_LOGBUFFER)
65#include <logbuff.h>
66#endif
wdenk42d1f032003-10-15 23:53:47 +000067#if defined(CFG_INIT_RAM_LOCK) && defined(CONFIG_E500)
68#include <asm/cache.h>
69#endif
wdenk1c437712004-01-16 00:30:56 +000070#ifdef CONFIG_PS2KBD
71#include <keyboard.h>
72#endif
wdenkfe8c2802002-11-03 00:38:21 +000073
74#if (CONFIG_COMMANDS & CFG_CMD_DOC)
75void doc_init (void);
76#endif
77#if defined(CONFIG_HARD_I2C) || \
78 defined(CONFIG_SOFT_I2C)
79#include <i2c.h>
80#endif
stroesebedc4972003-05-23 11:16:49 +000081#if (CONFIG_COMMANDS & CFG_CMD_NAND)
82void nand_init (void);
83#endif
wdenkfe8c2802002-11-03 00:38:21 +000084
85static char *failed = "*** failed ***\n";
86
wdenkfe8c2802002-11-03 00:38:21 +000087extern flash_info_t flash_info[];
wdenkfe8c2802002-11-03 00:38:21 +000088
89#include <environment.h>
90
wdenk7e780362004-04-08 22:31:29 +000091#if defined(CFG_ENV_IS_EMBEDDED)
92#define TOTAL_MALLOC_LEN CFG_MALLOC_LEN
93#elif ( ((CFG_ENV_ADDR+CFG_ENV_SIZE) < CFG_MONITOR_BASE) || \
94 (CFG_ENV_ADDR >= (CFG_MONITOR_BASE + CFG_MONITOR_LEN)) ) || \
95 defined(CFG_ENV_IS_IN_NVRAM)
wdenkfe8c2802002-11-03 00:38:21 +000096#define TOTAL_MALLOC_LEN (CFG_MALLOC_LEN + CFG_ENV_SIZE)
97#else
98#define TOTAL_MALLOC_LEN CFG_MALLOC_LEN
99#endif
100
wdenk3b57fe02003-05-30 12:48:29 +0000101extern ulong __init_end;
102extern ulong _end;
wdenk3b57fe02003-05-30 12:48:29 +0000103ulong monitor_flash_len;
104
wdenk8bde7f72003-06-27 21:31:46 +0000105#if (CONFIG_COMMANDS & CFG_CMD_BEDBUG)
106#include <bedbug/type.h>
107#endif
108
wdenkfe8c2802002-11-03 00:38:21 +0000109/*
110 * Begin and End of memory area for malloc(), and current "brk"
111 */
112static ulong mem_malloc_start = 0;
113static ulong mem_malloc_end = 0;
114static ulong mem_malloc_brk = 0;
115
116/************************************************************************
117 * Utilities *
118 ************************************************************************
119 */
120
121/*
122 * The Malloc area is immediately below the monitor copy in DRAM
123 */
124static void mem_malloc_init (void)
125{
126 DECLARE_GLOBAL_DATA_PTR;
127
128 ulong dest_addr = CFG_MONITOR_BASE + gd->reloc_off;
129
130 mem_malloc_end = dest_addr;
131 mem_malloc_start = dest_addr - TOTAL_MALLOC_LEN;
132 mem_malloc_brk = mem_malloc_start;
133
134 memset ((void *) mem_malloc_start,
135 0,
136 mem_malloc_end - mem_malloc_start);
137}
138
139void *sbrk (ptrdiff_t increment)
140{
141 ulong old = mem_malloc_brk;
142 ulong new = old + increment;
143
144 if ((new < mem_malloc_start) || (new > mem_malloc_end)) {
145 return (NULL);
146 }
147 mem_malloc_brk = new;
148 return ((void *) old);
149}
150
151char *strmhz (char *buf, long hz)
152{
153 long l, n;
154 long m;
155
156 n = hz / 1000000L;
157 l = sprintf (buf, "%ld", n);
158 m = (hz % 1000000L) / 1000L;
159 if (m != 0)
160 sprintf (buf + l, ".%03ld", m);
161 return (buf);
162}
163
wdenkfe8c2802002-11-03 00:38:21 +0000164/*
165 * All attempts to come up with a "common" initialization sequence
166 * that works for all boards and architectures failed: some of the
167 * requirements are just _too_ different. To get rid of the resulting
168 * mess of board dependend #ifdef'ed code we now make the whole
169 * initialization sequence configurable to the user.
170 *
171 * The requirements for any new initalization function is simple: it
172 * receives a pointer to the "global data" structure as it's only
173 * argument, and returns an integer return code, where 0 means
174 * "continue" and != 0 means "fatal error, hang the system".
175 */
176typedef int (init_fnc_t) (void);
177
178/************************************************************************
179 * Init Utilities *
180 ************************************************************************
181 * Some of this code should be moved into the core functions,
182 * but let's get it working (again) first...
183 */
184
185static int init_baudrate (void)
186{
187 DECLARE_GLOBAL_DATA_PTR;
188
189 uchar tmp[64]; /* long enough for environment variables */
190 int i = getenv_r ("baudrate", tmp, sizeof (tmp));
191
192 gd->baudrate = (i > 0)
193 ? (int) simple_strtoul (tmp, NULL, 10)
194 : CONFIG_BAUDRATE;
wdenkfe8c2802002-11-03 00:38:21 +0000195 return (0);
196}
197
198/***********************************************************************/
199
200static int init_func_ram (void)
201{
202 DECLARE_GLOBAL_DATA_PTR;
203
204#ifdef CONFIG_BOARD_TYPES
205 int board_type = gd->board_type;
206#else
207 int board_type = 0; /* use dummy arg */
208#endif
209 puts ("DRAM: ");
210
211 if ((gd->ram_size = initdram (board_type)) > 0) {
212 print_size (gd->ram_size, "\n");
213 return (0);
214 }
215 puts (failed);
216 return (1);
217}
218
219/***********************************************************************/
220
221#if defined(CONFIG_HARD_I2C) || defined(CONFIG_SOFT_I2C)
222static int init_func_i2c (void)
223{
224 puts ("I2C: ");
225 i2c_init (CFG_I2C_SPEED, CFG_I2C_SLAVE);
226 puts ("ready\n");
227 return (0);
228}
229#endif
230
231/***********************************************************************/
232
233#if defined(CONFIG_WATCHDOG)
234static int init_func_watchdog_init (void)
235{
236 puts (" Watchdog enabled\n");
237 WATCHDOG_RESET ();
238 return (0);
239}
240# define INIT_FUNC_WATCHDOG_INIT init_func_watchdog_init,
241
242static int init_func_watchdog_reset (void)
243{
244 WATCHDOG_RESET ();
245 return (0);
246}
247# define INIT_FUNC_WATCHDOG_RESET init_func_watchdog_reset,
248#else
249# define INIT_FUNC_WATCHDOG_INIT /* undef */
250# define INIT_FUNC_WATCHDOG_RESET /* undef */
251#endif /* CONFIG_WATCHDOG */
252
253/************************************************************************
254 * Initialization sequence *
255 ************************************************************************
256 */
257
258init_fnc_t *init_sequence[] = {
259
wdenkc837dcb2004-01-20 23:12:12 +0000260#if defined(CONFIG_BOARD_EARLY_INIT_F)
261 board_early_init_f,
wdenkfe8c2802002-11-03 00:38:21 +0000262#endif
wdenkc178d3d2004-01-24 20:25:54 +0000263
264#if !defined(CONFIG_TQM866M)
wdenkfe8c2802002-11-03 00:38:21 +0000265 get_clocks, /* get CPU and bus clocks (etc.) */
266 init_timebase,
wdenkc178d3d2004-01-24 20:25:54 +0000267#endif
wdenkfe8c2802002-11-03 00:38:21 +0000268#ifdef CFG_ALLOC_DPRAM
wdenk42d1f032003-10-15 23:53:47 +0000269#if !(defined(CONFIG_8260) || defined(CONFIG_MPC8560))
wdenkfe8c2802002-11-03 00:38:21 +0000270 dpram_init,
271#endif
wdenk7aa78612003-05-03 15:50:43 +0000272#endif
wdenkfe8c2802002-11-03 00:38:21 +0000273#if defined(CONFIG_BOARD_POSTCLK_INIT)
274 board_postclk_init,
275#endif
276 env_init,
wdenkc178d3d2004-01-24 20:25:54 +0000277#if defined(CONFIG_TQM866M)
278 get_clocks_866, /* get CPU and bus clocks according to the environment variable */
279 sdram_adjust_866, /* adjust sdram refresh rate according to the new clock */
280 init_timebase,
281#endif
wdenkfe8c2802002-11-03 00:38:21 +0000282 init_baudrate,
283 serial_init,
284 console_init_f,
285 display_options,
286#if defined(CONFIG_8260)
287 prt_8260_rsr,
288 prt_8260_clks,
289#endif /* CONFIG_8260 */
290 checkcpu,
wdenkcbd8a352004-02-24 02:00:03 +0000291#if defined(CONFIG_MPC5xxx)
wdenk945af8d2003-07-16 21:53:01 +0000292 prt_mpc5xxx_clks,
wdenkcbd8a352004-02-24 02:00:03 +0000293#endif /* CONFIG_MPC5xxx */
wdenkfe8c2802002-11-03 00:38:21 +0000294 checkboard,
295 INIT_FUNC_WATCHDOG_INIT
wdenkc837dcb2004-01-20 23:12:12 +0000296#if defined(CONFIG_MISC_INIT_F)
wdenkfe8c2802002-11-03 00:38:21 +0000297 misc_init_f,
298#endif
299 INIT_FUNC_WATCHDOG_RESET
300#if defined(CONFIG_HARD_I2C) || defined(CONFIG_SOFT_I2C)
301 init_func_i2c,
302#endif
303#if defined(CONFIG_DTT) /* Digital Thermometers and Thermostats */
304 dtt_init,
305#endif
wdenk4532cb62003-04-27 22:52:51 +0000306#ifdef CONFIG_POST
307 post_init_f,
308#endif
wdenkfe8c2802002-11-03 00:38:21 +0000309 INIT_FUNC_WATCHDOG_RESET
310 init_func_ram,
311#if defined(CFG_DRAM_TEST)
312 testdram,
313#endif /* CFG_DRAM_TEST */
314 INIT_FUNC_WATCHDOG_RESET
315
316 NULL, /* Terminate this list */
317};
318
319/************************************************************************
320 *
321 * This is the first part of the initialization sequence that is
322 * implemented in C, but still running from ROM.
323 *
324 * The main purpose is to provide a (serial) console interface as
325 * soon as possible (so we can see any error messages), and to
326 * initialize the RAM so that we can relocate the monitor code to
327 * RAM.
328 *
329 * Be aware of the restrictions: global data is read-only, BSS is not
330 * initialized, and stack space is limited to a few kB.
331 *
332 ************************************************************************
333 */
334
335void board_init_f (ulong bootflag)
336{
337 DECLARE_GLOBAL_DATA_PTR;
338
339 bd_t *bd;
340 ulong len, addr, addr_sp;
341 gd_t *id;
342 init_fnc_t **init_fnc_ptr;
343#ifdef CONFIG_PRAM
344 int i;
345 ulong reg;
346 uchar tmp[64]; /* long enough for environment variables */
347#endif
348
349 /* Pointer is writable since we allocated a register for it */
350 gd = (gd_t *) (CFG_INIT_RAM_ADDR + CFG_GBL_DATA_OFFSET);
351
wdenk42d1f032003-10-15 23:53:47 +0000352#if !(defined(CONFIG_8260) || defined(CONFIG_MPC8560))
wdenkfe8c2802002-11-03 00:38:21 +0000353 /* Clear initial global data */
354 memset ((void *) gd, 0, sizeof (gd_t));
355#endif
356
357 for (init_fnc_ptr = init_sequence; *init_fnc_ptr; ++init_fnc_ptr) {
358 if ((*init_fnc_ptr) () != 0) {
359 hang ();
360 }
361 }
362
363 /*
364 * Now that we have DRAM mapped and working, we can
365 * relocate the code and continue running from DRAM.
366 *
367 * Reserve memory at end of RAM for (top down in that order):
wdenk8bde7f72003-06-27 21:31:46 +0000368 * - kernel log buffer
wdenkfe8c2802002-11-03 00:38:21 +0000369 * - protected RAM
370 * - LCD framebuffer
371 * - monitor code
372 * - board info struct
373 */
wdenk3b57fe02003-05-30 12:48:29 +0000374 len = (ulong)&_end - CFG_MONITOR_BASE;
wdenkfe8c2802002-11-03 00:38:21 +0000375
376#ifndef CONFIG_VERY_BIG_RAM
377 addr = CFG_SDRAM_BASE + gd->ram_size;
378#else
379 /* only allow stack below 256M */
380 addr = CFG_SDRAM_BASE +
381 (gd->ram_size > 256 << 20) ? 256 << 20 : gd->ram_size;
382#endif
383
wdenk228f29a2002-12-08 09:53:23 +0000384#ifdef CONFIG_LOGBUFFER
385 /* reserve kernel log buffer */
386 addr -= (LOGBUFF_RESERVE);
wdenk9d2b18a2003-06-28 23:11:04 +0000387 debug ("Reserving %dk for kernel logbuffer at %08lx\n", LOGBUFF_LEN, addr);
wdenk228f29a2002-12-08 09:53:23 +0000388#endif
389
wdenkfe8c2802002-11-03 00:38:21 +0000390#ifdef CONFIG_PRAM
391 /*
392 * reserve protected RAM
393 */
394 i = getenv_r ("pram", tmp, sizeof (tmp));
395 reg = (i > 0) ? simple_strtoul (tmp, NULL, 10) : CONFIG_PRAM;
396 addr -= (reg << 10); /* size is in kB */
wdenk9d2b18a2003-06-28 23:11:04 +0000397 debug ("Reserving %ldk for protected RAM at %08lx\n", reg, addr);
wdenkfe8c2802002-11-03 00:38:21 +0000398#endif /* CONFIG_PRAM */
399
400 /* round down to next 4 kB limit */
401 addr &= ~(4096 - 1);
wdenk9d2b18a2003-06-28 23:11:04 +0000402 debug ("Top of RAM usable for U-Boot at: %08lx\n", addr);
wdenkfe8c2802002-11-03 00:38:21 +0000403
404#ifdef CONFIG_LCD
405 /* reserve memory for LCD display (always full pages) */
406 addr = lcd_setmem (addr);
407 gd->fb_base = addr;
408#endif /* CONFIG_LCD */
409
410#if defined(CONFIG_VIDEO) && defined(CONFIG_8xx)
411 /* reserve memory for video display (always full pages) */
412 addr = video_setmem (addr);
413 gd->fb_base = addr;
414#endif /* CONFIG_VIDEO */
415
416 /*
417 * reserve memory for U-Boot code, data & bss
wdenk682011f2003-06-03 23:54:09 +0000418 * round down to next 4 kB limit
wdenkfe8c2802002-11-03 00:38:21 +0000419 */
420 addr -= len;
wdenk682011f2003-06-03 23:54:09 +0000421 addr &= ~(4096 - 1);
wdenkfe8c2802002-11-03 00:38:21 +0000422
wdenk9d2b18a2003-06-28 23:11:04 +0000423 debug ("Reserving %ldk for U-Boot at: %08lx\n", len >> 10, addr);
wdenkfe8c2802002-11-03 00:38:21 +0000424
wdenkc7de8292002-11-19 11:04:11 +0000425#ifdef CONFIG_AMIGAONEG3SE
426 gd->relocaddr = addr;
427#endif
428
wdenkfe8c2802002-11-03 00:38:21 +0000429 /*
430 * reserve memory for malloc() arena
431 */
432 addr_sp = addr - TOTAL_MALLOC_LEN;
wdenk9d2b18a2003-06-28 23:11:04 +0000433 debug ("Reserving %dk for malloc() at: %08lx\n",
wdenkfe8c2802002-11-03 00:38:21 +0000434 TOTAL_MALLOC_LEN >> 10, addr_sp);
wdenkfe8c2802002-11-03 00:38:21 +0000435
436 /*
437 * (permanently) allocate a Board Info struct
438 * and a permanent copy of the "global" data
439 */
440 addr_sp -= sizeof (bd_t);
441 bd = (bd_t *) addr_sp;
442 gd->bd = bd;
wdenk9d2b18a2003-06-28 23:11:04 +0000443 debug ("Reserving %d Bytes for Board Info at: %08lx\n",
wdenkfe8c2802002-11-03 00:38:21 +0000444 sizeof (bd_t), addr_sp);
wdenkfe8c2802002-11-03 00:38:21 +0000445 addr_sp -= sizeof (gd_t);
446 id = (gd_t *) addr_sp;
wdenk9d2b18a2003-06-28 23:11:04 +0000447 debug ("Reserving %d Bytes for Global Data at: %08lx\n",
wdenkfe8c2802002-11-03 00:38:21 +0000448 sizeof (gd_t), addr_sp);
wdenkfe8c2802002-11-03 00:38:21 +0000449
450 /*
451 * Finally, we set up a new (bigger) stack.
452 *
453 * Leave some safety gap for SP, force alignment on 16 byte boundary
454 * Clear initial stack frame
455 */
456 addr_sp -= 16;
457 addr_sp &= ~0xF;
458 *((ulong *) addr_sp)-- = 0;
459 *((ulong *) addr_sp)-- = 0;
wdenk9d2b18a2003-06-28 23:11:04 +0000460 debug ("Stack Pointer at: %08lx\n", addr_sp);
wdenkfe8c2802002-11-03 00:38:21 +0000461
462 /*
463 * Save local variables to board info struct
464 */
465
wdenkc837dcb2004-01-20 23:12:12 +0000466 bd->bi_memstart = CFG_SDRAM_BASE; /* start of DRAM memory */
wdenkfe8c2802002-11-03 00:38:21 +0000467 bd->bi_memsize = gd->ram_size; /* size of DRAM memory in bytes */
468
469#ifdef CONFIG_IP860
wdenkc837dcb2004-01-20 23:12:12 +0000470 bd->bi_sramstart = SRAM_BASE; /* start of SRAM memory */
471 bd->bi_sramsize = SRAM_SIZE; /* size of SRAM memory */
wdenkfe8c2802002-11-03 00:38:21 +0000472#else
wdenkc837dcb2004-01-20 23:12:12 +0000473 bd->bi_sramstart = 0; /* FIXME */ /* start of SRAM memory */
474 bd->bi_sramsize = 0; /* FIXME */ /* size of SRAM memory */
wdenkfe8c2802002-11-03 00:38:21 +0000475#endif
476
wdenk42d1f032003-10-15 23:53:47 +0000477#if defined(CONFIG_8xx) || defined(CONFIG_8260) || defined(CONFIG_5xx) || \
478 defined(CONFIG_E500)
wdenkfe8c2802002-11-03 00:38:21 +0000479 bd->bi_immr_base = CFG_IMMR; /* base of IMMR register */
480#endif
wdenkcbd8a352004-02-24 02:00:03 +0000481#if defined(CONFIG_MPC5xxx)
wdenk945af8d2003-07-16 21:53:01 +0000482 bd->bi_mbar_base = CFG_MBAR; /* base of internal registers */
483#endif
wdenkfe8c2802002-11-03 00:38:21 +0000484
485 bd->bi_bootflags = bootflag; /* boot / reboot flag (for LynxOS) */
486
487 WATCHDOG_RESET ();
488 bd->bi_intfreq = gd->cpu_clk; /* Internal Freq, in Hz */
489 bd->bi_busfreq = gd->bus_clk; /* Bus Freq, in Hz */
wdenk42d1f032003-10-15 23:53:47 +0000490#if defined(CONFIG_8260) || defined(CONFIG_MPC8560)
wdenkfe8c2802002-11-03 00:38:21 +0000491 bd->bi_cpmfreq = gd->cpm_clk;
492 bd->bi_brgfreq = gd->brg_clk;
493 bd->bi_sccfreq = gd->scc_clk;
494 bd->bi_vco = gd->vco_out;
495#endif /* CONFIG_8260 */
wdenkcbd8a352004-02-24 02:00:03 +0000496#if defined(CONFIG_MPC5xxx)
wdenk945af8d2003-07-16 21:53:01 +0000497 bd->bi_ipbfreq = gd->ipb_clk;
498 bd->bi_pcifreq = gd->pci_clk;
wdenkcbd8a352004-02-24 02:00:03 +0000499#endif /* CONFIG_MPC5xxx */
wdenkfe8c2802002-11-03 00:38:21 +0000500 bd->bi_baudrate = gd->baudrate; /* Console Baudrate */
501
502#ifdef CFG_EXTBDINFO
503 strncpy (bd->bi_s_version, "1.2", sizeof (bd->bi_s_version));
504 strncpy (bd->bi_r_version, U_BOOT_VERSION, sizeof (bd->bi_r_version));
505
506 bd->bi_procfreq = gd->cpu_clk; /* Processor Speed, In Hz */
507 bd->bi_plb_busfreq = gd->bus_clk;
stroesebedc4972003-05-23 11:16:49 +0000508#if defined(CONFIG_405GP) || defined(CONFIG_405EP)
wdenkfe8c2802002-11-03 00:38:21 +0000509 bd->bi_pci_busfreq = get_PCI_freq ();
wdenk109c0e32004-03-23 21:43:07 +0000510 bd->bi_opbfreq = get_OPB_freq ();
wdenk5bb226e2003-11-17 21:14:37 +0000511
wdenkeeb1b772004-03-23 22:53:55 +0000512#if defined(CONFIG_I2CFAST)
513 /*
514 * set bi_iic_fast for linux taking environment variable
515 * "i2cfast" into account
516 */
517 {
518 char *s = getenv ("i2cfast");
519 if (s && ((*s == 'y') || (*s == 'Y'))) {
520 bd->bi_iic_fast[0] = 1;
521 bd->bi_iic_fast[1] = 1;
522 } else {
523 bd->bi_iic_fast[0] = 0;
524 bd->bi_iic_fast[1] = 0;
525 }
526 }
527#else
wdenk5bb226e2003-11-17 21:14:37 +0000528 bd->bi_iic_fast[0] = 0;
529 bd->bi_iic_fast[1] = 0;
wdenkeeb1b772004-03-23 22:53:55 +0000530#endif
531
wdenk028ab6b2004-02-23 23:54:43 +0000532#elif defined(CONFIG_XILINX_ML300)
533 bd->bi_pci_busfreq = get_PCI_freq ();
wdenkfe8c2802002-11-03 00:38:21 +0000534#endif
535#endif
536
wdenk9d2b18a2003-06-28 23:11:04 +0000537 debug ("New Stack Pointer is: %08lx\n", addr_sp);
wdenkfe8c2802002-11-03 00:38:21 +0000538
539 WATCHDOG_RESET ();
540
541#ifdef CONFIG_POST
542 post_bootmode_init();
wdenk6dff5522003-07-15 07:45:49 +0000543 post_run (NULL, POST_ROM | post_bootmode_get(0));
wdenkfe8c2802002-11-03 00:38:21 +0000544#endif
545
546 WATCHDOG_RESET();
547
wdenk27b207f2003-07-24 23:38:38 +0000548 memcpy (id, (void *)gd, sizeof (gd_t));
wdenkfe8c2802002-11-03 00:38:21 +0000549
550 relocate_code (addr_sp, id, addr);
551
552 /* NOTREACHED - relocate_code() does not return */
553}
554
555
556/************************************************************************
557 *
558 * This is the next part if the initialization sequence: we are now
559 * running from RAM and have a "normal" C environment, i. e. global
560 * data can be written, BSS has been cleared, the stack size in not
561 * that critical any more, etc.
562 *
563 ************************************************************************
564 */
565
566void board_init_r (gd_t *id, ulong dest_addr)
567{
568 DECLARE_GLOBAL_DATA_PTR;
wdenkfe8c2802002-11-03 00:38:21 +0000569 cmd_tbl_t *cmdtp;
570 char *s, *e;
571 bd_t *bd;
572 int i;
573 extern void malloc_bin_reloc (void);
574#ifndef CFG_ENV_IS_NOWHERE
575 extern char * env_name_spec;
576#endif
577
578#ifndef CFG_NO_FLASH
579 ulong flash_size;
580#endif
581
582 gd = id; /* initialize RAM version of global data */
583 bd = gd->bd;
584
585 gd->flags |= GD_FLG_RELOC; /* tell others: relocation done */
586
wdenk9d2b18a2003-06-28 23:11:04 +0000587 debug ("Now running in RAM - U-Boot at: %08lx\n", dest_addr);
wdenkfe8c2802002-11-03 00:38:21 +0000588
589 WATCHDOG_RESET ();
590
wdenkc837dcb2004-01-20 23:12:12 +0000591#if defined(CONFIG_BOARD_EARLY_INIT_R)
592 board_early_init_r ();
593#endif
594
wdenkfe8c2802002-11-03 00:38:21 +0000595 gd->reloc_off = dest_addr - CFG_MONITOR_BASE;
wdenk8bde7f72003-06-27 21:31:46 +0000596
wdenk3b57fe02003-05-30 12:48:29 +0000597 monitor_flash_len = (ulong)&__init_end - dest_addr;
wdenkfe8c2802002-11-03 00:38:21 +0000598
599 /*
600 * We have to relocate the command table manually
601 */
wdenk8bde7f72003-06-27 21:31:46 +0000602 for (cmdtp = &__u_boot_cmd_start; cmdtp != &__u_boot_cmd_end; cmdtp++) {
wdenkfe8c2802002-11-03 00:38:21 +0000603 ulong addr;
wdenkfe8c2802002-11-03 00:38:21 +0000604 addr = (ulong) (cmdtp->cmd) + gd->reloc_off;
605#if 0
606 printf ("Command \"%s\": 0x%08lx => 0x%08lx\n",
607 cmdtp->name, (ulong) (cmdtp->cmd), addr);
608#endif
609 cmdtp->cmd =
610 (int (*)(struct cmd_tbl_s *, int, int, char *[]))addr;
611
612 addr = (ulong)(cmdtp->name) + gd->reloc_off;
613 cmdtp->name = (char *)addr;
614
615 if (cmdtp->usage) {
616 addr = (ulong)(cmdtp->usage) + gd->reloc_off;
617 cmdtp->usage = (char *)addr;
618 }
619#ifdef CFG_LONGHELP
620 if (cmdtp->help) {
621 addr = (ulong)(cmdtp->help) + gd->reloc_off;
622 cmdtp->help = (char *)addr;
623 }
624#endif
625 }
626 /* there are some other pointer constants we must deal with */
627#ifndef CFG_ENV_IS_NOWHERE
628 env_name_spec += gd->reloc_off;
629#endif
630
631 WATCHDOG_RESET ();
632
wdenk56f94be2002-11-05 16:35:14 +0000633#ifdef CONFIG_LOGBUFFER
wdenk228f29a2002-12-08 09:53:23 +0000634 logbuff_init_ptrs ();
wdenk56f94be2002-11-05 16:35:14 +0000635#endif
wdenkfe8c2802002-11-03 00:38:21 +0000636#ifdef CONFIG_POST
wdenk228f29a2002-12-08 09:53:23 +0000637 post_output_backlog ();
wdenkfe8c2802002-11-03 00:38:21 +0000638 post_reloc ();
639#endif
640
641 WATCHDOG_RESET();
642
643#if defined(CONFIG_IP860) || defined(CONFIG_PCU_E) || defined (CONFIG_FLAGADM)
644 icache_enable (); /* it's time to enable the instruction cache */
645#endif
646
wdenk42d1f032003-10-15 23:53:47 +0000647#if defined(CFG_INIT_RAM_LOCK) && defined(CONFIG_E500)
wdenkc837dcb2004-01-20 23:12:12 +0000648 unlock_ram_in_cache(); /* it's time to unlock D-cache in e500 */
wdenk42d1f032003-10-15 23:53:47 +0000649#endif
650
wdenk3bac3512003-03-12 10:41:04 +0000651#if defined(CONFIG_BAB7xx) || defined(CONFIG_CPC45)
wdenkfe8c2802002-11-03 00:38:21 +0000652 /*
wdenk3bac3512003-03-12 10:41:04 +0000653 * Do PCI configuration on BAB7xx and CPC45 _before_ the flash
654 * gets initialised, because we need the ISA resp. PCI_to_LOCAL bus
655 * bridge there.
wdenkfe8c2802002-11-03 00:38:21 +0000656 */
657 pci_init ();
wdenk3bac3512003-03-12 10:41:04 +0000658#endif
659#if defined(CONFIG_BAB7xx)
wdenkfe8c2802002-11-03 00:38:21 +0000660 /*
661 * Initialise the ISA bridge
662 */
663 initialise_w83c553f ();
664#endif
665
666 asm ("sync ; isync");
667
668 /*
669 * Setup trap handlers
670 */
671 trap_init (dest_addr);
672
673#if !defined(CFG_NO_FLASH)
674 puts ("FLASH: ");
675
676 if ((flash_size = flash_init ()) > 0) {
wdenk0cb61d72003-08-30 00:05:50 +0000677# ifdef CFG_FLASH_CHECKSUM
wdenkfe8c2802002-11-03 00:38:21 +0000678 print_size (flash_size, "");
679 /*
680 * Compute and print flash CRC if flashchecksum is set to 'y'
681 *
682 * NOTE: Maybe we should add some WATCHDOG_RESET()? XXX
683 */
684 s = getenv ("flashchecksum");
685 if (s && (*s == 'y')) {
686 printf (" CRC: %08lX",
wdenk7e780362004-04-08 22:31:29 +0000687 crc32 (0, (const unsigned char *) CFG_FLASH_BASE, flash_size)
688 );
wdenkfe8c2802002-11-03 00:38:21 +0000689 }
690 putc ('\n');
wdenk0cb61d72003-08-30 00:05:50 +0000691# else /* !CFG_FLASH_CHECKSUM */
wdenkfe8c2802002-11-03 00:38:21 +0000692 print_size (flash_size, "\n");
wdenk0cb61d72003-08-30 00:05:50 +0000693# endif /* CFG_FLASH_CHECKSUM */
wdenkfe8c2802002-11-03 00:38:21 +0000694 } else {
695 puts (failed);
696 hang ();
697 }
698
699 bd->bi_flashstart = CFG_FLASH_BASE; /* update start of FLASH memory */
700 bd->bi_flashsize = flash_size; /* size of FLASH memory (final value) */
wdenk7e780362004-04-08 22:31:29 +0000701# if defined(CONFIG_PCU_E) || defined(CONFIG_OXC) || defined(CONFIG_RMU)
702 /* flash mapped at end of memory map */
703 bd->bi_flashoffset = TEXT_BASE + flash_size;
wdenk0cb61d72003-08-30 00:05:50 +0000704# elif CFG_MONITOR_BASE == CFG_FLASH_BASE
wdenk3b57fe02003-05-30 12:48:29 +0000705 bd->bi_flashoffset = monitor_flash_len; /* reserved area for startup monitor */
wdenk0cb61d72003-08-30 00:05:50 +0000706# else
wdenkfe8c2802002-11-03 00:38:21 +0000707 bd->bi_flashoffset = 0;
wdenk0cb61d72003-08-30 00:05:50 +0000708# endif
709#else /* CFG_NO_FLASH */
wdenkfe8c2802002-11-03 00:38:21 +0000710
711 bd->bi_flashsize = 0;
712 bd->bi_flashstart = 0;
713 bd->bi_flashoffset = 0;
714#endif /* !CFG_NO_FLASH */
715
716 WATCHDOG_RESET ();
717
718 /* initialize higher level parts of CPU like time base and timers */
719 cpu_init_r ();
720
721 WATCHDOG_RESET ();
722
723 /* initialize malloc() area */
724 mem_malloc_init ();
725 malloc_bin_reloc ();
726
727#ifdef CONFIG_SPI
728# if !defined(CFG_ENV_IS_IN_EEPROM)
729 spi_init_f ();
730# endif
731 spi_init_r ();
732#endif
733
734 /* relocate environment function pointers etc. */
735 env_relocate ();
736
737 /*
738 * Fill in missing fields of bd_info.
wdenk8bde7f72003-06-27 21:31:46 +0000739 * We do this here, where we have "normal" access to the
740 * environment; we used to do this still running from ROM,
741 * where had to use getenv_r(), which can be pretty slow when
742 * the environment is in EEPROM.
wdenkfe8c2802002-11-03 00:38:21 +0000743 */
744 s = getenv ("ethaddr");
745#if defined (CONFIG_MBX) || defined (CONFIG_RPXCLASSIC) || defined(CONFIG_IAD210)
746 if (s == NULL)
747 board_get_enetaddr (bd->bi_enetaddr);
748 else
749#endif
750 for (i = 0; i < 6; ++i) {
751 bd->bi_enetaddr[i] = s ? simple_strtoul (s, &e, 16) : 0;
752 if (s)
753 s = (*e) ? e + 1 : e;
754 }
755#ifdef CONFIG_HERMES
756 if ((gd->board_type >> 16) == 2)
757 bd->bi_ethspeed = gd->board_type & 0xFFFF;
758 else
759 bd->bi_ethspeed = 0xFFFF;
760#endif
761
762#ifdef CONFIG_NX823
763 load_sernum_ethaddr ();
764#endif
765
wdenk42d1f032003-10-15 23:53:47 +0000766#if defined(CFG_GT_6426x) || defined(CONFIG_PN62) || defined(CONFIG_PPCHAMELEONEVB) || \
wdenkba56f622004-02-06 23:19:44 +0000767 defined(CONFIG_MPC8540ADS) || defined(CONFIG_MPC8560ADS) || defined(CONFIG_440_GX)
wdenkfe8c2802002-11-03 00:38:21 +0000768 /* handle the 2nd ethernet address */
769
770 s = getenv ("eth1addr");
771
772 for (i = 0; i < 6; ++i) {
773 bd->bi_enet1addr[i] = s ? simple_strtoul (s, &e, 16) : 0;
774 if (s)
775 s = (*e) ? e + 1 : e;
776 }
777#endif
wdenkba56f622004-02-06 23:19:44 +0000778#if defined(CFG_GT_6426x) || defined(CONFIG_MPC8540ADS) || defined(CONFIG_MPC8560ADS) || \
779 defined(CONFIG_440_GX)
wdenkfe8c2802002-11-03 00:38:21 +0000780 /* handle the 3rd ethernet address */
781
782 s = getenv ("eth2addr");
wdenkba56f622004-02-06 23:19:44 +0000783#if defined(CONFIG_XPEDITE1K)
784 if (s == NULL)
785 board_get_enetaddr(bd->bi_enet2addr);
786 else
787#endif
wdenkfe8c2802002-11-03 00:38:21 +0000788 for (i = 0; i < 6; ++i) {
789 bd->bi_enet2addr[i] = s ? simple_strtoul (s, &e, 16) : 0;
790 if (s)
791 s = (*e) ? e + 1 : e;
792 }
793#endif
794
wdenkba56f622004-02-06 23:19:44 +0000795#if defined(CONFIG_440_GX)
796 /* handle 4th ethernet address */
797 s = getenv("eth3addr");
798#if defined(CONFIG_XPEDITE1K)
799 if (s == NULL)
800 board_get_enetaddr(bd->bi_enet3addr);
801 else
802#endif
803 for (i = 0; i < 6; ++i) {
804 bd->bi_enet3addr[i] = s ? simple_strtoul (s, &e, 16) : 0;
805 if (s)
806 s = (*e) ? e + 1 : e;
807 }
808#endif
wdenkfe8c2802002-11-03 00:38:21 +0000809
810#if defined(CONFIG_TQM8xxL) || defined(CONFIG_TQM8260) || \
811 defined(CONFIG_CCM)
812 load_sernum_ethaddr ();
813#endif
814 /* IP Address */
815 bd->bi_ip_addr = getenv_IPaddr ("ipaddr");
816
817 WATCHDOG_RESET ();
818
819#if defined(CONFIG_PCI) && !defined(CONFIG_BAB7xx)
820 /*
821 * Do pci configuration
822 */
823 pci_init ();
824#endif
825
826/** leave this here (after malloc(), environment and PCI are working) **/
827 /* Initialize devices */
828 devices_init ();
829
wdenk27b207f2003-07-24 23:38:38 +0000830 /* Initialize the jump table for applications */
831 jumptable_init ();
wdenkfe8c2802002-11-03 00:38:21 +0000832
833 /* Initialize the console (after the relocation and devices init) */
834 console_init_r ();
wdenkfe8c2802002-11-03 00:38:21 +0000835
836#if defined(CONFIG_CCM) || \
837 defined(CONFIG_COGENT) || \
838 defined(CONFIG_CPCI405) || \
839 defined(CONFIG_EVB64260) || \
wdenk56f94be2002-11-05 16:35:14 +0000840 defined(CONFIG_KUP4K) || \
wdenk0608e042004-03-25 19:29:38 +0000841 defined(CONFIG_KUP4X) || \
wdenkfe8c2802002-11-03 00:38:21 +0000842 defined(CONFIG_LWMON) || \
843 defined(CONFIG_PCU_E) || \
844 defined(CONFIG_W7O) || \
845 defined(CONFIG_MISC_INIT_R)
846 /* miscellaneous platform dependent initialisations */
847 misc_init_r ();
848#endif
849
850#ifdef CONFIG_HERMES
851 if (bd->bi_ethspeed != 0xFFFF)
852 hermes_start_lxt980 ((int) bd->bi_ethspeed);
853#endif
854
855#if (CONFIG_COMMANDS & CFG_CMD_NET) && ( \
856 defined(CONFIG_CCM) || \
wdenk3bac3512003-03-12 10:41:04 +0000857 defined(CONFIG_ELPT860) || \
wdenkfe8c2802002-11-03 00:38:21 +0000858 defined(CONFIG_EP8260) || \
859 defined(CONFIG_IP860) || \
860 defined(CONFIG_IVML24) || \
861 defined(CONFIG_IVMS8) || \
862 defined(CONFIG_LWMON) || \
863 defined(CONFIG_MPC8260ADS) || \
wdenk5d232d02003-05-22 22:52:13 +0000864 defined(CONFIG_MPC8266ADS) || \
wdenk42d1f032003-10-15 23:53:47 +0000865 defined(CONFIG_MPC8560ADS) || \
wdenkfe8c2802002-11-03 00:38:21 +0000866 defined(CONFIG_PCU_E) || \
867 defined(CONFIG_RPXSUPER) || \
868 defined(CONFIG_SPD823TS) )
869
870 WATCHDOG_RESET ();
wdenk9d2b18a2003-06-28 23:11:04 +0000871 debug ("Reset Ethernet PHY\n");
wdenkfe8c2802002-11-03 00:38:21 +0000872 reset_phy ();
873#endif
874
875#if (CONFIG_COMMANDS & CFG_CMD_KGDB)
876 WATCHDOG_RESET ();
877 puts ("KGDB: ");
878 kgdb_init ();
879#endif
880
wdenk9d2b18a2003-06-28 23:11:04 +0000881 debug ("U-Boot relocated to %08lx\n", dest_addr);
wdenkfe8c2802002-11-03 00:38:21 +0000882
883 /*
884 * Enable Interrupts
885 */
886 interrupt_init ();
887
888 /* Must happen after interrupts are initialized since
889 * an irq handler gets installed
890 */
wdenk42dfe7a2004-03-14 22:25:36 +0000891#ifdef CONFIG_SERIAL_SOFTWARE_FIFO
wdenkfe8c2802002-11-03 00:38:21 +0000892 serial_buffered_init();
893#endif
894
895#ifdef CONFIG_STATUS_LED
896 status_led_set (STATUS_LED_BOOT, STATUS_LED_BLINKING);
897#endif
898
899 udelay (20);
900
901 set_timer (0);
902
wdenkfe8c2802002-11-03 00:38:21 +0000903 /* Initialize from environment */
904 if ((s = getenv ("loadaddr")) != NULL) {
905 load_addr = simple_strtoul (s, NULL, 16);
906 }
907#if (CONFIG_COMMANDS & CFG_CMD_NET)
908 if ((s = getenv ("bootfile")) != NULL) {
909 copy_filename (BootFile, s, sizeof (BootFile));
910 }
911#endif /* CFG_CMD_NET */
912
913 WATCHDOG_RESET ();
914
915#if (CONFIG_COMMANDS & CFG_CMD_SCSI)
916 WATCHDOG_RESET ();
917 puts ("SCSI: ");
918 scsi_init ();
919#endif
920
921#if (CONFIG_COMMANDS & CFG_CMD_DOC)
922 WATCHDOG_RESET ();
923 puts ("DOC: ");
924 doc_init ();
925#endif
926
stroesebedc4972003-05-23 11:16:49 +0000927#if (CONFIG_COMMANDS & CFG_CMD_NAND)
928 WATCHDOG_RESET ();
wdenka43278a2003-09-11 19:48:06 +0000929 puts ("NAND:");
stroesebedc4972003-05-23 11:16:49 +0000930 nand_init(); /* go init the NAND */
931#endif
932
wdenkfe8c2802002-11-03 00:38:21 +0000933#if (CONFIG_COMMANDS & CFG_CMD_NET) && defined(CONFIG_NET_MULTI)
934 WATCHDOG_RESET ();
935 puts ("Net: ");
936 eth_initialize (bd);
937#endif
938
939#ifdef CONFIG_POST
wdenk6dff5522003-07-15 07:45:49 +0000940 post_run (NULL, POST_RAM | post_bootmode_get(0));
wdenkfe8c2802002-11-03 00:38:21 +0000941#endif
942
943#if (CONFIG_COMMANDS & CFG_CMD_PCMCIA) && !(CONFIG_COMMANDS & CFG_CMD_IDE)
944 WATCHDOG_RESET ();
945 puts ("PCMCIA:");
946 pcmcia_init ();
947#endif
948
949#if (CONFIG_COMMANDS & CFG_CMD_IDE)
950 WATCHDOG_RESET ();
951# ifdef CONFIG_IDE_8xx_PCCARD
952 puts ("PCMCIA:");
953# else
954 puts ("IDE: ");
955#endif
956 ide_init ();
957#endif /* CFG_CMD_IDE */
958
959#ifdef CONFIG_LAST_STAGE_INIT
960 WATCHDOG_RESET ();
961 /*
962 * Some parts can be only initialized if all others (like
963 * Interrupts) are up and running (i.e. the PC-style ISA
964 * keyboard).
965 */
966 last_stage_init ();
967#endif
968
969#if (CONFIG_COMMANDS & CFG_CMD_BEDBUG)
970 WATCHDOG_RESET ();
971 bedbug_init ();
972#endif
973
wdenk228f29a2002-12-08 09:53:23 +0000974#if defined(CONFIG_PRAM) || defined(CONFIG_LOGBUFFER)
wdenkfe8c2802002-11-03 00:38:21 +0000975 /*
976 * Export available size of memory for Linux,
977 * taking into account the protected RAM at top of memory
978 */
979 {
980 ulong pram;
wdenkfe8c2802002-11-03 00:38:21 +0000981 uchar memsz[32];
wdenk228f29a2002-12-08 09:53:23 +0000982#ifdef CONFIG_PRAM
983 char *s;
wdenkfe8c2802002-11-03 00:38:21 +0000984
985 if ((s = getenv ("pram")) != NULL) {
986 pram = simple_strtoul (s, NULL, 10);
987 } else {
988 pram = CONFIG_PRAM;
989 }
wdenk228f29a2002-12-08 09:53:23 +0000990#else
991 pram=0;
992#endif
993#ifdef CONFIG_LOGBUFFER
994 /* Also take the logbuffer into account (pram is in kB) */
995 pram += (LOGBUFF_LEN+LOGBUFF_OVERHEAD)/1024;
996#endif
wdenkfe8c2802002-11-03 00:38:21 +0000997 sprintf (memsz, "%ldk", (bd->bi_memsize / 1024) - pram);
998 setenv ("mem", memsz);
999 }
1000#endif
1001
wdenk1c437712004-01-16 00:30:56 +00001002#ifdef CONFIG_PS2KBD
1003 puts ("PS/2: ");
1004 kbd_init();
1005#endif
1006
wdenk4532cb62003-04-27 22:52:51 +00001007#ifdef CONFIG_MODEM_SUPPORT
1008 {
1009 extern int do_mdm_init;
1010 do_mdm_init = gd->do_mdm_init;
1011 }
1012#endif
1013
wdenkfe8c2802002-11-03 00:38:21 +00001014 /* Initialization complete - start the monitor */
1015
1016 /* main_loop() can return to retry autoboot, if so just run it again. */
1017 for (;;) {
1018 WATCHDOG_RESET ();
1019 main_loop ();
1020 }
1021
1022 /* NOTREACHED - no way out of command loop except booting */
1023}
1024
1025void hang (void)
1026{
1027 puts ("### ERROR ### Please RESET the board ###\n");
wdenk63e73c92004-02-23 22:22:28 +00001028#ifdef CONFIG_SHOW_BOOT_PROGRESS
1029 show_boot_progress(-30);
1030#endif
wdenkfe8c2802002-11-03 00:38:21 +00001031 for (;;);
1032}
1033
wdenk4532cb62003-04-27 22:52:51 +00001034#ifdef CONFIG_MODEM_SUPPORT
1035/* called from main loop (common/main.c) */
1036extern void dbg(const char *fmt, ...);
1037int mdm_init (void)
1038{
1039 char env_str[16];
1040 char *init_str;
1041 int i;
1042 extern char console_buffer[];
1043 static inline void mdm_readline(char *buf, int bufsiz);
1044 extern void enable_putc(void);
1045 extern int hwflow_onoff(int);
1046
1047 enable_putc(); /* enable serial_putc() */
1048
1049#ifdef CONFIG_HWFLOW
1050 init_str = getenv("mdm_flow_control");
1051 if (init_str && (strcmp(init_str, "rts/cts") == 0))
1052 hwflow_onoff (1);
1053 else
1054 hwflow_onoff(-1);
1055#endif
1056
1057 for (i = 1;;i++) {
1058 sprintf(env_str, "mdm_init%d", i);
1059 if ((init_str = getenv(env_str)) != NULL) {
1060 serial_puts(init_str);
1061 serial_puts("\n");
1062 for(;;) {
1063 mdm_readline(console_buffer, CFG_CBSIZE);
1064 dbg("ini%d: [%s]", i, console_buffer);
1065
1066 if ((strcmp(console_buffer, "OK") == 0) ||
1067 (strcmp(console_buffer, "ERROR") == 0)) {
1068 dbg("ini%d: cmd done", i);
1069 break;
1070 } else /* in case we are originating call ... */
1071 if (strncmp(console_buffer, "CONNECT", 7) == 0) {
1072 dbg("ini%d: connect", i);
1073 return 0;
1074 }
1075 }
1076 } else
1077 break; /* no init string - stop modem init */
1078
1079 udelay(100000);
1080 }
1081
1082 udelay(100000);
1083
1084 /* final stage - wait for connect */
1085 for(;i > 1;) { /* if 'i' > 1 - wait for connection
1086 message from modem */
1087 mdm_readline(console_buffer, CFG_CBSIZE);
1088 dbg("ini_f: [%s]", console_buffer);
1089 if (strncmp(console_buffer, "CONNECT", 7) == 0) {
1090 dbg("ini_f: connected");
1091 return 0;
1092 }
1093 }
1094
1095 return 0;
1096}
1097
1098/* 'inline' - We have to do it fast */
1099static inline void mdm_readline(char *buf, int bufsiz)
1100{
1101 char c;
1102 char *p;
1103 int n;
1104
1105 n = 0;
1106 p = buf;
1107 for(;;) {
1108 c = serial_getc();
1109
1110 /* dbg("(%c)", c); */
1111
1112 switch(c) {
1113 case '\r':
1114 break;
1115 case '\n':
1116 *p = '\0';
1117 return;
1118
1119 default:
1120 if(n++ > bufsiz) {
1121 *p = '\0';
1122 return; /* sanity check */
1123 }
1124 *p = c;
1125 p++;
1126 break;
1127 }
1128 }
1129}
1130#endif
1131
wdenkfe8c2802002-11-03 00:38:21 +00001132#if 0 /* We could use plain global data, but the resulting code is bigger */
1133/*
1134 * Pointer to initial global data area
1135 *
1136 * Here we initialize it.
1137 */
1138#undef XTRN_DECLARE_GLOBAL_DATA_PTR
1139#define XTRN_DECLARE_GLOBAL_DATA_PTR /* empty = allocate here */
1140DECLARE_GLOBAL_DATA_PTR = (gd_t *) (CFG_INIT_RAM_ADDR + CFG_GBL_DATA_OFFSET);
1141#endif /* 0 */
1142
1143/************************************************************************/