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/tty.h>
  28 #include <linux/ioport.h>
  29 #include <linux/delay.h>
  30 #include <linux/init.h>
  31 #include <linux/initrd.h>
  32 #include <linux/bootmem.h>
  33 #include <linux/root_dev.h>
  34 #include <linux/console.h>
  35 #include <linux/seq_file.h>
  36 #include <linux/kernel_stat.h>
  37 #include <linux/device.h>
  38 #include <linux/notifier.h>
  39 #include <linux/pfn.h>
  40 #include <linux/ctype.h>
  41 #include <linux/reboot.h>
  42 #include <linux/topology.h>
  43
  44 #include <asm/ipl.h>
  45 #include <asm/uaccess.h>
  46 #include <asm/system.h>
  47 #include <asm/smp.h>
  48 #include <asm/mmu_context.h>
  49 #include <asm/cpcmd.h>
  50 #include <asm/lowcore.h>
  51 #include <asm/irq.h>
  52 #include <asm/page.h>
  53 #include <asm/ptrace.h>
  54 #include <asm/sections.h>
  55 #include <asm/ebcdic.h>
  56 #include <asm/compat.h>
  57
  58 long psw_kernel_bits    = (PSW_BASE_BITS | PSW_MASK_DAT | PSW_ASC_PRIMARY |
  59                            PSW_MASK_MCHECK | PSW_DEFAULT_KEY);
  60 long psw_user_bits      = (PSW_BASE_BITS | PSW_MASK_DAT | PSW_ASC_HOME |
  61                            PSW_MASK_IO | PSW_MASK_EXT | PSW_MASK_MCHECK |
  62                            PSW_MASK_PSTATE | PSW_DEFAULT_KEY);
  63
  64 /*
  65  * User copy operations.
  66  */
  67 struct uaccess_ops uaccess;
  68 EXPORT_SYMBOL(uaccess);
  69
  70 /*
  71  * Machine setup..
  72  */
  73 unsigned int console_mode = 0;
  74 unsigned int console_devno = -1;
  75 unsigned int console_irq = -1;
  76 unsigned long machine_flags;
  77 unsigned long elf_hwcap = 0;
  78 char elf_platform[ELF_PLATFORM_SIZE];
  79
  80 struct mem_chunk __meminitdata memory_chunk[MEMORY_CHUNKS];
  81 volatile int __cpu_logical_map[NR_CPUS]; /* logical cpu to cpu address */
  82 static unsigned long __initdata memory_end;
  83
  84 /*
  85  * This is set up by the setup-routine at boot-time
  86  * for S390 need to find out, what we have to setup
  87  * using address 0x10400 ...
  88  */
  89
  90 #include <asm/setup.h>
  91
  92 static struct resource code_resource = {
  93         .name  = "Kernel code",
  94         .flags = IORESOURCE_BUSY | IORESOURCE_MEM,
  95 };
  96
  97 static struct resource data_resource = {
  98         .name = "Kernel data",
  99         .flags = IORESOURCE_BUSY | IORESOURCE_MEM,
 100 };
 101
 102 /*
 103  * cpu_init() initializes state that is per-CPU.
 104  */
 105 void __cpuinit cpu_init(void)
 106 {
 107         int addr = hard_smp_processor_id();
 108
 109         /*
 110          * Store processor id in lowcore (used e.g. in timer_interrupt)
 111          */
 112         get_cpu_id(&S390_lowcore.cpu_data.cpu_id);
 113         S390_lowcore.cpu_data.cpu_addr = addr;
 114
 115         /*
 116          * Force FPU initialization:
 117          */
 118         clear_thread_flag(TIF_USEDFPU);
 119         clear_used_math();
 120
 121         atomic_inc(&init_mm.mm_count);
 122         current->active_mm = &init_mm;
 123         if (current->mm)
 124                 BUG();
 125         enter_lazy_tlb(&init_mm, current);
 126 }
 127
 128 /*
 129  * condev= and conmode= setup parameter.
 130  */
 131
 132 static int __init condev_setup(char *str)
 133 {
 134         int vdev;
 135
 136         vdev = simple_strtoul(str, &str, 0);
 137         if (vdev >= 0 && vdev < 65536) {
 138                 console_devno = vdev;
 139                 console_irq = -1;
 140         }
 141         return 1;
 142 }
 143
 144 __setup("condev=", condev_setup);
 145
 146 static int __init conmode_setup(char *str)
 147 {
 148 #if defined(CONFIG_SCLP_CONSOLE) || defined(CONFIG_SCLP_VT220_CONSOLE)
 149         if (strncmp(str, "hwc", 4) == 0 || strncmp(str, "sclp", 5) == 0)
 150                 SET_CONSOLE_SCLP;
 151 #endif
 152 #if defined(CONFIG_TN3215_CONSOLE)
 153         if (strncmp(str, "3215", 5) == 0)
 154                 SET_CONSOLE_3215;
 155 #endif
 156 #if defined(CONFIG_TN3270_CONSOLE)
 157         if (strncmp(str, "3270", 5) == 0)
 158                 SET_CONSOLE_3270;
 159 #endif
 160         return 1;
 161 }
 162
 163 __setup("conmode=", conmode_setup);
 164
 165 static void __init conmode_default(void)
 166 {
 167         char query_buffer[1024];
 168         char *ptr;
 169
 170         if (MACHINE_IS_VM) {
 171                 cpcmd("QUERY CONSOLE", query_buffer, 1024, NULL);
 172                 console_devno = simple_strtoul(query_buffer + 5, NULL, 16);
 173                 ptr = strstr(query_buffer, "SUBCHANNEL =");
 174                 console_irq = simple_strtoul(ptr + 13, NULL, 16);
 175                 cpcmd("QUERY TERM", query_buffer, 1024, NULL);
 176                 ptr = strstr(query_buffer, "CONMODE");
 177                 /*
 178                  * Set the conmode to 3215 so that the device recognition
 179                  * will set the cu_type of the console to 3215. If the
 180                  * conmode is 3270 and we don't set it back then both
 181                  * 3215 and the 3270 driver will try to access the console
 182                  * device (3215 as console and 3270 as normal tty).
 183                  */
 184                 cpcmd("TERM CONMODE 3215", NULL, 0, NULL);
 185                 if (ptr == NULL) {
 186 #if defined(CONFIG_SCLP_CONSOLE) || defined(CONFIG_SCLP_VT220_CONSOLE)
 187                         SET_CONSOLE_SCLP;
 188 #endif
 189                         return;
 190                 }
 191                 if (strncmp(ptr + 8, "3270", 4) == 0) {
 192 #if defined(CONFIG_TN3270_CONSOLE)
 193                         SET_CONSOLE_3270;
 194 #elif defined(CONFIG_TN3215_CONSOLE)
 195                         SET_CONSOLE_3215;
 196 #elif defined(CONFIG_SCLP_CONSOLE) || defined(CONFIG_SCLP_VT220_CONSOLE)
 197                         SET_CONSOLE_SCLP;
 198 #endif
 199                 } else if (strncmp(ptr + 8, "3215", 4) == 0) {
 200 #if defined(CONFIG_TN3215_CONSOLE)
 201                         SET_CONSOLE_3215;
 202 #elif defined(CONFIG_TN3270_CONSOLE)
 203                         SET_CONSOLE_3270;
 204 #elif defined(CONFIG_SCLP_CONSOLE) || defined(CONFIG_SCLP_VT220_CONSOLE)
 205                         SET_CONSOLE_SCLP;
 206 #endif
 207                 }
 208         } else if (MACHINE_IS_P390) {
 209 #if defined(CONFIG_TN3215_CONSOLE)
 210                 SET_CONSOLE_3215;
 211 #elif defined(CONFIG_TN3270_CONSOLE)
 212                 SET_CONSOLE_3270;
 213 #endif
 214         } else {
 215 #if defined(CONFIG_SCLP_CONSOLE) || defined(CONFIG_SCLP_VT220_CONSOLE)
 216                 SET_CONSOLE_SCLP;
 217 #endif
 218         }
 219 }
 220
 221 #if defined(CONFIG_ZFCPDUMP) || defined(CONFIG_ZFCPDUMP_MODULE)
 222 static void __init setup_zfcpdump(unsigned int console_devno)
 223 {
 224         static char str[64];
 225
 226         if (ipl_info.type != IPL_TYPE_FCP_DUMP)
 227                 return;
 228         if (console_devno != -1)
 229                 sprintf(str, "cio_ignore=all,!0.0.%04x,!0.0.%04x",
 230                         ipl_info.data.fcp.dev_id.devno, console_devno);
 231         else
 232                 sprintf(str, "cio_ignore=all,!0.0.%04x",
 233                         ipl_info.data.fcp.dev_id.devno);
 234         strcat(COMMAND_LINE, " ");
 235         strcat(COMMAND_LINE, str);
 236         console_loglevel = 2;
 237 }
 238 #else
 239 static inline void setup_zfcpdump(unsigned int console_devno) {}
 240 #endif /* CONFIG_ZFCPDUMP */
 241
 242  /*
 243  * Reboot, halt and power_off stubs. They just call _machine_restart,
 244  * _machine_halt or _machine_power_off.
 245  */
 246
 247 void machine_restart(char *command)
 248 {
 249         if ((!in_interrupt() && !in_atomic()) || oops_in_progress)
 250                 /*
 251                  * Only unblank the console if we are called in enabled
 252                  * context or a bust_spinlocks cleared the way for us.
 253                  */
 254                 console_unblank();
 255         _machine_restart(command);
 256 }
 257
 258 void machine_halt(void)
 259 {
 260         if (!in_interrupt() || oops_in_progress)
 261                 /*
 262                  * Only unblank the console if we are called in enabled
 263                  * context or a bust_spinlocks cleared the way for us.
 264                  */
 265                 console_unblank();
 266         _machine_halt();
 267 }
 268
 269 void machine_power_off(void)
 270 {
 271         if (!in_interrupt() || oops_in_progress)
 272                 /*
 273                  * Only unblank the console if we are called in enabled
 274                  * context or a bust_spinlocks cleared the way for us.
 275                  */
 276                 console_unblank();
 277         _machine_power_off();
 278 }
 279
 280 /*
 281  * Dummy power off function.
 282  */
 283 void (*pm_power_off)(void) = machine_power_off;
 284
 285 static int __init early_parse_mem(char *p)
 286 {
 287         memory_end = memparse(p, &p);
 288         return 0;
 289 }
 290 early_param("mem", early_parse_mem);
 291
 292 /*
 293  * "ipldelay=XXX[sm]" sets ipl delay in seconds or minutes
 294  */
 295 static int __init early_parse_ipldelay(char *p)
 296 {
 297         unsigned long delay = 0;
 298
 299         delay = simple_strtoul(p, &p, 0);
 300
 301         switch (*p) {
 302         case 's':
 303         case 'S':
 304                 delay *= 1000000;
 305                 break;
 306         case 'm':
 307         case 'M':
 308                 delay *= 60 * 1000000;
 309         }
 310
 311         /* now wait for the requested amount of time */
 312         udelay(delay);
 313
 314         return 0;
 315 }
 316 early_param("ipldelay", early_parse_ipldelay);
 317
 318 #ifdef CONFIG_S390_SWITCH_AMODE
 319 #ifdef CONFIG_PGSTE
 320 unsigned int switch_amode = 1;
 321 #else
 322 unsigned int switch_amode = 0;
 323 #endif
 324 EXPORT_SYMBOL_GPL(switch_amode);
 325
 326 static void set_amode_and_uaccess(unsigned long user_amode,
 327                                   unsigned long user32_amode)
 328 {
 329         psw_user_bits = PSW_BASE_BITS | PSW_MASK_DAT | user_amode |
 330                         PSW_MASK_IO | PSW_MASK_EXT | PSW_MASK_MCHECK |
 331                         PSW_MASK_PSTATE | PSW_DEFAULT_KEY;
 332 #ifdef CONFIG_COMPAT
 333         psw_user32_bits = PSW_BASE32_BITS | PSW_MASK_DAT | user_amode |
 334                           PSW_MASK_IO | PSW_MASK_EXT | PSW_MASK_MCHECK |
 335                           PSW_MASK_PSTATE | PSW_DEFAULT_KEY;
 336         psw32_user_bits = PSW32_BASE_BITS | PSW32_MASK_DAT | user32_amode |
 337                           PSW32_MASK_IO | PSW32_MASK_EXT | PSW32_MASK_MCHECK |
 338                           PSW32_MASK_PSTATE;
 339 #endif
 340         psw_kernel_bits = PSW_BASE_BITS | PSW_MASK_DAT | PSW_ASC_HOME |
 341                           PSW_MASK_MCHECK | PSW_DEFAULT_KEY;
 342
 343         if (MACHINE_HAS_MVCOS) {
 344                 printk("mvcos available.\n");
 345                 memcpy(&uaccess, &uaccess_mvcos_switch, sizeof(uaccess));
 346         } else {
 347                 printk("mvcos not available.\n");
 348                 memcpy(&uaccess, &uaccess_pt, sizeof(uaccess));
 349         }
 350 }
 351
 352 /*
 353  * Switch kernel/user addressing modes?
 354  */
 355 static int __init early_parse_switch_amode(char *p)
 356 {
 357         switch_amode = 1;
 358         return 0;
 359 }
 360 early_param("switch_amode", early_parse_switch_amode);
 361
 362 #else /* CONFIG_S390_SWITCH_AMODE */
 363 static inline void set_amode_and_uaccess(unsigned long user_amode,
 364                                          unsigned long user32_amode)
 365 {
 366 }
 367 #endif /* CONFIG_S390_SWITCH_AMODE */
 368
 369 #ifdef CONFIG_S390_EXEC_PROTECT
 370 unsigned int s390_noexec = 0;
 371 EXPORT_SYMBOL_GPL(s390_noexec);
 372
 373 /*
 374  * Enable execute protection?
 375  */
 376 static int __init early_parse_noexec(char *p)
 377 {
 378         if (!strncmp(p, "off", 3))
 379                 return 0;
 380         switch_amode = 1;
 381         s390_noexec = 1;
 382         return 0;
 383 }
 384 early_param("noexec", early_parse_noexec);
 385 #endif /* CONFIG_S390_EXEC_PROTECT */
 386
 387 static void setup_addressing_mode(void)
 388 {
 389         if (s390_noexec) {
 390                 printk("S390 execute protection active, ");
 391                 set_amode_and_uaccess(PSW_ASC_SECONDARY, PSW32_ASC_SECONDARY);
 392         } else if (switch_amode) {
 393                 printk("S390 address spaces switched, ");
 394                 set_amode_and_uaccess(PSW_ASC_PRIMARY, PSW32_ASC_PRIMARY);
 395         }
 396 #ifdef CONFIG_TRACE_IRQFLAGS
 397         sysc_restore_trace_psw.mask = psw_kernel_bits & ~PSW_MASK_MCHECK;
 398         io_restore_trace_psw.mask = psw_kernel_bits & ~PSW_MASK_MCHECK;
 399 #endif
 400 }
 401
 402 static void __init
 403 setup_lowcore(void)
 404 {
 405         struct _lowcore *lc;
 406         int lc_pages;
 407
 408         /*
 409          * Setup lowcore for boot cpu
 410          */
 411         lc_pages = sizeof(void *) == 8 ? 2 : 1;
 412         lc = (struct _lowcore *)
 413                 __alloc_bootmem(lc_pages * PAGE_SIZE, lc_pages * PAGE_SIZE, 0);
 414         memset(lc, 0, lc_pages * PAGE_SIZE);
 415         lc->restart_psw.mask = PSW_BASE_BITS | PSW_DEFAULT_KEY;
 416         lc->restart_psw.addr =
 417                 PSW_ADDR_AMODE | (unsigned long) restart_int_handler;
 418         if (switch_amode)
 419                 lc->restart_psw.mask |= PSW_ASC_HOME;
 420         lc->external_new_psw.mask = psw_kernel_bits;
 421         lc->external_new_psw.addr =
 422                 PSW_ADDR_AMODE | (unsigned long) ext_int_handler;
 423         lc->svc_new_psw.mask = psw_kernel_bits | PSW_MASK_IO | PSW_MASK_EXT;
 424         lc->svc_new_psw.addr = PSW_ADDR_AMODE | (unsigned long) system_call;
 425         lc->program_new_psw.mask = psw_kernel_bits;
 426         lc->program_new_psw.addr =
 427                 PSW_ADDR_AMODE | (unsigned long)pgm_check_handler;
 428         lc->mcck_new_psw.mask =
 429                 psw_kernel_bits & ~PSW_MASK_MCHECK & ~PSW_MASK_DAT;
 430         lc->mcck_new_psw.addr =
 431                 PSW_ADDR_AMODE | (unsigned long) mcck_int_handler;
 432         lc->io_new_psw.mask = psw_kernel_bits;
 433         lc->io_new_psw.addr = PSW_ADDR_AMODE | (unsigned long) io_int_handler;
 434         lc->ipl_device = S390_lowcore.ipl_device;
 435         lc->clock_comparator = -1ULL;
 436         lc->kernel_stack = ((unsigned long) &init_thread_union) + THREAD_SIZE;
 437         lc->async_stack = (unsigned long)
 438                 __alloc_bootmem(ASYNC_SIZE, ASYNC_SIZE, 0) + ASYNC_SIZE;
 439         lc->panic_stack = (unsigned long)
 440                 __alloc_bootmem(PAGE_SIZE, PAGE_SIZE, 0) + PAGE_SIZE;
 441         lc->current_task = (unsigned long) init_thread_union.thread_info.task;
 442         lc->thread_info = (unsigned long) &init_thread_union;
 443 #ifndef CONFIG_64BIT
 444         if (MACHINE_HAS_IEEE) {
 445                 lc->extended_save_area_addr = (__u32)
 446                         __alloc_bootmem(PAGE_SIZE, PAGE_SIZE, 0);
 447                 /* enable extended save area */
 448                 __ctl_set_bit(14, 29);
 449         }
 450 #endif
 451         set_prefix((u32)(unsigned long) lc);
 452 }
 453
 454 static void __init
 455 setup_resources(void)
 456 {
 457         struct resource *res, *sub_res;
 458         int i;
 459
 460         code_resource.start = (unsigned long) &_text;
 461         code_resource.end = (unsigned long) &_etext - 1;
 462         data_resource.start = (unsigned long) &_etext;
 463         data_resource.end = (unsigned long) &_edata - 1;
 464
 465         for (i = 0; i < MEMORY_CHUNKS; i++) {
 466                 if (!memory_chunk[i].size)
 467                         continue;
 468                 res = alloc_bootmem_low(sizeof(struct resource));
 469                 res->flags = IORESOURCE_BUSY | IORESOURCE_MEM;
 470                 switch (memory_chunk[i].type) {
 471                 case CHUNK_READ_WRITE:
 472                         res->name = "System RAM";
 473                         break;
 474                 case CHUNK_READ_ONLY:
 475                         res->name = "System ROM";
 476                         res->flags |= IORESOURCE_READONLY;
 477                         break;
 478                 default:
 479                         res->name = "reserved";
 480                 }
 481                 res->start = memory_chunk[i].addr;
 482                 res->end = memory_chunk[i].addr +  memory_chunk[i].size - 1;
 483                 request_resource(&iomem_resource, res);
 484
 485                 if (code_resource.start >= res->start  &&
 486                         code_resource.start <= res->end &&
 487                         code_resource.end > res->end) {
 488                         sub_res = alloc_bootmem_low(sizeof(struct resource));
 489                         memcpy(sub_res, &code_resource,
 490                                 sizeof(struct resource));
 491                         sub_res->end = res->end;
 492                         code_resource.start = res->end + 1;
 493                         request_resource(res, sub_res);
 494                 }
 495
 496                 if (code_resource.start >= res->start &&
 497                         code_resource.start <= res->end &&
 498                         code_resource.end <= res->end)
 499                         request_resource(res, &code_resource);
 500
 501                 if (data_resource.start >= res->start &&
 502                         data_resource.start <= res->end &&
 503                         data_resource.end > res->end) {
 504                         sub_res = alloc_bootmem_low(sizeof(struct resource));
 505                         memcpy(sub_res, &data_resource,
 506                                 sizeof(struct resource));
 507                         sub_res->end = res->end;
 508                         data_resource.start = res->end + 1;
 509                         request_resource(res, sub_res);
 510                 }
 511
 512                 if (data_resource.start >= res->start &&
 513                         data_resource.start <= res->end &&
 514                         data_resource.end <= res->end)
 515                         request_resource(res, &data_resource);
 516         }
 517 }
 518
 519 unsigned long real_memory_size;
 520 EXPORT_SYMBOL_GPL(real_memory_size);
 521
 522 static void __init setup_memory_end(void)
 523 {
 524         unsigned long memory_size;
 525         unsigned long max_mem;
 526         int i;
 527
 528 #if defined(CONFIG_ZFCPDUMP) || defined(CONFIG_ZFCPDUMP_MODULE)
 529         if (ipl_info.type == IPL_TYPE_FCP_DUMP)
 530                 memory_end = ZFCPDUMP_HSA_SIZE;
 531 #endif
 532         memory_size = 0;
 533         memory_end &= PAGE_MASK;
 534
 535         max_mem = memory_end ? min(VMEM_MAX_PHYS, memory_end) : VMEM_MAX_PHYS;
 536         memory_end = min(max_mem, memory_end);
 537
 538         /*
 539          * Make sure all chunks are MAX_ORDER aligned so we don't need the
 540          * extra checks that HOLES_IN_ZONE would require.
 541          */
 542         for (i = 0; i < MEMORY_CHUNKS; i++) {
 543                 unsigned long start, end;
 544                 struct mem_chunk *chunk;
 545                 unsigned long align;
 546
 547                 chunk = &memory_chunk[i];
 548                 align = 1UL << (MAX_ORDER + PAGE_SHIFT - 1);
 549                 start = (chunk->addr + align - 1) & ~(align - 1);
 550                 end = (chunk->addr + chunk->size) & ~(align - 1);
 551                 if (start >= end)
 552                         memset(chunk, 0, sizeof(*chunk));
 553                 else {
 554                         chunk->addr = start;
 555                         chunk->size = end - start;
 556                 }
 557         }
 558
 559         for (i = 0; i < MEMORY_CHUNKS; i++) {
 560                 struct mem_chunk *chunk = &memory_chunk[i];
 561
 562                 real_memory_size = max(real_memory_size,
 563                                        chunk->addr + chunk->size);
 564                 if (chunk->addr >= max_mem) {
 565                         memset(chunk, 0, sizeof(*chunk));
 566                         continue;
 567                 }
 568                 if (chunk->addr + chunk->size > max_mem)
 569                         chunk->size = max_mem - chunk->addr;
 570                 memory_size = max(memory_size, chunk->addr + chunk->size);
 571         }
 572         if (!memory_end)
 573                 memory_end = memory_size;
 574 }
 575
 576 static void __init
 577 setup_memory(void)
 578 {
 579         unsigned long bootmap_size;
 580         unsigned long start_pfn, end_pfn;
 581         int i;
 582
 583         /*
 584          * partially used pages are not usable - thus
 585          * we are rounding upwards:
 586          */
 587         start_pfn = PFN_UP(__pa(&_end));
 588         end_pfn = max_pfn = PFN_DOWN(memory_end);
 589
 590 #ifdef CONFIG_BLK_DEV_INITRD
 591         /*
 592          * Move the initrd in case the bitmap of the bootmem allocater
 593          * would overwrite it.
 594          */
 595
 596         if (INITRD_START && INITRD_SIZE) {
 597                 unsigned long bmap_size;
 598                 unsigned long start;
 599
 600                 bmap_size = bootmem_bootmap_pages(end_pfn - start_pfn + 1);
 601                 bmap_size = PFN_PHYS(bmap_size);
 602
 603                 if (PFN_PHYS(start_pfn) + bmap_size > INITRD_START) {
 604                         start = PFN_PHYS(start_pfn) + bmap_size + PAGE_SIZE;
 605
 606                         if (start + INITRD_SIZE > memory_end) {
 607                                 printk("initrd extends beyond end of memory "
 608                                        "(0x%08lx > 0x%08lx)\n"
 609                                        "disabling initrd\n",
 610                                        start + INITRD_SIZE, memory_end);
 611                                 INITRD_START = INITRD_SIZE = 0;
 612                         } else {
 613                                 printk("Moving initrd (0x%08lx -> 0x%08lx, "
 614                                        "size: %ld)\n",
 615                                        INITRD_START, start, INITRD_SIZE);
 616                                 memmove((void *) start, (void *) INITRD_START,
 617                                         INITRD_SIZE);
 618                                 INITRD_START = start;
 619                         }
 620                 }
 621         }
 622 #endif
 623
 624         /*
 625          * Initialize the boot-time allocator
 626          */
 627         bootmap_size = init_bootmem(start_pfn, end_pfn);
 628
 629         /*
 630          * Register RAM areas with the bootmem allocator.
 631          */
 632
 633         for (i = 0; i < MEMORY_CHUNKS && memory_chunk[i].size > 0; i++) {
 634                 unsigned long start_chunk, end_chunk, pfn;
 635
 636                 if (memory_chunk[i].type != CHUNK_READ_WRITE)
 637                         continue;
 638                 start_chunk = PFN_DOWN(memory_chunk[i].addr);
 639                 end_chunk = start_chunk + PFN_DOWN(memory_chunk[i].size) - 1;
 640                 end_chunk = min(end_chunk, end_pfn);
 641                 if (start_chunk >= end_chunk)
 642                         continue;
 643                 add_active_range(0, start_chunk, end_chunk);
 644                 pfn = max(start_chunk, start_pfn);
 645                 for (; pfn <= end_chunk; pfn++)
 646                         page_set_storage_key(PFN_PHYS(pfn), PAGE_DEFAULT_KEY);
 647         }
 648
 649         psw_set_key(PAGE_DEFAULT_KEY);
 650
 651         free_bootmem_with_active_regions(0, max_pfn);
 652
 653         /*
 654          * Reserve memory used for lowcore/command line/kernel image.
 655          */
 656         reserve_bootmem(0, (unsigned long)_ehead, BOOTMEM_DEFAULT);
 657         reserve_bootmem((unsigned long)_stext,
 658                         PFN_PHYS(start_pfn) - (unsigned long)_stext,
 659                         BOOTMEM_DEFAULT);
 660         /*
 661          * Reserve the bootmem bitmap itself as well. We do this in two
 662          * steps (first step was init_bootmem()) because this catches
 663          * the (very unlikely) case of us accidentally initializing the
 664          * bootmem allocator with an invalid RAM area.
 665          */
 666         reserve_bootmem(start_pfn << PAGE_SHIFT, bootmap_size,
 667                         BOOTMEM_DEFAULT);
 668
 669 #ifdef CONFIG_BLK_DEV_INITRD
 670         if (INITRD_START && INITRD_SIZE) {
 671                 if (INITRD_START + INITRD_SIZE <= memory_end) {
 672                         reserve_bootmem(INITRD_START, INITRD_SIZE,
 673                                         BOOTMEM_DEFAULT);
 674                         initrd_start = INITRD_START;
 675                         initrd_end = initrd_start + INITRD_SIZE;
 676                 } else {
 677                         printk("initrd extends beyond end of memory "
 678                                "(0x%08lx > 0x%08lx)\ndisabling initrd\n",
 679                                initrd_start + INITRD_SIZE, memory_end);
 680                         initrd_start = initrd_end = 0;
 681                 }
 682         }
 683 #endif
 684 }
 685
 686 static int __init __stfle(unsigned long long *list, int doublewords)
 687 {
 688         typedef struct { unsigned long long _[doublewords]; } addrtype;
 689         register unsigned long __nr asm("0") = doublewords - 1;
 690
 691         asm volatile(".insn s,0xb2b00000,%0" /* stfle */
 692                      : "=m" (*(addrtype *) list), "+d" (__nr) : : "cc");
 693         return __nr + 1;
 694 }
 695
 696 int __init stfle(unsigned long long *list, int doublewords)
 697 {
 698         if (!(stfl() & (1UL << 24)))
 699                 return -EOPNOTSUPP;
 700         return __stfle(list, doublewords);
 701 }
 702
 703 /*
 704  * Setup hardware capabilities.
 705  */
 706 static void __init setup_hwcaps(void)
 707 {
 708         static const int stfl_bits[6] = { 0, 2, 7, 17, 19, 21 };
 709         struct cpuinfo_S390 *cpuinfo = &S390_lowcore.cpu_data;
 710         unsigned long long facility_list_extended;
 711         unsigned int facility_list;
 712         int i;
 713
 714         facility_list = stfl();
 715         /*
 716          * The store facility list bits numbers as found in the principles
 717          * of operation are numbered with bit 1UL<<31 as number 0 to
 718          * bit 1UL<<0 as number 31.
 719          *   Bit 0: instructions named N3, "backported" to esa-mode
 720          *   Bit 2: z/Architecture mode is active
 721          *   Bit 7: the store-facility-list-extended facility is installed
 722          *   Bit 17: the message-security assist is installed
 723          *   Bit 19: the long-displacement facility is installed
 724          *   Bit 21: the extended-immediate facility is installed
 725          * These get translated to:
 726          *   HWCAP_S390_ESAN3 bit 0, HWCAP_S390_ZARCH bit 1,
 727          *   HWCAP_S390_STFLE bit 2, HWCAP_S390_MSA bit 3,
 728          *   HWCAP_S390_LDISP bit 4, and HWCAP_S390_EIMM bit 5.
 729          */
 730         for (i = 0; i < 6; i++)
 731                 if (facility_list & (1UL << (31 - stfl_bits[i])))
 732                         elf_hwcap |= 1UL << i;
 733
 734         /*
 735          * Check for additional facilities with store-facility-list-extended.
 736          * stfle stores doublewords (8 byte) with bit 1ULL<<63 as bit 0
 737          * and 1ULL<<0 as bit 63. Bits 0-31 contain the same information
 738          * as stored by stfl, bits 32-xxx contain additional facilities.
 739          * How many facility words are stored depends on the number of
 740          * doublewords passed to the instruction. The additional facilites
 741          * are:
 742          *   Bit 43: decimal floating point facility is installed
 743          * translated to:
 744          *   HWCAP_S390_DFP bit 6.
 745          */
 746         if ((elf_hwcap & (1UL << 2)) &&
 747             __stfle(&facility_list_extended, 1) > 0) {
 748                 if (facility_list_extended & (1ULL << (64 - 43)))
 749                         elf_hwcap |= 1UL << 6;
 750         }
 751
 752         if (MACHINE_HAS_HPAGE)
 753                 elf_hwcap |= 1UL << 7;
 754
 755         switch (cpuinfo->cpu_id.machine) {
 756         case 0x9672:
 757 #if !defined(CONFIG_64BIT)
 758         default:        /* Use "g5" as default for 31 bit kernels. */
 759 #endif
 760                 strcpy(elf_platform, "g5");
 761                 break;
 762         case 0x2064:
 763         case 0x2066:
 764 #if defined(CONFIG_64BIT)
 765         default:        /* Use "z900" as default for 64 bit kernels. */
 766 #endif
 767                 strcpy(elf_platform, "z900");
 768                 break;
 769         case 0x2084:
 770         case 0x2086:
 771                 strcpy(elf_platform, "z990");
 772                 break;
 773         case 0x2094:
 774                 strcpy(elf_platform, "z9-109");
 775                 break;
 776         }
 777 }
 778
 779 /*
 780  * Setup function called from init/main.c just after the banner
 781  * was printed.
 782  */
 783
 784 void __init
 785 setup_arch(char **cmdline_p)
 786 {
 787         /*
 788          * print what head.S has found out about the machine
 789          */
 790 #ifndef CONFIG_64BIT
 791         printk((MACHINE_IS_VM) ?
 792                "We are running under VM (31 bit mode)\n" :
 793                "We are running native (31 bit mode)\n");
 794         printk((MACHINE_HAS_IEEE) ?
 795                "This machine has an IEEE fpu\n" :
 796                "This machine has no IEEE fpu\n");
 797 #else /* CONFIG_64BIT */
 798         if (MACHINE_IS_VM)
 799                 printk("We are running under VM (64 bit mode)\n");
 800         else if (MACHINE_IS_KVM) {
 801                 printk("We are running under KVM (64 bit mode)\n");
 802                 add_preferred_console("ttyS", 1, NULL);
 803         } else
 804                 printk("We are running native (64 bit mode)\n");
 805 #endif /* CONFIG_64BIT */
 806
 807         /* Save unparsed command line copy for /proc/cmdline */
 808         strlcpy(boot_command_line, COMMAND_LINE, COMMAND_LINE_SIZE);
 809
 810         *cmdline_p = COMMAND_LINE;
 811         *(*cmdline_p + COMMAND_LINE_SIZE - 1) = '\0';
 812
 813         ROOT_DEV = Root_RAM0;
 814
 815         init_mm.start_code = PAGE_OFFSET;
 816         init_mm.end_code = (unsigned long) &_etext;
 817         init_mm.end_data = (unsigned long) &_edata;
 818         init_mm.brk = (unsigned long) &_end;
 819
 820         if (MACHINE_HAS_MVCOS)
 821                 memcpy(&uaccess, &uaccess_mvcos, sizeof(uaccess));
 822         else
 823                 memcpy(&uaccess, &uaccess_std, sizeof(uaccess));
 824
 825         parse_early_param();
 826
 827         setup_ipl();
 828         setup_memory_end();
 829         setup_addressing_mode();
 830         setup_memory();
 831         setup_resources();
 832         setup_lowcore();
 833
 834         cpu_init();
 835         __cpu_logical_map[0] = S390_lowcore.cpu_data.cpu_addr;
 836         s390_init_cpu_topology();
 837
 838         /*
 839          * Setup capabilities (ELF_HWCAP & ELF_PLATFORM).
 840          */
 841         setup_hwcaps();
 842
 843         /*
 844          * Create kernel page tables and switch to virtual addressing.
 845          */
 846         paging_init();
 847
 848         /* Setup default console */
 849         conmode_default();
 850
 851         /* Setup zfcpdump support */
 852         setup_zfcpdump(console_devno);
 853 }
 854
 855 void __cpuinit print_cpu_info(struct cpuinfo_S390 *cpuinfo)
 856 {
 857    printk(KERN_INFO "cpu %d "
 858 #ifdef CONFIG_SMP
 859            "phys_idx=%d "
 860 #endif
 861            "vers=%02X ident=%06X machine=%04X unused=%04X\n",
 862            cpuinfo->cpu_nr,
 863 #ifdef CONFIG_SMP
 864            cpuinfo->cpu_addr,
 865 #endif
 866            cpuinfo->cpu_id.version,
 867            cpuinfo->cpu_id.ident,
 868            cpuinfo->cpu_id.machine,
 869            cpuinfo->cpu_id.unused);
 870 }
 871
 872 /*
 873  * show_cpuinfo - Get information on one CPU for use by procfs.
 874  */
 875
 876 static int show_cpuinfo(struct seq_file *m, void *v)
 877 {
 878         static const char *hwcap_str[8] = {
 879                 "esan3", "zarch", "stfle", "msa", "ldisp", "eimm", "dfp",
 880                 "edat"
 881         };
 882         struct cpuinfo_S390 *cpuinfo;
 883         unsigned long n = (unsigned long) v - 1;
 884         int i;
 885
 886         s390_adjust_jiffies();
 887         preempt_disable();
 888         if (!n) {
 889                 seq_printf(m, "vendor_id       : IBM/S390\n"
 890                                "# processors    : %i\n"
 891                                "bogomips per cpu: %lu.%02lu\n",
 892                                num_online_cpus(), loops_per_jiffy/(500000/HZ),
 893                                (loops_per_jiffy/(5000/HZ))%100);
 894                 seq_puts(m, "features\t: ");
 895                 for (i = 0; i < 8; i++)
 896                         if (hwcap_str[i] && (elf_hwcap & (1UL << i)))
 897                                 seq_printf(m, "%s ", hwcap_str[i]);
 898                 seq_puts(m, "\n");
 899         }
 900
 901         if (cpu_online(n)) {
 902 #ifdef CONFIG_SMP
 903                 if (smp_processor_id() == n)
 904                         cpuinfo = &S390_lowcore.cpu_data;
 905                 else
 906                         cpuinfo = &lowcore_ptr[n]->cpu_data;
 907 #else
 908                 cpuinfo = &S390_lowcore.cpu_data;
 909 #endif
 910                 seq_printf(m, "processor %li: "
 911                                "version = %02X,  "
 912                                "identification = %06X,  "
 913                                "machine = %04X\n",
 914                                n, cpuinfo->cpu_id.version,
 915                                cpuinfo->cpu_id.ident,
 916                                cpuinfo->cpu_id.machine);
 917         }
 918         preempt_enable();
 919         return 0;
 920 }
 921
 922 static void *c_start(struct seq_file *m, loff_t *pos)
 923 {
 924         return *pos < NR_CPUS ? (void *)((unsigned long) *pos + 1) : NULL;
 925 }
 926 static void *c_next(struct seq_file *m, void *v, loff_t *pos)
 927 {
 928         ++*pos;
 929         return c_start(m, pos);
 930 }
 931 static void c_stop(struct seq_file *m, void *v)
 932 {
 933 }
 934 const struct seq_operations cpuinfo_op = {
 935         .start  = c_start,
 936         .next   = c_next,
 937         .stop   = c_stop,
 938         .show   = show_cpuinfo,
 939 };
 940