setup.c 24.3 KB
Newer Older
Linus Torvalds's avatar
Linus Torvalds committed
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
/*
 *  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/module.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/tty.h>
#include <linux/ioport.h>
#include <linux/delay.h>
#include <linux/init.h>
#include <linux/initrd.h>
#include <linux/bootmem.h>
#include <linux/root_dev.h>
#include <linux/console.h>
#include <linux/seq_file.h>
#include <linux/kernel_stat.h>
37
#include <linux/device.h>
38
#include <linux/notifier.h>
39
#include <linux/pfn.h>
Hongjie Yang's avatar
Hongjie Yang committed
40
#include <linux/ctype.h>
41
#include <linux/reboot.h>
42
#include <linux/topology.h>
Linus Torvalds's avatar
Linus Torvalds committed
43

Michael Holzheu's avatar
Michael Holzheu committed
44
#include <asm/ipl.h>
Linus Torvalds's avatar
Linus Torvalds committed
45
46
47
48
49
50
51
#include <asm/uaccess.h>
#include <asm/system.h>
#include <asm/smp.h>
#include <asm/mmu_context.h>
#include <asm/cpcmd.h>
#include <asm/lowcore.h>
#include <asm/irq.h>
52
53
#include <asm/page.h>
#include <asm/ptrace.h>
54
#include <asm/sections.h>
Hongjie Yang's avatar
Hongjie Yang committed
55
#include <asm/ebcdic.h>
Gerald Schaefer's avatar
Gerald Schaefer committed
56
57
58
59
60
61
62
#include <asm/compat.h>

long psw_kernel_bits	= (PSW_BASE_BITS | PSW_MASK_DAT | PSW_ASC_PRIMARY |
			   PSW_MASK_MCHECK | PSW_DEFAULT_KEY);
long psw_user_bits	= (PSW_BASE_BITS | PSW_MASK_DAT | PSW_ASC_HOME |
			   PSW_MASK_IO | PSW_MASK_EXT | PSW_MASK_MCHECK |
			   PSW_MASK_PSTATE | PSW_DEFAULT_KEY);
Linus Torvalds's avatar
Linus Torvalds committed
63

64
65
66
67
/*
 * User copy operations.
 */
struct uaccess_ops uaccess;
68
EXPORT_SYMBOL(uaccess);
69

Linus Torvalds's avatar
Linus Torvalds committed
70
71
72
73
74
75
76
/*
 * Machine setup..
 */
unsigned int console_mode = 0;
unsigned int console_devno = -1;
unsigned int console_irq = -1;
unsigned long machine_flags = 0;
77
78
unsigned long elf_hwcap = 0;
char elf_platform[ELF_PLATFORM_SIZE];
79

80
struct mem_chunk __meminitdata memory_chunk[MEMORY_CHUNKS];
Linus Torvalds's avatar
Linus Torvalds committed
81
volatile int __cpu_logical_map[NR_CPUS]; /* logical cpu to cpu address */
82
static unsigned long __initdata memory_end;
Linus Torvalds's avatar
Linus Torvalds committed
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104

/*
 * 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 struct resource code_resource = {
	.name  = "Kernel code",
	.flags = IORESOURCE_BUSY | IORESOURCE_MEM,
};

static struct resource data_resource = {
	.name = "Kernel data",
	.flags = IORESOURCE_BUSY | IORESOURCE_MEM,
};

/*
 * cpu_init() initializes state that is per-CPU.
 */
105
void __cpuinit cpu_init(void)
Linus Torvalds's avatar
Linus Torvalds committed
106
107
108
109
110
111
{
        int addr = hard_smp_processor_id();

        /*
         * Store processor id in lowcore (used e.g. in timer_interrupt)
         */
112
	get_cpu_id(&S390_lowcore.cpu_data.cpu_id);
Linus Torvalds's avatar
Linus Torvalds committed
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
        S390_lowcore.cpu_data.cpu_addr = addr;

        /*
         * Force FPU initialization:
         */
        clear_thread_flag(TIF_USEDFPU);
        clear_used_math();

	atomic_inc(&init_mm.mm_count);
	current->active_mm = &init_mm;
        if (current->mm)
                BUG();
        enter_lazy_tlb(&init_mm, current);
}

