x2apic_uv_x.c 19.8 KB
Newer Older
J
Jack Steiner 已提交
1 2 3 4 5 6 7
/*
 * This file is subject to the terms and conditions of the GNU General Public
 * License.  See the file "COPYING" in the main directory of this archive
 * for more details.
 *
 * SGI UV APIC functions (note: not an Intel compatible APIC)
 *
8
 * Copyright (C) 2007-2010 Silicon Graphics, Inc. All rights reserved.
J
Jack Steiner 已提交
9 10
 */
#include <linux/cpumask.h>
11 12 13 14 15
#include <linux/hardirq.h>
#include <linux/proc_fs.h>
#include <linux/threads.h>
#include <linux/kernel.h>
#include <linux/module.h>
J
Jack Steiner 已提交
16 17 18
#include <linux/string.h>
#include <linux/ctype.h>
#include <linux/sched.h>
19
#include <linux/timer.h>
20
#include <linux/slab.h>
21 22
#include <linux/cpu.h>
#include <linux/init.h>
23
#include <linux/io.h>
24
#include <linux/pci.h>
25
#include <linux/kdebug.h>
26

J
Jack Steiner 已提交
27 28
#include <asm/uv/uv_mmrs.h>
#include <asm/uv/uv_hub.h>
29 30
#include <asm/current.h>
#include <asm/pgtable.h>
31
#include <asm/uv/bios.h>
32 33 34 35
#include <asm/uv/uv.h>
#include <asm/apic.h>
#include <asm/ipi.h>
#include <asm/smp.h>
36
#include <asm/x86_init.h>
J
Jack Steiner 已提交
37

38 39
DEFINE_PER_CPU(int, x2apic_extra_bits);

40 41
#define PR_DEVEL(fmt, args...)	pr_devel("%s: " fmt, __func__, args)

42
static enum uv_system_type uv_system_type;
43
static u64 gru_start_paddr, gru_end_paddr;
44
static union uvh_apicid uvh_apicid;
45 46
int uv_min_hub_revision_id;
EXPORT_SYMBOL_GPL(uv_min_hub_revision_id);
47
static DEFINE_SPINLOCK(uv_nmi_lock);
48

49
static inline bool is_GRU_range(u64 start, u64 end)
50
{
51
	return start >= gru_start_paddr && end <= gru_end_paddr;
52 53
}

54
static bool uv_is_untracked_pat_range(u64 start, u64 end)
55 56 57
{
	return is_ISA_range(start, end) || is_GRU_range(start, end);
}
58

59 60 61 62 63 64 65 66
static int early_get_nodeid(void)
{
	union uvh_node_id_u node_id;
	unsigned long *mmr;

	mmr = early_ioremap(UV_LOCAL_MMR_BASE | UVH_NODE_ID, sizeof(*mmr));
	node_id.v = *mmr;
	early_iounmap(mmr, sizeof(*mmr));
67 68 69 70

	/* Currently, all blades have same revision number */
	uv_min_hub_revision_id = node_id.s.revision;

71 72 73
	return node_id.s.node_id;
}

74
static void __init early_get_apic_pnode_shift(void)
75 76 77 78 79 80 81 82 83 84 85 86 87
{
	unsigned long *mmr;

	mmr = early_ioremap(UV_LOCAL_MMR_BASE | UVH_APICID, sizeof(*mmr));
	uvh_apicid.v = *mmr;
	early_iounmap(mmr, sizeof(*mmr));
	if (!uvh_apicid.v)
		/*
		 * Old bios, use default value
		 */
		uvh_apicid.s.pnode_shift = UV_APIC_PNODE_SHIFT;
}

88
static int __init uv_acpi_madt_oem_check(char *oem_id, char *oem_table_id)
89
{
90 91
	int nodeid;

92
	if (!strcmp(oem_id, "SGI")) {
93
		nodeid = early_get_nodeid();
94
		early_get_apic_pnode_shift();
95
		x86_platform.is_untracked_pat_range =  uv_is_untracked_pat_range;
96
		x86_platform.nmi_init = uv_nmi_init;
97 98 99 100 101
		if (!strcmp(oem_table_id, "UVL"))
			uv_system_type = UV_LEGACY_APIC;
		else if (!strcmp(oem_table_id, "UVX"))
			uv_system_type = UV_X2APIC;
		else if (!strcmp(oem_table_id, "UVH")) {
102
			__get_cpu_var(x2apic_extra_bits) =
103
				nodeid << (uvh_apicid.s.pnode_shift - 1);
104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119
			uv_system_type = UV_NON_UNIQUE_APIC;
			return 1;
		}
	}
	return 0;
}

