setup.c 19.6 KB
Newer Older
L
Linus Torvalds 已提交
1
/*
2
 *  64-bit pSeries and RS/6000 setup code.
L
Linus Torvalds 已提交
3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18
 *
 *  Copyright (C) 1995  Linus Torvalds
 *  Adapted from 'alpha' version by Gary Thomas
 *  Modified by Cort Dougan (cort@cs.nmt.edu)
 *  Modified by PPC64 Team, IBM Corp
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License
 * as published by the Free Software Foundation; either version
 * 2 of the License, or (at your option) any later version.
 */

/*
 * bootup setup stuff..
 */

19
#include <linux/cpu.h>
L
Linus Torvalds 已提交
20 21 22 23 24 25 26 27 28 29 30 31 32 33 34
#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/user.h>
#include <linux/tty.h>
#include <linux/major.h>
#include <linux/interrupt.h>
#include <linux/reboot.h>
#include <linux/init.h>
#include <linux/ioport.h>
#include <linux/console.h>
#include <linux/pci.h>
35
#include <linux/utsname.h>
L
Linus Torvalds 已提交
36
#include <linux/adb.h>
37
#include <linux/export.h>
L
Linus Torvalds 已提交
38 39 40 41
#include <linux/delay.h>
#include <linux/irq.h>
#include <linux/seq_file.h>
#include <linux/root_dev.h>
42
#include <linux/of.h>
43
#include <linux/of_pci.h>
44
#include <linux/kexec.h>
L
Linus Torvalds 已提交
45 46 47 48 49 50 51 52 53 54 55 56 57 58

#include <asm/mmu.h>
#include <asm/processor.h>
#include <asm/io.h>
#include <asm/pgtable.h>
#include <asm/prom.h>
#include <asm/rtas.h>
#include <asm/pci-bridge.h>
#include <asm/iommu.h>
#include <asm/dma.h>
#include <asm/machdep.h>
#include <asm/irq.h>
#include <asm/time.h>
#include <asm/nvram.h>
59
#include <asm/pmc.h>
60
#include <asm/xics.h>
61
#include <asm/ppc-pci.h>
62 63
#include <asm/i8259.h>
#include <asm/udbg.h>
P
Paul Mackerras 已提交
64
#include <asm/smp.h>
65
#include <asm/firmware.h>
66
#include <asm/eeh.h>
67
#include <asm/reg.h>
68
#include <asm/plpar_wrappers.h>
L
Linus Torvalds 已提交
69

70
#include "pseries.h"
71

72 73
int CMO_PrPSP = -1;
int CMO_SecPSP = -1;
74
unsigned long CMO_PageSize = (ASM_CONST(1) << IOMMU_PAGE_SHIFT_4K);
A
Andrew Morton 已提交
75
EXPORT_SYMBOL(CMO_PageSize);
L
Linus Torvalds 已提交
76 77 78

int fwnmi_active;  /* TRUE if an FWNMI handler is present */

79
static void pSeries_show_cpuinfo(struct seq_file *m)
L
Linus Torvalds 已提交
80 81 82 83 84 85
{
	struct device_node *root;
	const char *model = "";

	root = of_find_node_by_path("/");
	if (root)
86
		model = of_get_property(root, "model", NULL);
L
Linus Torvalds 已提交
87 88 89 90 91 92 93 94 95
	seq_printf(m, "machine\t\t: CHRP %s\n", model);
	of_node_put(root);
}

/* Initialize firmware assisted non-maskable interrupts if
 * the firmware supports this feature.
 */
static void __init fwnmi_init(void)
{
96 97
	unsigned long system_reset_addr, machine_check_addr;

L
Linus Torvalds 已提交
98 99 100
	int ibm_nmi_register = rtas_token("ibm,nmi-register");
	if (ibm_nmi_register == RTAS_UNKNOWN_SERVICE)
		return;
101 102 103 104 105 106 107 108

	/* If the kernel's not linked at zero we point the firmware at low
	 * addresses anyway, and use a trampoline to get to the real code. */
	system_reset_addr  = __pa(system_reset_fwnmi) - PHYSICAL_START;
	machine_check_addr = __pa(machine_check_fwnmi) - PHYSICAL_START;

	if (0 == rtas_call(ibm_nmi_register, 2, 1, NULL, system_reset_addr,
				machine_check_addr))
L
Linus Torvalds 已提交
109 110 111
		fwnmi_active = 1;
}