/*
 * 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_devno = vdev;
		console_irq = -1;
	}
	return 1;
}

__setup("condev=", condev_setup);

static int __init conmode_setup(char *str)
{
148
#if defined(CONFIG_SCLP_CONSOLE) || defined(CONFIG_SCLP_VT220_CONSOLE)
Linus Torvalds's avatar
Linus Torvalds committed
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
	if (strncmp(str, "hwc", 4) == 0 || strncmp(str, "sclp", 5) == 0)
                SET_CONSOLE_SCLP;
#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) {
171
		cpcmd("QUERY CONSOLE", query_buffer, 1024, NULL);
Linus Torvalds's avatar
Linus Torvalds committed
172
173
174
		console_devno = simple_strtoul(query_buffer + 5, NULL, 16);
		ptr = strstr(query_buffer, "SUBCHANNEL =");
		console_irq = simple_strtoul(ptr + 13, NULL, 16);
175
		cpcmd("QUERY TERM", query_buffer, 1024, NULL);
Linus Torvalds's avatar
Linus Torvalds committed
176
177
178
179
180
181
182
183
		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).
		 */
184
		cpcmd("TERM CONMODE 3215", NULL, 0, NULL);
Linus Torvalds's avatar
Linus Torvalds committed
185
		if (ptr == NULL) {
186
#if defined(CONFIG_SCLP_CONSOLE) || defined(CONFIG_SCLP_VT220_CONSOLE)
Linus Torvalds's avatar
Linus Torvalds committed
187
188
189
190
191
192
193
194
195
			SET_CONSOLE_SCLP;
#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;
196
#elif defined(CONFIG_SCLP_CONSOLE) || defined(CONFIG_SCLP_VT220_CONSOLE)
Linus Torvalds's avatar
Linus Torvalds committed
197
198
199
200
201
202
203
			SET_CONSOLE_SCLP;
#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;
204
#elif defined(CONFIG_SCLP_CONSOLE) || defined(CONFIG_SCLP_VT220_CONSOLE)
Linus Torvalds's avatar
Linus Torvalds committed
205
206
207
208
209
210
211
212
213
214
			SET_CONSOLE_SCLP;
#endif
		}
        } else if (MACHINE_IS_P390) {
#if defined(CONFIG_TN3215_CONSOLE)
		SET_CONSOLE_3215;
#elif defined(CONFIG_TN3270_CONSOLE)
		SET_CONSOLE_3270;
#endif
	} else {
215
#if defined(CONFIG_SCLP_CONSOLE) || defined(CONFIG_SCLP_VT220_CONSOLE)
Linus Torvalds's avatar
Linus Torvalds committed
216
217
218
219
220
		SET_CONSOLE_SCLP;
#endif
	}
}

Michael Holzheu's avatar
Michael Holzheu committed
221
222
223
224
225
226
227
228
229
230
231
232
233
#if defined(CONFIG_ZFCPDUMP) || defined(CONFIG_ZFCPDUMP_MODULE)
static void __init setup_zfcpdump(unsigned int console_devno)
{
	static char str[64];

	if (ipl_info.type != IPL_TYPE_FCP_DUMP)
		return;
	if (console_devno != -1)
		sprintf(str, "cio_ignore=all,!0.0.%04x,!0.0.%04x",
			ipl_info.data.fcp.dev_id.devno, console_devno);
	else
		sprintf(str, "cio_ignore=all,!0.0.%04x",
			ipl_info.data.fcp.dev_id.devno);
234
	strcat(COMMAND_LINE, " ");
Michael Holzheu's avatar
Michael Holzheu committed
235
236
237
238
239
240
241
	strcat(COMMAND_LINE, str);
	console_loglevel = 2;
}
#else
static inline void setup_zfcpdump(unsigned int console_devno) {}
#endif /* CONFIG_ZFCPDUMP */

Linus Torvalds's avatar
Linus Torvalds committed
242
243
244
245
246
247
248
 /*
 * Reboot, halt and power_off stubs. They just call _machine_restart,
 * _machine_halt or _machine_power_off. 
 */

void machine_restart(char *command)
{
249
	if ((!in_interrupt() && !in_atomic()) || oops_in_progress)
250
251
252
253
254
		/*
		 * Only unblank the console if we are called in enabled
		 * context or a bust_spinlocks cleared the way for us.
		 */
		console_unblank();
Linus Torvalds's avatar
Linus Torvalds committed
255
256
257
258
259
	_machine_restart(command);
}

void machine_halt(void)
{
260
261
262
263
264
265
	if (!in_interrupt() || oops_in_progress)
		/*
		 * Only unblank the console if we are called in enabled
		 * context or a bust_spinlocks cleared the way for us.
		 */
		console_unblank();
Linus Torvalds's avatar
Linus Torvalds committed
266
267
268
269
270
	_machine_halt();
}

void machine_power_off(void)
{
271
272
273
274
275
276
	if (!in_interrupt() || oops_in_progress)
		/*
		 * Only unblank the console if we are called in enabled
		 * context or a bust_spinlocks cleared the way for us.
		 */
		console_unblank();
Linus Torvalds's avatar
Linus Torvalds committed
277
278
279
	_machine_power_off();
}

280
281
282
283
284
/*
 * Dummy power off function.
 */