enum uv_system_type get_uv_system_type(void)
{
	return uv_system_type;
}

int is_uv_system(void)
{
	return uv_system_type != UV_NONE;
}
120
EXPORT_SYMBOL_GPL(is_uv_system);
121

J
Jack Steiner 已提交
122 123 124 125 126 127 128 129 130 131 132 133 134 135 136
DEFINE_PER_CPU(struct uv_hub_info_s, __uv_hub_info);
EXPORT_PER_CPU_SYMBOL_GPL(__uv_hub_info);

struct uv_blade_info *uv_blade_info;
EXPORT_SYMBOL_GPL(uv_blade_info);

short *uv_node_to_blade;
EXPORT_SYMBOL_GPL(uv_node_to_blade);

short *uv_cpu_to_blade;
EXPORT_SYMBOL_GPL(uv_cpu_to_blade);

short uv_possible_blades;
EXPORT_SYMBOL_GPL(uv_possible_blades);

137 138 139
unsigned long sn_rtc_cycles_per_second;
EXPORT_SYMBOL(sn_rtc_cycles_per_second);

140
static const struct cpumask *uv_target_cpus(void)
J
Jack Steiner 已提交
141
{
142
	return cpu_online_mask;
J
Jack Steiner 已提交
143 144
}

145
static void uv_vector_allocation_domain(int cpu, struct cpumask *retmask)
J
Jack Steiner 已提交
146
{
147 148
	cpumask_clear(retmask);
	cpumask_set_cpu(cpu, retmask);
J
Jack Steiner 已提交
149 150
}

151
static int __cpuinit uv_wakeup_secondary(int phys_apicid, unsigned long start_rip)
J
Jack Steiner 已提交
152
{
153
#ifdef CONFIG_SMP
J
Jack Steiner 已提交
154
	unsigned long val;
155
	int pnode;
J
Jack Steiner 已提交
156

157
	pnode = uv_apicid_to_pnode(phys_apicid);
J
Jack Steiner 已提交
158 159
	val = (1UL << UVH_IPI_INT_SEND_SHFT) |
	    (phys_apicid << UVH_IPI_INT_APIC_ID_SHFT) |
160
	    ((start_rip << UVH_IPI_INT_VECTOR_SHFT) >> 12) |
J
Jack Steiner 已提交
161
	    APIC_DM_INIT;
162
	uv_write_global_mmr64(pnode, UVH_IPI_INT, val);
J
Jack Steiner 已提交
163 164 165 166
	mdelay(10);

	val = (1UL << UVH_IPI_INT_SEND_SHFT) |
	    (phys_apicid << UVH_IPI_INT_APIC_ID_SHFT) |
167
	    ((start_rip << UVH_IPI_INT_VECTOR_SHFT) >> 12) |
J
Jack Steiner 已提交
168
	    APIC_DM_STARTUP;
169
	uv_write_global_mmr64(pnode, UVH_IPI_INT, val);
170 171

	atomic_set(&init_deasserted, 1);
172
#endif
J
Jack Steiner 已提交
173 174 175 176 177
	return 0;
}

static void uv_send_IPI_one(int cpu, int vector)
{
178
	unsigned long apicid;
179
	int pnode;
J
Jack Steiner 已提交
180

181
	apicid = per_cpu(x86_cpu_to_apicid, cpu);
182
	pnode = uv_apicid_to_pnode(apicid);
183
	uv_hub_send_ipi(pnode, apicid, vector);
J
Jack Steiner 已提交
184 185
}

186
static void uv_send_IPI_mask(const struct cpumask *mask, int vector)
J
Jack Steiner 已提交
187 188 189
{
	unsigned int cpu;

190
	for_each_cpu(cpu, mask)
191 192 193
		uv_send_IPI_one(cpu, vector);
}

194
static void uv_send_IPI_mask_allbutself(const struct cpumask *mask, int vector)
195 196
{
	unsigned int this_cpu = smp_processor_id();
197
	unsigned int cpu;
198

199
	for_each_cpu(cpu, mask) {
200
		if (cpu != this_cpu)
J
Jack Steiner 已提交
201
			uv_send_IPI_one(cpu, vector);
202
	}
J
Jack Steiner 已提交
203 204 205 206
}