112
static void pseries_8259_cascade(struct irq_desc *desc)
113
{
114
	struct irq_chip *chip = irq_desc_get_chip(desc);
O
Olaf Hering 已提交
115
	unsigned int cascade_irq = i8259_irq();
116

117
	if (cascade_irq != NO_IRQ)
118
		generic_handle_irq(cascade_irq);
119 120

	chip->irq_eoi(&desc->irq_data);
121 122
}

123
static void __init pseries_setup_i8259_cascade(void)
124 125
{
	struct device_node *np, *old, *found = NULL;
126
	unsigned int cascade;
127 128
	const u32 *addrp;
	unsigned long intack = 0;
129
	int naddr;
130

131
	for_each_node_by_type(np, "interrupt-controller") {
132 133 134 135
		if (of_device_is_compatible(np, "chrp,iic")) {
			found = np;
			break;
		}
136 137
	}

138
	if (found == NULL) {
139
		printk(KERN_DEBUG "pic: no ISA interrupt controller\n");
140 141
		return;
	}
142

143 144
	cascade = irq_of_parse_and_map(found, 0);
	if (cascade == NO_IRQ) {
145
		printk(KERN_ERR "pic: failed to map cascade interrupt");
146 147
		return;
	}
148
	pr_debug("pic: cascade mapped to irq %d\n", cascade);
149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165

	for (old = of_node_get(found); old != NULL ; old = np) {
		np = of_get_parent(old);
		of_node_put(old);
		if (np == NULL)
			break;
		if (strcmp(np->name, "pci") != 0)
			continue;
		addrp = of_get_property(np, "8259-interrupt-acknowledge", NULL);
		if (addrp == NULL)
			continue;
		naddr = of_n_addr_cells(np);
		intack = addrp[naddr-1];
		if (naddr > 1)
			intack |= ((unsigned long)addrp[naddr-2]) << 32;
	}
	if (intack)
166
		printk(KERN_DEBUG "pic: PCI 8259 intack at 0x%016lx\n", intack);
167 168
	i8259_init(found, intack);
	of_node_put(found);
169
	irq_set_chained_handler(cascade, pseries_8259_cascade);
170 171
}

172
static void __init pseries_init_irq(void)
173
{
174
	xics_init();
175
	pseries_setup_i8259_cascade();
176 177
}

178 179 180 181 182 183 184 185 186
static void pseries_lpar_enable_pmcs(void)
{
	unsigned long set, reset;

	set = 1UL << 63;
	reset = 0;
	plpar_hcall_norets(H_PERFMON, set, reset);
}

187
static int pci_dn_reconfig_notifier(struct notifier_block *nb, unsigned long action, void *data)
188
{
189
	struct of_reconfig_data *rd = data;
190 191
	struct device_node *parent, *np = rd->dn;
	struct pci_dn *pdn;
192 193 194
	int err = NOTIFY_OK;

	switch (action) {
195
	case OF_RECONFIG_ATTACH_NODE:
196 197 198 199
		parent = of_get_parent(np);
		pdn = parent ? PCI_DN(parent) : NULL;
		if (pdn) {
			/* Create pdn and EEH device */
200
			pci_add_device_node_info(pdn->phb, np);
201
			eeh_dev_init(PCI_DN(np), pdn->phb);
G
Gavin Shan 已提交
202
		}
203 204

		of_node_put(parent);
205
		break;
206
	case OF_RECONFIG_DETACH_NODE:
207 208 209
		pdn = PCI_DN(np);
		if (pdn)
			list_del(&pdn->list);
210
		break;
211 212 213 214 215 216 217 218 219 220 221
	default:
		err = NOTIFY_DONE;
		break;
	}
	return err;
}

static struct notifier_block pci_dn_reconfig_nb = {
	.notifier_call = pci_dn_reconfig_notifier,
};

222 223
struct kmem_cache *dtl_cache;

224
#ifdef CONFIG_VIRT_CPU_ACCOUNTING_NATIVE
225 226 227 228 229 230 231 232 233 234 235 236 237 238
/*
 * Allocate space for the dispatch trace log for all possible cpus
 * and register the buffers with the hypervisor.  This is used for
 * computing time stolen by the hypervisor.
 */
