Blackfin: use common strmhz() in system output
[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 <i2c.h>
17 #include <malloc.h>
18 #include <net.h>
19 #include <timestamp.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 #if defined(CONFIG_SOFT_I2C) || defined(CONFIG_HARD_I2C)
335 static int init_func_i2c(void)
336 {
337         puts("I2C:   ");
338         i2c_init(CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE);
339         puts("ready\n");
340         return (0);
341 }
342 #endif
343
344 void board_init_r(gd_t * id, ulong dest_addr)
345 {
346         extern void malloc_bin_reloc(void);
347         char *s;
348         bd_t *bd;
349         gd = id;
350         gd->flags |= GD_FLG_RELOC;      /* tell others: relocation done */
351         bd = gd->bd;
352
353 #if defined(CONFIG_POST)
354         post_output_backlog();
355         post_reloc();
356 #endif
357
358 #if     !defined(CONFIG_SYS_NO_FLASH)
359         /* There are some other pointer constants we must deal with */
360         /* configure available FLASH banks */
361         extern flash_info_t flash_info[];
362         ulong size = flash_init();
363         puts("Flash: ");
364         print_size(size, "\n");
365         flash_protect(FLAG_PROTECT_SET, CONFIG_SYS_FLASH_BASE,
366                       CONFIG_SYS_FLASH_BASE + 0x1ffff, &flash_info[0]);
367         bd->bi_flashstart = CONFIG_SYS_FLASH_BASE;
368         bd->bi_flashsize = size;
369         bd->bi_flashoffset = 0;
370 #else
371         bd->bi_flashstart = 0;
372         bd->bi_flashsize = 0;
373         bd->bi_flashoffset = 0;
374 #endif
375         /* initialize malloc() area */
376         mem_malloc_init();
377         malloc_bin_reloc();
378
379 #ifdef CONFIG_CMD_NAND
380         puts("NAND:  ");
381         nand_init();            /* go init the NAND */
382 #endif
383
384         /* relocate environment function pointers etc. */
385         env_relocate();
386
387 #ifdef CONFIG_CMD_NET
388         /* board MAC address */
389         s = getenv("ethaddr");
390         if (s == NULL) {
391 # ifndef CONFIG_ETHADDR
392 #  if 0
393                 if (!board_get_enetaddr(bd->bi_enetaddr)) {
394                         char nid[20];
395                         sprintf(nid, "%02X:%02X:%02X:%02X:%02X:%02X",
396                                 bd->bi_enetaddr[0], bd->bi_enetaddr[1],
397                                 bd->bi_enetaddr[2], bd->bi_enetaddr[3],
398                                 bd->bi_enetaddr[4], bd->bi_enetaddr[5]);
399                         setenv("ethaddr", nid);
400                 }
401 #  endif
402 # endif
403         } else {
404                 int i;
405                 char *e;
406                 for (i = 0; i < 6; ++i) {
407                         bd->bi_enetaddr[i] = simple_strtoul(s, &e, 16);
408                         s = (*e) ? e + 1 : e;
409                 }
410         }
411
412         /* IP Address */
413         bd->bi_ip_addr = getenv_IPaddr("ipaddr");
414 #endif
415
416         /* Initialize devices */
417         devices_init();
418         jumptable_init();
419
420         /* Initialize the console (after the relocation and devices init) */
421         console_init_r();
422
423         /* Initialize from environment */
424         if ((s = getenv("loadaddr")) != NULL)
425                 load_addr = simple_strtoul(s, NULL, 16);
426 #ifdef CONFIG_CMD_NET
427         if ((s = getenv("bootfile")) != NULL)
428                 copy_filename(BootFile, s, sizeof(BootFile));
429 #endif
430
431 #if defined(CONFIG_MISC_INIT_R)
432         /* miscellaneous platform dependent initialisations */
433         misc_init_r();
434 #endif
435
436 #ifdef CONFIG_CMD_NET
437         printf("Net:   ");
438         eth_initialize(gd->bd);
439         if (getenv("ethaddr"))
440                 printf("MAC:   %02X:%02X:%02X:%02X:%02X:%02X\n",
441                         bd->bi_enetaddr[0], bd->bi_enetaddr[1], bd->bi_enetaddr[2],
442                         bd->bi_enetaddr[3], bd->bi_enetaddr[4], bd->bi_enetaddr[5]);
443 #endif
444
445 #if defined(CONFIG_SOFT_I2C) || defined(CONFIG_HARD_I2C)
446         init_func_i2c();
447 #endif
448
449         display_global_data();
450
451 #if defined(CONFIG_POST)
452         if (post_flag)
453                 post_run(NULL, POST_RAM | post_bootmode_get(0));
454 #endif
455
456         /* main_loop() can return to retry autoboot, if so just run it again. */
457         for (;;)
458                 main_loop();
459 }
460
461 void hang(void)
462 {
463         puts("### ERROR ### Please RESET the board ###\n");
464         while (1)
465                 /* If a JTAG emulator is hooked up, we'll automatically trigger
466                  * a breakpoint in it.  If one isn't, this is just a NOP.
467                  */
468                 asm("emuexcpt;");
469 }