static void uv_send_IPI_allbutself(int vector)
{
207
	unsigned int this_cpu = smp_processor_id();
208
	unsigned int cpu;
J
Jack Steiner 已提交
209

210
	for_each_online_cpu(cpu) {
211 212
		if (cpu != this_cpu)
			uv_send_IPI_one(cpu, vector);
213
	}
J
Jack Steiner 已提交
214 215 216 217
}

static void uv_send_IPI_all(int vector)
{
218
	uv_send_IPI_mask(cpu_online_mask, vector);
J
Jack Steiner 已提交
219 220 221 222 223 224 225
}

static int uv_apic_id_registered(void)
{
	return 1;
}

226
static void uv_init_apic_ldr(void)
227 228 229
{
}

230
static unsigned int uv_cpu_mask_to_apicid(const struct cpumask *cpumask)
J
Jack Steiner 已提交
231 232 233 234 235
{
	/*
	 * We're using fixed IRQ delivery, can only return one phys APIC ID.
	 * May as well be the first.
	 */
236 237
	int cpu = cpumask_first(cpumask);

238
	if ((unsigned)cpu < nr_cpu_ids)
J
Jack Steiner 已提交
239 240 241 242 243
		return per_cpu(x86_cpu_to_apicid, cpu);
	else
		return BAD_APICID;
}

244 245 246
static unsigned int
uv_cpu_mask_to_apicid_and(const struct cpumask *cpumask,
			  const struct cpumask *andmask)
M
Mike Travis 已提交
247 248 249 250 251 252 253
{
	int cpu;

	/*
	 * We're using fixed IRQ delivery, can only return one phys APIC ID.
	 * May as well be the first.
	 */
254
	for_each_cpu_and(cpu, cpumask, andmask) {
255 256
		if (cpumask_test_cpu(cpu, cpu_online_mask))
			break;
257
	}
258
	return per_cpu(x86_cpu_to_apicid, cpu);
M
Mike Travis 已提交
259 260
}

261
static unsigned int x2apic_get_apic_id(unsigned long x)
262 263 264 265
{
	unsigned int id;

	WARN_ON(preemptible() && num_online_cpus() > 1);
Y
Yinghai Lu 已提交
266
	id = x | __get_cpu_var(x2apic_extra_bits);
267 268 269 270

	return id;
}

271
static unsigned long set_apic_id(unsigned int id)
Y
Yinghai Lu 已提交
272 273 274 275 276 277 278 279 280 281 282
{
	unsigned long x;

	/* maskout x2apic_extra_bits ? */
	x = id;
	return x;
}

static unsigned int uv_read_apic_id(void)
{

283
	return x2apic_get_apic_id(apic_read(APIC_ID));
Y
Yinghai Lu 已提交
284 285
}

I
Ingo Molnar 已提交
286
static int uv_phys_pkg_id(int initial_apicid, int index_msb)
J
Jack Steiner 已提交
287
{
288
	return uv_read_apic_id() >> index_msb;
J
Jack Steiner 已提交
289 290 291 292 293 294 295
}

static void uv_send_IPI_self(int vector)
{
	apic_write(APIC_SELF_IPI, vector);
}

296
struct apic __refdata apic_x2apic_uv_x = {
I
Ingo Molnar 已提交
297 298 299 300 301 302

	.name				= "UV large system",
	.probe				= NULL,
	.acpi_madt_oem_check		= uv_acpi_madt_oem_check,
	.apic_id_registered		= uv_apic_id_registered,

303
	.irq_delivery_mode		= dest_Fixed,
J
Jack Steiner 已提交
304
	.irq_dest_mode			= 0, /* physical */
I
Ingo Molnar 已提交
305 306

	.target_cpus			= uv_target_cpus,
307
	.disable_esr			= 0,
308
	.dest_logical			= APIC_DEST_LOGICAL,
I
Ingo Molnar 已提交
309 310 311 312 313 314 315 316 317 318 319
	.check_apicid_used		= NULL,
	.check_apicid_present		= NULL,

	.vector_allocation_domain	= uv_vector_allocation_domain,
	.init_apic_ldr			= uv_init_apic_ldr,