static int alloc_dispatch_logs(void)
{
	int cpu, ret;
	struct paca_struct *pp;
	struct dtl_entry *dtl;

	if (!firmware_has_feature(FW_FEATURE_SPLPAR))
		return 0;

239
	if (!dtl_cache)
240 241
		return 0;

242 243
	for_each_possible_cpu(cpu) {
		pp = &paca[cpu];
244
		dtl = kmem_cache_alloc(dtl_cache, GFP_KERNEL);
245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264
		if (!dtl) {
			pr_warn("Failed to allocate dispatch trace log for cpu %d\n",
				cpu);
			pr_warn("Stolen time statistics will be unreliable\n");
			break;
		}

		pp->dtl_ridx = 0;
		pp->dispatch_log = dtl;
		pp->dispatch_log_end = dtl + N_DISPATCH_LOG;
		pp->dtl_curr = dtl;
	}

	/* Register the DTL for the current (boot) cpu */
	dtl = get_paca()->dispatch_log;
	get_paca()->dtl_ridx = 0;
	get_paca()->dtl_curr = dtl;
	get_paca()->lppaca_ptr->dtl_idx = 0;

	/* hypervisor reads buffer length from this field */
265
	dtl->enqueue_to_dispatch_time = cpu_to_be32(DISPATCH_LOG_BYTES);
266 267
	ret = register_dtl(hard_smp_processor_id(), __pa(dtl));
	if (ret)
268 269 270
		pr_err("WARNING: DTL registration of cpu %d (hw %d) failed "
		       "with %d\n", smp_processor_id(),
		       hard_smp_processor_id(), ret);
271 272 273 274
	get_paca()->lppaca_ptr->dtl_enable_mask = 2;

	return 0;
}
275
#else /* !CONFIG_VIRT_CPU_ACCOUNTING_NATIVE */
276 277 278 279
static inline int alloc_dispatch_logs(void)
{
	return 0;
}
280
#endif /* CONFIG_VIRT_CPU_ACCOUNTING_NATIVE */
281

282 283 284 285 286 287 288 289 290 291 292 293
static int alloc_dispatch_log_kmem_cache(void)
{
	dtl_cache = kmem_cache_create("dtl", DISPATCH_LOG_BYTES,
						DISPATCH_LOG_BYTES, 0, NULL);
	if (!dtl_cache) {
		pr_warn("Failed to create dispatch trace log buffer cache\n");
		pr_warn("Stolen time statistics will be unreliable\n");
		return 0;
	}

	return alloc_dispatch_logs();
}
294
machine_early_initcall(pseries, alloc_dispatch_log_kmem_cache);
295

296
static void pseries_lpar_idle(void)
297
{
298 299
	/*
	 * Default handler to go into low thread priority and possibly
M
Michael Ellerman 已提交
300
	 * low power mode by ceding processor to hypervisor
301
	 */
302 303 304 305 306 307 308 309 310 311 312 313 314 315

	/* Indicate to hypervisor that we are idle. */
	get_lppaca()->idle = 1;

	/*
	 * Yield the processor to the hypervisor.  We return if
	 * an external interrupt occurs (which are driven prior
	 * to returning here) or if a prod occurs from another
	 * processor. When returning here, external interrupts
	 * are enabled.
	 */
	cede_processor();

	get_lppaca()->idle = 0;
316 317
}

318 319 320 321 322 323 324
/*
 * Enable relocation on during exceptions. This has partition wide scope and
 * may take a while to complete, if it takes longer than one second we will
 * just give up rather than wasting any more time on this - if that turns out
 * to ever be a problem in practice we can move this into a kernel thread to
 * finish off the process later in boot.
 */
325
long pSeries_enable_reloc_on_exc(void)
326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346
{
	long rc;
	unsigned int delay, total_delay = 0;

	while (1) {
		rc = enable_reloc_on_exceptions();
		if (!H_IS_LONG_BUSY(rc))
			return rc;

		delay = get_longbusy_msecs(rc);
		total_delay += delay;
		if (total_delay > 1000) {
			pr_warn("Warning: Giving up waiting to enable "
				"relocation on exceptions (%u msec)!\n",
				total_delay);
			return rc;
		}

		mdelay(delay);
	}
}
347
EXPORT_SYMBOL(pSeries_enable_reloc_on_exc);
348

