setup.c
上传用户:jlfgdled
上传日期:2013-04-10
资源大小:33168k
文件大小:15k
- /*
- * arch/s390/kernel/setup.c
- *
- * S390 version
- * Copyright (C) 1999,2000 IBM Deutschland Entwicklung GmbH, IBM Corporation
- * Author(s): Hartmut Penner (hp@de.ibm.com),
- * Martin Schwidefsky (schwidefsky@de.ibm.com)
- *
- * Derived from "arch/i386/kernel/setup.c"
- * Copyright (C) 1995, Linus Torvalds
- */
- /*
- * This file handles the architecture-dependent parts of initialization
- */
- #include <linux/errno.h>
- #include <linux/sched.h>
- #include <linux/kernel.h>
- #include <linux/mm.h>
- #include <linux/stddef.h>
- #include <linux/unistd.h>
- #include <linux/ptrace.h>
- #include <linux/slab.h>
- #include <linux/user.h>
- #include <linux/a.out.h>
- #include <linux/tty.h>
- #include <linux/ioport.h>
- #include <linux/delay.h>
- #include <linux/config.h>
- #include <linux/init.h>
- #ifdef CONFIG_BLK_DEV_RAM
- #include <linux/blk.h>
- #endif
- #include <linux/bootmem.h>
- #include <linux/console.h>
- #include <linux/seq_file.h>
- #include <asm/uaccess.h>
- #include <asm/system.h>
- #include <asm/smp.h>
- #include <asm/mmu_context.h>
- #include <asm/cpcmd.h>
- /*
- * Machine setup..
- */
- unsigned int console_mode = 0;
- unsigned int console_device = -1;
- unsigned long memory_size = 0;
- unsigned long machine_flags = 0;
- struct { unsigned long addr, size, type; } memory_chunk[16] = { { 0 } };
- #define CHUNK_READ_WRITE 0
- #define CHUNK_READ_ONLY 1
- __u16 boot_cpu_addr;
- int cpus_initialized = 0;
- unsigned long cpu_initialized = 0;
- volatile int __cpu_logical_map[NR_CPUS]; /* logical cpu to cpu address */
- /*
- * Setup options
- */
- extern int _text,_etext, _edata, _end;
- /*
- * This is set up by the setup-routine at boot-time
- * for S390 need to find out, what we have to setup
- * using address 0x10400 ...
- */
- #include <asm/setup.h>
- static char command_line[COMMAND_LINE_SIZE] = { 0, };
- char saved_command_line[COMMAND_LINE_SIZE];
- static struct resource code_resource = { "Kernel code", 0x100000, 0 };
- static struct resource data_resource = { "Kernel data", 0, 0 };
- /*
- * cpu_init() initializes state that is per-CPU.
- */
- void __init cpu_init (void)
- {
- int nr = smp_processor_id();
- int addr = hard_smp_processor_id();
- if (test_and_set_bit(nr,&cpu_initialized)) {
- printk("CPU#%d ALREADY INITIALIZED!!!!!!!!!n", nr);
- for (;;) __sti();
- }
- cpus_initialized++;
- /*
- * Store processor id in lowcore (used e.g. in timer_interrupt)
- */
- asm volatile ("stidp %0": "=m" (S390_lowcore.cpu_data.cpu_id));
- S390_lowcore.cpu_data.cpu_addr = addr;
- S390_lowcore.cpu_data.cpu_nr = nr;
- /*
- * Force FPU initialization:
- */
- current->flags &= ~PF_USEDFPU;
- current->used_math = 0;
- /* Setup active_mm for idle_task */
- atomic_inc(&init_mm.mm_count);
- current->active_mm = &init_mm;
- if (current->mm)
- BUG();
- enter_lazy_tlb(&init_mm, current, nr);
- }
- /*
- * VM halt and poweroff setup routines
- */
- char vmhalt_cmd[128] = "";
- char vmpoff_cmd[128] = "";
- static inline void strncpy_skip_quote(char *dst, char *src, int n)
- {
- int sx, dx;
- dx = 0;
- for (sx = 0; src[sx] != 0; sx++) {
- if (src[sx] == '"') continue;
- dst[dx++] = src[sx];
- if (dx >= n) break;
- }
- }
- static int __init vmhalt_setup(char *str)
- {
- strncpy_skip_quote(vmhalt_cmd, str, 127);
- vmhalt_cmd[127] = 0;
- return 1;
- }
- __setup("vmhalt=", vmhalt_setup);
- static int __init vmpoff_setup(char *str)
- {
- strncpy_skip_quote(vmpoff_cmd, str, 127);
- vmpoff_cmd[127] = 0;
- return 1;
- }
- __setup("vmpoff=", vmpoff_setup);
- /*
- * condev= and conmode= setup parameter.
- */
- static int __init condev_setup(char *str)
- {
- int vdev;
- vdev = simple_strtoul(str, &str, 0);
- if (vdev >= 0 && vdev < 65536)
- console_device = vdev;
- return 1;
- }
- __setup("condev=", condev_setup);
- static int __init conmode_setup(char *str)
- {
- #if defined(CONFIG_HWC_CONSOLE)
- if (strncmp(str, "hwc", 4) == 0)
- SET_CONSOLE_HWC;
- #endif
- #if defined(CONFIG_TN3215_CONSOLE)
- if (strncmp(str, "3215", 5) == 0)
- SET_CONSOLE_3215;
- #endif
- #if defined(CONFIG_TN3270_CONSOLE)
- if (strncmp(str, "3270", 5) == 0)
- SET_CONSOLE_3270;
- #endif
- return 1;
- }
- __setup("conmode=", conmode_setup);
- static void __init conmode_default(void)
- {
- char query_buffer[1024];
- char *ptr;
- if (MACHINE_IS_VM) {
- cpcmd("QUERY TERM", query_buffer, 1024);
- ptr = strstr(query_buffer, "CONMODE");
- /*
- * Set the conmode to 3215 so that the device recognition
- * will set the cu_type of the console to 3215. If the
- * conmode is 3270 and we don't set it back then both
- * 3215 and the 3270 driver will try to access the console
- * device (3215 as console and 3270 as normal tty).
- */
- cpcmd("TERM CONMODE 3215", NULL, 0);
- if (ptr == NULL) {
- #if defined(CONFIG_HWC_CONSOLE)
- SET_CONSOLE_HWC;
- #endif
- return;
- }
- if (strncmp(ptr + 8, "3270", 4) == 0) {
- #if defined(CONFIG_TN3270_CONSOLE)
- SET_CONSOLE_3270;
- #elif defined(CONFIG_TN3215_CONSOLE)
- SET_CONSOLE_3215;
- #elif defined(CONFIG_HWC_CONSOLE)
- SET_CONSOLE_HWC;
- #endif
- } else if (strncmp(ptr + 8, "3215", 4) == 0) {
- #if defined(CONFIG_TN3215_CONSOLE)
- SET_CONSOLE_3215;
- #elif defined(CONFIG_TN3270_CONSOLE)
- SET_CONSOLE_3270;
- #elif defined(CONFIG_HWC_CONSOLE)
- SET_CONSOLE_HWC;
- #endif
- }
- } else if (MACHINE_IS_P390) {
- #if defined(CONFIG_TN3215_CONSOLE)
- SET_CONSOLE_3215;
- #elif defined(CONFIG_TN3270_CONSOLE)
- SET_CONSOLE_3270;
- #endif
- } else {
- #if defined(CONFIG_HWC_CONSOLE)
- SET_CONSOLE_HWC;
- #endif
- }
- }
- #ifdef CONFIG_SMP
- extern void machine_restart_smp(char *);
- extern void machine_halt_smp(void);
- extern void machine_power_off_smp(void);
- void (*_machine_restart)(char *command) = machine_restart_smp;
- void (*_machine_halt)(void) = machine_halt_smp;
- void (*_machine_power_off)(void) = machine_power_off_smp;
- #else
- /*
- * Reboot, halt and power_off routines for non SMP.
- */
- static void do_machine_restart_nonsmp(char * __unused)
- {
- reipl(S390_lowcore.ipl_device);
- }
- static void do_machine_halt_nonsmp(void)
- {
- if (MACHINE_IS_VM && strlen(vmhalt_cmd) > 0)
- cpcmd(vmhalt_cmd, NULL, 0);
- signal_processor(smp_processor_id(), sigp_stop_and_store_status);
- }
- static void do_machine_power_off_nonsmp(void)
- {
- if (MACHINE_IS_VM && strlen(vmpoff_cmd) > 0)
- cpcmd(vmpoff_cmd, NULL, 0);
- signal_processor(smp_processor_id(), sigp_stop_and_store_status);
- }
- void (*_machine_restart)(char *command) = do_machine_restart_nonsmp;
- void (*_machine_halt)(void) = do_machine_halt_nonsmp;
- void (*_machine_power_off)(void) = do_machine_power_off_nonsmp;
- #endif
- /*
- * Reboot, halt and power_off stubs. They just call _machine_restart,
- * _machine_halt or _machine_power_off.
- */
- void machine_restart(char *command)
- {
- _machine_restart(command);
- }
- void machine_halt(void)
- {
- _machine_halt();
- }
- void machine_power_off(void)
- {
- _machine_power_off();
- }
- /*
- * Setup function called from init/main.c just after the banner
- * was printed.
- */
- extern char _pstart, _pend, _stext;
- void __init setup_arch(char **cmdline_p)
- {
- unsigned long bootmap_size;
- unsigned long memory_start, memory_end;
- char c = ' ', cn, *to = command_line, *from = COMMAND_LINE;
- struct resource *res;
- unsigned long start_pfn, end_pfn;
- static unsigned int smptrap=0;
- unsigned long delay = 0;
- struct _lowcore *lowcore;
- int i;
- if (smptrap)
- return;
- smptrap=1;
- /*
- * print what head.S has found out about the machine
- */
- printk((MACHINE_IS_VM) ?
- "We are running under VM (64 bit mode)n" :
- "We are running native (64 bit mode)n");
- ROOT_DEV = to_kdev_t(0x0100);
- memory_start = (unsigned long) &_end; /* fixit if use $CODELO etc*/
- memory_end = memory_size & ~0x200000UL; /* detected in head.s */
- init_mm.start_code = PAGE_OFFSET;
- init_mm.end_code = (unsigned long) &_etext;
- init_mm.end_data = (unsigned long) &_edata;
- init_mm.brk = (unsigned long) &_end;
- code_resource.start = (unsigned long) &_text;
- code_resource.end = (unsigned long) &_etext - 1;
- data_resource.start = (unsigned long) &_etext;
- data_resource.end = (unsigned long) &_edata - 1;
- /* Save unparsed command line copy for /proc/cmdline */
- memcpy(saved_command_line, COMMAND_LINE, COMMAND_LINE_SIZE);
- saved_command_line[COMMAND_LINE_SIZE-1] = ' ';
- for (;;) {
- /*
- * "mem=XXX[kKmM]" sets memsize
- */
- if (c == ' ' && strncmp(from, "mem=", 4) == 0) {
- memory_end = simple_strtoul(from+4, &from, 0);
- if ( *from == 'K' || *from == 'k' ) {
- memory_end = memory_end << 10;
- from++;
- } else if ( *from == 'M' || *from == 'm' ) {
- memory_end = memory_end << 20;
- from++;
- }
- }
- /*
- * "ipldelay=XXX[sm]" sets ipl delay in seconds or minutes
- */
- if (c == ' ' && strncmp(from, "ipldelay=", 9) == 0) {
- delay = simple_strtoul(from+9, &from, 0);
- if (*from == 's' || *from == 'S') {
- delay = delay*1000000;
- from++;
- } else if (*from == 'm' || *from == 'M') {
- delay = delay*60*1000000;
- from++;
- }
- /* now wait for the requested amount of time */
- udelay(delay);
- }
- cn = *(from++);
- if (!cn)
- break;
- if (cn == 'n')
- cn = ' '; /* replace newlines with space */
- if (cn == 0x0d)
- cn = ' '; /* replace 0x0d with space */
- if (cn == ' ' && c == ' ')
- continue; /* remove additional spaces */
- c = cn;
- if (to - command_line >= COMMAND_LINE_SIZE)
- break;
- *(to++) = c;
- }
- if (c == ' ' && to > command_line) to--;
- *to = ' ';
- *cmdline_p = command_line;
- /*
- * partially used pages are not usable - thus
- * we are rounding upwards:
- */
- start_pfn = (__pa(&_end) + PAGE_SIZE - 1) >> PAGE_SHIFT;
- end_pfn = memory_end >> PAGE_SHIFT;
- /*
- * Initialize the boot-time allocator
- */
- bootmap_size = init_bootmem(start_pfn, end_pfn);
- /*
- * Register RAM areas with the bootmem allocator.
- */
- for (i = 0; i < 16 && memory_chunk[i].size > 0; i++) {
- unsigned long start_chunk, end_chunk;
- if (memory_chunk[i].type != CHUNK_READ_WRITE)
- continue;
- start_chunk = (memory_chunk[i].addr + PAGE_SIZE - 1);
- start_chunk >>= PAGE_SHIFT;
- end_chunk = (memory_chunk[i].addr + memory_chunk[i].size);
- end_chunk >>= PAGE_SHIFT;
- if (start_chunk < start_pfn)
- start_chunk = start_pfn;
- if (end_chunk > end_pfn)
- end_chunk = end_pfn;
- if (start_chunk < end_chunk)
- free_bootmem(start_chunk << PAGE_SHIFT,
- (end_chunk - start_chunk) << PAGE_SHIFT);
- }
-
- /*
- * Reserve the bootmem bitmap itself as well. We do this in two
- * steps (first step was init_bootmem()) because this catches
- * the (very unlikely) case of us accidentally initializing the
- * bootmem allocator with an invalid RAM area.
- */
- reserve_bootmem(start_pfn << PAGE_SHIFT, bootmap_size);
- #ifdef CONFIG_BLK_DEV_INITRD
- if (INITRD_START) {
- if (INITRD_START + INITRD_SIZE <= memory_end) {
- reserve_bootmem(INITRD_START, INITRD_SIZE);
- initrd_start = INITRD_START;
- initrd_end = initrd_start + INITRD_SIZE;
- } else {
- printk("initrd extends beyond end of memory "
- "(0x%08lx > 0x%08lx)ndisabling initrdn",
- initrd_start + INITRD_SIZE, memory_end);
- initrd_start = initrd_end = 0;
- }
- }
- #endif
- /*
- * Setup lowcore for boot cpu
- */
- lowcore = (struct _lowcore *)
- __alloc_bootmem(2*PAGE_SIZE, 2*PAGE_SIZE, 0);
- memset(lowcore, 0, 2*PAGE_SIZE);
- lowcore->restart_psw.mask = _RESTART_PSW_MASK;
- lowcore->restart_psw.addr = (addr_t) &restart_int_handler;
- lowcore->external_new_psw.mask = _EXT_PSW_MASK;
- lowcore->external_new_psw.addr = (addr_t) &ext_int_handler;
- lowcore->svc_new_psw.mask = _SVC_PSW_MASK;
- lowcore->svc_new_psw.addr = (addr_t) &system_call;
- lowcore->program_new_psw.mask = _PGM_PSW_MASK;
- lowcore->program_new_psw.addr = (addr_t) &pgm_check_handler;
- lowcore->mcck_new_psw.mask = _MCCK_PSW_MASK;
- lowcore->mcck_new_psw.addr = (addr_t) &mcck_int_handler;
- lowcore->io_new_psw.mask = _IO_PSW_MASK;
- lowcore->io_new_psw.addr = (addr_t) &io_int_handler;
- lowcore->ipl_device = S390_lowcore.ipl_device;
- lowcore->kernel_stack = ((__u64) &init_task_union) + 16384;
- lowcore->async_stack = (__u64)
- __alloc_bootmem(4*PAGE_SIZE, 4*PAGE_SIZE, 0) + 16384;
- lowcore->jiffy_timer = -1LL;
- if (MACHINE_HAS_DIAG44)
- lowcore->diag44_opcode = 0x83000044;
- else
- lowcore->diag44_opcode = 0x07000700;
- set_prefix((__u32)(__u64) lowcore);
- cpu_init();
- boot_cpu_addr = S390_lowcore.cpu_data.cpu_addr;
- __cpu_logical_map[0] = boot_cpu_addr;
- /*
- * Create kernel page tables and switch to virtual addressing.
- */
- paging_init();
- res = alloc_bootmem_low(sizeof(struct resource));
- res->start = 0;
- res->end = memory_end;
- res->flags = IORESOURCE_MEM | IORESOURCE_BUSY;
- request_resource(&iomem_resource, res);
- request_resource(res, &code_resource);
- request_resource(res, &data_resource);
- /* Setup default console */
- conmode_default();
- }
- void print_cpu_info(struct cpuinfo_S390 *cpuinfo)
- {
- printk("cpu %d "
- #ifdef CONFIG_SMP
- "phys_idx=%d "
- #endif
- "vers=%02X ident=%06X machine=%04X unused=%04Xn",
- cpuinfo->cpu_nr,
- #ifdef CONFIG_SMP
- cpuinfo->cpu_addr,
- #endif
- cpuinfo->cpu_id.version,
- cpuinfo->cpu_id.ident,
- cpuinfo->cpu_id.machine,
- cpuinfo->cpu_id.unused);
- }
- /*
- * show_cpuinfo - Get information on one CPU for use by procfs.
- */
- static int show_cpuinfo(struct seq_file *m, void *v)
- {
- struct cpuinfo_S390 *cpuinfo;
- unsigned long n = (unsigned long) v - 1;
- if (!n) {
- seq_printf(m, "vendor_id : IBM/S390n"
- "# processors : %in"
- "bogomips per cpu: %lu.%02lun",
- smp_num_cpus, loops_per_jiffy/(500000/HZ),
- (loops_per_jiffy/(5000/HZ))%100);
- }
- if (cpu_online_map & (1 << n)) {
- cpuinfo = &safe_get_cpu_lowcore(n)->cpu_data;
- seq_printf(m, "processor %li: "
- "version = %02X, "
- "identification = %06X, "
- "machine = %04Xn",
- n, cpuinfo->cpu_id.version,
- cpuinfo->cpu_id.ident,
- cpuinfo->cpu_id.machine);
- }
- return 0;
- }
- static void *c_start(struct seq_file *m, loff_t *pos)
- {
- return *pos <= NR_CPUS ? (void *)((unsigned long) *pos + 1) : NULL;
- }
- static void *c_next(struct seq_file *m, void *v, loff_t *pos)
- {
- ++*pos;
- return c_start(m, pos);
- }
- static void c_stop(struct seq_file *m, void *v)
- {
- }
- struct seq_operations cpuinfo_op = {
- start: c_start,
- next: c_next,
- stop: c_stop,
- show: show_cpuinfo,
- };