void (*pm_power_off)(void) = machine_power_off;

285
286
287
288
289
290
291
292
293
294
295
static int __init early_parse_mem(char *p)
{
	memory_end = memparse(p, &p);
	return 0;
}
early_param("mem", early_parse_mem);

/*
 * "ipldelay=XXX[sm]" sets ipl delay in seconds or minutes
 */
static int __init early_parse_ipldelay(char *p)
296
297
{
	unsigned long delay = 0;
Linus Torvalds's avatar
Linus Torvalds committed
298

299
	delay = simple_strtoul(p, &p, 0);
Linus Torvalds's avatar
Linus Torvalds committed
300

301
302
303
304
305
306
307
308
	switch (*p) {
	case 's':
	case 'S':
		delay *= 1000000;
		break;
	case 'm':
	case 'M':
		delay *= 60 * 1000000;
309
	}
310
311
312
313
314

	/* now wait for the requested amount of time */
	udelay(delay);

	return 0;
315
}
316
early_param("ipldelay", early_parse_ipldelay);
317

Gerald Schaefer's avatar
Gerald Schaefer committed
318
#ifdef CONFIG_S390_SWITCH_AMODE
319
320
321
#ifdef CONFIG_PGSTE
unsigned int switch_amode = 1;
#else
Gerald Schaefer's avatar
Gerald Schaefer committed
322
unsigned int switch_amode = 0;
323
#endif
Gerald Schaefer's avatar
Gerald Schaefer committed
324
325
EXPORT_SYMBOL_GPL(switch_amode);

326
327
static void set_amode_and_uaccess(unsigned long user_amode,
				  unsigned long user32_amode)
Gerald Schaefer's avatar
Gerald Schaefer committed
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
{
	psw_user_bits = PSW_BASE_BITS | PSW_MASK_DAT | user_amode |
			PSW_MASK_IO | PSW_MASK_EXT | PSW_MASK_MCHECK |
			PSW_MASK_PSTATE | PSW_DEFAULT_KEY;
#ifdef CONFIG_COMPAT
	psw_user32_bits = PSW_BASE32_BITS | PSW_MASK_DAT | user_amode |
			  PSW_MASK_IO | PSW_MASK_EXT | PSW_MASK_MCHECK |
			  PSW_MASK_PSTATE | PSW_DEFAULT_KEY;
	psw32_user_bits = PSW32_BASE_BITS | PSW32_MASK_DAT | user32_amode |
			  PSW32_MASK_IO | PSW32_MASK_EXT | PSW32_MASK_MCHECK |
			  PSW32_MASK_PSTATE;
#endif
	psw_kernel_bits = PSW_BASE_BITS | PSW_MASK_DAT | PSW_ASC_HOME |
			  PSW_MASK_MCHECK | PSW_DEFAULT_KEY;

	if (MACHINE_HAS_MVCOS) {
		printk("mvcos available.\n");
		memcpy(&uaccess, &uaccess_mvcos_switch, sizeof(uaccess));
	} else {
		printk("mvcos not available.\n");
		memcpy(&uaccess, &uaccess_pt, sizeof(uaccess));
	}
}

/*
 * Switch kernel/user addressing modes?
 */
static int __init early_parse_switch_amode(char *p)
{
	switch_amode = 1;
	return 0;
}
early_param("switch_amode", early_parse_switch_amode);

#else /* CONFIG_S390_SWITCH_AMODE */
static inline void set_amode_and_uaccess(unsigned long user_amode,
					 unsigned long user32_amode)
{
}
#endif /* CONFIG_S390_SWITCH_AMODE */

#ifdef CONFIG_S390_EXEC_PROTECT
unsigned int s390_noexec = 0;
EXPORT_SYMBOL_GPL(s390_noexec);

/*
 * Enable execute protection?
 */
static int __init early_parse_noexec(char *p)
{
	if (!strncmp(p, "off", 3))
		return 0;
	switch_amode = 1;
	s390_noexec = 1;
	return 0;
}
early_param("noexec", early_parse_noexec);
#endif /* CONFIG_S390_EXEC_PROTECT */

static void setup_addressing_mode(void)
{
	if (s390_noexec) {
		printk("S390 execute protection active, ");
		set_amode_and_uaccess(PSW_ASC_SECONDARY, PSW32_ASC_SECONDARY);
392
	} else if (switch_amode) {
Gerald Schaefer's avatar
Gerald Schaefer committed
393
394
395
		printk("S390 address spaces switched, ");
		set_amode_and_uaccess(PSW_ASC_PRIMARY, PSW32_ASC_PRIMARY);
	}
396
397
398
399
#ifdef CONFIG_TRACE_IRQFLAGS
	sysc_restore_trace_psw.mask = psw_kernel_bits & ~PSW_MASK_MCHECK;
	io_restore_trace_psw.mask = psw_kernel_bits & ~PSW_MASK_MCHECK;
#endif
Gerald Schaefer's avatar
Gerald Schaefer committed
400
401
}