349
long pSeries_disable_reloc_on_exc(void)
350 351 352 353 354 355 356 357 358 359
{
	long rc;

	while (1) {
		rc = disable_reloc_on_exceptions();
		if (!H_IS_LONG_BUSY(rc))
			return rc;
		mdelay(get_longbusy_msecs(rc));
	}
}
360
EXPORT_SYMBOL(pSeries_disable_reloc_on_exc);
361

362
#ifdef CONFIG_KEXEC
363 364 365 366
static void pSeries_machine_kexec(struct kimage *image)
{
	long rc;

367
	if (firmware_has_feature(FW_FEATURE_SET_MODE)) {
368 369 370 371 372 373 374 375 376 377
		rc = pSeries_disable_reloc_on_exc();
		if (rc != H_SUCCESS)
			pr_warning("Warning: Failed to disable relocation on "
				   "exceptions: %ld\n", rc);
	}

	default_machine_kexec(image);
}
#endif

378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403
#ifdef __LITTLE_ENDIAN__
long pseries_big_endian_exceptions(void)
{
	long rc;

	while (1) {
		rc = enable_big_endian_exceptions();
		if (!H_IS_LONG_BUSY(rc))
			return rc;
		mdelay(get_longbusy_msecs(rc));
	}
}

static long pseries_little_endian_exceptions(void)
{
	long rc;

	while (1) {
		rc = enable_little_endian_exceptions();
		if (!H_IS_LONG_BUSY(rc))
			return rc;
		mdelay(get_longbusy_msecs(rc));
	}
}
#endif

404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420
static void __init find_and_init_phbs(void)
{
	struct device_node *node;
	struct pci_controller *phb;
	struct device_node *root = of_find_node_by_path("/");

	for_each_child_of_node(root, node) {
		if (node->type == NULL || (strcmp(node->type, "pci") != 0 &&
					   strcmp(node->type, "pciex") != 0))
			continue;

		phb = pcibios_alloc_controller(node);
		if (!phb)
			continue;
		rtas_setup_phb(phb);
		pci_process_bridge_OF_ranges(phb, node, 0);
		isa_bridge_find_early(phb);
421
		phb->controller_ops = pseries_pci_controller_ops;
422 423 424 425 426 427 428 429 430
	}

	of_node_put(root);
	pci_devs_phb_init();

	/*
	 * PCI_PROBE_ONLY and PCI_REASSIGN_ALL_BUS can be set via properties
	 * in chosen.
	 */
431
	of_pci_check_probe_only();
432 433
}

434 435
static void __init pSeries_setup_arch(void)
{
436
	set_arch_panic_timeout(10, ARCH_PANIC_TIMEOUT);
437

438
	/* Discover PIC type and setup ppc_md accordingly */
439 440 441
	setup_kexec_cpu_down_xics();
	smp_init_pseries_xics();

442

L
Linus Torvalds 已提交
443 444 445 446 447 448 449 450 451
	/* openpic global configuration register (64-bit format). */
	/* openpic Interrupt Source Unit pointer (64-bit format). */
	/* python0 facility area (mmio) (64-bit format) REAL address. */

	/* init to some ~sane value until calibrate_delay() runs */
	loops_per_jiffy = 50000000;

	fwnmi_init();

452
	/* By default, only probe PCI (can be overridden by rtas_pci) */
453
	pci_add_flags(PCI_PROBE_ONLY);
454

L
Linus Torvalds 已提交
455 456 457
	/* Find and initialize PCI host bridges */
	init_pci_config_tokens();
	find_and_init_phbs();
458
	of_reconfig_notifier_register(&pci_dn_reconfig_nb);
L
Linus Torvalds 已提交
459 460 461

	pSeries_nvram_init();

462
	if (firmware_has_feature(FW_FEATURE_LPAR)) {
463
		vpa_init(boot_cpuid);
464
		ppc_md.power_save = pseries_lpar_idle;
465
		ppc_md.enable_pmcs = pseries_lpar_enable_pmcs;
466 467
	} else {
		/* No special idle routine */
468
		ppc_md.enable_pmcs = power4_enable_pmcs;
469
	}
470

471 472
	ppc_md.pcibios_root_bridge_prepare = pseries_root_bridge_prepare;

473 474
	if (firmware_has_feature(FW_FEATURE_SET_MODE)) {
		long rc;
475 476 477 478 479

		rc = pSeries_enable_reloc_on_exc();
		if (rc == H_P2) {
			pr_info("Relocation on exceptions not supported\n");
		} else if (rc != H_SUCCESS) {
480 481 482 483
			pr_warn("Unable to enable relocation on exceptions: "
				"%ld\n", rc);
		}
	}
L
Linus Torvalds 已提交
484 485 486 487 488
}

