blob: 5e0455391170942d8fd937b581787560e3fdbcb8 [file] [log] [blame]
wdenkc6097192002-11-03 00:24:07 +00001/*
Wolfgang Denk57cac1f2006-01-29 19:12:41 +01002 * (C) Copyright 2002-2006
wdenkc6097192002-11-03 00:24:07 +00003 * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
4 *
5 * (C) Copyright 2002
6 * Sysgo Real-Time Solutions, GmbH <www.elinos.com>
7 * Marius Groeger <mgroeger@sysgo.de>
8 *
9 * See file CREDITS for list of people who contributed to this
10 * project.
11 *
12 * This program is free software; you can redistribute it and/or
13 * modify it under the terms of the GNU General Public License as
14 * published by the Free Software Foundation; either version 2 of
15 * the License, or (at your option) any later version.
16 *
17 * This program is distributed in the hope that it will be useful,
18 * but WITHOUT ANY WARRANTY; without even the implied warranty of
19 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
20 * GNU General Public License for more details.
21 *
22 * You should have received a copy of the GNU General Public License
23 * along with this program; if not, write to the Free Software
24 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
25 * MA 02111-1307 USA
26 */
27
Wolfgang Denk57cac1f2006-01-29 19:12:41 +010028/*
29 * To match the U-Boot user interface on ARM platforms to the U-Boot
30 * standard (as on PPC platforms), some messages with debug character
31 * are removed from the default U-Boot build.
32 *
33 * Define DEBUG here if you want additional info as shown below
34 * printed upon startup:
35 *
36 * U-Boot code: 00F00000 -> 00F3C774 BSS: -> 00FC3274
37 * IRQ Stack: 00ebff7c
38 * FIQ Stack: 00ebef7c
39 */
40
wdenkc6097192002-11-03 00:24:07 +000041#include <common.h>
42#include <command.h>
wdenk3595ac42003-06-22 17:18:28 +000043#include <malloc.h>
wdenkc6097192002-11-03 00:24:07 +000044#include <devices.h>
45#include <version.h>
46#include <net.h>
Marcel Ziswilerb71190f2008-05-01 09:05:26 +020047#include <serial.h>
Scott Woodd6ac2ed2008-05-22 10:49:46 -050048#include <nand.h>
49#include <onenand_uboot.h>
wdenkc6097192002-11-03 00:24:07 +000050
wdenkf39748a2004-06-09 13:37:52 +000051#ifdef CONFIG_DRIVER_SMC91111
Jean-Christophe PLAGNIOL-VILLARD2439e4b2007-11-21 21:19:24 +010052#include "../drivers/net/smc91111.h"
wdenkf39748a2004-06-09 13:37:52 +000053#endif
54#ifdef CONFIG_DRIVER_LAN91C96
Jean-Christophe PLAGNIOL-VILLARD2439e4b2007-11-21 21:19:24 +010055#include "../drivers/net/lan91c96.h"
wdenkf39748a2004-06-09 13:37:52 +000056#endif
57
Markus Klotzbücherb2b43462006-02-10 11:25:41 +010058DECLARE_GLOBAL_DATA_PTR;
59
wdenk3b57fe02003-05-30 12:48:29 +000060ulong monitor_flash_len;
61
wdenk2abbe072003-06-16 23:50:08 +000062#ifdef CONFIG_HAS_DATAFLASH
63extern int AT91F_DataflashInit(void);
64extern void dataflash_print_info(void);
65#endif
66
wdenk48b42612003-06-19 23:01:32 +000067#ifndef CONFIG_IDENT_STRING
68#define CONFIG_IDENT_STRING ""
69#endif
70
wdenkc6097192002-11-03 00:24:07 +000071const char version_string[] =
wdenk48b42612003-06-19 23:01:32 +000072 U_BOOT_VERSION" (" __DATE__ " - " __TIME__ ")"CONFIG_IDENT_STRING;
wdenkc6097192002-11-03 00:24:07 +000073
74#ifdef CONFIG_DRIVER_CS8900
75extern void cs8900_get_enetaddr (uchar * addr);
76#endif
77
wdenk5ca26792004-06-06 22:11:41 +000078#ifdef CONFIG_DRIVER_RTL8019
wdenkef5a9672003-12-07 00:46:27 +000079extern void rtl8019_get_enetaddr (uchar * addr);
80#endif
81
Hebbarf7ad79b2007-12-18 16:00:54 -080082#if defined(CONFIG_HARD_I2C) || \
83 defined(CONFIG_SOFT_I2C)
84#include <i2c.h>
85#endif
86
wdenkc6097192002-11-03 00:24:07 +000087/*
88 * Begin and End of memory area for malloc(), and current "brk"
89 */
90static ulong mem_malloc_start = 0;
91static ulong mem_malloc_end = 0;
92static ulong mem_malloc_brk = 0;
93
wdenka6c7ad22002-12-03 21:28:10 +000094static
wdenka6c7ad22002-12-03 21:28:10 +000095void mem_malloc_init (ulong dest_addr)
wdenkc6097192002-11-03 00:24:07 +000096{
97 mem_malloc_start = dest_addr;
wdenk699b13a2002-11-03 18:03:52 +000098 mem_malloc_end = dest_addr + CFG_MALLOC_LEN;
wdenkc6097192002-11-03 00:24:07 +000099 mem_malloc_brk = mem_malloc_start;
100
101 memset ((void *) mem_malloc_start, 0,
102 mem_malloc_end - mem_malloc_start);
103}
104
105void *sbrk (ptrdiff_t increment)
106{
107 ulong old = mem_malloc_brk;
108 ulong new = old + increment;
109
110 if ((new < mem_malloc_start) || (new > mem_malloc_end)) {
111 return (NULL);
112 }
113 mem_malloc_brk = new;
114
115 return ((void *) old);
116}
117
118/************************************************************************
Peter Pearse9f5c3d32007-09-04 16:18:38 +0100119 * Coloured LED functionality
120 ************************************************************************
121 * May be supplied by boards if desired
122 */
123void inline __coloured_LED_init (void) {}
Wolfgang Denkde74b9e2007-10-13 21:15:39 +0200124void inline coloured_LED_init (void) __attribute__((weak, alias("__coloured_LED_init")));
Peter Pearse9f5c3d32007-09-04 16:18:38 +0100125void inline __red_LED_on (void) {}
126void inline red_LED_on (void) __attribute__((weak, alias("__red_LED_on")));
127void inline __red_LED_off(void) {}
Wolfgang Denkde74b9e2007-10-13 21:15:39 +0200128void inline red_LED_off(void) __attribute__((weak, alias("__red_LED_off")));
Peter Pearse9f5c3d32007-09-04 16:18:38 +0100129void inline __green_LED_on(void) {}
Wolfgang Denkde74b9e2007-10-13 21:15:39 +0200130void inline green_LED_on(void) __attribute__((weak, alias("__green_LED_on")));
Peter Pearse9f5c3d32007-09-04 16:18:38 +0100131void inline __green_LED_off(void) {}
Wolfgang Denkde74b9e2007-10-13 21:15:39 +0200132void inline green_LED_off(void)__attribute__((weak, alias("__green_LED_off")));
Peter Pearse9f5c3d32007-09-04 16:18:38 +0100133void inline __yellow_LED_on(void) {}
Wolfgang Denkde74b9e2007-10-13 21:15:39 +0200134void inline yellow_LED_on(void)__attribute__((weak, alias("__yellow_LED_on")));
Peter Pearse9f5c3d32007-09-04 16:18:38 +0100135void inline __yellow_LED_off(void) {}
Wolfgang Denkde74b9e2007-10-13 21:15:39 +0200136void inline yellow_LED_off(void)__attribute__((weak, alias("__yellow_LED_off")));
Peter Pearse9f5c3d32007-09-04 16:18:38 +0100137
138/************************************************************************
wdenkc6097192002-11-03 00:24:07 +0000139 * Init Utilities *
140 ************************************************************************
141 * Some of this code should be moved into the core functions,
142 * or dropped completely,
143 * but let's get it working (again) first...
144 */
145
146static int init_baudrate (void)
147{
Wolfgang Denkd52fb7e2006-03-11 22:53:33 +0100148 char tmp[64]; /* long enough for environment variables */
wdenkc6097192002-11-03 00:24:07 +0000149 int i = getenv_r ("baudrate", tmp, sizeof (tmp));
wdenk3595ac42003-06-22 17:18:28 +0000150 gd->bd->bi_baudrate = gd->baudrate = (i > 0)
wdenkc6097192002-11-03 00:24:07 +0000151 ? (int) simple_strtoul (tmp, NULL, 10)
152 : CONFIG_BAUDRATE;
153
154 return (0);
155}
156
157static int display_banner (void)
158{
wdenkc6097192002-11-03 00:24:07 +0000159 printf ("\n\n%s\n\n", version_string);
Wolfgang Denk57cac1f2006-01-29 19:12:41 +0100160 debug ("U-Boot code: %08lX -> %08lX BSS: -> %08lX\n",
161 _armboot_start, _bss_start, _bss_end);
wdenkc6097192002-11-03 00:24:07 +0000162#ifdef CONFIG_MODEM_SUPPORT
Wolfgang Denk57cac1f2006-01-29 19:12:41 +0100163 debug ("Modem Support enabled\n");
wdenkc6097192002-11-03 00:24:07 +0000164#endif
165#ifdef CONFIG_USE_IRQ
Wolfgang Denk57cac1f2006-01-29 19:12:41 +0100166 debug ("IRQ Stack: %08lx\n", IRQ_STACK_START);
167 debug ("FIQ Stack: %08lx\n", FIQ_STACK_START);
wdenkc6097192002-11-03 00:24:07 +0000168#endif
wdenkf72da342003-10-10 10:05:42 +0000169
wdenkc6097192002-11-03 00:24:07 +0000170 return (0);
171}
172
173/*
174 * WARNING: this code looks "cleaner" than the PowerPC version, but
175 * has the disadvantage that you either get nothing, or everything.
176 * On PowerPC, you might see "DRAM: " before the system hangs - which
177 * gives a simple yet clear indication which part of the
178 * initialization if failing.
179 */
180static int display_dram_config (void)
181{
wdenkc6097192002-11-03 00:24:07 +0000182 int i;
183
Wolfgang Denk57cac1f2006-01-29 19:12:41 +0100184#ifdef DEBUG
wdenka8c7c702003-12-06 19:49:23 +0000185 puts ("RAM Configuration:\n");
wdenkc6097192002-11-03 00:24:07 +0000186
187 for(i=0; i<CONFIG_NR_DRAM_BANKS; i++) {
188 printf ("Bank #%d: %08lx ", i, gd->bd->bi_dram[i].start);
189 print_size (gd->bd->bi_dram[i].size, "\n");
190 }
Wolfgang Denk57cac1f2006-01-29 19:12:41 +0100191#else
192 ulong size = 0;
193
194 for (i=0; i<CONFIG_NR_DRAM_BANKS; i++) {
195 size += gd->bd->bi_dram[i].size;
196 }
197 puts("DRAM: ");
198 print_size(size, "\n");
199#endif
wdenkc6097192002-11-03 00:24:07 +0000200
201 return (0);
202}
203
Markus Klotzbücher69493282006-02-28 18:05:25 +0100204#ifndef CFG_NO_FLASH
wdenkc6097192002-11-03 00:24:07 +0000205static void display_flash_config (ulong size)
206{
207 puts ("Flash: ");
208 print_size (size, "\n");
209}
Markus Klotzbücher69493282006-02-28 18:05:25 +0100210#endif /* CFG_NO_FLASH */
wdenkc6097192002-11-03 00:24:07 +0000211
Hebbarf7ad79b2007-12-18 16:00:54 -0800212#if defined(CONFIG_HARD_I2C) || defined(CONFIG_SOFT_I2C)
213static int init_func_i2c (void)
214{
215 puts ("I2C: ");
216 i2c_init (CFG_I2C_SPEED, CFG_I2C_SLAVE);
217 puts ("ready\n");
218 return (0);
219}
220#endif
221
wdenkc6097192002-11-03 00:24:07 +0000222/*
wdenka8c7c702003-12-06 19:49:23 +0000223 * Breathe some life into the board...
wdenkc6097192002-11-03 00:24:07 +0000224 *
wdenkb0639ca2003-09-17 22:48:07 +0000225 * Initialize a serial port as console, and carry out some hardware
wdenkc6097192002-11-03 00:24:07 +0000226 * tests.
227 *
228 * The first part of initialization is running from Flash memory;
229 * its main purpose is to initialize the RAM so that we
230 * can relocate the monitor code to RAM.
231 */
232
233/*
234 * All attempts to come up with a "common" initialization sequence
235 * that works for all boards and architectures failed: some of the
236 * requirements are just _too_ different. To get rid of the resulting
wdenkf6e20fc2004-02-08 19:38:38 +0000237 * mess of board dependent #ifdef'ed code we now make the whole
wdenkc6097192002-11-03 00:24:07 +0000238 * initialization sequence configurable to the user.
239 *
240 * The requirements for any new initalization function is simple: it
241 * receives a pointer to the "global data" structure as it's only
242 * argument, and returns an integer return code, where 0 means
243 * "continue" and != 0 means "fatal error, hang the system".
244 */
245typedef int (init_fnc_t) (void);
246
Wolfgang Denk57cac1f2006-01-29 19:12:41 +0100247int print_cpuinfo (void); /* test-only */
248
wdenkc6097192002-11-03 00:24:07 +0000249init_fnc_t *init_sequence[] = {
250 cpu_init, /* basic cpu dependent setup */
251 board_init, /* basic board dependent setup */
252 interrupt_init, /* set up exceptions */
253 env_init, /* initialize environment */
254 init_baudrate, /* initialze baudrate settings */
255 serial_init, /* serial communications setup */
wdenk3595ac42003-06-22 17:18:28 +0000256 console_init_f, /* stage 1 init of console */
wdenk699b13a2002-11-03 18:03:52 +0000257 display_banner, /* say that we are here */
Wolfgang Denk57cac1f2006-01-29 19:12:41 +0100258#if defined(CONFIG_DISPLAY_CPUINFO)
259 print_cpuinfo, /* display cpu info (and speed) */
260#endif
261#if defined(CONFIG_DISPLAY_BOARDINFO)
262 checkboard, /* display board info */
263#endif
Hebbarf7ad79b2007-12-18 16:00:54 -0800264#if defined(CONFIG_HARD_I2C) || defined(CONFIG_SOFT_I2C)
265 init_func_i2c,
266#endif
wdenkc6097192002-11-03 00:24:07 +0000267 dram_init, /* configure available RAM banks */
268 display_dram_config,
wdenkc6097192002-11-03 00:24:07 +0000269 NULL,
270};
271
272void start_armboot (void)
273{
wdenkc6097192002-11-03 00:24:07 +0000274 init_fnc_t **init_fnc_ptr;
wdenk3e386912003-04-05 00:53:31 +0000275 char *s;
Wolfgang Denkd52fb7e2006-03-11 22:53:33 +0100276#ifndef CFG_NO_FLASH
277 ulong size;
278#endif
wdenkbc54f302004-07-11 18:10:30 +0000279#if defined(CONFIG_VFD) || defined(CONFIG_LCD)
wdenkc6097192002-11-03 00:24:07 +0000280 unsigned long addr;
281#endif
282
283 /* Pointer is writable since we allocated a register for it */
wdenka8c7c702003-12-06 19:49:23 +0000284 gd = (gd_t*)(_armboot_start - CFG_MALLOC_LEN - sizeof(gd_t));
wdenk93f6a672004-07-01 20:28:03 +0000285 /* compiler optimization barrier needed for GCC >= 3.4 */
286 __asm__ __volatile__("": : :"memory");
287
wdenka8c7c702003-12-06 19:49:23 +0000288 memset ((void*)gd, 0, sizeof (gd_t));
289 gd->bd = (bd_t*)((char*)gd - sizeof(bd_t));
wdenkc6097192002-11-03 00:24:07 +0000290 memset (gd->bd, 0, sizeof (bd_t));
291
wdenkf6e20fc2004-02-08 19:38:38 +0000292 monitor_flash_len = _bss_start - _armboot_start;
wdenk3b57fe02003-05-30 12:48:29 +0000293
wdenkc6097192002-11-03 00:24:07 +0000294 for (init_fnc_ptr = init_sequence; *init_fnc_ptr; ++init_fnc_ptr) {
295 if ((*init_fnc_ptr)() != 0) {
296 hang ();
297 }
298 }
299
Markus Klotzbücher69493282006-02-28 18:05:25 +0100300#ifndef CFG_NO_FLASH
wdenkc6097192002-11-03 00:24:07 +0000301 /* configure available FLASH banks */
302 size = flash_init ();
303 display_flash_config (size);
Markus Klotzbücher69493282006-02-28 18:05:25 +0100304#endif /* CFG_NO_FLASH */
wdenkc6097192002-11-03 00:24:07 +0000305
306#ifdef CONFIG_VFD
wdenka8c7c702003-12-06 19:49:23 +0000307# ifndef PAGE_SIZE
308# define PAGE_SIZE 4096
309# endif
wdenkc6097192002-11-03 00:24:07 +0000310 /*
311 * reserve memory for VFD display (always full pages)
312 */
wdenkbc54f302004-07-11 18:10:30 +0000313 /* bss_end is defined in the board-specific linker script */
314 addr = (_bss_end + (PAGE_SIZE - 1)) & ~(PAGE_SIZE - 1);
wdenkc6097192002-11-03 00:24:07 +0000315 size = vfd_setmem (addr);
316 gd->fb_base = addr;
wdenkc6097192002-11-03 00:24:07 +0000317#endif /* CONFIG_VFD */
318
wdenkbc54f302004-07-11 18:10:30 +0000319#ifdef CONFIG_LCD
wdenk281e00a2004-08-01 22:48:16 +0000320# ifndef PAGE_SIZE
321# define PAGE_SIZE 4096
322# endif
wdenkbc54f302004-07-11 18:10:30 +0000323 /*
324 * reserve memory for LCD display (always full pages)
325 */
326 /* bss_end is defined in the board-specific linker script */
327 addr = (_bss_end + (PAGE_SIZE - 1)) & ~(PAGE_SIZE - 1);
328 size = lcd_setmem (addr);
329 gd->fb_base = addr;
330#endif /* CONFIG_LCD */
331
wdenka8c7c702003-12-06 19:49:23 +0000332 /* armboot_start is defined in the board-specific linker script */
333 mem_malloc_init (_armboot_start - CFG_MALLOC_LEN);
334
Jon Loeliger67350562007-07-09 18:05:38 -0500335#if defined(CONFIG_CMD_NAND)
Markus Klotzbuecherd860c342006-04-25 17:00:33 +0200336 puts ("NAND: ");
wdenkdc7c9a12003-03-26 06:55:25 +0000337 nand_init(); /* go init the NAND */
338#endif
339
Kyungmin Parkd7e8ce12007-09-10 17:15:14 +0900340#if defined(CONFIG_CMD_ONENAND)
341 onenand_init();
342#endif
343
wdenk2abbe072003-06-16 23:50:08 +0000344#ifdef CONFIG_HAS_DATAFLASH
345 AT91F_DataflashInit();
346 dataflash_print_info();
347#endif
348
wdenkc6097192002-11-03 00:24:07 +0000349 /* initialize environment */
350 env_relocate ();
351
wdenk6069ff22003-02-28 00:49:47 +0000352#ifdef CONFIG_VFD
353 /* must do this after the framebuffer is allocated */
354 drv_vfd_init();
wdenka8c7c702003-12-06 19:49:23 +0000355#endif /* CONFIG_VFD */
wdenk6069ff22003-02-28 00:49:47 +0000356
stefano babic80172c62007-08-30 22:57:04 +0200357#ifdef CONFIG_SERIAL_MULTI
358 serial_initialize();
359#endif
360
wdenkc6097192002-11-03 00:24:07 +0000361 /* IP Address */
wdenka8c7c702003-12-06 19:49:23 +0000362 gd->bd->bi_ip_addr = getenv_IPaddr ("ipaddr");
wdenkc6097192002-11-03 00:24:07 +0000363
364 /* MAC Address */
365 {
366 int i;
367 ulong reg;
368 char *s, *e;
Wolfgang Denkd52fb7e2006-03-11 22:53:33 +0100369 char tmp[64];
wdenkc6097192002-11-03 00:24:07 +0000370
371 i = getenv_r ("ethaddr", tmp, sizeof (tmp));
372 s = (i > 0) ? tmp : NULL;
373
374 for (reg = 0; reg < 6; ++reg) {
wdenka8c7c702003-12-06 19:49:23 +0000375 gd->bd->bi_enetaddr[reg] = s ? simple_strtoul (s, &e, 16) : 0;
wdenkc6097192002-11-03 00:24:07 +0000376 if (s)
377 s = (*e) ? e + 1 : e;
378 }
Wolfgang Denk57cac1f2006-01-29 19:12:41 +0100379
380#ifdef CONFIG_HAS_ETH1
381 i = getenv_r ("eth1addr", tmp, sizeof (tmp));
382 s = (i > 0) ? tmp : NULL;
383
384 for (reg = 0; reg < 6; ++reg) {
385 gd->bd->bi_enet1addr[reg] = s ? simple_strtoul (s, &e, 16) : 0;
386 if (s)
387 s = (*e) ? e + 1 : e;
388 }
389#endif
wdenkc6097192002-11-03 00:24:07 +0000390 }
391
wdenkf54ebdf2003-09-17 15:10:32 +0000392 devices_init (); /* get the devices list going. */
wdenk3595ac42003-06-22 17:18:28 +0000393
Wolfgang Denkc7db9a32005-08-19 00:53:02 +0200394#ifdef CONFIG_CMC_PU2
395 load_sernum_ethaddr ();
396#endif /* CONFIG_CMC_PU2 */
397
wdenk27b207f2003-07-24 23:38:38 +0000398 jumptable_init ();
wdenk3595ac42003-06-22 17:18:28 +0000399
400 console_init_r (); /* fully init console as a device */
401
wdenkc6097192002-11-03 00:24:07 +0000402#if defined(CONFIG_MISC_INIT_R)
403 /* miscellaneous platform dependent initialisations */
404 misc_init_r ();
405#endif
406
407 /* enable exceptions */
408 enable_interrupts ();
409
wdenka8c7c702003-12-06 19:49:23 +0000410 /* Perform network card initialisation if necessary */
Sergey Kubushync74b2102007-08-10 20:26:18 +0200411#ifdef CONFIG_DRIVER_TI_EMAC
412extern void dm644x_eth_set_mac_addr (const u_int8_t *addr);
413 if (getenv ("ethaddr")) {
414 dm644x_eth_set_mac_addr(gd->bd->bi_enetaddr);
415 }
416#endif
417
wdenkc6097192002-11-03 00:24:07 +0000418#ifdef CONFIG_DRIVER_CS8900
wdenk6069ff22003-02-28 00:49:47 +0000419 cs8900_get_enetaddr (gd->bd->bi_enetaddr);
wdenkc6097192002-11-03 00:24:07 +0000420#endif
421
wdenkf39748a2004-06-09 13:37:52 +0000422#if defined(CONFIG_DRIVER_SMC91111) || defined (CONFIG_DRIVER_LAN91C96)
wdenk45219c42003-05-12 21:50:16 +0000423 if (getenv ("ethaddr")) {
424 smc_set_mac_addr(gd->bd->bi_enetaddr);
425 }
wdenkf39748a2004-06-09 13:37:52 +0000426#endif /* CONFIG_DRIVER_SMC91111 || CONFIG_DRIVER_LAN91C96 */
wdenk45219c42003-05-12 21:50:16 +0000427
wdenk3e386912003-04-05 00:53:31 +0000428 /* Initialize from environment */
429 if ((s = getenv ("loadaddr")) != NULL) {
430 load_addr = simple_strtoul (s, NULL, 16);
431 }
Jon Loeliger67350562007-07-09 18:05:38 -0500432#if defined(CONFIG_CMD_NET)
wdenk3e386912003-04-05 00:53:31 +0000433 if ((s = getenv ("bootfile")) != NULL) {
434 copy_filename (BootFile, s, sizeof (BootFile));
435 }
Jon Loeligerb3aff0c2007-07-10 11:19:50 -0500436#endif
wdenk3e386912003-04-05 00:53:31 +0000437
wdenkc837dcb2004-01-20 23:12:12 +0000438#ifdef BOARD_LATE_INIT
439 board_late_init ();
wdenkc6097192002-11-03 00:24:07 +0000440#endif
Jon Loeliger67350562007-07-09 18:05:38 -0500441#if defined(CONFIG_CMD_NET)
Marian Balakowicz63ff0042005-10-28 22:30:33 +0200442#if defined(CONFIG_NET_MULTI)
wdenka1191902005-01-09 17:12:27 +0000443 puts ("Net: ");
Marian Balakowicz63ff0042005-10-28 22:30:33 +0200444#endif
wdenka1191902005-01-09 17:12:27 +0000445 eth_initialize(gd->bd);
Jean-Christophe PLAGNIOL-VILLARD23776ff2007-12-11 10:53:12 +0100446#if defined(CONFIG_RESET_PHY_R)
447 debug ("Reset Ethernet PHY\n");
448 reset_phy();
449#endif
wdenka1191902005-01-09 17:12:27 +0000450#endif
wdenkc6097192002-11-03 00:24:07 +0000451 /* main_loop() can return to retry autoboot, if so just run it again. */
452 for (;;) {
453 main_loop ();
454 }
455
456 /* NOTREACHED - no way out of command loop except booting */
457}
458
459void hang (void)
460{
461 puts ("### ERROR ### Please RESET the board ###\n");
462 for (;;);
463}
464
465#ifdef CONFIG_MODEM_SUPPORT
Wolfgang Denkd2ed2f62006-03-11 23:07:09 +0100466static inline void mdm_readline(char *buf, int bufsiz);
467
wdenkc6097192002-11-03 00:24:07 +0000468/* called from main loop (common/main.c) */
469extern void dbg(const char *fmt, ...);
470int mdm_init (void)
471{
472 char env_str[16];
473 char *init_str;
474 int i;
475 extern char console_buffer[];
wdenkc6097192002-11-03 00:24:07 +0000476 extern void enable_putc(void);
477 extern int hwflow_onoff(int);
478
479 enable_putc(); /* enable serial_putc() */
480
481#ifdef CONFIG_HWFLOW
482 init_str = getenv("mdm_flow_control");
483 if (init_str && (strcmp(init_str, "rts/cts") == 0))
484 hwflow_onoff (1);
485 else
486 hwflow_onoff(-1);
487#endif
488
489 for (i = 1;;i++) {
490 sprintf(env_str, "mdm_init%d", i);
491 if ((init_str = getenv(env_str)) != NULL) {
492 serial_puts(init_str);
493 serial_puts("\n");
494 for(;;) {
495 mdm_readline(console_buffer, CFG_CBSIZE);
496 dbg("ini%d: [%s]", i, console_buffer);
497
498 if ((strcmp(console_buffer, "OK") == 0) ||
499 (strcmp(console_buffer, "ERROR") == 0)) {
500 dbg("ini%d: cmd done", i);
501 break;
502 } else /* in case we are originating call ... */
503 if (strncmp(console_buffer, "CONNECT", 7) == 0) {
504 dbg("ini%d: connect", i);
505 return 0;
506 }
507 }
508 } else
509 break; /* no init string - stop modem init */
510
511 udelay(100000);
512 }
513
514 udelay(100000);
515
516 /* final stage - wait for connect */
517 for(;i > 1;) { /* if 'i' > 1 - wait for connection
518 message from modem */
519 mdm_readline(console_buffer, CFG_CBSIZE);
520 dbg("ini_f: [%s]", console_buffer);
521 if (strncmp(console_buffer, "CONNECT", 7) == 0) {
522 dbg("ini_f: connected");
523 return 0;
524 }
525 }
526
527 return 0;
528}
529
530/* 'inline' - We have to do it fast */
531static inline void mdm_readline(char *buf, int bufsiz)
532{
533 char c;
534 char *p;
535 int n;
536
537 n = 0;
538 p = buf;
539 for(;;) {
540 c = serial_getc();
541
542 /* dbg("(%c)", c); */
543
544 switch(c) {
545 case '\r':
546 break;
547 case '\n':
548 *p = '\0';
549 return;
550
551 default:
552 if(n++ > bufsiz) {
553 *p = '\0';
554 return; /* sanity check */
555 }
556 *p = c;
557 p++;
558 break;
559 }
560 }
561}
562#endif /* CONFIG_MODEM_SUPPORT */