| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* | 
 | 2 |  *  arch/s390/kernel/setup.c | 
 | 3 |  * | 
 | 4 |  *  S390 version | 
 | 5 |  *    Copyright (C) 1999,2000 IBM Deutschland Entwicklung GmbH, IBM Corporation | 
 | 6 |  *    Author(s): Hartmut Penner (hp@de.ibm.com), | 
 | 7 |  *               Martin Schwidefsky (schwidefsky@de.ibm.com) | 
 | 8 |  * | 
 | 9 |  *  Derived from "arch/i386/kernel/setup.c" | 
 | 10 |  *    Copyright (C) 1995, Linus Torvalds | 
 | 11 |  */ | 
 | 12 |  | 
 | 13 | /* | 
 | 14 |  * This file handles the architecture-dependent parts of initialization | 
 | 15 |  */ | 
 | 16 |  | 
 | 17 | #include <linux/errno.h> | 
 | 18 | #include <linux/module.h> | 
 | 19 | #include <linux/sched.h> | 
 | 20 | #include <linux/kernel.h> | 
 | 21 | #include <linux/mm.h> | 
 | 22 | #include <linux/stddef.h> | 
 | 23 | #include <linux/unistd.h> | 
 | 24 | #include <linux/ptrace.h> | 
 | 25 | #include <linux/slab.h> | 
 | 26 | #include <linux/user.h> | 
 | 27 | #include <linux/a.out.h> | 
 | 28 | #include <linux/tty.h> | 
 | 29 | #include <linux/ioport.h> | 
 | 30 | #include <linux/delay.h> | 
 | 31 | #include <linux/config.h> | 
 | 32 | #include <linux/init.h> | 
 | 33 | #include <linux/initrd.h> | 
 | 34 | #include <linux/bootmem.h> | 
 | 35 | #include <linux/root_dev.h> | 
 | 36 | #include <linux/console.h> | 
 | 37 | #include <linux/seq_file.h> | 
 | 38 | #include <linux/kernel_stat.h> | 
| Heiko Carstens | 1e8e338 | 2005-10-30 15:00:11 -0800 | [diff] [blame] | 39 | #include <linux/device.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 40 |  | 
 | 41 | #include <asm/uaccess.h> | 
 | 42 | #include <asm/system.h> | 
 | 43 | #include <asm/smp.h> | 
 | 44 | #include <asm/mmu_context.h> | 
 | 45 | #include <asm/cpcmd.h> | 
 | 46 | #include <asm/lowcore.h> | 
 | 47 | #include <asm/irq.h> | 
| Peter Oberparleiter | 0b642ed | 2005-05-01 08:58:58 -0700 | [diff] [blame] | 48 | #include <asm/page.h> | 
 | 49 | #include <asm/ptrace.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 50 |  | 
 | 51 | /* | 
 | 52 |  * Machine setup.. | 
 | 53 |  */ | 
 | 54 | unsigned int console_mode = 0; | 
 | 55 | unsigned int console_devno = -1; | 
 | 56 | unsigned int console_irq = -1; | 
 | 57 | unsigned long memory_size = 0; | 
 | 58 | unsigned long machine_flags = 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 59 | struct { | 
 | 60 | 	unsigned long addr, size, type; | 
 | 61 | } memory_chunk[MEMORY_CHUNKS] = { { 0 } }; | 
 | 62 | #define CHUNK_READ_WRITE 0 | 
 | 63 | #define CHUNK_READ_ONLY 1 | 
 | 64 | volatile int __cpu_logical_map[NR_CPUS]; /* logical cpu to cpu address */ | 