402
403
404
405
406
407
408
409
410
411
412
413
414
static void __init
setup_lowcore(void)
{
	struct _lowcore *lc;
	int lc_pages;

	/*
	 * Setup lowcore for boot cpu
	 */
	lc_pages = sizeof(void *) == 8 ? 2 : 1;
	lc = (struct _lowcore *)
		__alloc_bootmem(lc_pages * PAGE_SIZE, lc_pages * PAGE_SIZE, 0);
	memset(lc, 0, lc_pages * PAGE_SIZE);
415
	lc->restart_psw.mask = PSW_BASE_BITS | PSW_DEFAULT_KEY;
416
417
	lc->restart_psw.addr =
		PSW_ADDR_AMODE | (unsigned long) restart_int_handler;
Gerald Schaefer's avatar
Gerald Schaefer committed
418
419
420
	if (switch_amode)
		lc->restart_psw.mask |= PSW_ASC_HOME;
	lc->external_new_psw.mask = psw_kernel_bits;
421
422
	lc->external_new_psw.addr =
		PSW_ADDR_AMODE | (unsigned long) ext_int_handler;
Gerald Schaefer's avatar
Gerald Schaefer committed
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;
Gerald Schaefer's avatar
Gerald Schaefer committed
425
	lc->program_new_psw.mask = psw_kernel_bits;
426
427
	lc->program_new_psw.addr =
		PSW_ADDR_AMODE | (unsigned long)pgm_check_handler;
428
	lc->mcck_new_psw.mask =
Gerald Schaefer's avatar
Gerald Schaefer committed
429
		psw_kernel_bits & ~PSW_MASK_MCHECK & ~PSW_MASK_DAT;
430
431
	lc->mcck_new_psw.addr =
		PSW_ADDR_AMODE | (unsigned long) mcck_int_handler;
Gerald Schaefer's avatar
Gerald Schaefer committed
432
	lc->io_new_psw.mask = psw_kernel_bits;
433
434
	lc->io_new_psw.addr = PSW_ADDR_AMODE | (unsigned long) io_int_handler;
	lc->ipl_device = S390_lowcore.ipl_device;
435
	lc->clock_comparator = -1ULL;
436
437
438
439
440
441
442
	lc->kernel_stack = ((unsigned long) &init_thread_union) + THREAD_SIZE;
	lc->async_stack = (unsigned long)
		__alloc_bootmem(ASYNC_SIZE, ASYNC_SIZE, 0) + ASYNC_SIZE;
	lc->panic_stack = (unsigned long)
		__alloc_bootmem(PAGE_SIZE, PAGE_SIZE, 0) + PAGE_SIZE;
	lc->current_task = (unsigned long) init_thread_union.thread_info.task;
	lc->thread_info = (unsigned long) &init_thread_union;
443
#ifndef CONFIG_64BIT
444
445
446
447
	if (MACHINE_HAS_IEEE) {
		lc->extended_save_area_addr = (__u32)
			__alloc_bootmem(PAGE_SIZE, PAGE_SIZE, 0);
		/* enable extended save area */
448
		__ctl_set_bit(14, 29);
449
450
	}
#endif
451
452
453
454
455
456
	set_prefix((u32)(unsigned long) lc);
}

static void __init
setup_resources(void)
{
Hongjie Yang's avatar
Hongjie Yang committed
457
	struct resource *res, *sub_res;
458
459
	int i;

460
461
462
463
464
	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;

465
466
467
	for (i = 0; i < MEMORY_CHUNKS; i++) {
		if (!memory_chunk[i].size)
			continue;
468
469
470
471
472
473
474
475
476
477
478
479
480
481
482
483
		res = alloc_bootmem_low(sizeof(struct resource));
		res->flags = IORESOURCE_BUSY | IORESOURCE_MEM;
		switch (memory_chunk[i].type) {
		case CHUNK_READ_WRITE:
			res->name = "System RAM";
			break;
		case CHUNK_READ_ONLY:
			res->name = "System ROM";
			res->flags |= IORESOURCE_READONLY;
			break;
		default:
			res->name = "reserved";
		}
		res->start = memory_chunk[i].addr;
		res->end = memory_chunk[i].addr +  memory_chunk[i].size - 1;
		request_resource(&iomem_resource, res);
Hongjie Yang's avatar
Hongjie Yang committed
484
485
486
487
488
489
490
491
492
493
494
495
496
497
498
499
500
501
502
503
504
505
506
507
508
509
510
511
512
513
514
515

		if (code_resource.start >= res->start  &&
			code_resource.start <= res->end &&
			code_resource.end > res->end) {
			sub_res = alloc_bootmem_low(sizeof(struct resource));
			memcpy(sub_res, &code_resource,
				sizeof(struct resource));
			sub_res->end = res->end;
			code_resource.start = res->end + 1;
			request_resource(res, sub_res);
		}

		if (code_resource.start >= res->start &&
			code_resource.start <= res->end &&
			code_resource.end <= res->end)
			request_resource(res, &code_resource);

		if (data_resource.start >= res->start &&
			data_resource.start <= res->end &&
			data_resource.end > res->end) {
			sub_res = alloc_bootmem_low(sizeof(struct resource));
			memcpy(sub_res, &data_resource,
				sizeof(struct resource));
			sub_res->end = res->end;
			data_resource.start = res->end + 1;
			request_resource(res, sub_res);
		}

		if (data_resource.start >= res->start &&
			data_resource.start <= res->end &&
			data_resource.end <= res->end)
			request_resource(res, &data_resource);
516
517
518
	}
}

