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> 39 #include <linux/device.h> 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> 48 #include <asm/page.h> 49 #include <asm/ptrace.h> 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; 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 */ 65 unsigned long __initdata zholes_size[MAX_NR_ZONES]; 66 static unsigned long __initdata memory_end; 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", 85 .start = (unsigned long) &_text, 86 .end = (unsigned long) &_etext - 1, 87 .flags = IORESOURCE_BUSY | IORESOURCE_MEM, 88 }; 89 90 static struct resource data_resource = { 91 .name = "Kernel data", 92 .start = (unsigned long) &_etext, 93 .end = (unsigned long) &_edata - 1, 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) { 202 __cpcmd("QUERY CONSOLE", query_buffer, 1024, NULL); 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); 206 __cpcmd("QUERY TERM", query_buffer, 1024, NULL); 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 */ 215 __cpcmd("TERM CONMODE 3215", NULL, 0, NULL); 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); 265 extern void reipl_diag(void); 266 static void do_machine_restart_nonsmp(char * __unused) 267 { 268 reipl_diag(); 269 270 if (MACHINE_IS_VM) 271 cpcmd ("IPL", NULL, 0, NULL); 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) 279 cpcmd(vmhalt_cmd, NULL, 0, NULL); 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) 286 cpcmd(vmpoff_cmd, NULL, 0, NULL); 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 306 void machine_halt(void) 307 { 308 console_unblank(); 309 _machine_halt(); 310 } 311 312 void machine_power_off(void) 313 { 314 console_unblank(); 315 _machine_power_off(); 316 } 317 318 /* 319 * Dummy power off function. 320 */ 321 void (*pm_power_off)(void) = machine_power_off; 322 323 static void __init 324 add_memory_hole(unsigned long start, unsigned long end) 325 { 326 unsigned long dma_pfn = MAX_DMA_ADDRESS >> PAGE_SHIFT; 327 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 } 337 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; 343 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'; 347 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); 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); 376 } 377 cn = *(from++); 378 if (!cn) 379 break; 380 if (cn == '\n') 381 cn = ' '; /* replace newlines with space */ 382 if (cn == 0x0d) 383 cn = ' '; /* replace 0x0d with space */ 384 if (cn == ' ' && c == ' ') 385 continue; /* remove additional spaces */ 386 c = cn; 387 if (to - command_line >= COMMAND_LINE_SIZE) 388 break; 389 *(to++) = c; 390 } 391 if (c == ' ' && to > command_line) to--; 392 *to = '\0'; 393 *cmdline_p = command_line; 394 } 395 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); 409 lc->restart_psw.mask = PSW_BASE_BITS | PSW_DEFAULT_KEY; 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; 420 lc->mcck_new_psw.mask = 421 PSW_KERNEL_BITS & ~PSW_MASK_MCHECK & ~PSW_MASK_DAT; 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; 431 lc->panic_stack = (unsigned long) 432 __alloc_bootmem(PAGE_SIZE, PAGE_SIZE, 0) + PAGE_SIZE; 433 lc->current_task = (unsigned long) init_thread_union.thread_info.task; 434 lc->thread_info = (unsigned long) &init_thread_union; 435 #ifndef CONFIG_64BIT 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 443 set_prefix((u32)(unsigned long) lc); 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; 478 unsigned long start_pfn, end_pfn, init_pfn; 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 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 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 503 for (i = 0; i < MEMORY_CHUNKS && memory_chunk[i].size > 0; i++) { 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) { 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); 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 530 psw_set_key(PAGE_DEFAULT_KEY); 531 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 */ 570 #ifndef CONFIG_64BIT 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"); 577 #else /* CONFIG_64BIT */ 578 printk((MACHINE_IS_VM) ? 579 "We are running under VM (64 bit mode)\n" : 580 "We are running native (64 bit mode)\n"); 581 #endif /* CONFIG_64BIT */ 582 583 ROOT_DEV = Root_RAM0; 584 #ifndef CONFIG_64BIT 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; 593 #else /* CONFIG_64BIT */ 594 memory_end = memory_size & ~0x200000UL; /* detected in head.s */ 595 #endif /* CONFIG_64BIT */ 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); 603 parse_early_param(); 604 605 setup_memory(); 606 setup_resources(); 607 setup_lowcore(); 608 609 cpu_init(); 610 __cpu_logical_map[0] = S390_lowcore.cpu_data.cpu_addr; 611 smp_setup_cpu_possible_map(); 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 648 preempt_disable(); 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 } 673 preempt_enable(); 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 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); 881