airport: remove useless return in a function returning void
[linux/fpc-iii.git] / arch / mips / sibyte / cfe / setup.c
blob3de30f79db3f33dcbf945bca58389456af40e1f3
1 /*
2 * Copyright (C) 2000, 2001, 2002, 2003 Broadcom Corporation
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.
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.
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.
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>
28 #include <asm/bootinfo.h>
29 #include <asm/reboot.h>
30 #include <asm/sibyte/board.h>
31 #include <asm/smp-ops.h>
33 #include <asm/fw/cfe/cfe_api.h>
34 #include <asm/fw/cfe/cfe_error.h>
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
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;
56 int cfe_cons_handle;
58 #ifdef CONFIG_BLK_DEV_INITRD
59 extern unsigned long initrd_start, initrd_end;
60 #endif
62 static void __noreturn cfe_linux_exit(void *arg)
64 int warm = *(int *)arg;
66 if (smp_processor_id()) {
67 static int reboot_smp;
69 /* Don't repeat the process from another CPU */
70 if (!reboot_smp) {
71 /* Get CPU 0 to do the cfe_exit */
72 reboot_smp = 1;
73 smp_call_function(cfe_linux_exit, arg, 0);
75 } else {
76 printk("Passing control back to CFE...\n");
77 cfe_exit(warm, 0);
78 printk("cfe_exit returned??\n");
80 while (1);
83 static void __noreturn cfe_linux_restart(char *command)
85 static const int zero;
87 cfe_linux_exit((void *)&zero);
90 static void __noreturn cfe_linux_halt(void)
92 static const int one = 1;
94 cfe_linux_exit((void *)&one);
97 static __init void prom_meminit(void)
99 u64 addr, size, type; /* regardless of 64BIT_PHYS_ADDR */
100 int mem_flags = 0;
101 unsigned int idx;
102 int rd_flag;
103 #ifdef CONFIG_BLK_DEV_INITRD
104 unsigned long initrd_pstart;
105 unsigned long initrd_pend;
107 initrd_pstart = CPHYSADDR(initrd_start);
108 initrd_pend = CPHYSADDR(initrd_end);
109 if (initrd_start &&
110 ((initrd_pstart > MAX_RAM_SIZE)
111 || (initrd_pend > MAX_RAM_SIZE))) {
112 panic("initrd out of addressable memory");
115 #endif /* INITRD */
117 for (idx = 0; cfe_enummem(idx, mem_flags, &addr, &size, &type) != CFE_ERR_NOMORE;
118 idx++) {
119 rd_flag = 0;
120 if (type == CFE_MI_AVAILABLE) {
122 * See if this block contains (any portion of) the
123 * ramdisk
125 #ifdef CONFIG_BLK_DEV_INITRD
126 if (initrd_start) {
127 if ((initrd_pstart > addr) &&
128 (initrd_pstart < (addr + size))) {
129 add_memory_region(addr,
130 initrd_pstart - addr,
131 BOOT_MEM_RAM);
132 rd_flag = 1;
134 if ((initrd_pend > addr) &&
135 (initrd_pend < (addr + size))) {
136 add_memory_region(initrd_pend,
137 (addr + size) - initrd_pend,
138 BOOT_MEM_RAM);
139 rd_flag = 1;
142 #endif
143 if (!rd_flag) {
144 if (addr > MAX_RAM_SIZE)
145 continue;
146 if (addr+size > MAX_RAM_SIZE)
147 size = MAX_RAM_SIZE - (addr+size) + 1;
149 * memcpy/__copy_user prefetch, which
150 * will cause a bus error for
151 * KSEG/KUSEG addrs not backed by RAM.
152 * Hence, reserve some padding for the
153 * prefetch distance.
155 if (size > 512)
156 size -= 512;
157 add_memory_region(addr, size, BOOT_MEM_RAM);
159 board_mem_region_addrs[board_mem_region_count] = addr;
160 board_mem_region_sizes[board_mem_region_count] = size;
161 board_mem_region_count++;
162 if (board_mem_region_count ==
163 SIBYTE_MAX_MEM_REGIONS) {
165 * Too many regions. Need to configure more
167 while(1);
171 #ifdef CONFIG_BLK_DEV_INITRD
172 if (initrd_start) {
173 add_memory_region(initrd_pstart, initrd_pend - initrd_pstart,
174 BOOT_MEM_RESERVED);
176 #endif
179 #ifdef CONFIG_BLK_DEV_INITRD
180 static int __init initrd_setup(char *str)
182 char rdarg[64];
183 int idx;
184 char *tmp, *endptr;
185 unsigned long initrd_size;
187 /* Make a copy of the initrd argument so we can smash it up here */
188 for (idx = 0; idx < sizeof(rdarg)-1; idx++) {
189 if (!str[idx] || (str[idx] == ' ')) break;
190 rdarg[idx] = str[idx];
193 rdarg[idx] = 0;
194 str = rdarg;
197 *Initrd location comes in the form "<hex size of ramdisk in bytes>@<location in memory>"
198 * e.g. initrd=3abfd@80010000. This is set up by the loader.
200 for (tmp = str; *tmp != '@'; tmp++) {
201 if (!*tmp) {
202 goto fail;
205 *tmp = 0;
206 tmp++;
207 if (!*tmp) {
208 goto fail;
210 initrd_size = simple_strtoul(str, &endptr, 16);
211 if (*endptr) {
212 *(tmp-1) = '@';
213 goto fail;
215 *(tmp-1) = '@';
216 initrd_start = simple_strtoul(tmp, &endptr, 16);
217 if (*endptr) {
218 goto fail;
220 initrd_end = initrd_start + initrd_size;
221 printk("Found initrd of %lx@%lx\n", initrd_size, initrd_start);
222 return 1;
223 fail:
224 printk("Bad initrd argument. Disabling initrd\n");
225 initrd_start = 0;
226 initrd_end = 0;
227 return 1;
230 #endif
232 extern struct plat_smp_ops sb_smp_ops;
233 extern struct plat_smp_ops bcm1480_smp_ops;
236 * prom_init is called just after the cpu type is determined, from setup_arch()
238 void __init prom_init(void)
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;
246 _machine_restart = cfe_linux_restart;
247 _machine_halt = cfe_linux_halt;
248 pm_power_off = cfe_linux_halt;
251 * Check if a loader was used; if NOT, the 4 arguments are
252 * what CFE gives us (handle, 0, EPT and EPTSEAL)
254 if (argc < 0) {
255 cfe_handle = (uint64_t)(long)argc;
256 cfe_ept = (long)envp;
257 cfe_eptseal = (uint32_t)(unsigned long)prom_vec;
258 } else {
259 if ((int32_t)(long)prom_vec < 0) {
261 * Old loader; all it gives us is the handle,
262 * so use the "known" entrypoint and assume
263 * the seal.
265 cfe_handle = (uint64_t)(long)prom_vec;
266 cfe_ept = (uint64_t)((int32_t)0x9fc00500);
267 cfe_eptseal = CFE_EPTSEAL;
268 } else {
270 * Newer loaders bundle the handle/ept/eptseal
271 * Note: prom_vec is in the loader's useg
272 * which is still alive in the TLB.
274 cfe_handle = (uint64_t)((int32_t *)prom_vec)[0];
275 cfe_ept = (uint64_t)((int32_t *)prom_vec)[2];
276 cfe_eptseal = (unsigned int)((uint32_t *)prom_vec)[3];
279 if (cfe_eptseal != CFE_EPTSEAL) {
280 /* too early for panic to do any good */
281 printk("CFE's entrypoint seal doesn't match. Spinning.");
282 while (1) ;
284 cfe_init(cfe_handle, cfe_ept);
286 * Get the handle for (at least) prom_putchar, possibly for
287 * boot console
289 cfe_cons_handle = cfe_getstdhandle(CFE_STDHANDLE_CONSOLE);
290 if (cfe_getenv("LINUX_CMDLINE", arcs_cmdline, CL_SIZE) < 0) {
291 if (argc < 0) {
293 * It's OK for direct boot to not provide a
294 * command line
296 strcpy(arcs_cmdline, "root=/dev/ram0 ");
297 } else {
298 /* The loader should have set the command line */
299 /* too early for panic to do any good */
300 printk("LINUX_CMDLINE not defined in cfe.");
301 while (1) ;
305 #ifdef CONFIG_BLK_DEV_INITRD
307 char *ptr;
308 /* Need to find out early whether we've got an initrd. So scan
309 the list looking now */
310 for (ptr = arcs_cmdline; *ptr; ptr++) {
311 while (*ptr == ' ') {
312 ptr++;
314 if (!strncmp(ptr, "initrd=", 7)) {
315 initrd_setup(ptr+7);
316 break;
317 } else {
318 while (*ptr && (*ptr != ' ')) {
319 ptr++;
324 #endif /* CONFIG_BLK_DEV_INITRD */
326 /* Not sure this is needed, but it's the safe way. */
327 arcs_cmdline[CL_SIZE-1] = 0;
329 prom_meminit();
331 #if defined(CONFIG_SIBYTE_BCM112X) || defined(CONFIG_SIBYTE_SB1250)
332 register_smp_ops(&sb_smp_ops);
333 #endif
334 #if defined(CONFIG_SIBYTE_BCM1x55) || defined(CONFIG_SIBYTE_BCM1x80)
335 register_smp_ops(&bcm1480_smp_ops);
336 #endif
339 void __init prom_free_prom_memory(void)
341 /* Not sure what I'm supposed to do here. Nothing, I think */
344 void prom_putchar(char c)
346 int ret;
348 while ((ret = cfe_write(cfe_cons_handle, &c, 1)) == 0)