Michael Holzheu's avatar
Michael Holzheu committed
519
520
521
unsigned long real_memory_size;
EXPORT_SYMBOL_GPL(real_memory_size);

522
523
static void __init setup_memory_end(void)
{
Michael Holzheu's avatar
Michael Holzheu committed
524
	unsigned long memory_size;
525
	unsigned long max_mem;
526
527
	int i;

Michael Holzheu's avatar
Michael Holzheu committed
528
529
530
531
532
#if defined(CONFIG_ZFCPDUMP) || defined(CONFIG_ZFCPDUMP_MODULE)
	if (ipl_info.type == IPL_TYPE_FCP_DUMP)
		memory_end = ZFCPDUMP_HSA_SIZE;
#endif
	memory_size = 0;
533
534
	memory_end &= PAGE_MASK;

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
540
541
542
543
544
545
546
547
548
549
550
551
552
553
554
555
556
557
558
	/*
	 * Make sure all chunks are MAX_ORDER aligned so we don't need the
	 * extra checks that HOLES_IN_ZONE would require.
	 */
	for (i = 0; i < MEMORY_CHUNKS; i++) {
		unsigned long start, end;
		struct mem_chunk *chunk;
		unsigned long align;

		chunk = &memory_chunk[i];
		align = 1UL << (MAX_ORDER + PAGE_SHIFT - 1);
		start = (chunk->addr + align - 1) & ~(align - 1);
		end = (chunk->addr + chunk->size) & ~(align - 1);
		if (start >= end)
			memset(chunk, 0, sizeof(*chunk));
		else {
			chunk->addr = start;
			chunk->size = end - start;
		}
	}

559
560
561
	for (i = 0; i < MEMORY_CHUNKS; i++) {
		struct mem_chunk *chunk = &memory_chunk[i];

Michael Holzheu's avatar
Michael Holzheu committed
562
563
		real_memory_size = max(real_memory_size,
				       chunk->addr + chunk->size);
564
565
566
567
568
569
570
571
572
573
574
575
		if (chunk->addr >= max_mem) {
			memset(chunk, 0, sizeof(*chunk));
			continue;
		}
		if (chunk->addr + chunk->size > max_mem)
			chunk->size = max_mem - chunk->addr;
		memory_size = max(memory_size, chunk->addr + chunk->size);
	}
	if (!memory_end)
		memory_end = memory_size;
}