| Heiko Carstens | c9e3735 | 2005-05-01 08:58:57 -0700 | [diff] [blame] | 65 | unsigned long __initdata zholes_size[MAX_NR_ZONES]; | 
 | 66 | static unsigned long __initdata memory_end; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 67 |  | 
 | 68 | /* | 
 | 69 |  * Setup options | 
 | 70 |  */ | 
 | 71 | extern int _text,_etext, _edata, _end; | 
 | 72 |  | 
 | 73 | /* | 
 | 74 |  * This is set up by the setup-routine at boot-time | 
 | 75 |  * for S390 need to find out, what we have to setup | 
 | 76 |  * using address 0x10400 ... | 
 | 77 |  */ | 
 | 78 |  | 
 | 79 | #include <asm/setup.h> | 
 | 80 |  | 
 | 81 | static char command_line[COMMAND_LINE_SIZE] = { 0, }; | 
 | 82 |  | 
 | 83 | static struct resource code_resource = { | 
 | 84 | 	.name  = "Kernel code", | 
| Heiko Carstens | c9e3735 | 2005-05-01 08:58:57 -0700 | [diff] [blame] | 85 | 	.start = (unsigned long) &_text, | 
 | 86 | 	.end = (unsigned long) &_etext - 1, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 87 | 	.flags = IORESOURCE_BUSY | IORESOURCE_MEM, | 
 | 88 | }; | 
 | 89 |  | 
 | 90 | static struct resource data_resource = { | 
 | 91 | 	.name = "Kernel data", | 
| Heiko Carstens | c9e3735 | 2005-05-01 08:58:57 -0700 | [diff] [blame] | 92 | 	.start = (unsigned long) &_etext, | 
 | 93 | 	.end = (unsigned long) &_edata - 1, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 94 | 	.flags = IORESOURCE_BUSY | IORESOURCE_MEM, | 
 | 95 | }; | 
 | 96 |  | 
 | 97 | /* | 
 | 98 |  * cpu_init() initializes state that is per-CPU. | 
 | 99 |  */ | 
 | 100 | void __devinit cpu_init (void) | 
 | 101 | { | 
 | 102 |         int addr = hard_smp_processor_id(); | 
 | 103 |  | 
 | 104 |         /* | 
 | 105 |          * Store processor id in lowcore (used e.g. in timer_interrupt) | 
 | 106 |          */ | 
 | 107 |         asm volatile ("stidp %0": "=m" (S390_lowcore.cpu_data.cpu_id)); | 
 | 108 |         S390_lowcore.cpu_data.cpu_addr = addr; | 
 | 109 |  | 
 | 110 |         /* | 
 | 111 |          * Force FPU initialization: | 
 | 112 |          */ | 
 | 113 |         clear_thread_flag(TIF_USEDFPU); | 
 | 114 |         clear_used_math(); | 
 | 115 |  | 
 | 116 | 	atomic_inc(&init_mm.mm_count); | 
 | 117 | 	current->active_mm = &init_mm; | 
 | 118 |         if (current->mm) | 
 | 119 |                 BUG(); | 
 | 120 |         enter_lazy_tlb(&init_mm, current); | 
 | 121 | } | 
 | 122 |  | 
 | 123 | /* | 
 | 124 |  * VM halt and poweroff setup routines | 
 | 125 |  */ | 
 | 126 | char vmhalt_cmd[128] = ""; | 
 | 127 | char vmpoff_cmd[128] = ""; | 
 | 128 |  | 
 | 129 | static inline void strncpy_skip_quote(char *dst, char *src, int n) | 
 | 130 | { | 
 | 131 |         int sx, dx; | 
 | 132 |  | 
 | 133 |         dx = 0; | 
 | 134 |         for (sx = 0; src[sx] != 0; sx++) { | 
 | 135 |                 if (src[sx] == '"') continue; | 
 | 136 |                 dst[dx++] = src[sx]; | 
 | 137 |                 if (dx >= n) break; | 
 | 138 |         } | 
 | 139 | } | 
 | 140 |  | 
 | 141 | static int __init vmhalt_setup(char *str) | 
 | 142 | { | 
 | 143 |         strncpy_skip_quote(vmhalt_cmd, str, 127); | 
 | 144 |         vmhalt_cmd[127] = 0; | 
 | 145 |         return 1; | 
 | 146 | } | 
 | 147 |  | 
 | 148 | __setup("vmhalt=", vmhalt_setup); | 
 | 149 |  | 
 | 150 | static int __init vmpoff_setup(char *str) | 
 | 151 | { | 
 | 152 |         strncpy_skip_quote(vmpoff_cmd, str, 127); | 
 | 153 |         vmpoff_cmd[127] = 0; | 
 | 154 |         return 1; | 
 | 155 | } | 
 | 156 |  | 
 | 157 | __setup("vmpoff=", vmpoff_setup); | 
 | 158 |  | 
 | 159 | /* | 
 | 160 |  * condev= and conmode= setup parameter. | 
 | 161 |  */ | 
 | 162 |  | 
 | 163 | static int __init condev_setup(char *str) | 
 | 164 | { | 
 | 165 | 	int vdev; | 
 | 166 |  | 
 | 167 | 	vdev = simple_strtoul(str, &str, 0); | 
 | 168 | 	if (vdev >= 0 && vdev < 65536) { | 
 | 169 | 		console_devno = vdev; | 
 | 170 | 		console_irq = -1; | 
 | 171 | 	} | 
 | 172 | 	return 1; | 
 | 173 | } | 
 | 174 |  | 
 | 175 | __setup("condev=", condev_setup); | 
 | 176 |  | 
 | 177 | static int __init conmode_setup(char *str) | 
 | 178 | { | 
 | 179 | #if defined(CONFIG_SCLP_CONSOLE) | 
 | 180 | 	if (strncmp(str, "hwc", 4) == 0 || strncmp(str, "sclp", 5) == 0) | 
 | 181 |                 SET_CONSOLE_SCLP; | 
 | 182 | #endif | 
 | 183 | #if defined(CONFIG_TN3215_CONSOLE) | 
 | 184 | 	if (strncmp(str, "3215", 5) == 0) | 
 | 185 | 		SET_CONSOLE_3215; | 
 | 186 | #endif | 
 | 187 | #if defined(CONFIG_TN3270_CONSOLE) | 
 | 188 | 	if (strncmp(str, "3270", 5) == 0) | 
 | 189 | 		SET_CONSOLE_3270; | 
 | 190 | #endif | 
 | 191 |         return 1; | 
 | 192 | } | 
 | 193 |  | 
 | 194 | __setup("conmode=", conmode_setup); | 
 | 195 |  | 
 | 196 | static void __init conmode_default(void) | 
 | 197 | { | 
 | 198 | 	char query_buffer[1024]; | 
 | 199 | 	char *ptr; | 
 | 200 |  | 
 | 201 |         if (MACHINE_IS_VM) { | 
| Christian Borntraeger | 6b979de | 2005-06-25 14:55:32 -0700 | [diff] [blame] | 202 | 		__cpcmd("QUERY CONSOLE", query_buffer, 1024, NULL); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 203 | 		console_devno = simple_strtoul(query_buffer + 5, NULL, 16); | 
 | 204 | 		ptr = strstr(query_buffer, "SUBCHANNEL ="); | 
 | 205 | 		console_irq = simple_strtoul(ptr + 13, NULL, 16); | 
| Christian Borntraeger | 6b979de | 2005-06-25 14:55:32 -0700 | [diff] [blame] | 206 | 		__cpcmd("QUERY TERM", query_buffer, 1024, NULL); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 207 | 		ptr = strstr(query_buffer, "CONMODE"); | 
 | 208 | 		/* | 
 | 209 | 		 * Set the conmode to 3215 so that the device recognition  | 
 | 210 | 		 * will set the cu_type of the console to 3215. If the | 
 | 211 | 		 * conmode is 3270 and we don't set it back then both | 
 | 212 | 		 * 3215 and the 3270 driver will try to access the console | 
 | 213 | 		 * device (3215 as console and 3270 as normal tty). | 
 | 214 | 		 */ | 
| Christian Borntraeger | 6b979de | 2005-06-25 14:55:32 -0700 | [diff] [blame] | 215 | 		__cpcmd("TERM CONMODE 3215", NULL, 0, NULL); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 216 | 		if (ptr == NULL) { | 
 | 217 | #if defined(CONFIG_SCLP_CONSOLE) | 
 | 218 | 			SET_CONSOLE_SCLP; | 
 | 219 | #endif | 
 | 220 | 			return; | 
 | 221 | 		} | 
 | 222 | 		if (strncmp(ptr + 8, "3270", 4) == 0) { | 
 | 223 | #if defined(CONFIG_TN3270_CONSOLE) | 
 | 224 | 			SET_CONSOLE_3270; | 
 | 225 | #elif defined(CONFIG_TN3215_CONSOLE) | 
 | 226 | 			SET_CONSOLE_3215; | 
 | 227 | #elif defined(CONFIG_SCLP_CONSOLE) | 
 | 228 | 			SET_CONSOLE_SCLP; | 
 | 229 | #endif | 
 | 230 | 		} else if (strncmp(ptr + 8, "3215", 4) == 0) { | 
 | 231 | #if defined(CONFIG_TN3215_CONSOLE) | 
 | 232 | 			SET_CONSOLE_3215; | 
 | 233 | #elif defined(CONFIG_TN3270_CONSOLE) | 
 | 234 | 			SET_CONSOLE_3270; | 
 | 235 | #elif defined(CONFIG_SCLP_CONSOLE) | 
 | 236 | 			SET_CONSOLE_SCLP; | 
 | 237 | #endif | 
 | 238 | 		} | 
 | 239 |         } else if (MACHINE_IS_P390) { | 
 | 240 | #if defined(CONFIG_TN3215_CONSOLE) | 
 | 241 | 		SET_CONSOLE_3215; | 
 | 242 | #elif defined(CONFIG_TN3270_CONSOLE) | 
 | 243 | 		SET_CONSOLE_3270; | 
 | 244 | #endif | 
 | 245 | 	} else { | 
 | 246 | #if defined(CONFIG_SCLP_CONSOLE) | 
 | 247 | 		SET_CONSOLE_SCLP; | 
 | 248 | #endif | 
 | 249 | 	} | 
 | 250 | } | 
 | 251 |  | 
 | 252 | #ifdef CONFIG_SMP | 
 | 253 | extern void machine_restart_smp(char *); | 
 | 254 | extern void machine_halt_smp(void); | 
 | 255 | extern void machine_power_off_smp(void); | 
 | 256 |  | 
 | 257 | void (*_machine_restart)(char *command) = machine_restart_smp; | 
 | 258 | void (*_machine_halt)(void) = machine_halt_smp; | 
 | 259 | void (*_machine_power_off)(void) = machine_power_off_smp; | 
 | 260 | #else | 
 | 261 | /* | 
 | 262 |  * Reboot, halt and power_off routines for non SMP. | 
 | 263 |  */ | 
 | 264 | extern void reipl(unsigned long devno); | 
