Merge branch 'linux-next' of git://git.infradead.org/~dedekind/ubi-2.6
[linux-2.6] / arch / mips / sibyte / cfe / setup.c
1 /*
2  * Copyright (C) 2000, 2001, 2002, 2003 Broadcom Corporation
3  *
4  * This program is free software; you can redistribute it and/or
5  * modify it under the terms of the GNU General Public License
6  * as published by the Free Software Foundation; either version 2
7  * of the License, or (at your option) any later version.
8  *
9  * This program is distributed in the hope that it will be useful,
10  * but WITHOUT ANY WARRANTY; without even the implied warranty of
11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
12  * GNU General Public License for more details.
13  *
14  * You should have received a copy of the GNU General Public License
15  * along with this program; if not, write to the Free Software
16  * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.
17  */
18
19 #include <linux/init.h>
20 #include <linux/kernel.h>
21 #include <linux/linkage.h>
22 #include <linux/mm.h>
23 #include <linux/blkdev.h>
24 #include <linux/bootmem.h>
25 #include <linux/pm.h>
26 #include <linux/smp.h>
27
28 #include <asm/bootinfo.h>
29 #include <asm/reboot.h>
30 #include <asm/sibyte/board.h>
31 #include <asm/smp-ops.h>
32
33 #include <asm/fw/cfe/cfe_api.h>
34 #include <asm/fw/cfe/cfe_error.h>
35
36 /* Max ram addressable in 32-bit segments */
37 #ifdef CONFIG_64BIT
38 #define MAX_RAM_SIZE (~0ULL)
39 #else
40 #ifdef CONFIG_HIGHMEM
41 #ifdef CONFIG_64BIT_PHYS_ADDR
42 #define MAX_RAM_SIZE (~0ULL)
43 #else
44 #define MAX_RAM_SIZE (0xffffffffULL)
45 #endif
46 #else
47 #define MAX_RAM_SIZE (0x1fffffffULL)
48 #endif
49 #endif
50
51 #define SIBYTE_MAX_MEM_REGIONS 8
52 phys_t board_mem_region_addrs[SIBYTE_MAX_MEM_REGIONS];
53 phys_t board_mem_region_sizes[SIBYTE_MAX_MEM_REGIONS];
54 unsigned int board_mem_region_count;
55
56 int cfe_cons_handle;
57
58 #ifdef CONFIG_BLK_DEV_INITRD
59 extern unsigned long initrd_start, initrd_end;
60 #endif
61
62 #ifdef CONFIG_KGDB
63 extern int kgdb_port;
64 #endif
65
66 static void __noreturn cfe_linux_exit(void *arg)
67 {
68         int warm = *(int *)arg;
69
70         if (smp_processor_id()) {
71                 static int reboot_smp;
72
73                 /* Don't repeat the process from another CPU */
74                 if (!reboot_smp) {
75                         /* Get CPU 0 to do the cfe_exit */
76                         reboot_smp = 1;
77                         smp_call_function(cfe_linux_exit, arg, 0);
78                 }
79         } else {
80                 printk("Passing control back to CFE...\n");
81                 cfe_exit(warm, 0);
82                 printk("cfe_exit returned??\n");
83         }
84         while (1);
85 }
86
87 static void __noreturn cfe_linux_restart(char *command)
88 {
89         static const int zero;
90
91         cfe_linux_exit((void *)&zero);
92 }
93
94 static void __noreturn cfe_linux_halt(void)
95 {
96         static const int one = 1;
97
98         cfe_linux_exit((void *)&one);
99 }
100
101 static __init void prom_meminit(void)
102 {
103         u64 addr, size, type; /* regardless of 64BIT_PHYS_ADDR */
104         int mem_flags = 0;
105         unsigned int idx;
106         int rd_flag;
107 #ifdef CONFIG_BLK_DEV_INITRD
108         unsigned long initrd_pstart;
109         unsigned long initrd_pend;
110
111         initrd_pstart = CPHYSADDR(initrd_start);
112         initrd_pend = CPHYSADDR(initrd_end);
113         if (initrd_start &&
114             ((initrd_pstart > MAX_RAM_SIZE)
115              || (initrd_pend > MAX_RAM_SIZE))) {
116                 panic("initrd out of addressable memory");
117         }
118
119 #endif /* INITRD */
120
121         for (idx = 0; cfe_enummem(idx, mem_flags, &addr, &size, &type) != CFE_ERR_NOMORE;
122              idx++) {
123                 rd_flag = 0;
124                 if (type == CFE_MI_AVAILABLE) {
125                         /*
126                          * See if this block contains (any portion of) the
127                          * ramdisk
128                          */
129 #ifdef CONFIG_BLK_DEV_INITRD
130                         if (initrd_start) {
131                                 if ((initrd_pstart > addr) &&
132                                     (initrd_pstart < (addr + size))) {
133                                         add_memory_region(addr,
134                                                           initrd_pstart - addr,
135                                                           BOOT_MEM_RAM);
136                                         rd_flag = 1;
137                                 }
138                                 if ((initrd_pend > addr) &&
139                                     (initrd_pend < (addr + size))) {
140                                         add_memory_region(initrd_pend,
141                                                 (addr + size) - initrd_pend,
142                                                  BOOT_MEM_RAM);
143                                         rd_flag = 1;
144                                 }
145                         }
146 #endif
147                         if (!rd_flag) {
148                                 if (addr > MAX_RAM_SIZE)
149                                         continue;
150                                 if (addr+size > MAX_RAM_SIZE)
151                                         size = MAX_RAM_SIZE - (addr+size) + 1;
152                                 /*
153                                  * memcpy/__copy_user prefetch, which
154                                  * will cause a bus error for
155                                  * KSEG/KUSEG addrs not backed by RAM.
156                                  * Hence, reserve some padding for the
157                                  * prefetch distance.
158                                  */
159                                 if (size > 512)
160                                         size -= 512;
161                                 add_memory_region(addr, size, BOOT_MEM_RAM);
162                         }
163                         board_mem_region_addrs[board_mem_region_count] = addr;
164                         board_mem_region_sizes[board_mem_region_count] = size;
165                         board_mem_region_count++;
166                         if (board_mem_region_count ==
167                             SIBYTE_MAX_MEM_REGIONS) {
168                                 /*
169                                  * Too many regions.  Need to configure more
170                                  */
171                                 while(1);
172                         }
173                 }
174         }
175 #ifdef CONFIG_BLK_DEV_INITRD
176         if (initrd_start) {
177                 add_memory_region(initrd_pstart, initrd_pend - initrd_pstart,
178                                   BOOT_MEM_RESERVED);
179         }
180 #endif
181 }
182
183 #ifdef CONFIG_BLK_DEV_INITRD
184 static int __init initrd_setup(char *str)
185 {
186         char rdarg[64];
187         int idx;
188         char *tmp, *endptr;
189         unsigned long initrd_size;
190
191         /* Make a copy of the initrd argument so we can smash it up here */
192         for (idx = 0; idx < sizeof(rdarg)-1; idx++) {
193                 if (!str[idx] || (str[idx] == ' ')) break;
194                 rdarg[idx] = str[idx];
195         }
196
197         rdarg[idx] = 0;
198         str = rdarg;
199
200         /*
201          *Initrd location comes in the form "<hex size of ramdisk in bytes>@<location in memory>"
202          *  e.g. initrd=3abfd@80010000.  This is set up by the loader.
203          */
204         for (tmp = str; *tmp != '@'; tmp++) {
205                 if (!*tmp) {
206                         goto fail;
207                 }
208         }
209         *tmp = 0;
210         tmp++;
211         if (!*tmp) {
212                 goto fail;
213         }
214         initrd_size = simple_strtoul(str, &endptr, 16);
215         if (*endptr) {
216                 *(tmp-1) = '@';
217                 goto fail;
218         }
219         *(tmp-1) = '@';
220         initrd_start = simple_strtoul(tmp, &endptr, 16);
221         if (*endptr) {
222                 goto fail;
223         }
224         initrd_end = initrd_start + initrd_size;
225         printk("Found initrd of %lx@%lx\n", initrd_size, initrd_start);
226         return 1;
227  fail:
228         printk("Bad initrd argument.  Disabling initrd\n");
229         initrd_start = 0;
230         initrd_end = 0;
231         return 1;
232 }
233
234 #endif
235
236 extern struct plat_smp_ops sb_smp_ops;
237 extern struct plat_smp_ops bcm1480_smp_ops;
238
239 /*
240  * prom_init is called just after the cpu type is determined, from setup_arch()
241  */
242 void __init prom_init(void)
243 {
244         uint64_t cfe_ept, cfe_handle;
245         unsigned int cfe_eptseal;
246         int argc = fw_arg0;
247         char **envp = (char **) fw_arg2;
248         int *prom_vec = (int *) fw_arg3;
249 #ifdef CONFIG_KGDB
250         char *arg;
251 #endif
252
253         _machine_restart   = cfe_linux_restart;
254         _machine_halt      = cfe_linux_halt;
255         pm_power_off = cfe_linux_halt;
256
257         /*
258          * Check if a loader was used; if NOT, the 4 arguments are
259          * what CFE gives us (handle, 0, EPT and EPTSEAL)
260          */
261         if (argc < 0) {
262                 cfe_handle = (uint64_t)(long)argc;
263                 cfe_ept = (long)envp;
264                 cfe_eptseal = (uint32_t)(unsigned long)prom_vec;
265         } else {
266                 if ((int32_t)(long)prom_vec < 0) {
267                         /*
268                          * Old loader; all it gives us is the handle,
269                          * so use the "known" entrypoint and assume
270                          * the seal.
271                          */
272                         cfe_handle = (uint64_t)(long)prom_vec;
273                         cfe_ept = (uint64_t)((int32_t)0x9fc00500);
274                         cfe_eptseal = CFE_EPTSEAL;
275                 } else {
276                         /*
277                          * Newer loaders bundle the handle/ept/eptseal
278                          * Note: prom_vec is in the loader's useg
279                          * which is still alive in the TLB.
280                          */
281                         cfe_handle = (uint64_t)((int32_t *)prom_vec)[0];
282                         cfe_ept = (uint64_t)((int32_t *)prom_vec)[2];
283                         cfe_eptseal = (unsigned int)((uint32_t *)prom_vec)[3];
284                 }
285         }
286         if (cfe_eptseal != CFE_EPTSEAL) {
287                 /* too early for panic to do any good */
288                 printk("CFE's entrypoint seal doesn't match. Spinning.");
289                 while (1) ;
290         }
291         cfe_init(cfe_handle, cfe_ept);
292         /*
293          * Get the handle for (at least) prom_putchar, possibly for
294          * boot console
295          */
296         cfe_cons_handle = cfe_getstdhandle(CFE_STDHANDLE_CONSOLE);
297         if (cfe_getenv("LINUX_CMDLINE", arcs_cmdline, CL_SIZE) < 0) {
298                 if (argc < 0) {
299                         /*
300                          * It's OK for direct boot to not provide a
301                          *  command line
302                          */
303                         strcpy(arcs_cmdline, "root=/dev/ram0 ");
304                 } else {
305                         /* The loader should have set the command line */
306                         /* too early for panic to do any good */
307                         printk("LINUX_CMDLINE not defined in cfe.");
308                         while (1) ;
309                 }
310         }
311
312 #ifdef CONFIG_KGDB
313         if ((arg = strstr(arcs_cmdline, "kgdb=duart")) != NULL)
314                 kgdb_port = (arg[10] == '0') ? 0 : 1;
315         else
316                 kgdb_port = 1;
317 #endif
318
319 #ifdef CONFIG_BLK_DEV_INITRD
320         {
321                 char *ptr;
322                 /* Need to find out early whether we've got an initrd.  So scan
323                    the list looking now */
324                 for (ptr = arcs_cmdline; *ptr; ptr++) {
325                         while (*ptr == ' ') {
326                                 ptr++;
327                         }
328                         if (!strncmp(ptr, "initrd=", 7)) {
329                                 initrd_setup(ptr+7);
330                                 break;
331                         } else {
332                                 while (*ptr && (*ptr != ' ')) {
333                                         ptr++;
334                                 }
335                         }
336                 }
337         }
338 #endif /* CONFIG_BLK_DEV_INITRD */
339
340         /* Not sure this is needed, but it's the safe way. */
341         arcs_cmdline[CL_SIZE-1] = 0;
342
343         prom_meminit();
344
345 #if defined(CONFIG_SIBYTE_BCM112X) || defined(CONFIG_SIBYTE_SB1250)
346         register_smp_ops(&sb_smp_ops);
347 #endif
348 #if defined(CONFIG_SIBYTE_BCM1x55) || defined(CONFIG_SIBYTE_BCM1x80)
349         register_smp_ops(&bcm1480_smp_ops);
350 #endif
351 }
352
353 void __init prom_free_prom_memory(void)
354 {
355         /* Not sure what I'm supposed to do here.  Nothing, I think */
356 }
357
358 void prom_putchar(char c)
359 {
360         int ret;
361
362         while ((ret = cfe_write(cfe_cons_handle, &c, 1)) == 0)
363                 ;
364 }