576
577
578
579
static void __init
setup_memory(void)
{
        unsigned long bootmap_size;
Hongjie Yang's avatar
Hongjie Yang committed
580
	unsigned long start_pfn, end_pfn;
581
	int i;
Linus Torvalds's avatar
Linus Torvalds committed
582
583
584
585
586

	/*
	 * partially used pages are not usable - thus
	 * we are rounding upwards:
	 */
587
588
	start_pfn = PFN_UP(__pa(&_end));
	end_pfn = max_pfn = PFN_DOWN(memory_end);
Linus Torvalds's avatar
Linus Torvalds committed
589

590
591
592
593
594
595
596
597
598
599
600
601
602
603
604
605
606
607
608
609
610
611
612
613
614
615
616
617
618
619
620
621
622
623
#ifdef CONFIG_BLK_DEV_INITRD
	/*
	 * Move the initrd in case the bitmap of the bootmem allocater
	 * would overwrite it.
	 */

	if (INITRD_START && INITRD_SIZE) {
		unsigned long bmap_size;
		unsigned long start;

		bmap_size = bootmem_bootmap_pages(end_pfn - start_pfn + 1);
		bmap_size = PFN_PHYS(bmap_size);

		if (PFN_PHYS(start_pfn) + bmap_size > INITRD_START) {
			start = PFN_PHYS(start_pfn) + bmap_size + PAGE_SIZE;

			if (start + INITRD_SIZE > memory_end) {
				printk("initrd extends beyond end of memory "
				       "(0x%08lx > 0x%08lx)\n"
				       "disabling initrd\n",
				       start + INITRD_SIZE, memory_end);
				INITRD_START = INITRD_SIZE = 0;
			} else {
				printk("Moving initrd (0x%08lx -> 0x%08lx, "
				       "size: %ld)\n",
				       INITRD_START, start, INITRD_SIZE);
				memmove((void *) start, (void *) INITRD_START,
					INITRD_SIZE);
				INITRD_START = start;
			}
		}
	}
#endif

Linus Torvalds's avatar
Linus Torvalds committed
624
	/*
625
	 * Initialize the boot-time allocator
Linus Torvalds's avatar
Linus Torvalds committed
626
627
628
629
630
631
	 */
	bootmap_size = init_bootmem(start_pfn, end_pfn);

	/*
	 * Register RAM areas with the bootmem allocator.
	 */
632

633
	for (i = 0; i < MEMORY_CHUNKS && memory_chunk[i].size > 0; i++) {
634
		unsigned long start_chunk, end_chunk, pfn;
Linus Torvalds's avatar
Linus Torvalds committed
635
636
637

		if (memory_chunk[i].type != CHUNK_READ_WRITE)
			continue;
638
639
640
641
642
643
644
645
646
		start_chunk = PFN_DOWN(memory_chunk[i].addr);
		end_chunk = start_chunk + PFN_DOWN(memory_chunk[i].size) - 1;
		end_chunk = min(end_chunk, end_pfn);
		if (start_chunk >= end_chunk)
			continue;
		add_active_range(0, start_chunk, end_chunk);
		pfn = max(start_chunk, start_pfn);
		for (; pfn <= end_chunk; pfn++)
			page_set_storage_key(PFN_PHYS(pfn), PAGE_DEFAULT_KEY);
Linus Torvalds's avatar
Linus Torvalds committed
647
648
	}

649
650
	psw_set_key(PAGE_DEFAULT_KEY);

651
	free_bootmem_with_active_regions(0, max_pfn);
652

653
654
655
	/*
	 * Reserve memory used for lowcore/command line/kernel image.
	 */
656
	reserve_bootmem(0, (unsigned long)_ehead, BOOTMEM_DEFAULT);
657
	reserve_bootmem((unsigned long)_stext,
658
659
			PFN_PHYS(start_pfn) - (unsigned long)_stext,
			BOOTMEM_DEFAULT);
660
661
662
663
664
665
	/*
	 * 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.
	 */
666
667
	reserve_bootmem(start_pfn << PAGE_SHIFT, bootmap_size,
			BOOTMEM_DEFAULT);
Linus Torvalds's avatar
Linus Torvalds committed
668
669

#ifdef CONFIG_BLK_DEV_INITRD
670
	if (INITRD_START && INITRD_SIZE) {
Linus Torvalds's avatar
Linus Torvalds committed
671
		if (INITRD_START + INITRD_SIZE <= memory_end) {
672
673
			reserve_bootmem(INITRD_START, INITRD_SIZE,
					BOOTMEM_DEFAULT);
Linus Torvalds's avatar
Linus Torvalds committed
674
675
676
			initrd_start = INITRD_START;
			initrd_end = initrd_start + INITRD_SIZE;
		} else {
677
678
679
680
			printk("initrd extends beyond end of memory "
			       "(0x%08lx > 0x%08lx)\ndisabling initrd\n",
			       initrd_start + INITRD_SIZE, memory_end);
			initrd_start = initrd_end = 0;
Linus Torvalds's avatar
Linus Torvalds committed
681
		}
682
	}
Linus Torvalds's avatar
Linus Torvalds committed
683
#endif
684
}
Linus Torvalds's avatar
Linus Torvalds committed
685

686
687
688
689
690
691
692
693
694
static __init unsigned int stfl(void)
{
	asm volatile(
		"	.insn	s,0xb2b10000,0(0)\n" /* stfl */
		"0:\n"
		EX_TABLE(0b,0b));
	return S390_lowcore.stfl_fac_list;
}

Heiko Carstens's avatar
Heiko Carstens committed
695
static int __init __stfle(unsigned long long *list, int doublewords)
696
697
698
699
700
701
702
703
704
{
	typedef struct { unsigned long long _[doublewords]; } addrtype;
	register unsigned long __nr asm("0") = doublewords - 1;

	asm volatile(".insn s,0xb2b00000,%0" /* stfle */
		     : "=m" (*(addrtype *) list), "+d" (__nr) : : "cc");
	return __nr + 1;
}