| Volker Sameske | c782268 | 2005-09-16 19:27:35 -0700 | [diff] [blame] | 265 | extern void reipl_diag(void); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 266 | static void do_machine_restart_nonsmp(char * __unused) | 
 | 267 | { | 
| Volker Sameske | c782268 | 2005-09-16 19:27:35 -0700 | [diff] [blame] | 268 | 	reipl_diag(); | 
 | 269 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 270 | 	if (MACHINE_IS_VM) | 
| Alexey Dobriyan | 68c1191 | 2006-01-14 13:20:58 -0800 | [diff] [blame] | 271 | 		cpcmd ("IPL", NULL, 0, NULL); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 272 | 	else | 
 | 273 | 		reipl (0x10000 | S390_lowcore.ipl_device); | 
 | 274 | } | 
 | 275 |  | 
 | 276 | static void do_machine_halt_nonsmp(void) | 
 | 277 | { | 
 | 278 |         if (MACHINE_IS_VM && strlen(vmhalt_cmd) > 0) | 
| Alexey Dobriyan | 68c1191 | 2006-01-14 13:20:58 -0800 | [diff] [blame] | 279 |                 cpcmd(vmhalt_cmd, NULL, 0, NULL); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 280 |         signal_processor(smp_processor_id(), sigp_stop_and_store_status); | 
 | 281 | } | 
 | 282 |  | 
 | 283 | static void do_machine_power_off_nonsmp(void) | 
 | 284 | { | 
 | 285 |         if (MACHINE_IS_VM && strlen(vmpoff_cmd) > 0) | 
| Alexey Dobriyan | 68c1191 | 2006-01-14 13:20:58 -0800 | [diff] [blame] | 286 |                 cpcmd(vmpoff_cmd, NULL, 0, NULL); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 287 |         signal_processor(smp_processor_id(), sigp_stop_and_store_status); | 
 | 288 | } | 
 | 289 |  | 
 | 290 | void (*_machine_restart)(char *command) = do_machine_restart_nonsmp; | 
 | 291 | void (*_machine_halt)(void) = do_machine_halt_nonsmp; | 
 | 292 | void (*_machine_power_off)(void) = do_machine_power_off_nonsmp; | 
 | 293 | #endif | 
 | 294 |  | 
 | 295 |  /* | 
 | 296 |  * Reboot, halt and power_off stubs. They just call _machine_restart, | 
 | 297 |  * _machine_halt or _machine_power_off.  | 
 | 298 |  */ | 
 | 299 |  | 
 | 300 | void machine_restart(char *command) | 
 | 301 | { | 
 | 302 | 	console_unblank(); | 
 | 303 | 	_machine_restart(command); | 
 | 304 | } | 
 | 305 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 306 | void machine_halt(void) | 
 | 307 | { | 
 | 308 | 	console_unblank(); | 
 | 309 | 	_machine_halt(); | 
 | 310 | } | 
 | 311 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 312 | void machine_power_off(void) | 
 | 313 | { | 
 | 314 | 	console_unblank(); | 
 | 315 | 	_machine_power_off(); | 
 | 316 | } | 
 | 317 |  | 
| Martin Schwidefsky | 53df751 | 2006-01-14 13:21:01 -0800 | [diff] [blame] | 318 | /* | 
 | 319 |  * Dummy power off function. | 
 | 320 |  */ | 
 | 321 | void (*pm_power_off)(void) = machine_power_off; | 
 | 322 |  | 
