avr32: fix relocation address calculation
[platform/kernel/u-boot.git] / arch / avr32 / lib / board.c
1 /*
2  * Copyright (C) 2004-2006 Atmel Corporation
3  *
4  * See file CREDITS for list of people who contributed to this
5  * project.
6  *
7  * This program is free software; you can redistribute it and/or
8  * modify it under the terms of the GNU General Public License as
9  * published by the Free Software Foundation; either version 2 of
10  * the License, or (at your option) any later version.
11  *
12  * This program is distributed in the hope that it will be useful,
13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
15  * GNU General Public License for more details.
16  *
17  * You should have received a copy of the GNU General Public License
18  * along with this program; if not, write to the Free Software
19  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
20  * MA 02111-1307 USA
21  */
22 #include <common.h>
23 #include <command.h>
24 #include <malloc.h>
25 #include <stdio_dev.h>
26 #include <version.h>
27 #include <net.h>
28 #include <atmel_mci.h>
29
30 #ifdef CONFIG_BITBANGMII
31 #include <miiphy.h>
32 #endif
33
34 #include <asm/sections.h>
35 #include <asm/arch/mmu.h>
36 #include <asm/arch/hardware.h>
37
38 #ifndef CONFIG_IDENT_STRING
39 #define CONFIG_IDENT_STRING ""
40 #endif
41
42 #ifdef CONFIG_GENERIC_ATMEL_MCI
43 #include <mmc.h>
44 #endif
45 DECLARE_GLOBAL_DATA_PTR;
46
47 unsigned long monitor_flash_len;
48
49 /* Weak aliases for optional board functions */
50 static int __do_nothing(void)
51 {
52         return 0;
53 }
54 int board_postclk_init(void) __attribute__((weak, alias("__do_nothing")));
55 int board_early_init_r(void) __attribute__((weak, alias("__do_nothing")));
56
57 /* provide cpu_mmc_init, to overwrite provide board_mmc_init */
58 int cpu_mmc_init(bd_t *bd)
59 {
60         /* This calls the atmel_mci_init in gen_atmel_mci.c */
61         return atmel_mci_init((void *)ATMEL_BASE_MMCI);
62 }
63
64 #ifdef CONFIG_SYS_DMA_ALLOC_LEN
65 #include <asm/arch/cacheflush.h>
66 #include <asm/io.h>
67
68 static unsigned long dma_alloc_start;
69 static unsigned long dma_alloc_end;
70 static unsigned long dma_alloc_brk;
71
72 static void dma_alloc_init(void)
73 {
74         unsigned long monitor_addr;
75
76         monitor_addr = CONFIG_SYS_MONITOR_BASE + gd->reloc_off;
77         dma_alloc_end = monitor_addr - CONFIG_SYS_MALLOC_LEN;
78         dma_alloc_start = dma_alloc_end - CONFIG_SYS_DMA_ALLOC_LEN;
79         dma_alloc_brk = dma_alloc_start;
80
81         printf("DMA: Using memory from 0x%08lx to 0x%08lx\n",
82                dma_alloc_start, dma_alloc_end);
83
84         dcache_invalidate_range(cached(dma_alloc_start),
85                                 dma_alloc_end - dma_alloc_start);
86 }
87
88 void *dma_alloc_coherent(size_t len, unsigned long *handle)
89 {
90         unsigned long paddr = dma_alloc_brk;
91
92         if (dma_alloc_brk + len > dma_alloc_end)
93                 return NULL;
94
95         dma_alloc_brk = ((paddr + len + CONFIG_SYS_DCACHE_LINESZ - 1)
96                          & ~(CONFIG_SYS_DCACHE_LINESZ - 1));
97
98         *handle = paddr;
99         return uncached(paddr);
100 }
101 #else
102 static inline void dma_alloc_init(void)
103 {
104
105 }
106 #endif
107
108 static int init_baudrate(void)
109 {
110         gd->baudrate = getenv_ulong("baudrate", 10, CONFIG_BAUDRATE);
111         return 0;
112 }
113
114 static int display_banner (void)
115 {
116         printf ("\n\n%s\n\n", version_string);
117         printf ("U-Boot code: %08lx -> %08lx  data: %08lx -> %08lx\n",
118                 (unsigned long)_text, (unsigned long)_etext,
119                 (unsigned long)_data, (unsigned long)(&__bss_end));
120         return 0;
121 }
122
123 static int display_dram_config (void)
124 {
125         int i;
126
127         puts ("DRAM Configuration:\n");
128
129         for (i = 0; i < CONFIG_NR_DRAM_BANKS; i++) {
130                 printf ("Bank #%d: %08lx ", i, gd->bd->bi_dram[i].start);
131                 print_size (gd->bd->bi_dram[i].size, "\n");
132         }
133
134         return 0;
135 }
136
137 static void display_flash_config (void)
138 {
139         puts ("Flash: ");
140         print_size(gd->bd->bi_flashsize, " ");
141         printf("at address 0x%08lx\n", gd->bd->bi_flashstart);
142 }
143
144 void board_init_f(ulong board_type)
145 {
146         gd_t gd_data;
147         gd_t *new_gd;
148         bd_t *bd;
149         unsigned long *new_sp;
150         unsigned long monitor_len;
151         unsigned long monitor_addr;
152         unsigned long addr;
153         long sdram_size;
154
155         /* Initialize the global data pointer */
156         memset(&gd_data, 0, sizeof(gd_data));
157         gd = &gd_data;
158
159         /* Perform initialization sequence */
160         board_early_init_f();
161         cpu_init();
162         board_postclk_init();
163         env_init();
164         init_baudrate();
165         serial_init();
166         console_init_f();
167         display_banner();
168         sdram_size = initdram(board_type);
169
170         /* If we have no SDRAM, we can't go on */
171         if (sdram_size <= 0)
172                 panic("No working SDRAM available\n");
173
174         /*
175          * Now that we have DRAM mapped and working, we can
176          * relocate the code and continue running from DRAM.
177          *
178          * Reserve memory at end of RAM for (top down in that order):
179          *  - u-boot image
180          *  - heap for malloc()
181          *  - board info struct
182          *  - global data struct
183          *  - stack
184          */
185         addr = CONFIG_SYS_SDRAM_BASE + sdram_size;
186         monitor_len = (char *)(&__bss_end) - _text;
187
188         /*
189          * Reserve memory for u-boot code, data and bss.
190          * Round down to next 4 kB limit.
191          */
192         addr -= monitor_len;
193         addr &= ~(4096UL - 1);
194         monitor_addr = addr;
195
196         /* Reserve memory for malloc() */
197         addr -= CONFIG_SYS_MALLOC_LEN;
198
199 #ifdef CONFIG_SYS_DMA_ALLOC_LEN
200         /* Reserve DMA memory (must be cache aligned) */
201         addr &= ~(CONFIG_SYS_DCACHE_LINESZ - 1);
202         addr -= CONFIG_SYS_DMA_ALLOC_LEN;
203 #endif
204
205 #ifdef CONFIG_LCD
206 #ifdef CONFIG_FB_ADDR
207         printf("LCD: Frame buffer allocated at preset 0x%08x\n",
208                CONFIG_FB_ADDR);
209         gd->fb_base = CONFIG_FB_ADDR;
210 #else
211         addr = lcd_setmem(addr);
212         printf("LCD: Frame buffer allocated at 0x%08lx\n", addr);
213         gd->fb_base = addr;
214 #endif /* CONFIG_FB_ADDR */
215 #endif /* CONFIG_LCD */
216
217         /* Allocate a Board Info struct on a word boundary */
218         addr -= sizeof(bd_t);
219         addr &= ~3UL;
220         gd->bd = bd = (bd_t *)addr;
221
222         /* Allocate a new global data copy on a 8-byte boundary. */
223         addr -= sizeof(gd_t);
224         addr &= ~7UL;
225         new_gd = (gd_t *)addr;
226
227         /* And finally, a new, bigger stack. */
228         new_sp = (unsigned long *)addr;
229         gd->arch.stack_end = addr;
230         *(--new_sp) = 0;
231         *(--new_sp) = 0;
232
233         /*
234          * Initialize the board information struct with the
235          * information we have.
236          */
237         bd->bi_dram[0].start = CONFIG_SYS_SDRAM_BASE;
238         bd->bi_dram[0].size = sdram_size;
239         bd->bi_baudrate = gd->baudrate;
240
241         memcpy(new_gd, gd, sizeof(gd_t));
242
243         relocate_code((unsigned long)new_sp, new_gd, monitor_addr);
244 }
245
246 void board_init_r(gd_t *new_gd, ulong dest_addr)
247 {
248 #ifndef CONFIG_ENV_IS_NOWHERE
249         extern char * env_name_spec;
250 #endif
251         bd_t *bd;
252
253         gd = new_gd;
254         bd = gd->bd;
255
256         gd->flags |= GD_FLG_RELOC;
257         gd->reloc_off = dest_addr - CONFIG_SYS_MONITOR_BASE;
258
259         /* Enable the MMU so that we can keep u-boot simple */
260         mmu_init_r(dest_addr);
261
262         board_early_init_r();
263
264         monitor_flash_len = _edata - _text;
265
266 #if defined(CONFIG_NEEDS_MANUAL_RELOC)
267         /*
268          * We have to relocate the command table manually
269          */
270         fixup_cmdtable(ll_entry_start(cmd_tbl_t, cmd),
271                         ll_entry_count(cmd_tbl_t, cmd));
272 #endif /* defined(CONFIG_NEEDS_MANUAL_RELOC) */
273
274         /* there are some other pointer constants we must deal with */
275 #ifndef CONFIG_ENV_IS_NOWHERE
276         env_name_spec += gd->reloc_off;
277 #endif
278
279         timer_init();
280
281         /* The malloc area is right below the monitor image in RAM */
282         mem_malloc_init(CONFIG_SYS_MONITOR_BASE + gd->reloc_off -
283                         CONFIG_SYS_MALLOC_LEN, CONFIG_SYS_MALLOC_LEN);
284         dma_alloc_init();
285
286         enable_interrupts();
287
288         bd->bi_flashstart = 0;
289         bd->bi_flashsize = 0;
290         bd->bi_flashoffset = 0;
291
292 #ifndef CONFIG_SYS_NO_FLASH
293         bd->bi_flashstart = CONFIG_SYS_FLASH_BASE;
294         bd->bi_flashsize = flash_init();
295         bd->bi_flashoffset = (unsigned long)_edata - (unsigned long)_text;
296
297         if (bd->bi_flashsize)
298                 display_flash_config();
299 #endif
300
301         if (bd->bi_dram[0].size)
302                 display_dram_config();
303
304         gd->bd->bi_boot_params = malloc(CONFIG_SYS_BOOTPARAMS_LEN);
305         if (!gd->bd->bi_boot_params)
306                 puts("WARNING: Cannot allocate space for boot parameters\n");
307
308         /* initialize environment */
309         env_relocate();
310
311         stdio_init();
312         jumptable_init();
313         console_init_r();
314
315         /* Initialize from environment */
316         load_addr = getenv_ulong("loadaddr", 16, load_addr);
317
318 #ifdef CONFIG_BITBANGMII
319         bb_miiphy_init();
320 #endif
321 #if defined(CONFIG_CMD_NET)
322         puts("Net:   ");
323         eth_initialize(gd->bd);
324 #endif
325
326 #ifdef CONFIG_GENERIC_ATMEL_MCI
327         mmc_initialize(gd->bd);
328 #endif
329         for (;;) {
330                 main_loop();
331         }
332 }