Some code cleanup for GCC 4.x
[platform/kernel/u-boot.git] / lib_arm / board.c
1 /*
2  * (C) Copyright 2002-2006
3  * 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
28 /*
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
41 #include <common.h>
42 #include <command.h>
43 #include <malloc.h>
44 #include <devices.h>
45 #include <version.h>
46 #include <net.h>
47
48 #ifdef CONFIG_DRIVER_SMC91111
49 #include "../drivers/smc91111.h"
50 #endif
51 #ifdef CONFIG_DRIVER_LAN91C96
52 #include "../drivers/lan91c96.h"
53 #endif
54
55 DECLARE_GLOBAL_DATA_PTR;
56
57 #if (CONFIG_COMMANDS & CFG_CMD_NAND)
58 void nand_init (void);
59 #endif
60
61 ulong monitor_flash_len;
62
63 #ifdef CONFIG_HAS_DATAFLASH
64 extern int  AT91F_DataflashInit(void);
65 extern void dataflash_print_info(void);
66 #endif
67
68 #ifndef CONFIG_IDENT_STRING
69 #define CONFIG_IDENT_STRING ""
70 #endif
71
72 const char version_string[] =
73         U_BOOT_VERSION" (" __DATE__ " - " __TIME__ ")"CONFIG_IDENT_STRING;
74
75 #ifdef CONFIG_DRIVER_CS8900
76 extern void cs8900_get_enetaddr (uchar * addr);
77 #endif
78
79 #ifdef CONFIG_DRIVER_RTL8019
80 extern void rtl8019_get_enetaddr (uchar * addr);
81 #endif
82
83 /*
84  * Begin and End of memory area for malloc(), and current "brk"
85  */
86 static ulong mem_malloc_start = 0;
87 static ulong mem_malloc_end = 0;
88 static ulong mem_malloc_brk = 0;
89
90 static
91 void mem_malloc_init (ulong dest_addr)
92 {
93         mem_malloc_start = dest_addr;
94         mem_malloc_end = dest_addr + CFG_MALLOC_LEN;
95         mem_malloc_brk = mem_malloc_start;
96
97         memset ((void *) mem_malloc_start, 0,
98                         mem_malloc_end - mem_malloc_start);
99 }
100
101 void *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 /************************************************************************
115  * Init Utilities                                                       *
116  ************************************************************************
117  * Some of this code should be moved into the core functions,
118  * or dropped completely,
119  * but let's get it working (again) first...
120  */
121
122 static int init_baudrate (void)
123 {
124         char tmp[64];   /* long enough for environment variables */
125         int i = getenv_r ("baudrate", tmp, sizeof (tmp));
126         gd->bd->bi_baudrate = gd->baudrate = (i > 0)
127                         ? (int) simple_strtoul (tmp, NULL, 10)
128                         : CONFIG_BAUDRATE;
129
130         return (0);
131 }
132
133 static int display_banner (void)
134 {
135         printf ("\n\n%s\n\n", version_string);
136         debug ("U-Boot code: %08lX -> %08lX  BSS: -> %08lX\n",
137                _armboot_start, _bss_start, _bss_end);
138 #ifdef CONFIG_MODEM_SUPPORT
139         debug ("Modem Support enabled\n");
140 #endif
141 #ifdef CONFIG_USE_IRQ
142         debug ("IRQ Stack: %08lx\n", IRQ_STACK_START);
143         debug ("FIQ Stack: %08lx\n", FIQ_STACK_START);
144 #endif
145
146         return (0);
147 }
148
149 /*
150  * WARNING: this code looks "cleaner" than the PowerPC version, but
151  * has the disadvantage that you either get nothing, or everything.
152  * On PowerPC, you might see "DRAM: " before the system hangs - which
153  * gives a simple yet clear indication which part of the
154  * initialization if failing.
155  */
156 static int display_dram_config (void)
157 {
158         int i;
159
160 #ifdef DEBUG
161         puts ("RAM Configuration:\n");
162
163         for(i=0; i<CONFIG_NR_DRAM_BANKS; i++) {
164                 printf ("Bank #%d: %08lx ", i, gd->bd->bi_dram[i].start);
165                 print_size (gd->bd->bi_dram[i].size, "\n");
166         }
167 #else
168         ulong size = 0;
169
170         for (i=0; i<CONFIG_NR_DRAM_BANKS; i++) {
171                 size += gd->bd->bi_dram[i].size;
172         }
173         puts("DRAM:  ");
174         print_size(size, "\n");
175 #endif
176
177         return (0);
178 }
179
180 #ifndef CFG_NO_FLASH
181 static void display_flash_config (ulong size)
182 {
183         puts ("Flash: ");
184         print_size (size, "\n");
185 }
186 #endif /* CFG_NO_FLASH */
187
188
189 /*
190  * Breathe some life into the board...
191  *
192  * Initialize a serial port as console, and carry out some hardware
193  * tests.
194  *
195  * The first part of initialization is running from Flash memory;
196  * its main purpose is to initialize the RAM so that we
197  * can relocate the monitor code to RAM.
198  */
199
200 /*
201  * All attempts to come up with a "common" initialization sequence
202  * that works for all boards and architectures failed: some of the
203  * requirements are just _too_ different. To get rid of the resulting
204  * mess of board dependent #ifdef'ed code we now make the whole
205  * initialization sequence configurable to the user.
206  *
207  * The requirements for any new initalization function is simple: it
208  * receives a pointer to the "global data" structure as it's only
209  * argument, and returns an integer return code, where 0 means
210  * "continue" and != 0 means "fatal error, hang the system".
211  */
212 typedef int (init_fnc_t) (void);
213
214 int print_cpuinfo (void); /* test-only */
215
216 init_fnc_t *init_sequence[] = {
217         cpu_init,               /* basic cpu dependent setup */
218         board_init,             /* basic board dependent setup */
219         interrupt_init,         /* set up exceptions */
220         env_init,               /* initialize environment */
221         init_baudrate,          /* initialze baudrate settings */
222         serial_init,            /* serial communications setup */
223         console_init_f,         /* stage 1 init of console */
224         display_banner,         /* say that we are here */
225 #if defined(CONFIG_DISPLAY_CPUINFO)
226         print_cpuinfo,          /* display cpu info (and speed) */
227 #endif
228 #if defined(CONFIG_DISPLAY_BOARDINFO)
229         checkboard,             /* display board info */
230 #endif
231         dram_init,              /* configure available RAM banks */
232         display_dram_config,
233         NULL,
234 };
235
236 void start_armboot (void)
237 {
238         init_fnc_t **init_fnc_ptr;
239         char *s;
240 #ifndef CFG_NO_FLASH
241         ulong size;
242 #endif
243 #if defined(CONFIG_VFD) || defined(CONFIG_LCD)
244         unsigned long addr;
245 #endif
246
247         /* Pointer is writable since we allocated a register for it */
248         gd = (gd_t*)(_armboot_start - CFG_MALLOC_LEN - sizeof(gd_t));
249         /* compiler optimization barrier needed for GCC >= 3.4 */
250         __asm__ __volatile__("": : :"memory");
251
252         memset ((void*)gd, 0, sizeof (gd_t));
253         gd->bd = (bd_t*)((char*)gd - sizeof(bd_t));
254         memset (gd->bd, 0, sizeof (bd_t));
255
256         monitor_flash_len = _bss_start - _armboot_start;
257
258         for (init_fnc_ptr = init_sequence; *init_fnc_ptr; ++init_fnc_ptr) {
259                 if ((*init_fnc_ptr)() != 0) {
260                         hang ();
261                 }
262         }
263
264 #ifndef CFG_NO_FLASH
265         /* configure available FLASH banks */
266         size = flash_init ();
267         display_flash_config (size);
268 #endif /* CFG_NO_FLASH */
269
270 #ifdef CONFIG_VFD
271 #       ifndef PAGE_SIZE
272 #         define PAGE_SIZE 4096
273 #       endif
274         /*
275          * reserve memory for VFD display (always full pages)
276          */
277         /* bss_end is defined in the board-specific linker script */
278         addr = (_bss_end + (PAGE_SIZE - 1)) & ~(PAGE_SIZE - 1);
279         size = vfd_setmem (addr);
280         gd->fb_base = addr;
281 #endif /* CONFIG_VFD */
282
283 #ifdef CONFIG_LCD
284 #       ifndef PAGE_SIZE
285 #         define PAGE_SIZE 4096
286 #       endif
287         /*
288          * reserve memory for LCD display (always full pages)
289          */
290         /* bss_end is defined in the board-specific linker script */
291         addr = (_bss_end + (PAGE_SIZE - 1)) & ~(PAGE_SIZE - 1);
292         size = lcd_setmem (addr);
293         gd->fb_base = addr;
294 #endif /* CONFIG_LCD */
295
296         /* armboot_start is defined in the board-specific linker script */
297         mem_malloc_init (_armboot_start - CFG_MALLOC_LEN);
298
299 #if (CONFIG_COMMANDS & CFG_CMD_NAND)
300         puts ("NAND:");
301         nand_init();            /* go init the NAND */
302 #endif
303
304 #ifdef CONFIG_HAS_DATAFLASH
305         AT91F_DataflashInit();
306         dataflash_print_info();
307 #endif
308
309         /* initialize environment */
310         env_relocate ();
311
312 #ifdef CONFIG_VFD
313         /* must do this after the framebuffer is allocated */
314         drv_vfd_init();
315 #endif /* CONFIG_VFD */
316
317         /* IP Address */
318         gd->bd->bi_ip_addr = getenv_IPaddr ("ipaddr");
319
320         /* MAC Address */
321         {
322                 int i;
323                 ulong reg;
324                 char *s, *e;
325                 char tmp[64];
326
327                 i = getenv_r ("ethaddr", tmp, sizeof (tmp));
328                 s = (i > 0) ? tmp : NULL;
329
330                 for (reg = 0; reg < 6; ++reg) {
331                         gd->bd->bi_enetaddr[reg] = s ? simple_strtoul (s, &e, 16) : 0;
332                         if (s)
333                                 s = (*e) ? e + 1 : e;
334                 }
335
336 #ifdef CONFIG_HAS_ETH1
337                 i = getenv_r ("eth1addr", tmp, sizeof (tmp));
338                 s = (i > 0) ? tmp : NULL;
339
340                 for (reg = 0; reg < 6; ++reg) {
341                         gd->bd->bi_enet1addr[reg] = s ? simple_strtoul (s, &e, 16) : 0;
342                         if (s)
343                                 s = (*e) ? e + 1 : e;
344                 }
345 #endif
346         }
347
348         devices_init ();        /* get the devices list going. */
349
350 #ifdef CONFIG_CMC_PU2
351         load_sernum_ethaddr ();
352 #endif /* CONFIG_CMC_PU2 */
353
354         jumptable_init ();
355
356         console_init_r ();      /* fully init console as a device */
357
358 #if defined(CONFIG_MISC_INIT_R)
359         /* miscellaneous platform dependent initialisations */
360         misc_init_r ();
361 #endif
362
363         /* enable exceptions */
364         enable_interrupts ();
365
366         /* Perform network card initialisation if necessary */
367 #ifdef CONFIG_DRIVER_CS8900
368         cs8900_get_enetaddr (gd->bd->bi_enetaddr);
369 #endif
370
371 #if defined(CONFIG_DRIVER_SMC91111) || defined (CONFIG_DRIVER_LAN91C96)
372         if (getenv ("ethaddr")) {
373                 smc_set_mac_addr(gd->bd->bi_enetaddr);
374         }
375 #endif /* CONFIG_DRIVER_SMC91111 || CONFIG_DRIVER_LAN91C96 */
376
377         /* Initialize from environment */
378         if ((s = getenv ("loadaddr")) != NULL) {
379                 load_addr = simple_strtoul (s, NULL, 16);
380         }
381 #if (CONFIG_COMMANDS & CFG_CMD_NET)
382         if ((s = getenv ("bootfile")) != NULL) {
383                 copy_filename (BootFile, s, sizeof (BootFile));
384         }
385 #endif  /* CFG_CMD_NET */
386
387 #ifdef BOARD_LATE_INIT
388         board_late_init ();
389 #endif
390 #if (CONFIG_COMMANDS & CFG_CMD_NET)
391 #if defined(CONFIG_NET_MULTI)
392         puts ("Net:   ");
393 #endif
394         eth_initialize(gd->bd);
395 #endif
396         /* main_loop() can return to retry autoboot, if so just run it again. */
397         for (;;) {
398                 main_loop ();
399         }
400
401         /* NOTREACHED - no way out of command loop except booting */
402 }
403
404 void hang (void)
405 {
406         puts ("### ERROR ### Please RESET the board ###\n");
407         for (;;);
408 }
409
410 #ifdef CONFIG_MODEM_SUPPORT
411 /* called from main loop (common/main.c) */
412 extern void  dbg(const char *fmt, ...);
413 int mdm_init (void)
414 {
415         char env_str[16];
416         char *init_str;
417         int i;
418         extern char console_buffer[];
419         static inline void mdm_readline(char *buf, int bufsiz);
420         extern void enable_putc(void);
421         extern int hwflow_onoff(int);
422
423         enable_putc(); /* enable serial_putc() */
424
425 #ifdef CONFIG_HWFLOW
426         init_str = getenv("mdm_flow_control");
427         if (init_str && (strcmp(init_str, "rts/cts") == 0))
428                 hwflow_onoff (1);
429         else
430                 hwflow_onoff(-1);
431 #endif
432
433         for (i = 1;;i++) {
434                 sprintf(env_str, "mdm_init%d", i);
435                 if ((init_str = getenv(env_str)) != NULL) {
436                         serial_puts(init_str);
437                         serial_puts("\n");
438                         for(;;) {
439                                 mdm_readline(console_buffer, CFG_CBSIZE);
440                                 dbg("ini%d: [%s]", i, console_buffer);
441
442                                 if ((strcmp(console_buffer, "OK") == 0) ||
443                                         (strcmp(console_buffer, "ERROR") == 0)) {
444                                         dbg("ini%d: cmd done", i);
445                                         break;
446                                 } else /* in case we are originating call ... */
447                                         if (strncmp(console_buffer, "CONNECT", 7) == 0) {
448                                                 dbg("ini%d: connect", i);
449                                                 return 0;
450                                         }
451                         }
452                 } else
453                         break; /* no init string - stop modem init */
454
455                 udelay(100000);
456         }
457
458         udelay(100000);
459
460         /* final stage - wait for connect */
461         for(;i > 1;) { /* if 'i' > 1 - wait for connection
462                                   message from modem */
463                 mdm_readline(console_buffer, CFG_CBSIZE);
464                 dbg("ini_f: [%s]", console_buffer);
465                 if (strncmp(console_buffer, "CONNECT", 7) == 0) {
466                         dbg("ini_f: connected");
467                         return 0;
468                 }
469         }
470
471         return 0;
472 }
473
474 /* 'inline' - We have to do it fast */
475 static inline void mdm_readline(char *buf, int bufsiz)
476 {
477         char c;
478         char *p;
479         int n;
480
481         n = 0;
482         p = buf;
483         for(;;) {
484                 c = serial_getc();
485
486                 /*              dbg("(%c)", c); */
487
488                 switch(c) {
489                 case '\r':
490                         break;
491                 case '\n':
492                         *p = '\0';
493                         return;
494
495                 default:
496                         if(n++ > bufsiz) {
497                                 *p = '\0';
498                                 return; /* sanity check */
499                         }
500                         *p = c;
501                         p++;
502                         break;
503                 }
504         }
505 }
506 #endif  /* CONFIG_MODEM_SUPPORT */