	.ioapic_phys_id_map		= NULL,
	.setup_apic_routing		= NULL,
	.multi_timer_check		= NULL,
	.apicid_to_node			= NULL,
	.cpu_to_logical_apicid		= NULL,
320
	.cpu_present_to_apicid		= default_cpu_present_to_apicid,
I
Ingo Molnar 已提交
321 322
	.apicid_to_cpu_present		= NULL,
	.setup_portio_remap		= NULL,
323
	.check_phys_apicid_present	= default_check_phys_apicid_present,
I
Ingo Molnar 已提交
324
	.enable_apic_mode		= NULL,
I
Ingo Molnar 已提交
325
	.phys_pkg_id			= uv_phys_pkg_id,
I
Ingo Molnar 已提交
326 327
	.mps_oem_check			= NULL,

328
	.get_apic_id			= x2apic_get_apic_id,
I
Ingo Molnar 已提交
329 330 331 332 333 334 335 336 337 338 339 340
	.set_apic_id			= set_apic_id,
	.apic_id_mask			= 0xFFFFFFFFu,

	.cpu_mask_to_apicid		= uv_cpu_mask_to_apicid,
	.cpu_mask_to_apicid_and		= uv_cpu_mask_to_apicid_and,

	.send_IPI_mask			= uv_send_IPI_mask,
	.send_IPI_mask_allbutself	= uv_send_IPI_mask_allbutself,
	.send_IPI_allbutself		= uv_send_IPI_allbutself,
	.send_IPI_all			= uv_send_IPI_all,
	.send_IPI_self			= uv_send_IPI_self,

341
	.wakeup_secondary_cpu		= uv_wakeup_secondary,
342 343
	.trampoline_phys_low		= DEFAULT_TRAMPOLINE_PHYS_LOW,
	.trampoline_phys_high		= DEFAULT_TRAMPOLINE_PHYS_HIGH,
I
Ingo Molnar 已提交
344 345 346
	.wait_for_init_deassert		= NULL,
	.smp_callin_clear_local_apic	= NULL,
	.inquire_remote_apic		= NULL,
Y
Yinghai Lu 已提交
347 348 349 350 351 352 353

	.read				= native_apic_msr_read,
	.write				= native_apic_msr_write,
	.icr_read			= native_x2apic_icr_read,
	.icr_write			= native_x2apic_icr_write,
	.wait_icr_idle			= native_x2apic_wait_icr_idle,
	.safe_wait_icr_idle		= native_safe_x2apic_wait_icr_idle,
J
Jack Steiner 已提交
354 355
};

356
static __cpuinit void set_x2apic_extra_bits(int pnode)
J
Jack Steiner 已提交
357
{
358
	__get_cpu_var(x2apic_extra_bits) = (pnode << 6);
J
Jack Steiner 已提交
359 360 361 362 363
}

/*
 * Called on boot cpu.
 */
364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381
static __init int boot_pnode_to_blade(int pnode)
{
	int blade;

	for (blade = 0; blade < uv_num_possible_blades(); blade++)
		if (pnode == uv_blade_info[blade].pnode)
			return blade;
	BUG();
}

struct redir_addr {
	unsigned long redirect;
	unsigned long alias;
};

#define DEST_SHIFT UVH_RH_GAM_ALIAS210_REDIRECT_CONFIG_0_MMR_DEST_BASE_SHFT

static __initdata struct redir_addr redir_addrs[] = {
382 383 384
	{UVH_RH_GAM_ALIAS210_REDIRECT_CONFIG_0_MMR, UVH_RH_GAM_ALIAS210_OVERLAY_CONFIG_0_MMR},
	{UVH_RH_GAM_ALIAS210_REDIRECT_CONFIG_1_MMR, UVH_RH_GAM_ALIAS210_OVERLAY_CONFIG_1_MMR},
	{UVH_RH_GAM_ALIAS210_REDIRECT_CONFIG_2_MMR, UVH_RH_GAM_ALIAS210_OVERLAY_CONFIG_2_MMR},
385 386 387 388
};

static __init void get_lowmem_redirect(unsigned long *base, unsigned long *size)
{
389
	union uvh_rh_gam_alias210_overlay_config_2_mmr_u alias;
390 391 392 393 394
	union uvh_rh_gam_alias210_redirect_config_2_mmr_u redirect;
	int i;

	for (i = 0; i < ARRAY_SIZE(redir_addrs); i++) {
		alias.v = uv_read_local_mmr(redir_addrs[i].alias);
395
		if (alias.s.enable && alias.s.base == 0) {
396 397 398 399 400 401
			*size = (1UL << alias.s.m_alias);
			redirect.v = uv_read_local_mmr(redir_addrs[i].redirect);
			*base = (unsigned long)redirect.s.dest_base << DEST_SHIFT;
			return;
		}
	}
402
	*base = *size = 0;
403 404
}

