blob: af0233a62016f8ce555d93d9e59e7155c53cb69a [file] [log] [blame]
wdenkc6097192002-11-03 00:24:07 +00001/*
Wolfgang Denk7a132ae2006-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 Denk7a132ae2006-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>
wdenk56958612003-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>
47
wdenk3c711762004-06-09 13:37:52 +000048#ifdef CONFIG_DRIVER_SMC91111
49#include "../drivers/smc91111.h"
50#endif
51#ifdef CONFIG_DRIVER_LAN91C96
52#include "../drivers/lan91c96.h"
53#endif
54
Markus Klotzbücheraedd96a2006-02-10 11:25:41 +010055DECLARE_GLOBAL_DATA_PTR;
56
Jon Loeliger12077972007-07-09 18:05:38 -050057#if defined(CONFIG_CMD_NAND)
wdenkc8434db2003-03-26 06:55:25 +000058void nand_init (void);
59#endif
wdenkc6097192002-11-03 00:24:07 +000060
wdenkb9a83a92003-05-30 12:48:29 +000061ulong monitor_flash_len;
62
wdenk381669a2003-06-16 23:50:08 +000063#ifdef CONFIG_HAS_DATAFLASH
64extern int AT91F_DataflashInit(void);
65extern void dataflash_print_info(void);
66#endif
67
wdenk7539dea2003-06-19 23:01:32 +000068#ifndef CONFIG_IDENT_STRING
69#define CONFIG_IDENT_STRING ""
70#endif
71
wdenkc6097192002-11-03 00:24:07 +000072const char version_string[] =
wdenk7539dea2003-06-19 23:01:32 +000073 U_BOOT_VERSION" (" __DATE__ " - " __TIME__ ")"CONFIG_IDENT_STRING;
wdenkc6097192002-11-03 00:24:07 +000074
75#ifdef CONFIG_DRIVER_CS8900
76extern void cs8900_get_enetaddr (uchar * addr);
77#endif
78
wdenk6b1aa8d2004-06-06 22:11:41 +000079#ifdef CONFIG_DRIVER_RTL8019
wdenk5d5317e2003-12-07 00:46:27 +000080extern void rtl8019_get_enetaddr (uchar * addr);
81#endif
82
wdenkc6097192002-11-03 00:24:07 +000083/*
84 * Begin and End of memory area for malloc(), and current "brk"
85 */
86static ulong mem_malloc_start = 0;
87static ulong mem_malloc_end = 0;
88static ulong mem_malloc_brk = 0;
89
wdenk9dd2b882002-12-03 21:28:10 +000090static
wdenk9dd2b882002-12-03 21:28:10 +000091void mem_malloc_init (ulong dest_addr)
wdenkc6097192002-11-03 00:24:07 +000092{
93 mem_malloc_start = dest_addr;
wdenk699b13a2002-11-03 18:03:52 +000094 mem_malloc_end = dest_addr + CFG_MALLOC_LEN;
wdenkc6097192002-11-03 00:24:07 +000095 mem_malloc_brk = mem_malloc_start;
96
97 memset ((void *) mem_malloc_start, 0,
98 mem_malloc_end - mem_malloc_start);
99}
100
101void *sbrk (ptrdiff_t increment)
102{
103 ulong old = mem_malloc_brk;
104 ulong new = old + increment;
105
106 if ((new < mem_malloc_start) || (new > mem_malloc_end)) {
107 return (NULL);
108 }
109 mem_malloc_brk = new;
110
111 return ((void *) old);
112}
113
114/************************************************************************
Peter Pearse2c261ca2007-09-04 16:18:38 +0100115 * Coloured LED functionality
116 ************************************************************************
117 * May be supplied by boards if desired
118 */
119void inline __coloured_LED_init (void) {}
Wolfgang Denkebc15912007-10-13 21:15:39 +0200120void inline coloured_LED_init (void) __attribute__((weak, alias("__coloured_LED_init")));
Peter Pearse2c261ca2007-09-04 16:18:38 +0100121void inline __red_LED_on (void) {}
122void inline red_LED_on (void) __attribute__((weak, alias("__red_LED_on")));
123void inline __red_LED_off(void) {}
Wolfgang Denkebc15912007-10-13 21:15:39 +0200124void inline red_LED_off(void) __attribute__((weak, alias("__red_LED_off")));
Peter Pearse2c261ca2007-09-04 16:18:38 +0100125void inline __green_LED_on(void) {}
Wolfgang Denkebc15912007-10-13 21:15:39 +0200126void inline green_LED_on(void) __attribute__((weak, alias("__green_LED_on")));
Peter Pearse2c261ca2007-09-04 16:18:38 +0100127void inline __green_LED_off(void) {}
Wolfgang Denkebc15912007-10-13 21:15:39 +0200128void inline green_LED_off(void)__attribute__((weak, alias("__green_LED_off")));
Peter Pearse2c261ca2007-09-04 16:18:38 +0100129void inline __yellow_LED_on(void) {}
Wolfgang Denkebc15912007-10-13 21:15:39 +0200130void inline yellow_LED_on(void)__attribute__((weak, alias("__yellow_LED_on")));
Peter Pearse2c261ca2007-09-04 16:18:38 +0100131void inline __yellow_LED_off(void) {}
Wolfgang Denkebc15912007-10-13 21:15:39 +0200132void inline yellow_LED_off(void)__attribute__((weak, alias("__yellow_LED_off")));
Peter Pearse2c261ca2007-09-04 16:18:38 +0100133
134/************************************************************************
wdenkc6097192002-11-03 00:24:07 +0000135 * Init Utilities *
136 ************************************************************************
137 * Some of this code should be moved into the core functions,
138 * or dropped completely,
139 * but let's get it working (again) first...
140 */
141
142static int init_baudrate (void)
143{
Wolfgang Denk7fa6e902006-03-11 22:53:33 +0100144 char tmp[64]; /* long enough for environment variables */
wdenkc6097192002-11-03 00:24:07 +0000145 int i = getenv_r ("baudrate", tmp, sizeof (tmp));
wdenk56958612003-06-22 17:18:28 +0000146 gd->bd->bi_baudrate = gd->baudrate = (i > 0)
wdenkc6097192002-11-03 00:24:07 +0000147 ? (int) simple_strtoul (tmp, NULL, 10)
148 : CONFIG_BAUDRATE;
149
150 return (0);
151}
152
153static int display_banner (void)
154{
wdenkc6097192002-11-03 00:24:07 +0000155 printf ("\n\n%s\n\n", version_string);
Wolfgang Denk7a132ae2006-01-29 19:12:41 +0100156 debug ("U-Boot code: %08lX -> %08lX BSS: -> %08lX\n",
157 _armboot_start, _bss_start, _bss_end);
wdenkc6097192002-11-03 00:24:07 +0000158#ifdef CONFIG_MODEM_SUPPORT
Wolfgang Denk7a132ae2006-01-29 19:12:41 +0100159 debug ("Modem Support enabled\n");
wdenkc6097192002-11-03 00:24:07 +0000160#endif
161#ifdef CONFIG_USE_IRQ
Wolfgang Denk7a132ae2006-01-29 19:12:41 +0100162 debug ("IRQ Stack: %08lx\n", IRQ_STACK_START);
163 debug ("FIQ Stack: %08lx\n", FIQ_STACK_START);
wdenkc6097192002-11-03 00:24:07 +0000164#endif
wdenk808532a2003-10-10 10:05:42 +0000165
wdenkc6097192002-11-03 00:24:07 +0000166 return (0);
167}
168
169/*
170 * WARNING: this code looks "cleaner" than the PowerPC version, but
171 * has the disadvantage that you either get nothing, or everything.
172 * On PowerPC, you might see "DRAM: " before the system hangs - which
173 * gives a simple yet clear indication which part of the
174 * initialization if failing.
175 */
176static int display_dram_config (void)
177{
wdenkc6097192002-11-03 00:24:07 +0000178 int i;
179
Wolfgang Denk7a132ae2006-01-29 19:12:41 +0100180#ifdef DEBUG
wdenkc0aa5c52003-12-06 19:49:23 +0000181 puts ("RAM Configuration:\n");
wdenkc6097192002-11-03 00:24:07 +0000182
183 for(i=0; i<CONFIG_NR_DRAM_BANKS; i++) {
184 printf ("Bank #%d: %08lx ", i, gd->bd->bi_dram[i].start);
185 print_size (gd->bd->bi_dram[i].size, "\n");
186 }
Wolfgang Denk7a132ae2006-01-29 19:12:41 +0100187#else
188 ulong size = 0;
189
190 for (i=0; i<CONFIG_NR_DRAM_BANKS; i++) {
191 size += gd->bd->bi_dram[i].size;
192 }
193 puts("DRAM: ");
194 print_size(size, "\n");
195#endif
wdenkc6097192002-11-03 00:24:07 +0000196
197 return (0);
198}
199
Markus Klotzbücherf4a5c612006-02-28 18:05:25 +0100200#ifndef CFG_NO_FLASH
wdenkc6097192002-11-03 00:24:07 +0000201static void display_flash_config (ulong size)
202{
203 puts ("Flash: ");
204 print_size (size, "\n");
205}
Markus Klotzbücherf4a5c612006-02-28 18:05:25 +0100206#endif /* CFG_NO_FLASH */
wdenkc6097192002-11-03 00:24:07 +0000207
wdenkc6097192002-11-03 00:24:07 +0000208/*
wdenkc0aa5c52003-12-06 19:49:23 +0000209 * Breathe some life into the board...
wdenkc6097192002-11-03 00:24:07 +0000210 *
wdenkb6b2f0e2003-09-17 22:48:07 +0000211 * Initialize a serial port as console, and carry out some hardware
wdenkc6097192002-11-03 00:24:07 +0000212 * tests.
213 *
214 * The first part of initialization is running from Flash memory;
215 * its main purpose is to initialize the RAM so that we
216 * can relocate the monitor code to RAM.
217 */
218
219/*
220 * All attempts to come up with a "common" initialization sequence
221 * that works for all boards and architectures failed: some of the
222 * requirements are just _too_ different. To get rid of the resulting
wdenk927034e2004-02-08 19:38:38 +0000223 * mess of board dependent #ifdef'ed code we now make the whole
wdenkc6097192002-11-03 00:24:07 +0000224 * initialization sequence configurable to the user.
225 *
226 * The requirements for any new initalization function is simple: it
227 * receives a pointer to the "global data" structure as it's only
228 * argument, and returns an integer return code, where 0 means
229 * "continue" and != 0 means "fatal error, hang the system".
230 */
231typedef int (init_fnc_t) (void);
232
Wolfgang Denk7a132ae2006-01-29 19:12:41 +0100233int print_cpuinfo (void); /* test-only */
234
wdenkc6097192002-11-03 00:24:07 +0000235init_fnc_t *init_sequence[] = {
236 cpu_init, /* basic cpu dependent setup */
237 board_init, /* basic board dependent setup */
238 interrupt_init, /* set up exceptions */
239 env_init, /* initialize environment */
240 init_baudrate, /* initialze baudrate settings */
241 serial_init, /* serial communications setup */
wdenk56958612003-06-22 17:18:28 +0000242 console_init_f, /* stage 1 init of console */
wdenk699b13a2002-11-03 18:03:52 +0000243 display_banner, /* say that we are here */
Wolfgang Denk7a132ae2006-01-29 19:12:41 +0100244#if defined(CONFIG_DISPLAY_CPUINFO)
245 print_cpuinfo, /* display cpu info (and speed) */
246#endif
247#if defined(CONFIG_DISPLAY_BOARDINFO)
248 checkboard, /* display board info */
249#endif
wdenkc6097192002-11-03 00:24:07 +0000250 dram_init, /* configure available RAM banks */
251 display_dram_config,
wdenkc6097192002-11-03 00:24:07 +0000252 NULL,
253};
254
255void start_armboot (void)
256{
wdenkc6097192002-11-03 00:24:07 +0000257 init_fnc_t **init_fnc_ptr;
wdenkb02744a2003-04-05 00:53:31 +0000258 char *s;
Wolfgang Denk7fa6e902006-03-11 22:53:33 +0100259#ifndef CFG_NO_FLASH
260 ulong size;
261#endif
wdenk361f4a22004-07-11 18:10:30 +0000262#if defined(CONFIG_VFD) || defined(CONFIG_LCD)
wdenkc6097192002-11-03 00:24:07 +0000263 unsigned long addr;
264#endif
265
266 /* Pointer is writable since we allocated a register for it */
wdenkc0aa5c52003-12-06 19:49:23 +0000267 gd = (gd_t*)(_armboot_start - CFG_MALLOC_LEN - sizeof(gd_t));
wdenk3337af42004-07-01 20:28:03 +0000268 /* compiler optimization barrier needed for GCC >= 3.4 */
269 __asm__ __volatile__("": : :"memory");
270
wdenkc0aa5c52003-12-06 19:49:23 +0000271 memset ((void*)gd, 0, sizeof (gd_t));
272 gd->bd = (bd_t*)((char*)gd - sizeof(bd_t));
wdenkc6097192002-11-03 00:24:07 +0000273 memset (gd->bd, 0, sizeof (bd_t));
274
wdenk927034e2004-02-08 19:38:38 +0000275 monitor_flash_len = _bss_start - _armboot_start;
wdenkb9a83a92003-05-30 12:48:29 +0000276
wdenkc6097192002-11-03 00:24:07 +0000277 for (init_fnc_ptr = init_sequence; *init_fnc_ptr; ++init_fnc_ptr) {
278 if ((*init_fnc_ptr)() != 0) {
279 hang ();
280 }
281 }
282
Markus Klotzbücherf4a5c612006-02-28 18:05:25 +0100283#ifndef CFG_NO_FLASH
wdenkc6097192002-11-03 00:24:07 +0000284 /* configure available FLASH banks */
285 size = flash_init ();
286 display_flash_config (size);
Markus Klotzbücherf4a5c612006-02-28 18:05:25 +0100287#endif /* CFG_NO_FLASH */
wdenkc6097192002-11-03 00:24:07 +0000288
289#ifdef CONFIG_VFD
wdenkc0aa5c52003-12-06 19:49:23 +0000290# ifndef PAGE_SIZE
291# define PAGE_SIZE 4096
292# endif
wdenkc6097192002-11-03 00:24:07 +0000293 /*
294 * reserve memory for VFD display (always full pages)
295 */
wdenk361f4a22004-07-11 18:10:30 +0000296 /* bss_end is defined in the board-specific linker script */
297 addr = (_bss_end + (PAGE_SIZE - 1)) & ~(PAGE_SIZE - 1);
wdenkc6097192002-11-03 00:24:07 +0000298 size = vfd_setmem (addr);
299 gd->fb_base = addr;
wdenkc6097192002-11-03 00:24:07 +0000300#endif /* CONFIG_VFD */
301
wdenk361f4a22004-07-11 18:10:30 +0000302#ifdef CONFIG_LCD
wdenk7ac16102004-08-01 22:48:16 +0000303# ifndef PAGE_SIZE
304# define PAGE_SIZE 4096
305# endif
wdenk361f4a22004-07-11 18:10:30 +0000306 /*
307 * reserve memory for LCD display (always full pages)
308 */
309 /* bss_end is defined in the board-specific linker script */
310 addr = (_bss_end + (PAGE_SIZE - 1)) & ~(PAGE_SIZE - 1);
311 size = lcd_setmem (addr);
312 gd->fb_base = addr;
313#endif /* CONFIG_LCD */
314
wdenkc0aa5c52003-12-06 19:49:23 +0000315 /* armboot_start is defined in the board-specific linker script */
316 mem_malloc_init (_armboot_start - CFG_MALLOC_LEN);
317
Jon Loeliger12077972007-07-09 18:05:38 -0500318#if defined(CONFIG_CMD_NAND)
Markus Klotzbuecherb6437322006-04-25 17:00:33 +0200319 puts ("NAND: ");
wdenkc8434db2003-03-26 06:55:25 +0000320 nand_init(); /* go init the NAND */
321#endif
322
wdenk381669a2003-06-16 23:50:08 +0000323#ifdef CONFIG_HAS_DATAFLASH
324 AT91F_DataflashInit();
325 dataflash_print_info();
326#endif
327
wdenk4fc95692003-02-28 00:49:47 +0000328 /* initialize environment */
329 env_relocate ();
330
wdenkc6097192002-11-03 00:24:07 +0000331#ifdef CONFIG_VFD
332 /* must do this after the framebuffer is allocated */
333 drv_vfd_init();
wdenkc0aa5c52003-12-06 19:49:23 +0000334#endif /* CONFIG_VFD */
wdenkc6097192002-11-03 00:24:07 +0000335
stefano babic5ab4f032007-08-30 22:57:04 +0200336#ifdef CONFIG_SERIAL_MULTI
337 serial_initialize();
338#endif
339
wdenkc6097192002-11-03 00:24:07 +0000340 /* IP Address */
wdenkc0aa5c52003-12-06 19:49:23 +0000341 gd->bd->bi_ip_addr = getenv_IPaddr ("ipaddr");
wdenkc6097192002-11-03 00:24:07 +0000342
343 /* MAC Address */
344 {
345 int i;
346 ulong reg;
347 char *s, *e;
Wolfgang Denk7fa6e902006-03-11 22:53:33 +0100348 char tmp[64];
wdenkc6097192002-11-03 00:24:07 +0000349
350 i = getenv_r ("ethaddr", tmp, sizeof (tmp));
351 s = (i > 0) ? tmp : NULL;
352
353 for (reg = 0; reg < 6; ++reg) {
wdenkc0aa5c52003-12-06 19:49:23 +0000354 gd->bd->bi_enetaddr[reg] = s ? simple_strtoul (s, &e, 16) : 0;
wdenkc6097192002-11-03 00:24:07 +0000355 if (s)
356 s = (*e) ? e + 1 : e;
357 }
Wolfgang Denk7a132ae2006-01-29 19:12:41 +0100358
359#ifdef CONFIG_HAS_ETH1
360 i = getenv_r ("eth1addr", tmp, sizeof (tmp));
361 s = (i > 0) ? tmp : NULL;
362
363 for (reg = 0; reg < 6; ++reg) {
364 gd->bd->bi_enet1addr[reg] = s ? simple_strtoul (s, &e, 16) : 0;
365 if (s)
366 s = (*e) ? e + 1 : e;
367 }
368#endif
wdenkc6097192002-11-03 00:24:07 +0000369 }
370
wdenkf6a6ac12003-09-17 15:10:32 +0000371 devices_init (); /* get the devices list going. */
wdenk56958612003-06-22 17:18:28 +0000372
Wolfgang Denk9cf56102005-08-19 00:53:02 +0200373#ifdef CONFIG_CMC_PU2
374 load_sernum_ethaddr ();
375#endif /* CONFIG_CMC_PU2 */
376
wdenk874ac262003-07-24 23:38:38 +0000377 jumptable_init ();
wdenk56958612003-06-22 17:18:28 +0000378
379 console_init_r (); /* fully init console as a device */
380
wdenkc6097192002-11-03 00:24:07 +0000381#if defined(CONFIG_MISC_INIT_R)
382 /* miscellaneous platform dependent initialisations */
383 misc_init_r ();
384#endif
385
386 /* enable exceptions */
387 enable_interrupts ();
388
wdenkc0aa5c52003-12-06 19:49:23 +0000389 /* Perform network card initialisation if necessary */
Sergey Kubushyne8f39122007-08-10 20:26:18 +0200390#ifdef CONFIG_DRIVER_TI_EMAC
391extern void dm644x_eth_set_mac_addr (const u_int8_t *addr);
392 if (getenv ("ethaddr")) {
393 dm644x_eth_set_mac_addr(gd->bd->bi_enetaddr);
394 }
395#endif
396
wdenkc6097192002-11-03 00:24:07 +0000397#ifdef CONFIG_DRIVER_CS8900
wdenk4fc95692003-02-28 00:49:47 +0000398 cs8900_get_enetaddr (gd->bd->bi_enetaddr);
wdenkc6097192002-11-03 00:24:07 +0000399#endif
400
wdenk3c711762004-06-09 13:37:52 +0000401#if defined(CONFIG_DRIVER_SMC91111) || defined (CONFIG_DRIVER_LAN91C96)
wdenkaa603362003-05-12 21:50:16 +0000402 if (getenv ("ethaddr")) {
403 smc_set_mac_addr(gd->bd->bi_enetaddr);
404 }
wdenk3c711762004-06-09 13:37:52 +0000405#endif /* CONFIG_DRIVER_SMC91111 || CONFIG_DRIVER_LAN91C96 */
wdenkaa603362003-05-12 21:50:16 +0000406
wdenkb02744a2003-04-05 00:53:31 +0000407 /* Initialize from environment */
408 if ((s = getenv ("loadaddr")) != NULL) {
409 load_addr = simple_strtoul (s, NULL, 16);
410 }
Jon Loeliger12077972007-07-09 18:05:38 -0500411#if defined(CONFIG_CMD_NET)
wdenkb02744a2003-04-05 00:53:31 +0000412 if ((s = getenv ("bootfile")) != NULL) {
413 copy_filename (BootFile, s, sizeof (BootFile));
414 }
Jon Loeliger1670a5b2007-07-10 11:19:50 -0500415#endif
wdenkb02744a2003-04-05 00:53:31 +0000416
wdenkda55c6e2004-01-20 23:12:12 +0000417#ifdef BOARD_LATE_INIT
418 board_late_init ();
wdenkc6097192002-11-03 00:24:07 +0000419#endif
Jon Loeliger12077972007-07-09 18:05:38 -0500420#if defined(CONFIG_CMD_NET)
Marian Balakowiczaab8c492005-10-28 22:30:33 +0200421#if defined(CONFIG_NET_MULTI)
wdenk26c58432005-01-09 17:12:27 +0000422 puts ("Net: ");
Marian Balakowiczaab8c492005-10-28 22:30:33 +0200423#endif
wdenk26c58432005-01-09 17:12:27 +0000424 eth_initialize(gd->bd);
425#endif
wdenkc6097192002-11-03 00:24:07 +0000426 /* main_loop() can return to retry autoboot, if so just run it again. */
427 for (;;) {
428 main_loop ();
429 }
430
431 /* NOTREACHED - no way out of command loop except booting */
432}
433
434void hang (void)
435{
436 puts ("### ERROR ### Please RESET the board ###\n");
437 for (;;);
438}
439
440#ifdef CONFIG_MODEM_SUPPORT
Wolfgang Denk10e4f542006-03-11 23:07:09 +0100441static inline void mdm_readline(char *buf, int bufsiz);
442
wdenkc6097192002-11-03 00:24:07 +0000443/* called from main loop (common/main.c) */
444extern void dbg(const char *fmt, ...);
445int mdm_init (void)
446{
447 char env_str[16];
448 char *init_str;
449 int i;
450 extern char console_buffer[];
wdenkc6097192002-11-03 00:24:07 +0000451 extern void enable_putc(void);
452 extern int hwflow_onoff(int);
453
454 enable_putc(); /* enable serial_putc() */
455
456#ifdef CONFIG_HWFLOW
457 init_str = getenv("mdm_flow_control");
458 if (init_str && (strcmp(init_str, "rts/cts") == 0))
459 hwflow_onoff (1);
460 else
461 hwflow_onoff(-1);
462#endif
463
464 for (i = 1;;i++) {
465 sprintf(env_str, "mdm_init%d", i);
466 if ((init_str = getenv(env_str)) != NULL) {
467 serial_puts(init_str);
468 serial_puts("\n");
469 for(;;) {
470 mdm_readline(console_buffer, CFG_CBSIZE);
471 dbg("ini%d: [%s]", i, console_buffer);
472
473 if ((strcmp(console_buffer, "OK") == 0) ||
474 (strcmp(console_buffer, "ERROR") == 0)) {
475 dbg("ini%d: cmd done", i);
476 break;
477 } else /* in case we are originating call ... */
478 if (strncmp(console_buffer, "CONNECT", 7) == 0) {
479 dbg("ini%d: connect", i);
480 return 0;
481 }
482 }
483 } else
484 break; /* no init string - stop modem init */
485
486 udelay(100000);
487 }
488
489 udelay(100000);
490
491 /* final stage - wait for connect */
492 for(;i > 1;) { /* if 'i' > 1 - wait for connection
493 message from modem */
494 mdm_readline(console_buffer, CFG_CBSIZE);
495 dbg("ini_f: [%s]", console_buffer);
496 if (strncmp(console_buffer, "CONNECT", 7) == 0) {
497 dbg("ini_f: connected");
498 return 0;
499 }
500 }
501
502 return 0;
503}
504
505/* 'inline' - We have to do it fast */
506static inline void mdm_readline(char *buf, int bufsiz)
507{
508 char c;
509 char *p;
510 int n;
511
512 n = 0;
513 p = buf;
514 for(;;) {
515 c = serial_getc();
516
517 /* dbg("(%c)", c); */
518
519 switch(c) {
520 case '\r':
521 break;
522 case '\n':
523 *p = '\0';
524 return;
525
526 default:
527 if(n++ > bufsiz) {
528 *p = '\0';
529 return; /* sanity check */
530 }
531 *p = c;
532 p++;
533 break;
534 }
535 }
536}
537#endif /* CONFIG_MODEM_SUPPORT */