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 (64 bit mode)n" :
  278.        "We are running native (64 bit mode)n");
  279.         ROOT_DEV = to_kdev_t(0x0100);
  280.         memory_start = (unsigned long) &_end;    /* fixit if use $CODELO etc*/
  281. memory_end = memory_size & ~0x200000UL;  /* detected in head.s */
  282.         init_mm.start_code = PAGE_OFFSET;
  283.         init_mm.end_code = (unsigned long) &_etext;
  284.         init_mm.end_data = (unsigned long) &_edata;
  285.         init_mm.brk = (unsigned long) &_end;
  286. code_resource.start = (unsigned long) &_text;
  287. code_resource.end = (unsigned long) &_etext - 1;
  288. data_resource.start = (unsigned long) &_etext;
  289. data_resource.end = (unsigned long) &_edata - 1;
  290.         /* Save unparsed command line copy for /proc/cmdline */
  291.         memcpy(saved_command_line, COMMAND_LINE, COMMAND_LINE_SIZE);
  292.         saved_command_line[COMMAND_LINE_SIZE-1] = '';
  293.         for (;;) {
  294.                 /*
  295.                  * "mem=XXX[kKmM]" sets memsize 
  296.                  */
  297.                 if (c == ' ' && strncmp(from, "mem=", 4) == 0) {
  298.                         memory_end = simple_strtoul(from+4, &from, 0);
  299.                         if ( *from == 'K' || *from == 'k' ) {
  300.                                 memory_end = memory_end << 10;
  301.                                 from++;
  302.                         } else if ( *from == 'M' || *from == 'm' ) {
  303.                                 memory_end = memory_end << 20;
  304.                                 from++;
  305.                         }
  306.                 }
  307.                 /*
  308.                  * "ipldelay=XXX[sm]" sets ipl delay in seconds or minutes
  309.                  */
  310.                 if (c == ' ' && strncmp(from, "ipldelay=", 9) == 0) {
  311.                         delay = simple_strtoul(from+9, &from, 0);
  312. if (*from == 's' || *from == 'S') {
  313. delay = delay*1000000;
  314. from++;
  315. } else if (*from == 'm' || *from == 'M') {
  316. delay = delay*60*1000000;
  317. from++;
  318. }
  319. /* now wait for the requested amount of time */
  320. udelay(delay);
  321.                 }
  322.                 cn = *(from++);
  323.                 if (!cn)
  324.                         break;
  325.                 if (cn == 'n')
  326.                         cn = ' ';  /* replace newlines with space */
  327. if (cn == 0x0d)
  328. cn = ' ';  /* replace 0x0d with space */
  329.                 if (cn == ' ' && c == ' ')
  330.                         continue;  /* remove additional spaces */
  331.                 c = cn;
  332.                 if (to - command_line >= COMMAND_LINE_SIZE)
  333.                         break;
  334.                 *(to++) = c;
  335.         }
  336.         if (c == ' ' && to > command_line) to--;
  337.         *to = '';
  338.         *cmdline_p = command_line;
  339. /*
  340.  * partially used pages are not usable - thus
  341.  * we are rounding upwards:
  342.  */
  343. start_pfn = (__pa(&_end) + PAGE_SIZE - 1) >> PAGE_SHIFT;
  344. end_pfn = memory_end >> PAGE_SHIFT;
  345. /*
  346.  * Initialize the boot-time allocator
  347.  */
  348. bootmap_size = init_bootmem(start_pfn, end_pfn);
  349. /*
  350.  * Register RAM areas with the bootmem allocator.
  351.  */
  352. for (i = 0; i < 16 && memory_chunk[i].size > 0; i++) {
  353. unsigned long start_chunk, end_chunk;
  354. if (memory_chunk[i].type != CHUNK_READ_WRITE)
  355. continue;
  356. start_chunk = (memory_chunk[i].addr + PAGE_SIZE - 1);
  357. start_chunk >>= PAGE_SHIFT;
  358. end_chunk = (memory_chunk[i].addr + memory_chunk[i].size);
  359. end_chunk >>= PAGE_SHIFT;
  360. if (start_chunk < start_pfn)
  361. start_chunk = start_pfn;
  362. if (end_chunk > end_pfn)
  363. end_chunk = end_pfn;
  364. if (start_chunk < end_chunk)
  365. free_bootmem(start_chunk << PAGE_SHIFT,
  366.      (end_chunk - start_chunk) << PAGE_SHIFT);
  367. }
  368.         /*
  369.          * Reserve the bootmem bitmap itself as well. We do this in two
  370.          * steps (first step was init_bootmem()) because this catches
  371.          * the (very unlikely) case of us accidentally initializing the
  372.          * bootmem allocator with an invalid RAM area.
  373.          */
  374.         reserve_bootmem(start_pfn << PAGE_SHIFT, bootmap_size);
  375. #ifdef CONFIG_BLK_DEV_INITRD
  376.         if (INITRD_START) {
  377. if (INITRD_START + INITRD_SIZE <= memory_end) {
  378. reserve_bootmem(INITRD_START, INITRD_SIZE);
  379. initrd_start = INITRD_START;
  380. initrd_end = initrd_start + INITRD_SIZE;
  381. } else {
  382.                         printk("initrd extends beyond end of memory "
  383.                                "(0x%08lx > 0x%08lx)ndisabling initrdn",
  384.                                initrd_start + INITRD_SIZE, memory_end);
  385.                         initrd_start = initrd_end = 0;
  386. }
  387.         }
  388. #endif
  389.         /*
  390.          * Setup lowcore for boot cpu
  391.          */
  392. lowcore = (struct _lowcore *) 
  393. __alloc_bootmem(2*PAGE_SIZE, 2*PAGE_SIZE, 0);
  394. memset(lowcore, 0, 2*PAGE_SIZE);
  395. lowcore->restart_psw.mask = _RESTART_PSW_MASK;
  396. lowcore->restart_psw.addr = (addr_t) &restart_int_handler;
  397. lowcore->external_new_psw.mask = _EXT_PSW_MASK;
  398. lowcore->external_new_psw.addr = (addr_t) &ext_int_handler;
  399. lowcore->svc_new_psw.mask = _SVC_PSW_MASK;
  400. lowcore->svc_new_psw.addr = (addr_t) &system_call;
  401. lowcore->program_new_psw.mask = _PGM_PSW_MASK;
  402. lowcore->program_new_psw.addr = (addr_t) &pgm_check_handler;
  403. lowcore->mcck_new_psw.mask = _MCCK_PSW_MASK;
  404. lowcore->mcck_new_psw.addr = (addr_t) &mcck_int_handler;
  405. lowcore->io_new_psw.mask = _IO_PSW_MASK;
  406. lowcore->io_new_psw.addr = (addr_t) &io_int_handler;
  407. lowcore->ipl_device = S390_lowcore.ipl_device;
  408. lowcore->kernel_stack = ((__u64) &init_task_union) + 16384;
  409. lowcore->async_stack = (__u64)
  410. __alloc_bootmem(4*PAGE_SIZE, 4*PAGE_SIZE, 0) + 16384;
  411. lowcore->jiffy_timer = -1LL;
  412. if (MACHINE_HAS_DIAG44)
  413. lowcore->diag44_opcode = 0x83000044;
  414. else
  415. lowcore->diag44_opcode = 0x07000700;
  416. set_prefix((__u32)(__u64) lowcore);
  417.         cpu_init();
  418.         boot_cpu_addr = S390_lowcore.cpu_data.cpu_addr;
  419.         __cpu_logical_map[0] = boot_cpu_addr;
  420. /*
  421.  * Create kernel page tables and switch to virtual addressing.
  422.  */
  423.         paging_init();
  424. res = alloc_bootmem_low(sizeof(struct resource));
  425. res->start = 0;
  426. res->end = memory_end;
  427. res->flags = IORESOURCE_MEM | IORESOURCE_BUSY;
  428. request_resource(&iomem_resource, res);
  429. request_resource(res, &code_resource);
  430. request_resource(res, &data_resource);
  431.         /* Setup default console */
  432. conmode_default();
  433. }
  434. void print_cpu_info(struct cpuinfo_S390 *cpuinfo)
  435. {
  436.    printk("cpu %d "
  437. #ifdef CONFIG_SMP
  438.            "phys_idx=%d "
  439. #endif
  440.            "vers=%02X ident=%06X machine=%04X unused=%04Xn",
  441.            cpuinfo->cpu_nr,
  442. #ifdef CONFIG_SMP
  443.            cpuinfo->cpu_addr,
  444. #endif
  445.            cpuinfo->cpu_id.version,
  446.            cpuinfo->cpu_id.ident,
  447.            cpuinfo->cpu_id.machine,
  448.            cpuinfo->cpu_id.unused);
  449. }
  450. /*
  451.  * show_cpuinfo - Get information on one CPU for use by procfs.
  452.  */
  453. static int show_cpuinfo(struct seq_file *m, void *v)
  454. {
  455.         struct cpuinfo_S390 *cpuinfo;
  456. unsigned long n = (unsigned long) v - 1;
  457. if (!n) {
  458. seq_printf(m, "vendor_id       : IBM/S390n"
  459. "# processors    : %in"
  460. "bogomips per cpu: %lu.%02lun",
  461. smp_num_cpus, loops_per_jiffy/(500000/HZ),
  462. (loops_per_jiffy/(5000/HZ))%100);
  463. }
  464. if (cpu_online_map & (1 << n)) {
  465. cpuinfo = &safe_get_cpu_lowcore(n)->cpu_data;
  466. seq_printf(m, "processor %li: "
  467. "version = %02X,  "
  468. "identification = %06X,  "
  469. "machine = %04Xn",
  470. n, cpuinfo->cpu_id.version,
  471. cpuinfo->cpu_id.ident,
  472. cpuinfo->cpu_id.machine);
  473. }
  474.         return 0;
  475. }
  476. static void *c_start(struct seq_file *m, loff_t *pos)
  477. {
  478. return *pos <= NR_CPUS ? (void *)((unsigned long) *pos + 1) : NULL;
  479. }
  480. static void *c_next(struct seq_file *m, void *v, loff_t *pos)
  481. {
  482. ++*pos;
  483. return c_start(m, pos);
  484. }
  485. static void c_stop(struct seq_file *m, void *v)
  486. {
  487. }
  488. struct seq_operations cpuinfo_op = {
  489. start: c_start,
  490. next: c_next,
  491. stop: c_stop,
  492. show: show_cpuinfo,
  493. };