405 406
enum map_type {map_wb, map_uc};

407 408
static __init void map_high(char *id, unsigned long base, int pshift,
			int bshift, int max_pnode, enum map_type map_type)
409 410 411
{
	unsigned long bytes, paddr;

412 413
	paddr = base << pshift;
	bytes = (1UL << bshift) * (max_pnode + 1);
414
	printk(KERN_INFO "UV: Map %s_HI 0x%lx - 0x%lx\n", id, paddr,
415
						paddr + bytes);
416 417 418 419 420 421 422 423 424 425 426 427
	if (map_type == map_uc)
		init_extra_mapping_uc(paddr, bytes);
	else
		init_extra_mapping_wb(paddr, bytes);

}
static __init void map_gru_high(int max_pnode)
{
	union uvh_rh_gam_gru_overlay_config_mmr_u gru;
	int shift = UVH_RH_GAM_GRU_OVERLAY_CONFIG_MMR_BASE_SHFT;

	gru.v = uv_read_local_mmr(UVH_RH_GAM_GRU_OVERLAY_CONFIG_MMR);
428
	if (gru.s.enable) {
429
		map_high("GRU", gru.s.base, shift, shift, max_pnode, map_wb);
430 431 432 433
		gru_start_paddr = ((u64)gru.s.base << shift);
		gru_end_paddr = gru_start_paddr + (1UL << shift) * (max_pnode + 1);

	}
434 435
}

436 437 438 439 440 441 442
static __init void map_mmr_high(int max_pnode)
{
	union uvh_rh_gam_mmr_overlay_config_mmr_u mmr;
	int shift = UVH_RH_GAM_MMR_OVERLAY_CONFIG_MMR_BASE_SHFT;

	mmr.v = uv_read_local_mmr(UVH_RH_GAM_MMR_OVERLAY_CONFIG_MMR);
	if (mmr.s.enable)
443
		map_high("MMR", mmr.s.base, shift, shift, max_pnode, map_uc);
444 445
}

446 447 448 449 450 451 452
static __init void map_mmioh_high(int max_pnode)
{
	union uvh_rh_gam_mmioh_overlay_config_mmr_u mmioh;
	int shift = UVH_RH_GAM_MMIOH_OVERLAY_CONFIG_MMR_BASE_SHFT;

	mmioh.v = uv_read_local_mmr(UVH_RH_GAM_MMIOH_OVERLAY_CONFIG_MMR);
	if (mmioh.s.enable)
453 454
		map_high("MMIOH", mmioh.s.base, shift, mmioh.s.m_io,
			max_pnode, map_uc);
455 456
}

J
Jack Steiner 已提交
457 458 459 460 461 462
static __init void map_low_mmrs(void)
{
	init_extra_mapping_uc(UV_GLOBAL_MMR32_BASE, UV_GLOBAL_MMR32_SIZE);
	init_extra_mapping_uc(UV_LOCAL_MMR_BASE, UV_LOCAL_MMR_SIZE);
}

463 464
static __init void uv_rtc_init(void)
{
R
Russ Anderson 已提交
465 466
	long status;
	u64 ticks_per_sec;
467

R
Russ Anderson 已提交
468 469 470
	status = uv_bios_freq_base(BIOS_FREQ_BASE_REALTIME_CLOCK,
					&ticks_per_sec);
	if (status != BIOS_STATUS_SUCCESS || ticks_per_sec < 100000) {
471 472 473 474 475 476 477 478 479
		printk(KERN_WARNING
			"unable to determine platform RTC clock frequency, "
			"guessing.\n");
		/* BIOS gives wrong value for clock freq. so guess */
		sn_rtc_cycles_per_second = 1000000000000UL / 30000UL;
	} else
		sn_rtc_cycles_per_second = ticks_per_sec;
}

480 481 482 483 484 485 486 487 488 489 490
/*
 * percpu heartbeat timer
 */