| Heiko Carstens | c9e3735 | 2005-05-01 08:58:57 -0700 | [diff] [blame] | 323 | static void __init | 
 | 324 | add_memory_hole(unsigned long start, unsigned long end) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 325 | { | 
| Heiko Carstens | c9e3735 | 2005-05-01 08:58:57 -0700 | [diff] [blame] | 326 | 	unsigned long dma_pfn = MAX_DMA_ADDRESS >> PAGE_SHIFT; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 327 |  | 
| Heiko Carstens | c9e3735 | 2005-05-01 08:58:57 -0700 | [diff] [blame] | 328 | 	if (end <= dma_pfn) | 
 | 329 | 		zholes_size[ZONE_DMA] += end - start + 1; | 
 | 330 | 	else if (start > dma_pfn) | 
 | 331 | 		zholes_size[ZONE_NORMAL] += end - start + 1; | 
 | 332 | 	else { | 
 | 333 | 		zholes_size[ZONE_DMA] += dma_pfn - start + 1; | 
 | 334 | 		zholes_size[ZONE_NORMAL] += end - dma_pfn; | 
 | 335 | 	} | 
 | 336 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 337 |  | 
| Heiko Carstens | c9e3735 | 2005-05-01 08:58:57 -0700 | [diff] [blame] | 338 | static void __init | 
 | 339 | parse_cmdline_early(char **cmdline_p) | 
 | 340 | { | 
 | 341 | 	char c = ' ', cn, *to = command_line, *from = COMMAND_LINE; | 
 | 342 | 	unsigned long delay = 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 343 |  | 
| Heiko Carstens | c9e3735 | 2005-05-01 08:58:57 -0700 | [diff] [blame] | 344 | 	/* Save unparsed command line copy for /proc/cmdline */ | 
 | 345 | 	memcpy(saved_command_line, COMMAND_LINE, COMMAND_LINE_SIZE); | 
 | 346 | 	saved_command_line[COMMAND_LINE_SIZE-1] = '\0'; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 347 |  | 
| Heiko Carstens | c9e3735 | 2005-05-01 08:58:57 -0700 | [diff] [blame] | 348 | 	for (;;) { | 
 | 349 | 		/* | 
 | 350 | 		 * "mem=XXX[kKmM]" sets memsize | 
 | 351 | 		 */ | 
 | 352 | 		if (c == ' ' && strncmp(from, "mem=", 4) == 0) { | 
 | 353 | 			memory_end = simple_strtoul(from+4, &from, 0); | 
 | 354 | 			if ( *from == 'K' || *from == 'k' ) { | 
 | 355 | 				memory_end = memory_end << 10; | 
 | 356 | 				from++; | 
 | 357 | 			} else if ( *from == 'M' || *from == 'm' ) { | 
 | 358 | 				memory_end = memory_end << 20; | 
 | 359 | 				from++; | 
 | 360 | 			} | 
 | 361 | 		} | 
 | 362 | 		/* | 
 | 363 | 		 * "ipldelay=XXX[sm]" sets ipl delay in seconds or minutes | 
 | 364 | 		 */ | 
 | 365 | 		if (c == ' ' && strncmp(from, "ipldelay=", 9) == 0) { | 
 | 366 | 			delay = simple_strtoul(from+9, &from, 0); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 367 | 			if (*from == 's' || *from == 'S') { | 
 | 368 | 				delay = delay*1000000; | 
 | 369 | 				from++; | 
 | 370 | 			} else if (*from == 'm' || *from == 'M') { | 
 | 371 | 				delay = delay*60*1000000; | 
 | 372 | 				from++; | 
 | 373 | 			} | 
 | 374 | 			/* now wait for the requested amount of time */ | 
 | 375 | 			udelay(delay); | 
| Heiko Carstens | c9e3735 | 2005-05-01 08:58:57 -0700 | [diff] [blame] | 376 | 		} | 
 | 377 | 		cn = *(from++); | 
 | 378 | 		if (!cn) | 
 | 379 | 			break; | 
 | 380 | 		if (cn == '\n') | 
 | 381 | 			cn = ' ';  /* replace newlines with space */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 382 | 		if (cn == 0x0d) | 
 | 383 | 			cn = ' ';  /* replace 0x0d with space */ | 
| Heiko Carstens | c9e3735 | 2005-05-01 08:58:57 -0700 | [diff] [blame] | 384 | 		if (cn == ' ' && c == ' ') | 
 | 385 | 			continue;  /* remove additional spaces */ | 
 | 386 | 		c = cn; | 
 | 387 | 		if (to - command_line >= COMMAND_LINE_SIZE) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 388 | 			break; | 
| Heiko Carstens | c9e3735 | 2005-05-01 08:58:57 -0700 | [diff] [blame] | 389 | 		*(to++) = c; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 390 | 	} | 
| Heiko Carstens | c9e3735 | 2005-05-01 08:58:57 -0700 | [diff] [blame] | 391 | 	if (c == ' ' && to > command_line) to--; | 
 | 392 | 	*to = '\0'; | 
 | 393 | 	*cmdline_p = command_line; | 
 | 394 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 395 |  | 
| Heiko Carstens | c9e3735 | 2005-05-01 08:58:57 -0700 | [diff] [blame] | 396 | static void __init | 
 | 397 | setup_lowcore(void) | 
 | 398 | { | 
 | 399 | 	struct _lowcore *lc; | 
 | 400 | 	int lc_pages; | 
 | 401 |  | 
 | 402 | 	/* | 
 | 403 | 	 * Setup lowcore for boot cpu | 
 | 404 | 	 */ | 
 | 405 | 	lc_pages = sizeof(void *) == 8 ? 2 : 1; | 
 | 406 | 	lc = (struct _lowcore *) | 
 | 407 | 		__alloc_bootmem(lc_pages * PAGE_SIZE, lc_pages * PAGE_SIZE, 0); | 
 | 408 | 	memset(lc, 0, lc_pages * PAGE_SIZE); | 
| Peter Oberparleiter | 0b642ed | 2005-05-01 08:58:58 -0700 | [diff] [blame] | 409 | 	lc->restart_psw.mask = PSW_BASE_BITS | PSW_DEFAULT_KEY; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 410 | 	lc->restart_psw.addr = | 
 | 411 | 		PSW_ADDR_AMODE | (unsigned long) restart_int_handler; | 
 | 412 | 	lc->external_new_psw.mask = PSW_KERNEL_BITS; | 
 | 413 | 	lc->external_new_psw.addr = | 
 | 414 | 		PSW_ADDR_AMODE | (unsigned long) ext_int_handler; | 
 | 415 | 	lc->svc_new_psw.mask = PSW_KERNEL_BITS | PSW_MASK_IO | PSW_MASK_EXT; | 
 | 416 | 	lc->svc_new_psw.addr = PSW_ADDR_AMODE | (unsigned long) system_call; | 
 | 417 | 	lc->program_new_psw.mask = PSW_KERNEL_BITS; | 
 | 418 | 	lc->program_new_psw.addr = | 
 | 419 | 		PSW_ADDR_AMODE | (unsigned long)pgm_check_handler; | 
| Heiko Carstens | 77fa224 | 2005-06-25 14:55:30 -0700 | [diff] [blame] | 420 | 	lc->mcck_new_psw.mask = | 
 | 421 | 		PSW_KERNEL_BITS & ~PSW_MASK_MCHECK & ~PSW_MASK_DAT; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 422 | 	lc->mcck_new_psw.addr = | 
 | 423 | 		PSW_ADDR_AMODE | (unsigned long) mcck_int_handler; | 
 | 424 | 	lc->io_new_psw.mask = PSW_KERNEL_BITS; | 
 | 425 | 	lc->io_new_psw.addr = PSW_ADDR_AMODE | (unsigned long) io_int_handler; | 
 | 426 | 	lc->ipl_device = S390_lowcore.ipl_device; | 
 | 427 | 	lc->jiffy_timer = -1LL; | 
 | 428 | 	lc->kernel_stack = ((unsigned long) &init_thread_union) + THREAD_SIZE; | 
 | 429 | 	lc->async_stack = (unsigned long) | 
 | 430 | 		__alloc_bootmem(ASYNC_SIZE, ASYNC_SIZE, 0) + ASYNC_SIZE; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 431 | 	lc->panic_stack = (unsigned long) | 
 | 432 | 		__alloc_bootmem(PAGE_SIZE, PAGE_SIZE, 0) + PAGE_SIZE; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 433 | 	lc->current_task = (unsigned long) init_thread_union.thread_info.task; | 
 | 434 | 	lc->thread_info = (unsigned long) &init_thread_union; | 
| Martin Schwidefsky | 347a8dc | 2006-01-06 00:19:28 -0800 | [diff] [blame] | 435 | #ifndef CONFIG_64BIT | 
| Heiko Carstens | 77fa224 | 2005-06-25 14:55:30 -0700 | [diff] [blame] | 436 | 	if (MACHINE_HAS_IEEE) { | 
 | 437 | 		lc->extended_save_area_addr = (__u32) | 
 | 438 | 			__alloc_bootmem(PAGE_SIZE, PAGE_SIZE, 0); | 
 | 439 | 		/* enable extended save area */ | 
 | 440 | 		ctl_set_bit(14, 29); | 
 | 441 | 	} | 
 | 442 | #endif | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 443 | 	set_prefix((u32)(unsigned long) lc); | 
| Heiko Carstens | c9e3735 | 2005-05-01 08:58:57 -0700 | [diff] [blame] | 444 | } | 
 | 445 |  | 
 | 446 | static void __init | 
 | 447 | setup_resources(void) | 
 | 448 | { | 
 | 449 | 	struct resource *res; | 
 | 450 | 	int i; | 
 | 451 |  | 
 | 452 | 	for (i = 0; i < MEMORY_CHUNKS && memory_chunk[i].size > 0; i++) { | 
 | 453 | 		res = alloc_bootmem_low(sizeof(struct resource)); | 
 | 454 | 		res->flags = IORESOURCE_BUSY | IORESOURCE_MEM; | 
 | 455 | 		switch (memory_chunk[i].type) { | 
 | 456 | 		case CHUNK_READ_WRITE: | 
 | 457 | 			res->name = "System RAM"; | 
 | 458 | 			break; | 
 | 459 | 		case CHUNK_READ_ONLY: | 
 | 460 | 			res->name = "System ROM"; | 
 | 461 | 			res->flags |= IORESOURCE_READONLY; | 
 | 462 | 			break; | 
 | 463 | 		default: | 
 | 464 | 			res->name = "reserved"; | 
 | 465 | 		} | 
 | 466 | 		res->start = memory_chunk[i].addr; | 
 | 467 | 		res->end = memory_chunk[i].addr +  memory_chunk[i].size - 1; | 
 | 468 | 		request_resource(&iomem_resource, res); | 
 | 469 | 		request_resource(res, &code_resource); | 
 | 470 | 		request_resource(res, &data_resource); | 
 | 471 | 	} | 
 | 472 | } | 
 | 473 |  | 
 | 474 | static void __init | 
 | 475 | setup_memory(void) | 
 | 476 | { | 
 | 477 |         unsigned long bootmap_size; | 
| Peter Oberparleiter | 0b642ed | 2005-05-01 08:58:58 -0700 | [diff] [blame] | 478 | 	unsigned long start_pfn, end_pfn, init_pfn; | 
| Heiko Carstens | c9e3735 | 2005-05-01 08:58:57 -0700 | [diff] [blame] | 479 | 	unsigned long last_rw_end; | 
 | 480 | 	int i; | 
 | 481 |  | 
 | 482 | 	/* | 
 | 483 | 	 * partially used pages are not usable - thus | 
 | 484 | 	 * we are rounding upwards: | 
 | 485 | 	 */ | 
 | 486 | 	start_pfn = (__pa(&_end) + PAGE_SIZE - 1) >> PAGE_SHIFT; | 
 | 487 | 	end_pfn = max_pfn = memory_end >> PAGE_SHIFT; | 
 | 488 |  | 
| Peter Oberparleiter | 0b642ed | 2005-05-01 08:58:58 -0700 | [diff] [blame] | 489 | 	/* Initialize storage key for kernel pages */ | 
 | 490 | 	for (init_pfn = 0 ; init_pfn < start_pfn; init_pfn++) | 
 | 491 | 		page_set_storage_key(init_pfn << PAGE_SHIFT, PAGE_DEFAULT_KEY); | 
 | 492 |  | 
| Heiko Carstens | c9e3735 | 2005-05-01 08:58:57 -0700 | [diff] [blame] | 493 | 	/* | 
 | 494 | 	 * Initialize the boot-time allocator (with low memory only): | 
 | 495 | 	 */ | 
 | 496 | 	bootmap_size = init_bootmem(start_pfn, end_pfn); | 
 | 497 |  | 
 | 498 | 	/* | 
 | 499 | 	 * Register RAM areas with the bootmem allocator. | 
 | 500 | 	 */ | 
 | 501 | 	last_rw_end = start_pfn; | 
 | 502 |  | 
| Peter Oberparleiter | 0b642ed | 2005-05-01 08:58:58 -0700 | [diff] [blame] | 503 | 	for (i = 0; i < MEMORY_CHUNKS && memory_chunk[i].size > 0; i++) { | 
| Heiko Carstens | c9e3735 | 2005-05-01 08:58:57 -0700 | [diff] [blame] | 504 | 		unsigned long start_chunk, end_chunk; | 
 | 505 |  | 
 | 506 | 		if (memory_chunk[i].type != CHUNK_READ_WRITE) | 
 | 507 | 			continue; | 
 | 508 | 		start_chunk = (memory_chunk[i].addr + PAGE_SIZE - 1); | 
 | 509 | 		start_chunk >>= PAGE_SHIFT; | 
 | 510 | 		end_chunk = (memory_chunk[i].addr + memory_chunk[i].size); | 
 | 511 | 		end_chunk >>= PAGE_SHIFT; | 
 | 512 | 		if (start_chunk < start_pfn) | 
 | 513 | 			start_chunk = start_pfn; | 
 | 514 | 		if (end_chunk > end_pfn) | 
 | 515 | 			end_chunk = end_pfn; | 
 | 516 | 		if (start_chunk < end_chunk) { | 
| Peter Oberparleiter | 0b642ed | 2005-05-01 08:58:58 -0700 | [diff] [blame] | 517 | 			/* Initialize storage key for RAM pages */ | 
 | 518 | 			for (init_pfn = start_chunk ; init_pfn < end_chunk; | 
 | 519 | 			     init_pfn++) | 
 | 520 | 				page_set_storage_key(init_pfn << PAGE_SHIFT, | 
 | 521 | 						     PAGE_DEFAULT_KEY); | 
| Heiko Carstens | c9e3735 | 2005-05-01 08:58:57 -0700 | [diff] [blame] | 522 | 			free_bootmem(start_chunk << PAGE_SHIFT, | 
 | 523 | 				     (end_chunk - start_chunk) << PAGE_SHIFT); | 
 | 524 | 			if (last_rw_end < start_chunk) | 
 | 525 | 				add_memory_hole(last_rw_end, start_chunk - 1); | 
 | 526 | 			last_rw_end = end_chunk; | 
 | 527 | 		} | 
 | 528 | 	} | 
 | 529 |  | 
| Peter Oberparleiter | 0b642ed | 2005-05-01 08:58:58 -0700 | [diff] [blame] | 530 | 	psw_set_key(PAGE_DEFAULT_KEY); | 
 | 531 |  | 
| Heiko Carstens | c9e3735 | 2005-05-01 08:58:57 -0700 | [diff] [blame] | 532 | 	if (last_rw_end < end_pfn - 1) | 
 | 533 | 		add_memory_hole(last_rw_end, end_pfn - 1); | 
 | 534 |  | 
 | 535 | 	/* | 
 | 536 | 	 * Reserve the bootmem bitmap itself as well. We do this in two | 
 | 537 | 	 * steps (first step was init_bootmem()) because this catches | 
 | 538 | 	 * the (very unlikely) case of us accidentally initializing the | 
 | 539 | 	 * bootmem allocator with an invalid RAM area. | 
 | 540 | 	 */ | 
 | 541 | 	reserve_bootmem(start_pfn << PAGE_SHIFT, bootmap_size); | 
 | 542 |  | 
 | 543 | #ifdef CONFIG_BLK_DEV_INITRD | 
 | 544 | 	if (INITRD_START) { | 
 | 545 | 		if (INITRD_START + INITRD_SIZE <= memory_end) { | 
 | 546 | 			reserve_bootmem(INITRD_START, INITRD_SIZE); | 
 | 547 | 			initrd_start = INITRD_START; | 
 | 548 | 			initrd_end = initrd_start + INITRD_SIZE; | 
 | 549 | 		} else { | 
 | 550 | 			printk("initrd extends beyond end of memory " | 
 | 551 | 			       "(0x%08lx > 0x%08lx)\ndisabling initrd\n", | 
 | 552 | 			       initrd_start + INITRD_SIZE, memory_end); | 
 | 553 | 			initrd_start = initrd_end = 0; | 
 | 554 | 		} | 
 | 555 | 	} | 
 | 556 | #endif | 
 | 557 | } | 
 | 558 |  | 
 | 559 | /* | 
 | 560 |  * Setup function called from init/main.c just after the banner | 
 | 561 |  * was printed. | 
 | 562 |  */ | 
 | 563 |  | 
 | 564 | void __init | 
 | 565 | setup_arch(char **cmdline_p) | 
 | 566 | { | 
 | 567 |         /* | 
 | 568 |          * print what head.S has found out about the machine | 
 | 569 |          */ | 
| Martin Schwidefsky | 347a8dc | 2006-01-06 00:19:28 -0800 | [diff] [blame] | 570 | #ifndef CONFIG_64BIT | 
| Heiko Carstens | c9e3735 | 2005-05-01 08:58:57 -0700 | [diff] [blame] | 571 | 	printk((MACHINE_IS_VM) ? | 
 | 572 | 	       "We are running under VM (31 bit mode)\n" : | 
 | 573 | 	       "We are running native (31 bit mode)\n"); | 
 | 574 | 	printk((MACHINE_HAS_IEEE) ? | 
 | 575 | 	       "This machine has an IEEE fpu\n" : | 
 | 576 | 	       "This machine has no IEEE fpu\n"); | 
| Martin Schwidefsky | 347a8dc | 2006-01-06 00:19:28 -0800 | [diff] [blame] | 577 | #else /* CONFIG_64BIT */ | 
| Heiko Carstens | c9e3735 | 2005-05-01 08:58:57 -0700 | [diff] [blame] | 578 | 	printk((MACHINE_IS_VM) ? | 
 | 579 | 	       "We are running under VM (64 bit mode)\n" : | 
 | 580 | 	       "We are running native (64 bit mode)\n"); | 
| Martin Schwidefsky | 347a8dc | 2006-01-06 00:19:28 -0800 | [diff] [blame] | 581 | #endif /* CONFIG_64BIT */ | 
| Heiko Carstens | c9e3735 | 2005-05-01 08:58:57 -0700 | [diff] [blame] | 582 |  | 
 | 583 |         ROOT_DEV = Root_RAM0; | 
| Martin Schwidefsky | 347a8dc | 2006-01-06 00:19:28 -0800 | [diff] [blame] | 584 | #ifndef CONFIG_64BIT | 
| Heiko Carstens | c9e3735 | 2005-05-01 08:58:57 -0700 | [diff] [blame] | 585 | 	memory_end = memory_size & ~0x400000UL;  /* align memory end to 4MB */ | 
 | 586 |         /* | 
 | 587 |          * We need some free virtual space to be able to do vmalloc. | 
 | 588 |          * On a machine with 2GB memory we make sure that we have at | 
 | 589 |          * least 128 MB free space for vmalloc. | 
 | 590 |          */ | 
 | 591 |         if (memory_end > 1920*1024*1024) | 
 | 592 |                 memory_end = 1920*1024*1024; | 
| Martin Schwidefsky | 347a8dc | 2006-01-06 00:19:28 -0800 | [diff] [blame] | 593 | #else /* CONFIG_64BIT */ | 
| Heiko Carstens | c9e3735 | 2005-05-01 08:58:57 -0700 | [diff] [blame] | 594 | 	memory_end = memory_size & ~0x200000UL;  /* detected in head.s */ | 
| Martin Schwidefsky | 347a8dc | 2006-01-06 00:19:28 -0800 | [diff] [blame] | 595 | #endif /* CONFIG_64BIT */ | 
| Heiko Carstens | c9e3735 | 2005-05-01 08:58:57 -0700 | [diff] [blame] | 596 |  | 
 | 597 | 	init_mm.start_code = PAGE_OFFSET; | 
 | 598 | 	init_mm.end_code = (unsigned long) &_etext; | 
 | 599 | 	init_mm.end_data = (unsigned long) &_edata; | 
 | 600 | 	init_mm.brk = (unsigned long) &_end; | 
 | 601 |  | 
 | 602 | 	parse_cmdline_early(cmdline_p); | 
| Heiko Carstens | 255acee | 2006-02-17 13:52:46 -0800 | [diff] [blame] | 603 | 	parse_early_param(); | 
| Heiko Carstens | c9e3735 | 2005-05-01 08:58:57 -0700 | [diff] [blame] | 604 |  | 
 | 605 | 	setup_memory(); | 
 | 606 | 	setup_resources(); | 
 | 607 | 	setup_lowcore(); | 
 | 608 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 609 |         cpu_init(); | 
 | 610 |         __cpu_logical_map[0] = S390_lowcore.cpu_data.cpu_addr; | 
| Heiko Carstens | 255acee | 2006-02-17 13:52:46 -0800 | [diff] [blame] | 611 | 	smp_setup_cpu_possible_map(); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 612 |  | 
 | 613 | 	/* | 
 | 614 | 	 * Create kernel page tables and switch to virtual addressing. | 
 | 615 | 	 */ | 
 | 616 |         paging_init(); | 
 | 617 |  | 
 | 618 |         /* Setup default console */ | 
 | 619 | 	conmode_default(); | 
 | 620 | } | 
 | 621 |  | 
 | 622 | void print_cpu_info(struct cpuinfo_S390 *cpuinfo) | 
 | 623 | { | 
 | 624 |    printk("cpu %d " | 
 | 625 | #ifdef CONFIG_SMP | 
 | 626 |            "phys_idx=%d " | 
 | 627 | #endif | 
 | 628 |            "vers=%02X ident=%06X machine=%04X unused=%04X\n", | 
 | 629 |            cpuinfo->cpu_nr, | 
 | 630 | #ifdef CONFIG_SMP | 
 | 631 |            cpuinfo->cpu_addr, | 
 | 632 | #endif | 
 | 633 |            cpuinfo->cpu_id.version, | 
 | 634 |            cpuinfo->cpu_id.ident, | 
 | 635 |            cpuinfo->cpu_id.machine, | 
 | 636 |            cpuinfo->cpu_id.unused); | 
 | 637 | } | 
 | 638 |  | 
 | 639 | /* | 
 | 640 |  * show_cpuinfo - Get information on one CPU for use by procfs. | 
 | 641 |  */ | 
 | 642 |  | 
 | 643 | static int show_cpuinfo(struct seq_file *m, void *v) | 
 | 644 | { | 
 | 645 |         struct cpuinfo_S390 *cpuinfo; | 
 | 646 | 	unsigned long n = (unsigned long) v - 1; | 
 | 647 |  | 
| Heiko Carstens | b7ae9dd | 2005-09-16 19:27:34 -0700 | [diff] [blame] | 648 | 	preempt_disable(); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 649 | 	if (!n) { | 
 | 650 | 		seq_printf(m, "vendor_id       : IBM/S390\n" | 
 | 651 | 			       "# processors    : %i\n" | 
 | 652 | 			       "bogomips per cpu: %lu.%02lu\n", | 
 | 653 | 			       num_online_cpus(), loops_per_jiffy/(500000/HZ), | 
 | 654 | 			       (loops_per_jiffy/(5000/HZ))%100); | 
 | 655 | 	} | 
 | 656 | 	if (cpu_online(n)) { | 
 | 657 | #ifdef CONFIG_SMP | 
 | 658 | 		if (smp_processor_id() == n) | 
 | 659 | 			cpuinfo = &S390_lowcore.cpu_data; | 
 | 660 | 		else | 
 | 661 | 			cpuinfo = &lowcore_ptr[n]->cpu_data; | 
 | 662 | #else | 
 | 663 | 		cpuinfo = &S390_lowcore.cpu_data; | 
 | 664 | #endif | 
 | 665 | 		seq_printf(m, "processor %li: " | 
 | 666 | 			       "version = %02X,  " | 
 | 667 | 			       "identification = %06X,  " | 
 | 668 | 			       "machine = %04X\n", | 
 | 669 | 			       n, cpuinfo->cpu_id.version, | 
 | 670 | 			       cpuinfo->cpu_id.ident, | 
 | 671 | 			       cpuinfo->cpu_id.machine); | 
 | 672 | 	} | 
| Heiko Carstens | b7ae9dd | 2005-09-16 19:27:34 -0700 | [diff] [blame] | 673 | 	preempt_enable(); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 674 |         return 0; | 
 | 675 | } | 
 | 676 |  | 
 | 677 | static void *c_start(struct seq_file *m, loff_t *pos) | 
 | 678 | { | 
 | 679 | 	return *pos < NR_CPUS ? (void *)((unsigned long) *pos + 1) : NULL; | 
 | 680 | } | 
 | 681 | static void *c_next(struct seq_file *m, void *v, loff_t *pos) | 
 | 682 | { | 
 | 683 | 	++*pos; | 
 | 684 | 	return c_start(m, pos); | 
 | 685 | } | 
 | 686 | static void c_stop(struct seq_file *m, void *v) | 
 | 687 | { | 
 | 688 | } | 
 | 689 | struct seq_operations cpuinfo_op = { | 
 | 690 | 	.start	= c_start, | 
 | 691 | 	.next	= c_next, | 
 | 692 | 	.stop	= c_stop, | 
 | 693 | 	.show	= show_cpuinfo, | 
 | 694 | }; | 
 | 695 |  | 
| Heiko Carstens | 1e8e338 | 2005-10-30 15:00:11 -0800 | [diff] [blame] | 696 | #define DEFINE_IPL_ATTR(_name, _format, _value)			\ | 
 | 697 | static ssize_t ipl_##_name##_show(struct subsystem *subsys,	\ | 
 | 698 | 		char *page)					\ | 
 | 699 | {								\ | 
 | 700 | 	return sprintf(page, _format, _value);			\ | 
 | 701 | }								\ | 
 | 702 | static struct subsys_attribute ipl_##_name##_attr =		\ | 
 | 703 | 	__ATTR(_name, S_IRUGO, ipl_##_name##_show, NULL); | 
 | 704 |  | 
 | 705 | DEFINE_IPL_ATTR(wwpn, "0x%016llx\n", (unsigned long long) | 
 | 706 | 		IPL_PARMBLOCK_START->fcp.wwpn); | 
 | 707 | DEFINE_IPL_ATTR(lun, "0x%016llx\n", (unsigned long long) | 
 | 708 | 		IPL_PARMBLOCK_START->fcp.lun); | 
 | 709 | DEFINE_IPL_ATTR(bootprog, "%lld\n", (unsigned long long) | 
 | 710 | 		IPL_PARMBLOCK_START->fcp.bootprog); | 
 | 711 | DEFINE_IPL_ATTR(br_lba, "%lld\n", (unsigned long long) | 
 | 712 | 		IPL_PARMBLOCK_START->fcp.br_lba); | 
 | 713 |  | 
 | 714 | enum ipl_type_type { | 
 | 715 | 	ipl_type_unknown, | 
 | 716 | 	ipl_type_ccw, | 
 | 717 | 	ipl_type_fcp, | 
 | 718 | }; | 
 | 719 |  | 
 | 720 | static enum ipl_type_type | 
 | 721 | get_ipl_type(void) | 
 | 722 | { | 
 | 723 | 	struct ipl_parameter_block *ipl = IPL_PARMBLOCK_START; | 
 | 724 |  | 
 | 725 | 	if (!IPL_DEVNO_VALID) | 
 | 726 | 		return ipl_type_unknown; | 
 | 727 | 	if (!IPL_PARMBLOCK_VALID) | 
 | 728 | 		return ipl_type_ccw; | 
 | 729 | 	if (ipl->hdr.header.version > IPL_MAX_SUPPORTED_VERSION) | 
 | 730 | 		return ipl_type_unknown; | 
 | 731 | 	if (ipl->fcp.pbt != IPL_TYPE_FCP) | 
 | 732 | 		return ipl_type_unknown; | 
 | 733 | 	return ipl_type_fcp; | 
 | 734 | } | 
 | 735 |  | 
 | 736 | static ssize_t | 
 | 737 | ipl_type_show(struct subsystem *subsys, char *page) | 
 | 738 | { | 
 | 739 | 	switch (get_ipl_type()) { | 
 | 740 | 	case ipl_type_ccw: | 
 | 741 | 		return sprintf(page, "ccw\n"); | 
 | 742 | 	case ipl_type_fcp: | 
 | 743 | 		return sprintf(page, "fcp\n"); | 
 | 744 | 	default: | 
 | 745 | 		return sprintf(page, "unknown\n"); | 
 | 746 | 	} | 
 | 747 | } | 
 | 748 |  | 
 | 749 | static struct subsys_attribute ipl_type_attr = __ATTR_RO(ipl_type); | 
 | 750 |  | 
 | 751 | static ssize_t | 
 | 752 | ipl_device_show(struct subsystem *subsys, char *page) | 
 | 753 | { | 
 | 754 | 	struct ipl_parameter_block *ipl = IPL_PARMBLOCK_START; | 
 | 755 |  | 
 | 756 | 	switch (get_ipl_type()) { | 
 | 757 | 	case ipl_type_ccw: | 
 | 758 | 		return sprintf(page, "0.0.%04x\n", ipl_devno); | 
 | 759 | 	case ipl_type_fcp: | 
 | 760 | 		return sprintf(page, "0.0.%04x\n", ipl->fcp.devno); | 
 | 761 | 	default: | 
 | 762 | 		return 0; | 
 | 763 | 	} | 
 | 764 | } | 
 | 765 |  | 
 | 766 | static struct subsys_attribute ipl_device_attr = | 
 | 767 | 	__ATTR(device, S_IRUGO, ipl_device_show, NULL); | 
 | 768 |  | 
 | 769 | static struct attribute *ipl_fcp_attrs[] = { | 
 | 770 | 	&ipl_type_attr.attr, | 
 | 771 | 	&ipl_device_attr.attr, | 
 | 772 | 	&ipl_wwpn_attr.attr, | 
 | 773 | 	&ipl_lun_attr.attr, | 
 | 774 | 	&ipl_bootprog_attr.attr, | 
 | 775 | 	&ipl_br_lba_attr.attr, | 
 | 776 | 	NULL, | 
 | 777 | }; | 
 | 778 |  | 
 | 779 | static struct attribute_group ipl_fcp_attr_group = { | 
 | 780 | 	.attrs = ipl_fcp_attrs, | 
 | 781 | }; | 
 | 782 |  | 
 | 783 | static struct attribute *ipl_ccw_attrs[] = { | 
 | 784 | 	&ipl_type_attr.attr, | 
 | 785 | 	&ipl_device_attr.attr, | 
 | 786 | 	NULL, | 
 | 787 | }; | 
 | 788 |  | 
 | 789 | static struct attribute_group ipl_ccw_attr_group = { | 
 | 790 | 	.attrs = ipl_ccw_attrs, | 
 | 791 | }; | 
 | 792 |  | 
 | 793 | static struct attribute *ipl_unknown_attrs[] = { | 
 | 794 | 	&ipl_type_attr.attr, | 
 | 795 | 	NULL, | 
 | 796 | }; | 
 | 797 |  | 
 | 798 | static struct attribute_group ipl_unknown_attr_group = { | 
 | 799 | 	.attrs = ipl_unknown_attrs, | 
 | 800 | }; | 
 | 801 |  | 
 | 802 | static ssize_t | 
 | 803 | ipl_parameter_read(struct kobject *kobj, char *buf, loff_t off, size_t count) | 
 | 804 | { | 
 | 805 | 	unsigned int size = IPL_PARMBLOCK_SIZE; | 
 | 806 |  | 
 | 807 | 	if (off > size) | 
 | 808 | 		return 0; | 
 | 809 | 	if (off + count > size) | 
 | 810 | 		count = size - off; | 
 | 811 |  | 
 | 812 | 	memcpy(buf, (void *) IPL_PARMBLOCK_START + off, count); | 
 | 813 | 	return count; | 
 | 814 | } | 
 | 815 |  | 
 | 816 | static struct bin_attribute ipl_parameter_attr = { | 
 | 817 | 	.attr = { | 
 | 818 | 		.name = "binary_parameter", | 
 | 819 | 		.mode = S_IRUGO, | 
 | 820 | 		.owner = THIS_MODULE, | 
 | 821 | 	}, | 
 | 822 | 	.size = PAGE_SIZE, | 
 | 823 | 	.read = &ipl_parameter_read, | 
 | 824 | }; | 
 | 825 |  | 
 | 826 | static ssize_t | 
 | 827 | ipl_scp_data_read(struct kobject *kobj, char *buf, loff_t off, size_t count) | 
 | 828 | { | 
 | 829 | 	unsigned int size =  IPL_PARMBLOCK_START->fcp.scp_data_len; | 
 | 830 | 	void *scp_data = &IPL_PARMBLOCK_START->fcp.scp_data; | 
 | 831 |  | 
 | 832 | 	if (off > size) | 
 | 833 | 		return 0; | 
 | 834 | 	if (off + count > size) | 
 | 835 | 		count = size - off; | 
 | 836 |  | 
 | 837 | 	memcpy(buf, scp_data + off, count); | 
 | 838 | 	return count; | 
 | 839 | } | 
 | 840 |  | 
 | 841 | static struct bin_attribute ipl_scp_data_attr = { | 
 | 842 | 	.attr = { | 
 | 843 | 		.name = "scp_data", | 
 | 844 | 		.mode = S_IRUGO, | 
 | 845 | 		.owner = THIS_MODULE, | 
 | 846 | 	}, | 
 | 847 | 	.size = PAGE_SIZE, | 
 | 848 | 	.read = &ipl_scp_data_read, | 
 | 849 | }; | 
 | 850 |  | 
 | 851 | static decl_subsys(ipl, NULL, NULL); | 
 | 852 |  | 
 | 853 | static int __init | 
 | 854 | ipl_device_sysfs_register(void) { | 
 | 855 | 	int rc; | 
 | 856 |  | 
 | 857 | 	rc = firmware_register(&ipl_subsys); | 
 | 858 | 	if (rc) | 
 | 859 | 		return rc; | 
 | 860 |  | 
 | 861 | 	switch (get_ipl_type()) { | 
 | 862 | 	case ipl_type_ccw: | 
 | 863 | 		sysfs_create_group(&ipl_subsys.kset.kobj, &ipl_ccw_attr_group); | 
 | 864 | 		break; | 
 | 865 | 	case ipl_type_fcp: | 
 | 866 | 		sysfs_create_group(&ipl_subsys.kset.kobj, &ipl_fcp_attr_group); | 
 | 867 | 		sysfs_create_bin_file(&ipl_subsys.kset.kobj, | 
 | 868 | 				      &ipl_parameter_attr); | 
 | 869 | 		sysfs_create_bin_file(&ipl_subsys.kset.kobj, | 
 | 870 | 				      &ipl_scp_data_attr); | 
 | 871 | 		break; | 
 | 872 | 	default: | 
 | 873 | 		sysfs_create_group(&ipl_subsys.kset.kobj, | 
 | 874 | 				   &ipl_unknown_attr_group); | 
 | 875 | 		break; | 
 | 876 | 	} | 
 | 877 | 	return 0; | 
 | 878 | } | 
 | 879 |  | 
 | 880 | __initcall(ipl_device_sysfs_register); |