static int __init pSeries_init_panel(void)
{
	/* Manually leave the kernel version on the panel. */
489
#ifdef __BIG_ENDIAN__
L
Linus Torvalds 已提交
490
	ppc_md.progress("Linux ppc64\n", 0);
491 492 493
#else
	ppc_md.progress("Linux ppc64le\n", 0);
#endif
494
	ppc_md.progress(init_utsname()->version, 0);
L
Linus Torvalds 已提交
495 496 497

	return 0;
}
498
machine_arch_initcall(pseries, pSeries_init_panel);
L
Linus Torvalds 已提交
499

500
static int pseries_set_dabr(unsigned long dabr, unsigned long dabrx)
501
{
502
	return plpar_hcall_norets(H_SET_DABR, dabr);
503 504
}

505
static int pseries_set_xdabr(unsigned long dabr, unsigned long dabrx)
506
{
507 508 509 510
	/* Have to set at least one bit in the DABRX according to PAPR */
	if (dabrx == 0 && dabr == 0)
		dabrx = DABRX_USER;
	/* PAPR says we can only set kernel and user bits */
511
	dabrx &= DABRX_KERNEL | DABRX_USER;
512 513

	return plpar_hcall_norets(H_SET_XDABR, dabr, dabrx);
514
}
L
Linus Torvalds 已提交
515

516 517 518 519 520 521 522 523
static int pseries_set_dawr(unsigned long dawr, unsigned long dawrx)
{
	/* PAPR says we can't set HYP */
	dawrx &= ~DAWRX_HYP;

	return  plapr_set_watchpoint0(dawr, dawrx);
}

524 525 526
#define CMO_CHARACTERISTICS_TOKEN 44
#define CMO_MAXLENGTH 1026

527 528 529 530 531 532 533 534 535 536
void pSeries_coalesce_init(void)
{
	struct hvcall_mpp_x_data mpp_x_data;

	if (firmware_has_feature(FW_FEATURE_CMO) && !h_get_mpp_x(&mpp_x_data))
		powerpc_firmware_features |= FW_FEATURE_XCMO;
	else
		powerpc_firmware_features &= ~FW_FEATURE_XCMO;
}

537 538 539 540
/**
 * fw_cmo_feature_init - FW_FEATURE_CMO is not stored in ibm,hypertas-functions,
 * handle that here. (Stolen from parse_system_parameter_string)
 */
541
static void pSeries_cmo_feature_init(void)
542 543 544
{
	char *ptr, *key, *value, *end;
	int call_status;
545
	int page_order = IOMMU_PAGE_SHIFT_4K;
546 547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583

	pr_debug(" -> fw_cmo_feature_init()\n");
	spin_lock(&rtas_data_buf_lock);
	memset(rtas_data_buf, 0, RTAS_DATA_BUF_SIZE);
	call_status = rtas_call(rtas_token("ibm,get-system-parameter"), 3, 1,
				NULL,
				CMO_CHARACTERISTICS_TOKEN,
				__pa(rtas_data_buf),
				RTAS_DATA_BUF_SIZE);

	if (call_status != 0) {
		spin_unlock(&rtas_data_buf_lock);
		pr_debug("CMO not available\n");
		pr_debug(" <- fw_cmo_feature_init()\n");
		return;
	}

	end = rtas_data_buf + CMO_MAXLENGTH - 2;
	ptr = rtas_data_buf + 2;	/* step over strlen value */
	key = value = ptr;

	while (*ptr && (ptr <= end)) {
		/* Separate the key and value by replacing '=' with '\0' and
		 * point the value at the string after the '='
		 */
		if (ptr[0] == '=') {
			ptr[0] = '\0';
			value = ptr + 1;
		} else if (ptr[0] == '\0' || ptr[0] == ',') {
			/* Terminate the string containing the key/value pair */
			ptr[0] = '\0';

			if (key == value) {
				pr_debug("Malformed key/value pair\n");
				/* Never found a '=', end processing */
				break;
			}

584 585 586 587
			if (0 == strcmp(key, "CMOPageSize"))
				page_order = simple_strtol(value, NULL, 10);
			else if (0 == strcmp(key, "PrPSP"))
				CMO_PrPSP = simple_strtol(value, NULL, 10);
588
			else if (0 == strcmp(key, "SecPSP"))
589
				CMO_SecPSP = simple_strtol(value, NULL, 10);
590 591 592 593 594
			value = key = ptr + 1;
		}
		ptr++;
	}

595 596 597 598 599 600 601
	/* Page size is returned as the power of 2 of the page size,
	 * convert to the page size in bytes before returning
	 */
	CMO_PageSize = 1 << page_order;
	pr_debug("CMO_PageSize = %lu\n", CMO_PageSize);

	if (CMO_PrPSP != -1 || CMO_SecPSP != -1) {
602
		pr_info("CMO enabled\n");
603 604
		pr_debug("CMO enabled, PrPSP=%d, SecPSP=%d\n", CMO_PrPSP,
		         CMO_SecPSP);
605
		powerpc_firmware_features |= FW_FEATURE_CMO;
606
		pSeries_coalesce_init();
607
	} else
608 609
		pr_debug("CMO not enabled, PrPSP=%d, SecPSP=%d\n", CMO_PrPSP,
		         CMO_SecPSP);
610 611 612 613
	spin_unlock(&rtas_data_buf_lock);
	pr_debug(" <- fw_cmo_feature_init()\n");
}

