Blackfin: implement general support for CONFIG_STATUS_LED
[platform/kernel/u-boot.git] / lib_blackfin / board.c
1 /*
2  * U-boot - board.c First C file to be called contains init routines
3  *
4  * Copyright (c) 2005-2008 Analog Devices Inc.
5  *
6  * (C) Copyright 2000-2004
7  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
8  *
9  * Licensed under the GPL-2 or later.
10  */
11
12 #include <common.h>
13 #include <command.h>
14 #include <devices.h>
15 #include <environment.h>
16 #include <malloc.h>
17 #include <net.h>
18 #include <timestamp.h>
19 #include <status_led.h>
20 #include <version.h>
21
22 #include <asm/cplb.h>
23 #include <asm/mach-common/bits/mpu.h>
24
25 #ifdef CONFIG_CMD_NAND
26 #include <nand.h>       /* cannot even include nand.h if it isnt configured */
27 #endif
28
29 #if defined(CONFIG_POST)
30 #include <post.h>
31 int post_flag;
32 #endif
33
34 DECLARE_GLOBAL_DATA_PTR;
35
36 const char version_string[] = U_BOOT_VERSION " ("U_BOOT_DATE" - "U_BOOT_TIME")";
37
38 __attribute__((always_inline))
39 static inline void serial_early_puts(const char *s)
40 {
41 #ifdef CONFIG_DEBUG_EARLY_SERIAL
42         serial_puts("Early: ");
43         serial_puts(s);
44 #endif
45 }
46
47 /* Get the input voltage */
48 static u_long get_vco(void)
49 {
50         u_long msel;
51         u_long vco;
52
53         msel = (*pPLL_CTL >> 9) & 0x3F;
54         if (0 == msel)
55                 msel = 64;
56
57         vco = CONFIG_CLKIN_HZ;
58         vco >>= (1 & *pPLL_CTL);        /* DF bit */
59         vco = msel * vco;
60         return vco;
61 }
62
63 /* Get the Core clock */
64 u_long get_cclk(void)
65 {
66         u_long csel, ssel;
67         if (*pPLL_STAT & 0x1)
68                 return CONFIG_CLKIN_HZ;
69
70         ssel = *pPLL_DIV;
71         csel = ((ssel >> 4) & 0x03);
72         ssel &= 0xf;
73         if (ssel && ssel < (1 << csel)) /* SCLK > CCLK */
74                 return get_vco() / ssel;
75         return get_vco() >> csel;
76 }
77
78 /* Get the System clock */
79 u_long get_sclk(void)
80 {
81         u_long ssel;
82
83         if (*pPLL_STAT & 0x1)
84                 return CONFIG_CLKIN_HZ;
85
86         ssel = (*pPLL_DIV & 0xf);
87
88         return get_vco() / ssel;
89 }
90
91 static void *mem_malloc_start, *mem_malloc_end, *mem_malloc_brk;
92
93 static void mem_malloc_init(void)
94 {
95         mem_malloc_start = (void *)CONFIG_SYS_MALLOC_BASE;
96         mem_malloc_end = (void *)(CONFIG_SYS_MALLOC_BASE + CONFIG_SYS_MALLOC_LEN);
97         mem_malloc_brk = mem_malloc_start;
98         memset(mem_malloc_start, 0, mem_malloc_end - mem_malloc_start);
99 }
100
101 void *sbrk(ptrdiff_t increment)
102 {
103         void *old = mem_malloc_brk;
104         void *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 old;
112 }
113
114 static int display_banner(void)
115 {
116         printf("\n\n%s\n\n", version_string);
117         printf("CPU:   ADSP " MK_STR(CONFIG_BFIN_CPU) " (Detected Rev: 0.%d)\n", bfin_revid());
118         return 0;
119 }
120
121 static int init_baudrate(void)
122 {
123         char baudrate[15];
124         int i = getenv_r("baudrate", baudrate, sizeof(baudrate));
125         gd->bd->bi_baudrate = gd->baudrate = (i > 0)
126             ? simple_strtoul(baudrate, NULL, 10)
127             : CONFIG_BAUDRATE;
128         return 0;
129 }
130
131 static void display_global_data(void)
132 {
133 #ifdef CONFIG_DEBUG_EARLY_SERIAL
134         bd_t *bd;
135         bd = gd->bd;
136         printf(" gd: %x\n", gd);
137         printf(" |-flags: %x\n", gd->flags);
138         printf(" |-board_type: %x\n", gd->board_type);
139         printf(" |-baudrate: %i\n", gd->baudrate);
140         printf(" |-have_console: %x\n", gd->have_console);
141         printf(" |-ram_size: %x\n", gd->ram_size);
142         printf(" |-reloc_off: %x\n", gd->reloc_off);
143         printf(" |-env_addr: %x\n", gd->env_addr);
144         printf(" |-env_valid: %x\n", gd->env_valid);
145         printf(" |-jt(%x): %x\n", gd->jt, *(gd->jt));
146         printf(" \\-bd: %x\n", gd->bd);
147         printf("   |-bi_baudrate: %x\n", bd->bi_baudrate);
148         printf("   |-bi_ip_addr: %x\n", bd->bi_ip_addr);
149         printf("   |-bi_enetaddr: %x %x %x %x %x %x\n",
150                bd->bi_enetaddr[0], bd->bi_enetaddr[1],
151                bd->bi_enetaddr[2], bd->bi_enetaddr[3],
152                bd->bi_enetaddr[4], bd->bi_enetaddr[5]);
153         printf("   |-bi_boot_params: %x\n", bd->bi_boot_params);
154         printf("   |-bi_memstart: %x\n", bd->bi_memstart);
155         printf("   |-bi_memsize: %x\n", bd->bi_memsize);
156         printf("   |-bi_flashstart: %x\n", bd->bi_flashstart);
157         printf("   |-bi_flashsize: %x\n", bd->bi_flashsize);
158         printf("   \\-bi_flashoffset: %x\n", bd->bi_flashoffset);
159 #endif
160 }
161
162 #define CPLB_PAGE_SIZE (4 * 1024 * 1024)
163 #define CPLB_PAGE_MASK (~(CPLB_PAGE_SIZE - 1))
164 void init_cplbtables(void)
165 {
166         volatile uint32_t *ICPLB_ADDR, *ICPLB_DATA;
167         volatile uint32_t *DCPLB_ADDR, *DCPLB_DATA;
168         uint32_t extern_memory;
169         size_t i;
170
171         void icplb_add(uint32_t addr, uint32_t data)
172         {
173                 *(ICPLB_ADDR + i) = addr;
174                 *(ICPLB_DATA + i) = data;
175         }
176         void dcplb_add(uint32_t addr, uint32_t data)
177         {
178                 *(DCPLB_ADDR + i) = addr;
179                 *(DCPLB_DATA + i) = data;
180         }
181
182         /* populate a few common entries ... we'll let
183          * the memory map and cplb exception handler do
184          * the rest of the work.
185          */
186         i = 0;
187         ICPLB_ADDR = (uint32_t *)ICPLB_ADDR0;
188         ICPLB_DATA = (uint32_t *)ICPLB_DATA0;
189         DCPLB_ADDR = (uint32_t *)DCPLB_ADDR0;
190         DCPLB_DATA = (uint32_t *)DCPLB_DATA0;
191
192         icplb_add(0xFFA00000, L1_IMEMORY);
193         dcplb_add(0xFF800000, L1_DMEMORY);
194         ++i;
195
196         icplb_add(CONFIG_SYS_MONITOR_BASE & CPLB_PAGE_MASK, SDRAM_IKERNEL);
197         dcplb_add(CONFIG_SYS_MONITOR_BASE & CPLB_PAGE_MASK, SDRAM_DKERNEL);
198         ++i;
199
200         /* If the monitor crosses a 4 meg boundary, we'll need
201          * to lock two entries for it.
202          */
203         if ((CONFIG_SYS_MONITOR_BASE & CPLB_PAGE_MASK) != ((CONFIG_SYS_MONITOR_BASE + CONFIG_SYS_MONITOR_LEN) & CPLB_PAGE_MASK)) {
204                 icplb_add((CONFIG_SYS_MONITOR_BASE + CONFIG_SYS_MONITOR_LEN) & CPLB_PAGE_MASK, SDRAM_IKERNEL);
205                 dcplb_add((CONFIG_SYS_MONITOR_BASE + CONFIG_SYS_MONITOR_LEN) & CPLB_PAGE_MASK, SDRAM_DKERNEL);
206                 ++i;
207         }
208
209         icplb_add(0x20000000, SDRAM_INON_CHBL);
210         dcplb_add(0x20000000, SDRAM_EBIU);
211         ++i;
212
213         /* Add entries for the rest of external RAM up to the bootrom */
214         extern_memory = 0;
215
216 #ifdef CONFIG_DEBUG_NULL_PTR
217         icplb_add(extern_memory, (SDRAM_IKERNEL & ~PAGE_SIZE_MASK) | PAGE_SIZE_1KB);
218         dcplb_add(extern_memory, (SDRAM_DKERNEL & ~PAGE_SIZE_MASK) | PAGE_SIZE_1KB);
219         ++i;
220         icplb_add(extern_memory, SDRAM_IKERNEL);
221         dcplb_add(extern_memory, SDRAM_DKERNEL);
222         extern_memory += CPLB_PAGE_SIZE;
223         ++i;
224 #endif
225
226         while (i < 16 && extern_memory < (CONFIG_SYS_MONITOR_BASE & CPLB_PAGE_MASK)) {
227                 icplb_add(extern_memory, SDRAM_IGENERIC);
228                 dcplb_add(extern_memory, SDRAM_DGENERIC);
229                 extern_memory += CPLB_PAGE_SIZE;
230                 ++i;
231         }
232         while (i < 16) {
233                 icplb_add(0, 0);
234                 dcplb_add(0, 0);
235                 ++i;
236         }
237 }
238
239 /*
240  * All attempts to come up with a "common" initialization sequence
241  * that works for all boards and architectures failed: some of the
242  * requirements are just _too_ different. To get rid of the resulting
243  * mess of board dependend #ifdef'ed code we now make the whole
244  * initialization sequence configurable to the user.
245  *
246  * The requirements for any new initalization function is simple: it
247  * receives a pointer to the "global data" structure as it's only
248  * argument, and returns an integer return code, where 0 means
249  * "continue" and != 0 means "fatal error, hang the system".
250  */
251
252 extern int exception_init(void);
253 extern int irq_init(void);
254 extern int timer_init(void);
255
256 void board_init_f(ulong bootflag)
257 {
258         ulong addr;
259         bd_t *bd;
260         char buf[32];
261
262 #ifdef CONFIG_BOARD_EARLY_INIT_F
263         serial_early_puts("Board early init flash\n");
264         board_early_init_f();
265 #endif
266
267         serial_early_puts("Init CPLB tables\n");
268         init_cplbtables();
269
270         serial_early_puts("Exceptions setup\n");
271         exception_init();
272
273 #ifndef CONFIG_ICACHE_OFF
274         serial_early_puts("Turn on ICACHE\n");
275         icache_enable();
276 #endif
277 #ifndef CONFIG_DCACHE_OFF
278         serial_early_puts("Turn on DCACHE\n");
279         dcache_enable();
280 #endif
281
282         serial_early_puts("Init global data\n");
283         gd = (gd_t *) (CONFIG_SYS_GBL_DATA_ADDR);
284         memset((void *)gd, 0, sizeof(gd_t));
285
286         /* Board data initialization */
287         addr = (CONFIG_SYS_GBL_DATA_ADDR + sizeof(gd_t));
288
289         /* Align to 4 byte boundary */
290         addr &= ~(4 - 1);
291         bd = (bd_t *) addr;
292         gd->bd = bd;
293         memset((void *)bd, 0, sizeof(bd_t));
294
295         bd->bi_r_version = version_string;
296         bd->bi_cpu = MK_STR(CONFIG_BFIN_CPU);
297         bd->bi_board_name = BFIN_BOARD_NAME;
298         bd->bi_vco = get_vco();
299         bd->bi_cclk = get_cclk();
300         bd->bi_sclk = get_sclk();
301
302         /* Initialize */
303         serial_early_puts("IRQ init\n");
304         irq_init();
305         serial_early_puts("Environment init\n");
306         env_init();
307         serial_early_puts("Baudrate init\n");
308         init_baudrate();
309         serial_early_puts("Serial init\n");
310         serial_init();
311         serial_early_puts("Console init flash\n");
312         console_init_f();
313         serial_early_puts("End of early debugging\n");
314         display_banner();
315
316         checkboard();
317         timer_init();
318
319         printf("Clock: VCO: %s MHz, ", strmhz(buf, get_vco()));
320         printf("Core: %s MHz, ", strmhz(buf, get_cclk()));
321         printf("System: %s MHz\n", strmhz(buf, get_sclk()));
322
323         printf("RAM:   ");
324         print_size(initdram(0), "\n");
325 #if defined(CONFIG_POST)
326         post_init_f();
327         post_bootmode_init();
328         post_run(NULL, POST_ROM | post_bootmode_get(0));
329 #endif
330
331         board_init_r((gd_t *) gd, 0x20000010);
332 }
333
334 void board_init_r(gd_t * id, ulong dest_addr)
335 {
336         extern void malloc_bin_reloc(void);
337         char *s;
338         bd_t *bd;
339         gd = id;
340         gd->flags |= GD_FLG_RELOC;      /* tell others: relocation done */
341         bd = gd->bd;
342
343 #if defined(CONFIG_POST)
344         post_output_backlog();
345         post_reloc();
346 #endif
347
348 #if     !defined(CONFIG_SYS_NO_FLASH)
349         /* There are some other pointer constants we must deal with */
350         /* configure available FLASH banks */
351         extern flash_info_t flash_info[];
352         ulong size = flash_init();
353         puts("Flash: ");
354         print_size(size, "\n");
355         flash_protect(FLAG_PROTECT_SET, CONFIG_SYS_FLASH_BASE,
356                       CONFIG_SYS_FLASH_BASE + 0x1ffff, &flash_info[0]);
357         bd->bi_flashstart = CONFIG_SYS_FLASH_BASE;
358         bd->bi_flashsize = size;
359         bd->bi_flashoffset = 0;
360 #else
361         bd->bi_flashstart = 0;
362         bd->bi_flashsize = 0;
363         bd->bi_flashoffset = 0;
364 #endif
365         /* initialize malloc() area */
366         mem_malloc_init();
367         malloc_bin_reloc();
368
369 #ifdef CONFIG_CMD_NAND
370         puts("NAND:  ");
371         nand_init();            /* go init the NAND */
372 #endif
373
374         /* relocate environment function pointers etc. */
375         env_relocate();
376
377 #ifdef CONFIG_CMD_NET
378         /* board MAC address */
379         s = getenv("ethaddr");
380         if (s == NULL) {
381 # ifndef CONFIG_ETHADDR
382 #  if 0
383                 if (!board_get_enetaddr(bd->bi_enetaddr)) {
384                         char nid[20];
385                         sprintf(nid, "%02X:%02X:%02X:%02X:%02X:%02X",
386                                 bd->bi_enetaddr[0], bd->bi_enetaddr[1],
387                                 bd->bi_enetaddr[2], bd->bi_enetaddr[3],
388                                 bd->bi_enetaddr[4], bd->bi_enetaddr[5]);
389                         setenv("ethaddr", nid);
390                 }
391 #  endif
392 # endif
393         } else {
394                 int i;
395                 char *e;
396                 for (i = 0; i < 6; ++i) {
397                         bd->bi_enetaddr[i] = simple_strtoul(s, &e, 16);
398                         s = (*e) ? e + 1 : e;
399                 }
400         }
401
402         /* IP Address */
403         bd->bi_ip_addr = getenv_IPaddr("ipaddr");
404 #endif
405
406         /* Initialize devices */
407         devices_init();
408         jumptable_init();
409
410         /* Initialize the console (after the relocation and devices init) */
411         console_init_r();
412
413 #ifdef CONFIG_STATUS_LED
414         status_led_set(STATUS_LED_BOOT, STATUS_LED_BLINKING);
415         status_led_set(STATUS_LED_CRASH, STATUS_LED_OFF);
416 #endif
417
418         /* Initialize from environment */
419         if ((s = getenv("loadaddr")) != NULL)
420                 load_addr = simple_strtoul(s, NULL, 16);
421 #ifdef CONFIG_CMD_NET
422         if ((s = getenv("bootfile")) != NULL)
423                 copy_filename(BootFile, s, sizeof(BootFile));
424 #endif
425
426 #if defined(CONFIG_MISC_INIT_R)
427         /* miscellaneous platform dependent initialisations */
428         misc_init_r();
429 #endif
430
431 #ifdef CONFIG_CMD_NET
432         printf("Net:   ");
433         eth_initialize(gd->bd);
434         if (getenv("ethaddr"))
435                 printf("MAC:   %02X:%02X:%02X:%02X:%02X:%02X\n",
436                         bd->bi_enetaddr[0], bd->bi_enetaddr[1], bd->bi_enetaddr[2],
437                         bd->bi_enetaddr[3], bd->bi_enetaddr[4], bd->bi_enetaddr[5]);
438 #endif
439
440         display_global_data();
441
442 #if defined(CONFIG_POST)
443         if (post_flag)
444                 post_run(NULL, POST_RAM | post_bootmode_get(0));
445 #endif
446
447         /* main_loop() can return to retry autoboot, if so just run it again. */
448         for (;;)
449                 main_loop();
450 }
451
452 void hang(void)
453 {
454 #ifdef CONFIG_STATUS_LED
455         status_led_set(STATUS_LED_BOOT, STATUS_LED_OFF);
456         status_led_set(STATUS_LED_CRASH, STATUS_LED_BLINKING);
457 #endif
458         puts("### ERROR ### Please RESET the board ###\n");
459         while (1)
460                 /* If a JTAG emulator is hooked up, we'll automatically trigger
461                  * a breakpoint in it.  If one isn't, this is just a NOP.
462                  */
463                 asm("emuexcpt;");
464 }