Heiko Carstens's avatar
Heiko Carstens committed
705
706
707
708
709
710
711
int __init stfle(unsigned long long *list, int doublewords)
{
	if (!(stfl() & (1UL << 24)))
		return -EOPNOTSUPP;
	return __stfle(list, doublewords);
}

712
713
714
715
716
717
718
719
720
721
722
723
724
725
726
727
728
729
730
731
732
733
734
735
736
737
738
739
740
741
742
743
744
745
746
747
748
749
750
751
752
753
754
755
/*
 * Setup hardware capabilities.
 */
static void __init setup_hwcaps(void)
{
	static const int stfl_bits[6] = { 0, 2, 7, 17, 19, 21 };
	struct cpuinfo_S390 *cpuinfo = &S390_lowcore.cpu_data;
	unsigned long long facility_list_extended;
	unsigned int facility_list;
	int i;

	facility_list = stfl();
	/*
	 * The store facility list bits numbers as found in the principles
	 * of operation are numbered with bit 1UL<<31 as number 0 to
	 * bit 1UL<<0 as number 31.
	 *   Bit 0: instructions named N3, "backported" to esa-mode
	 *   Bit 2: z/Architecture mode is active
	 *   Bit 7: the store-facility-list-extended facility is installed
	 *   Bit 17: the message-security assist is installed
	 *   Bit 19: the long-displacement facility is installed
	 *   Bit 21: the extended-immediate facility is installed
	 * These get translated to:
	 *   HWCAP_S390_ESAN3 bit 0, HWCAP_S390_ZARCH bit 1,
	 *   HWCAP_S390_STFLE bit 2, HWCAP_S390_MSA bit 3,
	 *   HWCAP_S390_LDISP bit 4, and HWCAP_S390_EIMM bit 5.
	 */
	for (i = 0; i < 6; i++)
		if (facility_list & (1UL << (31 - stfl_bits[i])))
			elf_hwcap |= 1UL << i;

	/*
	 * Check for additional facilities with store-facility-list-extended.
	 * stfle stores doublewords (8 byte) with bit 1ULL<<63 as bit 0
	 * and 1ULL<<0 as bit 63. Bits 0-31 contain the same information
	 * as stored by stfl, bits 32-xxx contain additional facilities.
	 * How many facility words are stored depends on the number of
	 * doublewords passed to the instruction. The additional facilites
	 * are:
	 *   Bit 43: decimal floating point facility is installed
	 * translated to:
	 *   HWCAP_S390_DFP bit 6.
	 */
	if ((elf_hwcap & (1UL << 2)) &&
Heiko Carstens's avatar
Heiko Carstens committed
756
	    __stfle(&facility_list_extended, 1) > 0) {
757
758
759
760
761
762
763
764
765
766
767
768
769
770
771
772
773
774
775
776
777
778
779
780
781
782
783
784
		if (facility_list_extended & (1ULL << (64 - 43)))
			elf_hwcap |= 1UL << 6;
	}

	switch (cpuinfo->cpu_id.machine) {
	case 0x9672:
#if !defined(CONFIG_64BIT)
	default:	/* Use "g5" as default for 31 bit kernels. */
#endif
		strcpy(elf_platform, "g5");
		break;
	case 0x2064:
	case 0x2066:
#if defined(CONFIG_64BIT)
	default:	/* Use "z900" as default for 64 bit kernels. */
#endif
		strcpy(elf_platform, "z900");
		break;
	case 0x2084:
	case 0x2086:
		strcpy(elf_platform, "z990");
		break;
	case 0x2094:
		strcpy(elf_platform, "z9-109");
		break;
	}
}

785
786
787
788
/*
 * Setup function called from init/main.c just after the banner
 * was printed.
 */
Linus Torvalds's avatar
Linus Torvalds committed
789