L
Linus Torvalds 已提交
614 615 616 617 618
/*
 * Early initialization.  Relocation is on but do not reference unbolted pages
 */
static void __init pSeries_init_early(void)
{
619
	pr_debug(" -> pSeries_init_early()\n");
L
Linus Torvalds 已提交
620

621
#ifdef CONFIG_HVC_CONSOLE
622
	if (firmware_has_feature(FW_FEATURE_LPAR))
623 624
		hvc_vio_init_early();
#endif
M
Michael Neuling 已提交
625
	if (firmware_has_feature(FW_FEATURE_XDABR))
626
		ppc_md.set_dabr = pseries_set_xdabr;
M
Michael Neuling 已提交
627 628
	else if (firmware_has_feature(FW_FEATURE_DABR))
		ppc_md.set_dabr = pseries_set_dabr;
L
Linus Torvalds 已提交
629

630 631 632
	if (firmware_has_feature(FW_FEATURE_SET_MODE))
		ppc_md.set_dawr = pseries_set_dawr;

633
	pSeries_cmo_feature_init();
L
Linus Torvalds 已提交
634 635
	iommu_init_early_pSeries();

636
	pr_debug(" <- pSeries_init_early()\n");
L
Linus Torvalds 已提交
637 638
}

639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666
/**
 * pseries_power_off - tell firmware about how to power off the system.
 *
 * This function calls either the power-off rtas token in normal cases
 * or the ibm,power-off-ups token (if present & requested) in case of
 * a power failure. If power-off token is used, power on will only be
 * possible with power button press. If ibm,power-off-ups token is used
 * it will allow auto poweron after power is restored.
 */
static void pseries_power_off(void)
{
	int rc;
	int rtas_poweroff_ups_token = rtas_token("ibm,power-off-ups");

	if (rtas_flash_term_hook)
		rtas_flash_term_hook(SYS_POWER_OFF);

	if (rtas_poweron_auto == 0 ||
		rtas_poweroff_ups_token == RTAS_UNKNOWN_SERVICE) {
		rc = rtas_call(rtas_token("power-off"), 2, 1, NULL, -1, -1);
		printk(KERN_INFO "RTAS power-off returned %d\n", rc);
	} else {
		rc = rtas_call(rtas_poweroff_ups_token, 0, 1, NULL);
		printk(KERN_INFO "RTAS ibm,power-off-ups returned %d\n", rc);
	}
	for (;;);
}

L
Linus Torvalds 已提交
667 668 669 670
/*
 * Called very early, MMU is off, device-tree isn't unflattened
 */

671 672 673
static int __init pseries_probe_fw_features(unsigned long node,
					    const char *uname, int depth,
					    void *data)
