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