arch/s390/kernel/setup.c

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