790
791
792
void __init
setup_arch(char **cmdline_p)
{
Linus Torvalds's avatar
Linus Torvalds committed
793
        /*
794
         * print what head.S has found out about the machine
Linus Torvalds's avatar
Linus Torvalds committed
795
         */
796
#ifndef CONFIG_64BIT
797
798
799
800
801
802
	printk((MACHINE_IS_VM) ?
	       "We are running under VM (31 bit mode)\n" :
	       "We are running native (31 bit mode)\n");
	printk((MACHINE_HAS_IEEE) ?
	       "This machine has an IEEE fpu\n" :
	       "This machine has no IEEE fpu\n");
803
#else /* CONFIG_64BIT */
804
805
806
	printk((MACHINE_IS_VM) ?
	       "We are running under VM (64 bit mode)\n" :
	       "We are running native (64 bit mode)\n");
807
#endif /* CONFIG_64BIT */
808

809
	/* Save unparsed command line copy for /proc/cmdline */
810
	strlcpy(boot_command_line, COMMAND_LINE, COMMAND_LINE_SIZE);
811
812
813
814

	*cmdline_p = COMMAND_LINE;
	*(*cmdline_p + COMMAND_LINE_SIZE - 1) = '\0';

815
        ROOT_DEV = Root_RAM0;
816
817
818
819
820
821

	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;

822
823
824
825
826
	if (MACHINE_HAS_MVCOS)
		memcpy(&uaccess, &uaccess_mvcos, sizeof(uaccess));
	else
		memcpy(&uaccess, &uaccess_std, sizeof(uaccess));

827
828
	parse_early_param();

829
	setup_ipl();
830
	setup_memory_end();
Gerald Schaefer's avatar
Gerald Schaefer committed
831
	setup_addressing_mode();
832
833
834
835
	setup_memory();
	setup_resources();
	setup_lowcore();

Linus Torvalds's avatar
Linus Torvalds committed
836
837
        cpu_init();
        __cpu_logical_map[0] = S390_lowcore.cpu_data.cpu_addr;
838
	s390_init_cpu_topology();
Linus Torvalds's avatar
Linus Torvalds committed
839

840
841
842
843
844
	/*
	 * Setup capabilities (ELF_HWCAP & ELF_PLATFORM).
	 */
	setup_hwcaps();

Linus Torvalds's avatar
Linus Torvalds committed
845
846
847
848
849
850
851
	/*
	 * Create kernel page tables and switch to virtual addressing.
	 */
        paging_init();

        /* Setup default console */
	conmode_default();
Michael Holzheu's avatar
Michael Holzheu committed
852
853
854

	/* Setup zfcpdump support */
	setup_zfcpdump(console_devno);
Linus Torvalds's avatar
Linus Torvalds committed
855
856
}

857
void __cpuinit print_cpu_info(struct cpuinfo_S390 *cpuinfo)
Linus Torvalds's avatar
Linus Torvalds committed
858
{
859
   printk(KERN_INFO "cpu %d "
Linus Torvalds's avatar
Linus Torvalds committed
860
861
862
863
864
865
866
867
868
869
870
871
872
873
874
875
876
877
878
879
#ifdef CONFIG_SMP
           "phys_idx=%d "
#endif
           "vers=%02X ident=%06X machine=%04X unused=%04X\n",
           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)
{
880
881
882
	static const char *hwcap_str[7] = {
		"esan3", "zarch", "stfle", "msa", "ldisp", "eimm", "dfp"
	};
Linus Torvalds's avatar
Linus Torvalds committed
883
884
        struct cpuinfo_S390 *cpuinfo;
	unsigned long n = (unsigned long) v - 1;
885
	int i;
Linus Torvalds's avatar
Linus Torvalds committed
886

887
	s390_adjust_jiffies();
888
	preempt_disable();
Linus Torvalds's avatar
Linus Torvalds committed
889
890
891
892
893
894
	if (!n) {
		seq_printf(m, "vendor_id       : IBM/S390\n"
			       "# processors    : %i\n"
			       "bogomips per cpu: %lu.%02lu\n",
			       num_online_cpus(), loops_per_jiffy/(500000/HZ),
			       (loops_per_jiffy/(5000/HZ))%100);
895
896
897
898
899
		seq_puts(m, "features\t: ");
		for (i = 0; i < 7; i++)
			if (hwcap_str[i] && (elf_hwcap & (1UL << i)))
				seq_printf(m, "%s ", hwcap_str[i]);
		seq_puts(m, "\n");
Linus Torvalds's avatar
Linus Torvalds committed
900
	}
901

Linus Torvalds's avatar
Linus Torvalds committed
902
903
904
905
906
907
908
909
910
911
912
913
914
915
916
917
918
	if (cpu_online(n)) {
#ifdef CONFIG_SMP
		if (smp_processor_id() == n)
			cpuinfo = &S390_lowcore.cpu_data;
		else
			cpuinfo = &lowcore_ptr[n]->cpu_data;
#else
		cpuinfo = &S390_lowcore.cpu_data;
#endif
		seq_printf(m, "processor %li: "
			       "version = %02X,  "
			       "identification = %06X,  "
			       "machine = %04X\n",
			       n, cpuinfo->cpu_id.version,
			       cpuinfo->cpu_id.ident,
			       cpuinfo->cpu_id.machine);
	}
919
	preempt_enable();
Linus Torvalds's avatar
Linus Torvalds committed
920
921
922
923
924
925
926
927
928
929
930
931
932
933
934
        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)
{
}
935
const struct seq_operations cpuinfo_op = {
Linus Torvalds's avatar
Linus Torvalds committed
936
937
938
939
940
941
	.start	= c_start,
	.next	= c_next,
	.stop	= c_stop,
	.show	= show_cpuinfo,
};