setup.c
上传用户:jlfgdled
上传日期:2013-04-10
资源大小:33168k
文件大小:15k
源码类别:

Linux/Unix编程

开发平台:

Unix_Linux

  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.  * This file handles the architecture-dependent parts of initialization
  14.  */
  15. #include <linux/errno.h>
  16. #include <linux/sched.h>
  17. #include <linux/kernel.h>
  18. #include <linux/mm.h>
  19. #include <linux/stddef.h>
  20. #include <linux/unistd.h>
  21. #include <linux/ptrace.h>
  22. #include <linux/slab.h>
  23. #include <linux/user.h>
  24. #include <linux/a.out.h>
  25. #include <linux/tty.h>
  26. #include <linux/ioport.h>
  27. #include <linux/delay.h>
  28. #include <linux/config.h>
  29. #include <linux/init.h>
  30. #ifdef CONFIG_BLK_DEV_RAM
  31. #include <linux/blk.h>
  32. #endif
  33. #include <linux/bootmem.h>
  34. #include <linux/console.h>
  35. #include <linux/seq_file.h>
  36. #include <asm/uaccess.h>
  37. #include <asm/system.h>
  38. #include <asm/smp.h>
  39. #include <asm/mmu_context.h>
  40. #include <asm/cpcmd.h>
  41. /*
  42.  * Machine setup..
  43.  */
  44. unsigned int console_mode = 0;
  45. unsigned int console_device = -1;
  46. unsigned long memory_size = 0;
  47. unsigned long machine_flags = 0;
  48. struct { unsigned long addr, size, type; } memory_chunk[16] = { { 0 } };
  49. #define CHUNK_READ_WRITE 0
  50. #define CHUNK_READ_ONLY 1
  51. __u16 boot_cpu_addr;
  52. int cpus_initialized = 0;
  53. unsigned long cpu_initialized = 0;
  54. volatile int __cpu_logical_map[NR_CPUS]; /* logical cpu to cpu address */
  55. /*
  56.  * Setup options
  57.  */
  58. extern int _text,_etext, _edata, _end;
  59. /*
  60.  * This is set up by the setup-routine at boot-time
  61.  * for S390 need to find out, what we have to setup
  62.  * using address 0x10400 ...
  63.  */
  64. #include <asm/setup.h>
  65. static char command_line[COMMAND_LINE_SIZE] = { 0, };
  66.        char saved_command_line[COMMAND_LINE_SIZE];
  67. static struct resource code_resource = { "Kernel code", 0x100000, 0 };
  68. static struct resource data_resource = { "Kernel data", 0, 0 };
  69. /*
  70.  * cpu_init() initializes state that is per-CPU.
  71.  */
  72. void __init cpu_init (void)
  73. {
  74.         int nr = smp_processor_id();
  75.         int addr = hard_smp_processor_id();
  76.         if (test_and_set_bit(nr,&cpu_initialized)) {
  77.                 printk("CPU#%d ALREADY INITIALIZED!!!!!!!!!n", nr);
  78.                 for (;;) __sti();
  79.         }
  80.         cpus_initialized++;
  81.         /*
  82.          * Store processor id in lowcore (used e.g. in timer_interrupt)
  83.          */
  84.         asm volatile ("stidp %0": "=m" (S390_lowcore.cpu_data.cpu_id));
  85.         S390_lowcore.cpu_data.cpu_addr = addr;
  86.         S390_lowcore.cpu_data.cpu_nr = nr;
  87.         /*
  88.          * Force FPU initialization:
  89.          */
  90.         current->flags &= ~PF_USEDFPU;
  91.         current->used_math = 0;
  92.         /* Setup active_mm for idle_task  */
  93.         atomic_inc(&init_mm.mm_count);
  94.         current->active_mm = &init_mm;
  95.         if (current->mm)
  96.                 BUG();
  97.         enter_lazy_tlb(&init_mm, current, nr);
  98. }
  99. /*
  100.  * VM halt and poweroff setup routines
  101.  */
  102. char vmhalt_cmd[128] = "";
  103. char vmpoff_cmd[128] = "";
  104. static inline void strncpy_skip_quote(char *dst, char *src, int n)
  105. {
  106.         int sx, dx;
  107.         dx = 0;
  108.         for (sx = 0; src[sx] != 0; sx++) {
  109.                 if (src[sx] == '"') continue;
  110.                 dst[dx++] = src[sx];
  111.                 if (dx >= n) break;
  112.         }
  113. }
  114. static int __init vmhalt_setup(char *str)
  115. {
  116.         strncpy_skip_quote(vmhalt_cmd, str, 127);
  117.         vmhalt_cmd[127] = 0;
  118.         return 1;
  119. }
  120. __setup("vmhalt=", vmhalt_setup);
  121. static int __init vmpoff_setup(char *str)
  122. {
  123.         strncpy_skip_quote(vmpoff_cmd, str, 127);
  124.         vmpoff_cmd[127] = 0;
  125.         return 1;
  126. }
  127. __setup("vmpoff=", vmpoff_setup);
  128. /*
  129.  * condev= and conmode= setup parameter.
  130.  */
  131. static int __init condev_setup(char *str)
  132. {
  133. int vdev;
  134. vdev = simple_strtoul(str, &str, 0);
  135. if (vdev >= 0 && vdev < 65536)
  136. console_device = vdev;
  137. return 1;
  138. }
  139. __setup("condev=", condev_setup);
  140. static int __init conmode_setup(char *str)
  141. {
  142. #if defined(CONFIG_HWC_CONSOLE)
  143. if (strncmp(str, "hwc", 4) == 0)
  144.                 SET_CONSOLE_HWC;
  145. #endif
  146. #if defined(CONFIG_TN3215_CONSOLE)
  147. if (strncmp(str, "3215", 5) == 0)
  148. SET_CONSOLE_3215;
  149. #endif
  150. #if defined(CONFIG_TN3270_CONSOLE)
  151. if (strncmp(str, "3270", 5) == 0)
  152. SET_CONSOLE_3270;
  153. #endif
  154.         return 1;
  155. }
  156. __setup("conmode=", conmode_setup);
  157. static void __init conmode_default(void)
  158. {
  159. char query_buffer[1024];
  160. char *ptr;
  161.         if (MACHINE_IS_VM) {
  162. cpcmd("QUERY TERM", query_buffer, 1024);
  163. ptr = strstr(query_buffer, "CONMODE");
  164. /*
  165.  * Set the conmode to 3215 so that the device recognition 
  166.  * will set the cu_type of the console to 3215. If the
  167.  * conmode is 3270 and we don't set it back then both
  168.  * 3215 and the 3270 driver will try to access the console
  169.  * device (3215 as console and 3270 as normal tty).
  170.  */
  171. cpcmd("TERM CONMODE 3215", NULL, 0);
  172. if (ptr == NULL) {
  173. #if defined(CONFIG_HWC_CONSOLE)
  174. SET_CONSOLE_HWC;
  175. #endif
  176. return;
  177. }
  178. if (strncmp(ptr + 8, "3270", 4) == 0) {
  179. #if defined(CONFIG_TN3270_CONSOLE)
  180. SET_CONSOLE_3270;
  181. #elif defined(CONFIG_TN3215_CONSOLE)
  182. SET_CONSOLE_3215;
  183. #elif defined(CONFIG_HWC_CONSOLE)
  184. SET_CONSOLE_HWC;
  185. #endif
  186. } else if (strncmp(ptr + 8, "3215", 4) == 0) {
  187. #if defined(CONFIG_TN3215_CONSOLE)
  188. SET_CONSOLE_3215;
  189. #elif defined(CONFIG_TN3270_CONSOLE)
  190. SET_CONSOLE_3270;
  191. #elif defined(CONFIG_HWC_CONSOLE)
  192. SET_CONSOLE_HWC;
  193. #endif
  194. }
  195.         } else if (MACHINE_IS_P390) {
  196. #if defined(CONFIG_TN3215_CONSOLE)
  197. SET_CONSOLE_3215;
  198. #elif defined(CONFIG_TN3270_CONSOLE)
  199. SET_CONSOLE_3270;
  200. #endif
  201. } else {
  202. #if defined(CONFIG_HWC_CONSOLE)
  203. SET_CONSOLE_HWC;
  204. #endif
  205. }
  206. }
  207. #ifdef CONFIG_SMP
  208. extern void machine_restart_smp(char *);
  209. extern void machine_halt_smp(void);
  210. extern void machine_power_off_smp(void);
  211. void (*_machine_restart)(char *command) = machine_restart_smp;
  212. void (*_machine_halt)(void) = machine_halt_smp;
  213. void (*_machine_power_off)(void) = machine_power_off_smp;
  214. #else
  215. /*
  216.  * Reboot, halt and power_off routines for non SMP.
  217.  */
  218. static void do_machine_restart_nonsmp(char * __unused)
  219. {
  220. reipl(S390_lowcore.ipl_device);
  221. }
  222. static void do_machine_halt_nonsmp(void)
  223. {
  224.         if (MACHINE_IS_VM && strlen(vmhalt_cmd) > 0)
  225.                 cpcmd(vmhalt_cmd, NULL, 0);
  226.         signal_processor(smp_processor_id(), sigp_stop_and_store_status);
  227. }
  228. static void do_machine_power_off_nonsmp(void)
  229. {
  230.         if (MACHINE_IS_VM && strlen(vmpoff_cmd) > 0)
  231.                 cpcmd(vmpoff_cmd, NULL, 0);
  232.         signal_processor(smp_processor_id(), sigp_stop_and_store_status);
  233. }
  234. void (*_machine_restart)(char *command) = do_machine_restart_nonsmp;
  235. void (*_machine_halt)(void) = do_machine_halt_nonsmp;
  236. void (*_machine_power_off)(void) = do_machine_power_off_nonsmp;
  237. #endif
  238. /*
  239.  * Reboot, halt and power_off stubs. They just call _machine_restart,
  240.  * _machine_halt or _machine_power_off. 
  241.  */
  242. void machine_restart(char *command)
  243. {
  244. _machine_restart(command);
  245. }
  246. void machine_halt(void)
  247. {
  248. _machine_halt();
  249. }
  250. void machine_power_off(void)
  251. {
  252. _machine_power_off();
  253. }
  254. /*
  255.  * Setup function called from init/main.c just after the banner
  256.  * was printed.
  257.  */
  258. extern char _pstart, _pend, _stext;
  259. void __init setup_arch(char **cmdline_p)
  260. {
  261.         unsigned long bootmap_size;
  262.         unsigned long memory_start, memory_end;
  263.         char c = ' ', cn, *to = command_line, *from = COMMAND_LINE;
  264. struct resource *res;
  265. unsigned long start_pfn, end_pfn;
  266.         static unsigned int smptrap=0;
  267.         unsigned long delay = 0;
  268. struct _lowcore *lowcore;
  269. int i;
  270.         if (smptrap)
  271.                 return;
  272.         smptrap=1;
  273.         /*
  274.          * print what head.S has found out about the machine 
  275.          */
  276. printk((MACHINE_IS_VM) ?
  277.        "We are running under VM (31 bit mode)n" :
  278.        "We are running native (31 bit mode)n");
  279. printk((MACHINE_HAS_IEEE) ?
  280.        "This machine has an IEEE fpun" :
  281.        "This machine has no IEEE fpun");
  282.         ROOT_DEV = to_kdev_t(0x0100);
  283.         memory_start = (unsigned long) &_end;    /* fixit if use $CODELO etc*/
  284. memory_end = memory_size & ~0x400000UL;  /* align memory end to 4MB */
  285.         /*
  286.          * We need some free virtual space to be able to do vmalloc.
  287.          * On a machine with 2GB memory we make sure that we have at
  288.          * least 128 MB free space for vmalloc.
  289.          */
  290.         if (memory_end > 1920*1024*1024)
  291.                 memory_end = 1920*1024*1024;
  292.         init_mm.start_code = PAGE_OFFSET;
  293.         init_mm.end_code = (unsigned long) &_etext;
  294.         init_mm.end_data = (unsigned long) &_edata;
  295.         init_mm.brk = (unsigned long) &_end;
  296. code_resource.start = (unsigned long) &_text;
  297. code_resource.end = (unsigned long) &_etext - 1;
  298. data_resource.start = (unsigned long) &_etext;
  299. data_resource.end = (unsigned long) &_edata - 1;
  300.         /* Save unparsed command line copy for /proc/cmdline */
  301.         memcpy(saved_command_line, COMMAND_LINE, COMMAND_LINE_SIZE);
  302.         saved_command_line[COMMAND_LINE_SIZE-1] = '';
  303.         for (;;) {
  304.                 /*
  305.                  * "mem=XXX[kKmM]" sets memsize 
  306.                  */
  307.                 if (c == ' ' && strncmp(from, "mem=", 4) == 0) {
  308.                         memory_end = simple_strtoul(from+4, &from, 0);
  309.                         if ( *from == 'K' || *from == 'k' ) {
  310.                                 memory_end = memory_end << 10;
  311.                                 from++;
  312.                         } else if ( *from == 'M' || *from == 'm' ) {
  313.                                 memory_end = memory_end << 20;
  314.                                 from++;
  315.                         }
  316.                 }
  317.                 /*
  318.                  * "ipldelay=XXX[sm]" sets ipl delay in seconds or minutes
  319.                  */
  320.                 if (c == ' ' && strncmp(from, "ipldelay=", 9) == 0) {
  321.                         delay = simple_strtoul(from+9, &from, 0);
  322. if (*from == 's' || *from == 'S') {
  323. delay = delay*1000000;
  324. from++;
  325. } else if (*from == 'm' || *from == 'M') {
  326. delay = delay*60*1000000;
  327. from++;
  328. }
  329. /* now wait for the requested amount of time */
  330. udelay(delay);
  331.                 }
  332.                 cn = *(from++);
  333.                 if (!cn)
  334.                         break;
  335.                 if (cn == 'n')
  336.                         cn = ' ';  /* replace newlines with space */
  337. if (cn == 0x0d)
  338. cn = ' ';  /* replace 0x0d with space */
  339.                 if (cn == ' ' && c == ' ')
  340.                         continue;  /* remove additional spaces */
  341.                 c = cn;
  342.                 if (to - command_line >= COMMAND_LINE_SIZE)
  343.                         break;
  344.                 *(to++) = c;
  345.         }
  346.         if (c == ' ' && to > command_line) to--;
  347.         *to = '';
  348.         *cmdline_p = command_line;
  349. /*
  350.  * partially used pages are not usable - thus
  351.  * we are rounding upwards:
  352.  */
  353. start_pfn = (__pa(&_end) + PAGE_SIZE - 1) >> PAGE_SHIFT;
  354. end_pfn = memory_end >> PAGE_SHIFT;
  355. /*
  356.  * Initialize the boot-time allocator (with low memory only):
  357.  */
  358. bootmap_size = init_bootmem(start_pfn, end_pfn);
  359. /*
  360.  * Register RAM areas with the bootmem allocator.
  361.  */
  362. for (i = 0; i < 16 && memory_chunk[i].size > 0; i++) {
  363. unsigned long start_chunk, end_chunk;
  364. if (memory_chunk[i].type != CHUNK_READ_WRITE)
  365. continue;
  366. start_chunk = (memory_chunk[i].addr + PAGE_SIZE - 1);
  367. start_chunk >>= PAGE_SHIFT;
  368. end_chunk = (memory_chunk[i].addr + memory_chunk[i].size);
  369. end_chunk >>= PAGE_SHIFT;
  370. if (start_chunk < start_pfn)
  371. start_chunk = start_pfn;
  372. if (end_chunk > end_pfn)
  373. end_chunk = end_pfn;
  374. if (start_chunk < end_chunk)
  375. free_bootmem(start_chunk << PAGE_SHIFT,
  376.      (end_chunk - start_chunk) << PAGE_SHIFT);
  377. }
  378.         /*
  379.          * Reserve the bootmem bitmap itself as well. We do this in two
  380.          * steps (first step was init_bootmem()) because this catches
  381.          * the (very unlikely) case of us accidentally initializing the
  382.          * bootmem allocator with an invalid RAM area.
  383.          */
  384.         reserve_bootmem(start_pfn << PAGE_SHIFT, bootmap_size);
  385. #ifdef CONFIG_BLK_DEV_INITRD
  386.         if (INITRD_START) {
  387. if (INITRD_START + INITRD_SIZE <= memory_end) {
  388. reserve_bootmem(INITRD_START, INITRD_SIZE);
  389. initrd_start = INITRD_START;
  390. initrd_end = initrd_start + INITRD_SIZE;
  391. } else {
  392.                         printk("initrd extends beyond end of memory "
  393.                                "(0x%08lx > 0x%08lx)ndisabling initrdn",
  394.                                initrd_start + INITRD_SIZE, memory_end);
  395.                         initrd_start = initrd_end = 0;
  396. }
  397.         }
  398. #endif
  399.         /*
  400.          * Setup lowcore for boot cpu
  401.          */
  402. lowcore = (struct _lowcore *)
  403. __alloc_bootmem(PAGE_SIZE, PAGE_SIZE, 0);
  404. memset(lowcore, 0, PAGE_SIZE);
  405. lowcore->restart_psw.mask = _RESTART_PSW_MASK;
  406. lowcore->restart_psw.addr = _ADDR_31 + (addr_t) &restart_int_handler;
  407. lowcore->external_new_psw.mask = _EXT_PSW_MASK;
  408. lowcore->external_new_psw.addr = _ADDR_31 + (addr_t) &ext_int_handler;
  409. lowcore->svc_new_psw.mask = _SVC_PSW_MASK;
  410. lowcore->svc_new_psw.addr = _ADDR_31 + (addr_t) &system_call;
  411. lowcore->program_new_psw.mask = _PGM_PSW_MASK;
  412. lowcore->program_new_psw.addr = _ADDR_31 + (addr_t) &pgm_check_handler;
  413.         lowcore->mcck_new_psw.mask = _MCCK_PSW_MASK;
  414. lowcore->mcck_new_psw.addr = _ADDR_31 + (addr_t) &mcck_int_handler;
  415. lowcore->io_new_psw.mask = _IO_PSW_MASK;
  416. lowcore->io_new_psw.addr = _ADDR_31 + (addr_t) &io_int_handler;
  417. lowcore->ipl_device = S390_lowcore.ipl_device;
  418. lowcore->kernel_stack = ((__u32) &init_task_union) + 8192;
  419. lowcore->async_stack = (__u32)
  420. __alloc_bootmem(2*PAGE_SIZE, 2*PAGE_SIZE, 0) + 8192;
  421. lowcore->jiffy_timer = -1LL;
  422. set_prefix((__u32) lowcore);
  423.         cpu_init();
  424.         boot_cpu_addr = S390_lowcore.cpu_data.cpu_addr;
  425.         __cpu_logical_map[0] = boot_cpu_addr;
  426. /*
  427.  * Create kernel page tables and switch to virtual addressing.
  428.  */
  429.         paging_init();
  430. res = alloc_bootmem_low(sizeof(struct resource));
  431. res->start = 0;
  432. res->end = memory_end;
  433. res->flags = IORESOURCE_MEM | IORESOURCE_BUSY;
  434. request_resource(&iomem_resource, res);
  435. request_resource(res, &code_resource);
  436. request_resource(res, &data_resource);
  437.         /* Setup default console */
  438. conmode_default();
  439. }
  440. void print_cpu_info(struct cpuinfo_S390 *cpuinfo)
  441. {
  442.    printk("cpu %d "
  443. #ifdef CONFIG_SMP
  444.            "phys_idx=%d "
  445. #endif
  446.            "vers=%02X ident=%06X machine=%04X unused=%04Xn",
  447.            cpuinfo->cpu_nr,
  448. #ifdef CONFIG_SMP
  449.            cpuinfo->cpu_addr,
  450. #endif
  451.            cpuinfo->cpu_id.version,
  452.            cpuinfo->cpu_id.ident,
  453.            cpuinfo->cpu_id.machine,
  454.            cpuinfo->cpu_id.unused);
  455. }
  456. /*
  457.  * show_cpuinfo - Get information on one CPU for use by procfs.
  458.  */
  459. static int show_cpuinfo(struct seq_file *m, void *v)
  460. {
  461.         struct cpuinfo_S390 *cpuinfo;
  462. unsigned long n = (unsigned long) v - 1;
  463. if (!n) {
  464. seq_printf(m, "vendor_id       : IBM/S390n"
  465.        "# processors    : %in"
  466.        "bogomips per cpu: %lu.%02lun",
  467.        smp_num_cpus, loops_per_jiffy/(500000/HZ),
  468.        (loops_per_jiffy/(5000/HZ))%100);
  469. }
  470. if (cpu_online_map & (1 << n)) {
  471. cpuinfo = &safe_get_cpu_lowcore(n)->cpu_data;
  472. seq_printf(m, "processor %li: "
  473.        "version = %02X,  "
  474.        "identification = %06X,  "
  475.        "machine = %04Xn",
  476.        n, cpuinfo->cpu_id.version,
  477.        cpuinfo->cpu_id.ident,
  478.        cpuinfo->cpu_id.machine);
  479. }
  480.         return 0;
  481. }
  482. static void *c_start(struct seq_file *m, loff_t *pos)
  483. {
  484. return *pos <= NR_CPUS ? (void *)((unsigned long) *pos + 1) : NULL;
  485. }
  486. static void *c_next(struct seq_file *m, void *v, loff_t *pos)
  487. {
  488. ++*pos;
  489. return c_start(m, pos);
  490. }
  491. static void c_stop(struct seq_file *m, void *v)
  492. {
  493. }
  494. struct seq_operations cpuinfo_op = {
  495. start: c_start,
  496. next: c_next,
  497. stop: c_stop,
  498. show: show_cpuinfo,
  499. };