static void uv_heartbeat(unsigned long ignored)
{
	struct timer_list *timer = &uv_hub_info->scir.timer;
	unsigned char bits = uv_hub_info->scir.state;

	/* flip heartbeat bit */
	bits ^= SCIR_CPU_HEARTBEAT;

491 492
	/* is this cpu idle? */
	if (idle_cpu(raw_smp_processor_id()))
493 494 495 496 497 498 499 500
		bits &= ~SCIR_CPU_ACTIVITY;
	else
		bits |= SCIR_CPU_ACTIVITY;

	/* update system controller interface reg */
	uv_set_scir_bits(bits);

	/* enable next timer period */
501
	mod_timer_pinned(timer, jiffies + SCIR_CPU_HB_INTERVAL);
502 503 504 505
}

static void __cpuinit uv_heartbeat_enable(int cpu)
{
506
	while (!uv_cpu_hub_info(cpu)->scir.enabled) {
507 508 509 510 511 512 513 514
		struct timer_list *timer = &uv_cpu_hub_info(cpu)->scir.timer;

		uv_set_cpu_scir_bits(cpu, SCIR_CPU_HEARTBEAT|SCIR_CPU_ACTIVITY);
		setup_timer(timer, uv_heartbeat, cpu);
		timer->expires = jiffies + SCIR_CPU_HB_INTERVAL;
		add_timer_on(timer, cpu);
		uv_cpu_hub_info(cpu)->scir.enabled = 1;

515 516 517
		/* also ensure that boot cpu is enabled */
		cpu = 0;
	}
518 519
}

520
#ifdef CONFIG_HOTPLUG_CPU
521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 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
static void __cpuinit uv_heartbeat_disable(int cpu)
{
	if (uv_cpu_hub_info(cpu)->scir.enabled) {
		uv_cpu_hub_info(cpu)->scir.enabled = 0;
		del_timer(&uv_cpu_hub_info(cpu)->scir.timer);
	}
	uv_set_cpu_scir_bits(cpu, 0xff);
}

/*
 * cpu hotplug notifier
 */
static __cpuinit int uv_scir_cpu_notify(struct notifier_block *self,
				       unsigned long action, void *hcpu)
{
	long cpu = (long)hcpu;

	switch (action) {
	case CPU_ONLINE:
		uv_heartbeat_enable(cpu);
		break;
	case CPU_DOWN_PREPARE:
		uv_heartbeat_disable(cpu);
		break;
	default:
		break;
	}
	return NOTIFY_OK;
}

static __init void uv_scir_register_cpu_notifier(void)
{
	hotcpu_notifier(uv_scir_cpu_notify, 0);
}

#else /* !CONFIG_HOTPLUG_CPU */

static __init void uv_scir_register_cpu_notifier(void)
{
}

static __init int uv_init_heartbeat(void)
{
	int cpu;

	if (is_uv_system())
		for_each_online_cpu(cpu)
			uv_heartbeat_enable(cpu);
	return 0;
}

late_initcall(uv_init_heartbeat);

#endif /* !CONFIG_HOTPLUG_CPU */

576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599
/* Direct Legacy VGA I/O traffic to designated IOH */
int uv_set_vga_state(struct pci_dev *pdev, bool decode,
		      unsigned int command_bits, bool change_bridge)
{
	int domain, bus, rc;

	PR_DEVEL("devfn %x decode %d cmd %x chg_brdg %d\n",
			pdev->devfn, decode, command_bits, change_bridge);

	if (!change_bridge)
		return 0;

	if ((command_bits & PCI_COMMAND_IO) == 0)
		return 0;

	domain = pci_domain_nr(pdev->bus);
	bus = pdev->bus->number;

	rc = uv_bios_set_legacy_vga_target(decode, domain, bus);
	PR_DEVEL("vga decode %d %x:%x, rc: %d\n", decode, domain, bus, rc);

	return rc;
}

600 601
/*
 * Called on each cpu to initialize the per_cpu UV data area.
602
 * FIXME: hotplug not supported yet
603 604 605 606 607 608 609 610 611 612 613 614 615
 */
void __cpuinit uv_cpu_init(void)
{
	/* CPU 0 initilization will be done via uv_system_init. */
	if (!uv_blade_info)
		return;

	uv_blade_info[uv_numa_blade_id()].nr_online_cpus++;

	if (get_uv_system_type() == UV_NON_UNIQUE_APIC)
		set_x2apic_extra_bits(uv_hub_info->pnode);
}

616 617 618 619 620 621 622
/*
 * When NMI is received, print a stack trace.
 */