L
Linus Torvalds 已提交
674
{
675
	const char *prop;
676
	int len;
677 678
	static int hypertas_found;
	static int vec5_found;
679

680
	if (depth != 1)
681 682
		return 0;

683 684 685 686 687 688 689 690 691 692
	if (!strcmp(uname, "rtas") || !strcmp(uname, "rtas@0")) {
		prop = of_get_flat_dt_prop(node, "ibm,hypertas-functions",
					   &len);
		if (prop) {
			powerpc_firmware_features |= FW_FEATURE_LPAR;
			fw_hypertas_feature_init(prop, len);
		}

		hypertas_found = 1;
	}
693

694 695 696 697 698 699 700 701
	if (!strcmp(uname, "chosen")) {
		prop = of_get_flat_dt_prop(node, "ibm,architecture-vec-5",
					   &len);
		if (prop)
			fw_vec5_feature_init(prop, len);

		vec5_found = 1;
	}
702

703
	return hypertas_found && vec5_found;
704 705 706 707
}

static int __init pSeries_probe(void)
{
708
	unsigned long root = of_get_flat_dt_root();
709
	const char *dtype = of_get_flat_dt_prop(root, "device_type", NULL);
710

711 712 713
 	if (dtype == NULL)
 		return 0;
 	if (strcmp(dtype, "chrp"))
L
Linus Torvalds 已提交
714 715
		return 0;

716 717 718 719 720 721 722
	/* Cell blades firmware claims to be chrp while it's not. Until this
	 * is fixed, we need to avoid those here.
	 */
	if (of_flat_dt_is_compatible(root, "IBM,CPBW-1.0") ||
	    of_flat_dt_is_compatible(root, "IBM,CBEA"))
		return 0;

723
	pr_debug("pSeries detected, looking for LPAR capability...\n");
L
Linus Torvalds 已提交
724

725
	/* Now try to figure out if we are running on LPAR */
726
	of_scan_flat_dt(pseries_probe_fw_features, NULL);
727

728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743
#ifdef __LITTLE_ENDIAN__
	if (firmware_has_feature(FW_FEATURE_SET_MODE)) {
		long rc;
		/*
		 * Tell the hypervisor that we want our exceptions to
		 * be taken in little endian mode. If this fails we don't
		 * want to use BUG() because it will trigger an exception.
		 */
		rc = pseries_little_endian_exceptions();
		if (rc) {
			ppc_md.progress("H_SET_MODE LE exception fail", 0);
			panic("Could not enable little endian exceptions");
		}
	}
#endif

744 745 746 747 748
	if (firmware_has_feature(FW_FEATURE_LPAR))
		hpte_init_lpar();
	else
		hpte_init_native();

749 750
	pm_power_off = pseries_power_off;

751 752
	pr_debug("Machine is%s LPAR !\n",
	         (powerpc_firmware_features & FW_FEATURE_LPAR) ? "" : " not");
753

L
Linus Torvalds 已提交
754 755 756
	return 1;
}

757 758
static int pSeries_pci_probe_mode(struct pci_bus *bus)
{
759
	if (firmware_has_feature(FW_FEATURE_LPAR))
760 761 762 763
		return PCI_PROBE_DEVTREE;
	return PCI_PROBE_NORMAL;
}

764 765 766 767
struct pci_controller_ops pseries_pci_controller_ops = {
	.probe_mode		= pSeries_pci_probe_mode,
};

768 769
define_machine(pseries) {
	.name			= "pSeries",
L
Linus Torvalds 已提交
770 771 772
	.probe			= pSeries_probe,
	.setup_arch		= pSeries_setup_arch,
	.init_early		= pSeries_init_early,
773
	.init_IRQ		= pseries_init_irq,
774
	.show_cpuinfo		= pSeries_show_cpuinfo,
L
Linus Torvalds 已提交
775 776
	.log_error		= pSeries_log_error,
	.pcibios_fixup		= pSeries_final_fixup,
777 778
	.restart		= rtas_restart,
	.halt			= rtas_halt,
779
	.panic			= rtas_os_term,
780 781 782
	.get_boot_time		= rtas_get_boot_time,
	.get_rtc_time		= rtas_get_rtc_time,
	.set_rtc_time		= rtas_set_rtc_time,
783
	.calibrate_decr		= generic_calibrate_decr,
784
	.progress		= rtas_progress,
L
Linus Torvalds 已提交
785 786
	.system_reset_exception = pSeries_system_reset_exception,
	.machine_check_exception = pSeries_machine_check_exception,
787 788 789
#ifdef CONFIG_KEXEC
	.machine_kexec          = pSeries_machine_kexec,
#endif
790 791 792
#ifdef CONFIG_MEMORY_HOTPLUG_SPARSE
	.memory_block_size	= pseries_memory_block_size,
#endif
L
Linus Torvalds 已提交
793
};