int uv_handle_nmi(struct notifier_block *self, unsigned long reason, void *data)
{
	if (reason != DIE_NMI_IPI)
		return NOTIFY_OK;
623 624 625 626

	if (in_crash_kexec)
		/* do nothing if entering the crash kernel */
		return NOTIFY_OK;
627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659
	/*
	 * Use a lock so only one cpu prints at a time
	 * to prevent intermixed output.
	 */
	spin_lock(&uv_nmi_lock);
	pr_info("NMI stack dump cpu %u:\n", smp_processor_id());
	dump_stack();
	spin_unlock(&uv_nmi_lock);

	return NOTIFY_STOP;
}

static struct notifier_block uv_dump_stack_nmi_nb = {
	.notifier_call	= uv_handle_nmi
};

void uv_register_nmi_notifier(void)
{
	if (register_die_notifier(&uv_dump_stack_nmi_nb))
		printk(KERN_WARNING "UV NMI handler failed to register\n");
}

void uv_nmi_init(void)
{
	unsigned int value;

	/*
	 * Unmask NMI on all cpus
	 */
	value = apic_read(APIC_LVT1) | APIC_DM_NMI;
	value &= ~APIC_LVT_MASKED;
	apic_write(APIC_LVT1, value);
}
660 661

void __init uv_system_init(void)
J
Jack Steiner 已提交
662
{
663
	union uvh_rh_gam_config_mmr_u  m_n_config;
664 665 666
	union uvh_node_id_u node_id;
	unsigned long gnode_upper, lowmem_redir_base, lowmem_redir_size;
	int bytes, nid, cpu, lcpu, pnode, blade, i, j, m_val, n_val;
667
	int gnode_extra, max_pnode = 0;
668 669
	unsigned long mmr_base, present, paddr;
	unsigned short pnode_mask;
J
Jack Steiner 已提交
670

J
Jack Steiner 已提交
671 672
	map_low_mmrs();

673
	m_n_config.v = uv_read_local_mmr(UVH_RH_GAM_CONFIG_MMR );
674 675
	m_val = m_n_config.s.m_skt;
	n_val = m_n_config.s.n_skt;
J
Jack Steiner 已提交
676 677 678
	mmr_base =
	    uv_read_local_mmr(UVH_RH_GAM_MMR_OVERLAY_CONFIG_MMR) &
	    ~UV_MMR_ENABLE;
679 680 681 682 683 684 685
	pnode_mask = (1 << n_val) - 1;
	node_id.v = uv_read_local_mmr(UVH_NODE_ID);
	gnode_extra = (node_id.s.node_id & ~((1 << n_val) - 1)) >> 1;
	gnode_upper = ((unsigned long)gnode_extra  << m_val);
	printk(KERN_DEBUG "UV: N %d, M %d, gnode_upper 0x%lx, gnode_extra 0x%x\n",
			n_val, m_val, gnode_upper, gnode_extra);

J
Jack Steiner 已提交
686 687
	printk(KERN_DEBUG "UV: global MMR base 0x%lx\n", mmr_base);

688 689 690
	for(i = 0; i < UVH_NODE_PRESENT_TABLE_DEPTH; i++)
		uv_possible_blades +=
		  hweight64(uv_read_local_mmr( UVH_NODE_PRESENT_TABLE + i * 8));
J
Jack Steiner 已提交
691 692 693
	printk(KERN_DEBUG "UV: Found %d blades\n", uv_num_possible_blades());

	bytes = sizeof(struct uv_blade_info) * uv_num_possible_blades();
694
	uv_blade_info = kmalloc(bytes, GFP_KERNEL);
695
	BUG_ON(!uv_blade_info);
696 697
	for (blade = 0; blade < uv_num_possible_blades(); blade++)
		uv_blade_info[blade].memory_nid = -1;
J
Jack Steiner 已提交
698

699 700
	get_lowmem_redirect(&lowmem_redir_base, &lowmem_redir_size);

J
Jack Steiner 已提交
701
	bytes = sizeof(uv_node_to_blade[0]) * num_possible_nodes();
702
	uv_node_to_blade = kmalloc(bytes, GFP_KERNEL);
703
	BUG_ON(!uv_node_to_blade);
J
Jack Steiner 已提交
704 705 706
	memset(uv_node_to_blade, 255, bytes);

	bytes = sizeof(uv_cpu_to_blade[0]) * num_possible_cpus();
707
	uv_cpu_to_blade = kmalloc(bytes, GFP_KERNEL);
708
	BUG_ON(!uv_cpu_to_blade);
J
Jack Steiner 已提交
709 710
	memset(uv_cpu_to_blade, 255, bytes);

711 712 713 714 715 716
	blade = 0;
	for (i = 0; i < UVH_NODE_PRESENT_TABLE_DEPTH; i++) {
		present = uv_read_local_mmr(UVH_NODE_PRESENT_TABLE + i * 8);
		for (j = 0; j < 64; j++) {
			if (!test_bit(j, &present))
				continue;
717 718
			pnode = (i * 64 + j);
			uv_blade_info[blade].pnode = pnode;
719
			uv_blade_info[blade].nr_possible_cpus = 0;
J
Jack Steiner 已提交
720
			uv_blade_info[blade].nr_online_cpus = 0;
721
			max_pnode = max(pnode, max_pnode);
722
			blade++;
J
Jack Steiner 已提交
723
		}
724
	}
J
Jack Steiner 已提交
725

726
	uv_bios_init();
727 728
	uv_bios_get_sn_info(0, &uv_type, &sn_partition_id, &sn_coherency_id,
			    &sn_region_size, &system_serial_number);
729 730
	uv_rtc_init();

731
	for_each_present_cpu(cpu) {
732 733
		int apicid = per_cpu(x86_cpu_to_apicid, cpu);

734
		nid = cpu_to_node(cpu);
735 736 737 738
		/*
		 * apic_pnode_shift must be set before calling uv_apicid_to_pnode();
		 */
		uv_cpu_hub_info(cpu)->apic_pnode_shift = uvh_apicid.s.pnode_shift;
739
		pnode = uv_apicid_to_pnode(apicid);
740 741 742 743
		blade = boot_pnode_to_blade(pnode);
		lcpu = uv_blade_info[blade].nr_possible_cpus;
		uv_blade_info[blade].nr_possible_cpus++;

744 745 746
		/* Any node on the blade, else will contain -1. */
		uv_blade_info[blade].memory_nid = nid;

747
		uv_cpu_hub_info(cpu)->lowmem_remap_base = lowmem_redir_base;
748
		uv_cpu_hub_info(cpu)->lowmem_remap_top = lowmem_redir_size;
749
		uv_cpu_hub_info(cpu)->m_val = m_val;
750
		uv_cpu_hub_info(cpu)->n_val = n_val;
J
Jack Steiner 已提交
751 752
		uv_cpu_hub_info(cpu)->numa_blade_id = blade;
		uv_cpu_hub_info(cpu)->blade_processor_id = lcpu;
753
		uv_cpu_hub_info(cpu)->pnode = pnode;
754
		uv_cpu_hub_info(cpu)->pnode_mask = pnode_mask;
755
		uv_cpu_hub_info(cpu)->gpa_mask = (1UL << (m_val + n_val)) - 1;
756
		uv_cpu_hub_info(cpu)->gnode_upper = gnode_upper;
757
		uv_cpu_hub_info(cpu)->gnode_extra = gnode_extra;
J
Jack Steiner 已提交
758
		uv_cpu_hub_info(cpu)->global_mmr_base = mmr_base;
759
		uv_cpu_hub_info(cpu)->coherency_domain_number = sn_coherency_id;
760
		uv_cpu_hub_info(cpu)->scir.offset = uv_scir_offset(apicid);
J
Jack Steiner 已提交
761 762 763
		uv_node_to_blade[nid] = blade;
		uv_cpu_to_blade[cpu] = blade;
	}
764

765 766 767 768 769
	/* Add blade/pnode info for nodes without cpus */
	for_each_online_node(nid) {
		if (uv_node_to_blade[nid] >= 0)
			continue;
		paddr = node_start_pfn(nid) << PAGE_SHIFT;
770
		paddr = uv_soc_phys_ram_to_gpa(paddr);
771 772 773 774 775
		pnode = (paddr >> m_val) & pnode_mask;
		blade = boot_pnode_to_blade(pnode);
		uv_node_to_blade[nid] = blade;
	}

776
	map_gru_high(max_pnode);
777
	map_mmr_high(max_pnode);
778
	map_mmioh_high(max_pnode);
J
Jack Steiner 已提交
779

780
	uv_cpu_init();
781
	uv_scir_register_cpu_notifier();
782
	uv_register_nmi_notifier();
783
	proc_mkdir("sgi_uv", NULL);
784 785 786

	/* register Legacy VGA I/O redirection handler */
	pci_register_set_vga_state(uv_set_vga_state);
J
Jack Steiner 已提交
787
}