events_base.c 37.8 KB
Newer Older
J
Jeremy Fitzhardinge 已提交
1 2 3 4 5 6 7
/*
 * Xen event channels
 *
 * Xen models interrupts with abstract event channels.  Because each
 * domain gets 1024 event channels, but NR_IRQ is not that large, we
 * must dynamically map irqs<->event channels.  The event channels
 * interface with the rest of the kernel by defining a xen interrupt
L
Lucas De Marchi 已提交
8
 * chip.  When an event is received, it is mapped to an irq and sent
J
Jeremy Fitzhardinge 已提交
9 10 11 12 13 14 15 16 17 18
 * through the normal interrupt processing path.
 *
 * There are four kinds of events which can be mapped to an event
 * channel:
 *
 * 1. Inter-domain notifications.  This includes all the virtual
 *    device events, since they're driven by front-ends in another domain
 *    (typically dom0).
 * 2. VIRQs, typically used for timers.  These are per-cpu events.
 * 3. IPIs.
19
 * 4. PIRQs - Hardware interrupts.
J
Jeremy Fitzhardinge 已提交
20 21 22 23
 *
 * Jeremy Fitzhardinge <jeremy@xensource.com>, XenSource Inc, 2007
 */

J
Joe Perches 已提交
24 25
#define pr_fmt(fmt) "xen:" KBUILD_MODNAME ": " fmt

J
Jeremy Fitzhardinge 已提交
26 27 28
#include <linux/linkage.h>
#include <linux/interrupt.h>
#include <linux/irq.h>
29
#include <linux/moduleparam.h>
J
Jeremy Fitzhardinge 已提交
30
#include <linux/string.h>
31
#include <linux/bootmem.h>
32
#include <linux/slab.h>
33
#include <linux/irqnr.h>
34
#include <linux/pci.h>
J
Jeremy Fitzhardinge 已提交
35

36
#ifdef CONFIG_X86
37
#include <asm/desc.h>
J
Jeremy Fitzhardinge 已提交
38 39
#include <asm/ptrace.h>
#include <asm/irq.h>
40
#include <asm/idle.h>
41
#include <asm/io_apic.h>
42
#include <asm/i8259.h>
43
#include <asm/xen/pci.h>
44 45
#endif
#include <asm/sync_bitops.h>
J
Jeremy Fitzhardinge 已提交
46
#include <asm/xen/hypercall.h>
47
#include <asm/xen/hypervisor.h>
48
#include <xen/page.h>
J
Jeremy Fitzhardinge 已提交
49

50 51
#include <xen/xen.h>
#include <xen/hvm.h>
52
#include <xen/xen-ops.h>
J
Jeremy Fitzhardinge 已提交
53 54 55
#include <xen/events.h>
#include <xen/interface/xen.h>
#include <xen/interface/event_channel.h>
56 57
#include <xen/interface/hvm/hvm_op.h>
#include <xen/interface/hvm/params.h>
58 59
#include <xen/interface/physdev.h>
#include <xen/interface/sched.h>
60
#include <xen/interface/vcpu.h>
61
#include <asm/hw_irq.h>
J
Jeremy Fitzhardinge 已提交
62

63 64
#include "events_internal.h"

65 66
const struct evtchn_ops *evtchn_ops;

J
Jeremy Fitzhardinge 已提交
67 68 69 70
/*
 * This lock protects updates to the following mapping and reference-count
 * arrays. The lock does not need to be acquired to read the mapping tables.
 */
71
static DEFINE_MUTEX(irq_mapping_update_lock);
J
Jeremy Fitzhardinge 已提交
72

73 74
static LIST_HEAD(xen_irq_list_head);

J
Jeremy Fitzhardinge 已提交
75
/* IRQ <-> VIRQ mapping. */
76
static DEFINE_PER_CPU(int [NR_VIRQS], virq_to_irq) = {[0 ... NR_VIRQS-1] = -1};
J
Jeremy Fitzhardinge 已提交
77

J
Jeremy Fitzhardinge 已提交
78
/* IRQ <-> IPI mapping */
79
static DEFINE_PER_CPU(int [XEN_NR_IPIS], ipi_to_irq) = {[0 ... XEN_NR_IPIS-1] = -1};
J
Jeremy Fitzhardinge 已提交
80

81
int **evtchn_to_irq;
82
#ifdef CONFIG_X86
S
Stefano Stabellini 已提交
83
static unsigned long *pirq_eoi_map;
84
#endif
S
Stefano Stabellini 已提交
85
static bool (*pirq_needs_eoi)(unsigned irq);
86

87 88 89 90
#define EVTCHN_ROW(e)  (e / (PAGE_SIZE/sizeof(**evtchn_to_irq)))
#define EVTCHN_COL(e)  (e % (PAGE_SIZE/sizeof(**evtchn_to_irq)))
#define EVTCHN_PER_ROW (PAGE_SIZE / sizeof(**evtchn_to_irq))

J
Jeremy Fitzhardinge 已提交
91 92 93 94
/* Xen will never allocate port zero for any purpose. */
#define VALID_EVTCHN(chn)	((chn) != 0)

static struct irq_chip xen_dynamic_chip;
95
static struct irq_chip xen_percpu_chip;
96
static struct irq_chip xen_pirq_chip;
97 98
static void enable_dynirq(struct irq_data *data);
static void disable_dynirq(struct irq_data *data);
J
Jeremy Fitzhardinge 已提交
99

100 101 102 103 104 105 106 107 108 109 110 111 112 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 148 149 150 151 152 153 154
static void clear_evtchn_to_irq_row(unsigned row)
{
	unsigned col;

	for (col = 0; col < EVTCHN_PER_ROW; col++)
		evtchn_to_irq[row][col] = -1;
}

static void clear_evtchn_to_irq_all(void)
{
	unsigned row;

	for (row = 0; row < EVTCHN_ROW(xen_evtchn_max_channels()); row++) {
		if (evtchn_to_irq[row] == NULL)
			continue;
		clear_evtchn_to_irq_row(row);
	}
}

static int set_evtchn_to_irq(unsigned evtchn, unsigned irq)
{
	unsigned row;
	unsigned col;

	if (evtchn >= xen_evtchn_max_channels())
		return -EINVAL;

	row = EVTCHN_ROW(evtchn);
	col = EVTCHN_COL(evtchn);

	if (evtchn_to_irq[row] == NULL) {
		/* Unallocated irq entries return -1 anyway */
		if (irq == -1)
			return 0;

		evtchn_to_irq[row] = (int *)get_zeroed_page(GFP_KERNEL);
		if (evtchn_to_irq[row] == NULL)
			return -ENOMEM;

		clear_evtchn_to_irq_row(row);
	}

	evtchn_to_irq[EVTCHN_ROW(evtchn)][EVTCHN_COL(evtchn)] = irq;
	return 0;
}

int get_evtchn_to_irq(unsigned evtchn)
{
	if (evtchn >= xen_evtchn_max_channels())
		return -1;
	if (evtchn_to_irq[EVTCHN_ROW(evtchn)] == NULL)
		return -1;
	return evtchn_to_irq[EVTCHN_ROW(evtchn)][EVTCHN_COL(evtchn)];
}

155
/* Get info for IRQ */
156
struct irq_info *info_for_irq(unsigned irq)
157
{
T
Thomas Gleixner 已提交
158
	return irq_get_handler_data(irq);
159 160
}

161
/* Constructors for packed IRQ information. */
162
static int xen_irq_info_common_setup(struct irq_info *info,
163
				     unsigned irq,
164
				     enum xen_irq_type type,
165
				     unsigned evtchn,
166
				     unsigned short cpu)
167
{
168
	int ret;
169 170 171 172

	BUG_ON(info->type != IRQT_UNBOUND && info->type != type);

	info->type = type;
173
	info->irq = irq;
174 175
	info->evtchn = evtchn;
	info->cpu = cpu;
176

177 178 179
	ret = set_evtchn_to_irq(evtchn, irq);
	if (ret < 0)
		return ret;
180 181

	irq_clear_status_flags(irq, IRQ_NOREQUEST|IRQ_NOAUTOEN);
182

183
	return xen_evtchn_port_setup(info);
184 185
}

186
static int xen_irq_info_evtchn_setup(unsigned irq,
187
				     unsigned evtchn)
188
{
189 190
	struct irq_info *info = info_for_irq(irq);

191
	return xen_irq_info_common_setup(info, irq, IRQT_EVTCHN, evtchn, 0);
192 193
}

194
static int xen_irq_info_ipi_setup(unsigned cpu,
195
				  unsigned irq,
196
				  unsigned evtchn,
197
				  enum ipi_vector ipi)
J
Jeremy Fitzhardinge 已提交
198
{
199 200 201
	struct irq_info *info = info_for_irq(irq);

	info->u.ipi = ipi;
202 203

	per_cpu(ipi_to_irq, cpu)[ipi] = irq;
204 205

	return xen_irq_info_common_setup(info, irq, IRQT_IPI, evtchn, 0);
206 207
}

208
static int xen_irq_info_virq_setup(unsigned cpu,
209
				   unsigned irq,
210 211
				   unsigned evtchn,
				   unsigned virq)
212
{
213 214 215
	struct irq_info *info = info_for_irq(irq);

	info->u.virq = virq;
216 217

	per_cpu(virq_to_irq, cpu)[virq] = irq;
218 219

	return xen_irq_info_common_setup(info, irq, IRQT_VIRQ, evtchn, 0);
220 221
}

222
static int xen_irq_info_pirq_setup(unsigned irq,
223 224 225
				   unsigned evtchn,
				   unsigned pirq,
				   unsigned gsi,
226
				   uint16_t domid,
227
				   unsigned char flags)
228
{
229 230 231 232
	struct irq_info *info = info_for_irq(irq);

	info->u.pirq.pirq = pirq;
	info->u.pirq.gsi = gsi;
233
	info->u.pirq.domid = domid;
234
	info->u.pirq.flags = flags;
235 236

	return xen_irq_info_common_setup(info, irq, IRQT_PIRQ, evtchn, 0);
J
Jeremy Fitzhardinge 已提交
237 238
}

239 240 241 242 243 244
static void xen_irq_info_cleanup(struct irq_info *info)
{
	set_evtchn_to_irq(info->evtchn, -1);
	info->evtchn = 0;
}

J
Jeremy Fitzhardinge 已提交
245 246 247
/*
 * Accessors for packed IRQ information.
 */
248
unsigned int evtchn_from_irq(unsigned irq)
J
Jeremy Fitzhardinge 已提交
249
{
250
	if (unlikely(WARN(irq >= nr_irqs, "Invalid irq %d!\n", irq)))
251 252
		return 0;

253
	return info_for_irq(irq)->evtchn;
J
Jeremy Fitzhardinge 已提交
254 255
}

I
Ian Campbell 已提交
256 257
unsigned irq_from_evtchn(unsigned int evtchn)
{
258
	return get_evtchn_to_irq(evtchn);
I
Ian Campbell 已提交
259 260 261
}
EXPORT_SYMBOL_GPL(irq_from_evtchn);

262 263 264 265 266
int irq_from_virq(unsigned int cpu, unsigned int virq)
{
	return per_cpu(virq_to_irq, cpu)[virq];
}

267
static enum ipi_vector ipi_from_irq(unsigned irq)
J
Jeremy Fitzhardinge 已提交
268
{
269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286
	struct irq_info *info = info_for_irq(irq);

	BUG_ON(info == NULL);
	BUG_ON(info->type != IRQT_IPI);

	return info->u.ipi;
}

static unsigned virq_from_irq(unsigned irq)
{
	struct irq_info *info = info_for_irq(irq);

	BUG_ON(info == NULL);
	BUG_ON(info->type != IRQT_VIRQ);

	return info->u.virq;
}

S
Stefano Stabellini 已提交
287 288 289 290 291 292 293 294 295 296
static unsigned pirq_from_irq(unsigned irq)
{
	struct irq_info *info = info_for_irq(irq);

	BUG_ON(info == NULL);
	BUG_ON(info->type != IRQT_PIRQ);

	return info->u.pirq.pirq;
}

297 298 299 300 301
static enum xen_irq_type type_from_irq(unsigned irq)
{
	return info_for_irq(irq)->type;
}

302
unsigned cpu_from_irq(unsigned irq)
303 304 305 306
{
	return info_for_irq(irq)->cpu;
}

307
unsigned int cpu_from_evtchn(unsigned int evtchn)
308
{
309
	int irq = get_evtchn_to_irq(evtchn);
310 311 312 313 314 315
	unsigned ret = 0;

	if (irq != -1)
		ret = cpu_from_irq(irq);

	return ret;
J
Jeremy Fitzhardinge 已提交
316 317
}

318
#ifdef CONFIG_X86
S
Stefano Stabellini 已提交
319
static bool pirq_check_eoi_map(unsigned irq)
320
{
321
	return test_bit(pirq_from_irq(irq), pirq_eoi_map);
S
Stefano Stabellini 已提交
322
}
323
#endif
324

S
Stefano Stabellini 已提交
325 326 327
static bool pirq_needs_eoi_flag(unsigned irq)
{
	struct irq_info *info = info_for_irq(irq);
328 329 330 331 332
	BUG_ON(info->type != IRQT_PIRQ);

	return info->u.pirq.flags & PIRQ_NEEDS_EOI;
}

J
Jeremy Fitzhardinge 已提交
333 334
static void bind_evtchn_to_cpu(unsigned int chn, unsigned int cpu)
{
335
	int irq = get_evtchn_to_irq(chn);
336
	struct irq_info *info = info_for_irq(irq);
J
Jeremy Fitzhardinge 已提交
337 338 339

	BUG_ON(irq == -1);
#ifdef CONFIG_SMP
340
	cpumask_copy(irq_get_affinity_mask(irq), cpumask_of(cpu));
J
Jeremy Fitzhardinge 已提交
341
#endif
342
	xen_evtchn_port_bind_to_cpu(info, cpu);
343

344
	info->cpu = cpu;
345 346
}

347 348 349 350 351 352 353 354
static void xen_evtchn_mask_all(void)
{
	unsigned int evtchn;

	for (evtchn = 0; evtchn < xen_evtchn_nr_channels(); evtchn++)
		mask_evtchn(evtchn);
}

J
Jeremy Fitzhardinge 已提交
355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371
/**
 * notify_remote_via_irq - send event to remote end of event channel via irq
 * @irq: irq of event channel to send event to
 *
 * Unlike notify_remote_via_evtchn(), this is safe to use across
 * save/restore. Notifications on a broken connection are silently
 * dropped.
 */
void notify_remote_via_irq(int irq)
{
	int evtchn = evtchn_from_irq(irq);

	if (VALID_EVTCHN(evtchn))
		notify_remote_via_evtchn(evtchn);
}
EXPORT_SYMBOL_GPL(notify_remote_via_irq);

372 373 374
static void xen_irq_init(unsigned irq)
{
	struct irq_info *info;
375
#ifdef CONFIG_SMP
376
	/* By default all event channels notify CPU#0. */
377
	cpumask_copy(irq_get_affinity_mask(irq), cpumask_of(0));
378
#endif
379

380 381 382
	info = kzalloc(sizeof(*info), GFP_KERNEL);
	if (info == NULL)
		panic("Unable to allocate metadata for IRQ%d\n", irq);
383 384

	info->type = IRQT_UNBOUND;
385
	info->refcnt = -1;
386

T
Thomas Gleixner 已提交
387
	irq_set_handler_data(irq, info);
388

389 390 391
	list_add_tail(&info->list, &xen_irq_list_head);
}

392
static int __must_check xen_allocate_irqs_dynamic(int nvec)
393
{
394
	int i, irq = irq_alloc_descs(-1, 0, nvec, -1);
395

396 397 398 399
	if (irq >= 0) {
		for (i = 0; i < nvec; i++)
			xen_irq_init(irq + i);
	}
400

J
Jeremy Fitzhardinge 已提交
401
	return irq;
402 403
}

404 405 406 407 408 409
static inline int __must_check xen_allocate_irq_dynamic(void)
{

	return xen_allocate_irqs_dynamic(1);
}

410
static int __must_check xen_allocate_irq_gsi(unsigned gsi)
411 412 413
{
	int irq;

414 415 416 417 418 419 420
	/*
	 * A PV guest has no concept of a GSI (since it has no ACPI
	 * nor access to/knowledge of the physical APICs). Therefore
	 * all IRQs are dynamically allocated from the entire IRQ
	 * space.
	 */
	if (xen_pv_domain() && !xen_initial_domain())
421 422 423
		return xen_allocate_irq_dynamic();

	/* Legacy IRQ descriptors are already allocated by the arch. */
424
	if (gsi < nr_legacy_irqs())
425 426 427
		irq = gsi;
	else
		irq = irq_alloc_desc_at(gsi, -1);
428

429
	xen_irq_init(irq);
430 431 432 433 434 435

	return irq;
}

static void xen_free_irq(unsigned irq)
{
T
Thomas Gleixner 已提交
436
	struct irq_info *info = irq_get_handler_data(irq);
437

438 439 440
	if (WARN_ON(!info))
		return;

441
	list_del(&info->list);
442

T
Thomas Gleixner 已提交
443
	irq_set_handler_data(irq, NULL);
444

445 446
	WARN_ON(info->refcnt > 0);

447 448
	kfree(info);

449
	/* Legacy IRQ descriptors are managed by the arch. */
450
	if (irq < nr_legacy_irqs())
451 452
		return;

453 454 455
	irq_free_desc(irq);
}

456 457 458 459 460 461 462 463 464
static void xen_evtchn_close(unsigned int port)
{
	struct evtchn_close close;

	close.port = port;
	if (HYPERVISOR_event_channel_op(EVTCHNOP_close, &close) != 0)
		BUG();
}

465 466 467 468 469 470 471
static void pirq_query_unmask(int irq)
{
	struct physdev_irq_status_query irq_status;
	struct irq_info *info = info_for_irq(irq);

	BUG_ON(info->type != IRQT_PIRQ);

S
Stefano Stabellini 已提交
472
	irq_status.irq = pirq_from_irq(irq);
473 474 475 476 477 478 479 480
	if (HYPERVISOR_physdev_op(PHYSDEVOP_irq_status_query, &irq_status))
		irq_status.flags = 0;

	info->u.pirq.flags &= ~PIRQ_NEEDS_EOI;
	if (irq_status.flags & XENIRQSTAT_needs_eoi)
		info->u.pirq.flags |= PIRQ_NEEDS_EOI;
}

481 482 483 484 485 486
static void eoi_pirq(struct irq_data *data)
{
	int evtchn = evtchn_from_irq(data->irq);
	struct physdev_eoi eoi = { .irq = pirq_from_irq(data->irq) };
	int rc = 0;

B
Boris Ostrovsky 已提交
487 488
	if (!VALID_EVTCHN(evtchn))
		return;
489

490 491
	if (unlikely(irqd_is_setaffinity_pending(data)) &&
	    likely(!irqd_irq_disabled(data))) {
B
Boris Ostrovsky 已提交
492 493 494 495 496 497 498 499 500
		int masked = test_and_set_mask(evtchn);

		clear_evtchn(evtchn);

		irq_move_masked_irq(data);

		if (!masked)
			unmask_evtchn(evtchn);
	} else
501 502 503 504 505 506 507 508 509 510 511 512 513 514
		clear_evtchn(evtchn);

	if (pirq_needs_eoi(data->irq)) {
		rc = HYPERVISOR_physdev_op(PHYSDEVOP_eoi, &eoi);
		WARN_ON(rc);
	}
}

static void mask_ack_pirq(struct irq_data *data)
{
	disable_dynirq(data);
	eoi_pirq(data);
}

515
static unsigned int __startup_pirq(unsigned int irq)
516 517 518 519
{
	struct evtchn_bind_pirq bind_pirq;
	struct irq_info *info = info_for_irq(irq);
	int evtchn = evtchn_from_irq(irq);
520
	int rc;
521 522 523 524 525 526

	BUG_ON(info->type != IRQT_PIRQ);

	if (VALID_EVTCHN(evtchn))
		goto out;

S
Stefano Stabellini 已提交
527
	bind_pirq.pirq = pirq_from_irq(irq);
528
	/* NB. We are happy to share unless we are probing. */
529 530 531 532
	bind_pirq.flags = info->u.pirq.flags & PIRQ_SHAREABLE ?
					BIND_PIRQ__WILL_SHARE : 0;
	rc = HYPERVISOR_event_channel_op(EVTCHNOP_bind_pirq, &bind_pirq);
	if (rc != 0) {
533
		pr_warn("Failed to obtain physical IRQ %d\n", irq);
534 535 536 537 538 539
		return 0;
	}
	evtchn = bind_pirq.port;

	pirq_query_unmask(irq);

540
	rc = set_evtchn_to_irq(evtchn, irq);
541 542 543
	if (rc)
		goto err;

544
	info->evtchn = evtchn;
545
	bind_evtchn_to_cpu(evtchn, 0);
546

547 548 549 550
	rc = xen_evtchn_port_setup(info);
	if (rc)
		goto err;

551 552
out:
	unmask_evtchn(evtchn);
553
	eoi_pirq(irq_get_irq_data(irq));
554 555

	return 0;
556 557 558 559 560

err:
	pr_err("irq%d: Failed to set port to irq mapping (%d)\n", irq, rc);
	xen_evtchn_close(evtchn);
	return 0;
561 562
}

563 564 565 566 567 568
static unsigned int startup_pirq(struct irq_data *data)
{
	return __startup_pirq(data->irq);
}

static void shutdown_pirq(struct irq_data *data)
569
{
570
	unsigned int irq = data->irq;
571
	struct irq_info *info = info_for_irq(irq);
572
	unsigned evtchn = evtchn_from_irq(irq);
573 574 575 576 577 578 579

	BUG_ON(info->type != IRQT_PIRQ);

	if (!VALID_EVTCHN(evtchn))
		return;

	mask_evtchn(evtchn);
580 581
	xen_evtchn_close(evtchn);
	xen_irq_info_cleanup(info);
582 583
}

584
static void enable_pirq(struct irq_data *data)
585
{
586
	startup_pirq(data);
587 588
}

589
static void disable_pirq(struct irq_data *data)
590
{
591
	disable_dynirq(data);
592 593
}

594
int xen_irq_from_gsi(unsigned gsi)
595
{
596
	struct irq_info *info;
597

598 599
	list_for_each_entry(info, &xen_irq_list_head, list) {
		if (info->type != IRQT_PIRQ)
600 601
			continue;

602 603
		if (info->u.pirq.gsi == gsi)
			return info->irq;
604 605 606 607
	}

	return -1;
}
608
EXPORT_SYMBOL_GPL(xen_irq_from_gsi);
609

610 611 612 613 614 615 616 617 618 619 620 621
static void __unbind_from_irq(unsigned int irq)
{
	int evtchn = evtchn_from_irq(irq);
	struct irq_info *info = irq_get_handler_data(irq);

	if (info->refcnt > 0) {
		info->refcnt--;
		if (info->refcnt != 0)
			return;
	}

	if (VALID_EVTCHN(evtchn)) {
622 623 624
		unsigned int cpu = cpu_from_irq(irq);

		xen_evtchn_close(evtchn);
625 626 627

		switch (type_from_irq(irq)) {
		case IRQT_VIRQ:
628
			per_cpu(virq_to_irq, cpu)[virq_from_irq(irq)] = -1;
629 630
			break;
		case IRQT_IPI:
631
			per_cpu(ipi_to_irq, cpu)[ipi_from_irq(irq)] = -1;
632 633 634 635 636
			break;
		default:
			break;
		}

637
		xen_irq_info_cleanup(info);
638 639 640 641 642 643 644
	}

	BUG_ON(info_for_irq(irq)->type == IRQT_UNBOUND);

	xen_free_irq(irq);
}

I
Ian Campbell 已提交
645 646 647
/*
 * Do not make any assumptions regarding the relationship between the
 * IRQ number returned here and the Xen pirq argument.
S
Stefano Stabellini 已提交
648 649 650
 *
 * Note: We don't assign an event channel until the irq actually started
 * up.  Return an existing irq if we've already got one for the gsi.
651 652 653
 *
 * Shareable implies level triggered, not shareable implies edge
 * triggered here.
654
 */
655 656
int xen_bind_pirq_gsi_to_irq(unsigned gsi,
			     unsigned pirq, int shareable, char *name)
657
{
658
	int irq = -1;
659
	struct physdev_irq irq_op;
660
	int ret;
661

662
	mutex_lock(&irq_mapping_update_lock);
663

664
	irq = xen_irq_from_gsi(gsi);
665
	if (irq != -1) {
J
Joe Perches 已提交
666 667
		pr_info("%s: returning irq %d for gsi %u\n",
			__func__, irq, gsi);
668
		goto out;
669 670
	}

671
	irq = xen_allocate_irq_gsi(gsi);
672 673
	if (irq < 0)
		goto out;
674 675

	irq_op.irq = irq;
676 677 678 679 680 681 682
	irq_op.vector = 0;

	/* Only the privileged domain can do this. For non-priv, the pcifront
	 * driver provides a PCI bus that does the call to do exactly
	 * this in the priv domain. */
	if (xen_initial_domain() &&
	    HYPERVISOR_physdev_op(PHYSDEVOP_alloc_irq_vector, &irq_op)) {
683
		xen_free_irq(irq);
684 685 686 687
		irq = -ENOSPC;
		goto out;
	}

688
	ret = xen_irq_info_pirq_setup(irq, 0, pirq, gsi, DOMID_SELF,
689
			       shareable ? PIRQ_SHAREABLE : 0);
690 691 692 693 694
	if (ret < 0) {
		__unbind_from_irq(irq);
		irq = ret;
		goto out;
	}
695

696 697
	pirq_query_unmask(irq);
	/* We try to use the handler with the appropriate semantic for the
698 699
	 * type of interrupt: if the interrupt is an edge triggered
	 * interrupt we use handle_edge_irq.
700
	 *
701 702
	 * On the other hand if the interrupt is level triggered we use
	 * handle_fasteoi_irq like the native code does for this kind of
703
	 * interrupts.
704
	 *
705 706 707 708 709 710 711
	 * Depending on the Xen version, pirq_needs_eoi might return true
	 * not only for level triggered interrupts but for edge triggered
	 * interrupts too. In any case Xen always honors the eoi mechanism,
	 * not injecting any more pirqs of the same kind if the first one
	 * hasn't received an eoi yet. Therefore using the fasteoi handler
	 * is the right choice either way.
	 */
712
	if (shareable)
713 714 715 716 717 718
		irq_set_chip_and_handler_name(irq, &xen_pirq_chip,
				handle_fasteoi_irq, name);
	else
		irq_set_chip_and_handler_name(irq, &xen_pirq_chip,
				handle_edge_irq, name);

719
out:
720
	mutex_unlock(&irq_mapping_update_lock);
721 722 723 724

	return irq;
}

725
#ifdef CONFIG_PCI_MSI
726
int xen_allocate_pirq_msi(struct pci_dev *dev, struct msi_desc *msidesc)
727
{
728
	int rc;
729 730
	struct physdev_get_free_pirq op_get_free_pirq;

731
	op_get_free_pirq.type = MAP_PIRQ_TYPE_MSI;
732 733
	rc = HYPERVISOR_physdev_op(PHYSDEVOP_get_free_pirq, &op_get_free_pirq);

734 735 736 737
	WARN_ONCE(rc == -ENOSYS,
		  "hypervisor does not support the PHYSDEVOP_get_free_pirq interface\n");

	return rc ? -1 : op_get_free_pirq.pirq;
738 739
}

740
int xen_bind_pirq_msi_to_irq(struct pci_dev *dev, struct msi_desc *msidesc,
741
			     int pirq, int nvec, const char *name, domid_t domid)
S
Stefano Stabellini 已提交
742
{
743
	int i, irq, ret;
744

745
	mutex_lock(&irq_mapping_update_lock);
S
Stefano Stabellini 已提交
746

747
	irq = xen_allocate_irqs_dynamic(nvec);
748
	if (irq < 0)
749
		goto out;
S
Stefano Stabellini 已提交
750

751 752 753 754 755 756 757 758
	for (i = 0; i < nvec; i++) {
		irq_set_chip_and_handler_name(irq + i, &xen_pirq_chip, handle_edge_irq, name);

		ret = xen_irq_info_pirq_setup(irq + i, 0, pirq + i, 0, domid,
					      i == 0 ? 0 : PIRQ_MSI_GROUP);
		if (ret < 0)
			goto error_irq;
	}
S
Stefano Stabellini 已提交
759

760
	ret = irq_set_msi_desc(irq, msidesc);
761 762
	if (ret < 0)
		goto error_irq;
S
Stefano Stabellini 已提交
763
out:
764
	mutex_unlock(&irq_mapping_update_lock);
765
	return irq;
766
error_irq:
767 768
	for (; i >= 0; i--)
		__unbind_from_irq(irq + i);
769
	mutex_unlock(&irq_mapping_update_lock);
770
	return ret;
S
Stefano Stabellini 已提交
771
}
772 773
#endif

774 775
int xen_destroy_irq(int irq)
{
776 777
	struct physdev_unmap_pirq unmap_irq;
	struct irq_info *info = info_for_irq(irq);
778 779
	int rc = -ENOENT;

780
	mutex_lock(&irq_mapping_update_lock);
781

782 783 784 785 786 787
	/*
	 * If trying to remove a vector in a MSI group different
	 * than the first one skip the PIRQ unmap unless this vector
	 * is the first one in the group.
	 */
	if (xen_initial_domain() && !(info->u.pirq.flags & PIRQ_MSI_GROUP)) {
788
		unmap_irq.pirq = info->u.pirq.pirq;
789
		unmap_irq.domid = info->u.pirq.domid;
790
		rc = HYPERVISOR_physdev_op(PHYSDEVOP_unmap_pirq, &unmap_irq);
791 792 793 794 795
		/* If another domain quits without making the pci_disable_msix
		 * call, the Xen hypervisor takes care of freeing the PIRQs
		 * (free_domain_pirqs).
		 */
		if ((rc == -ESRCH && info->u.pirq.domid != DOMID_SELF))
J
Joe Perches 已提交
796
			pr_info("domain %d does not have %d anymore\n",
797 798
				info->u.pirq.domid, info->u.pirq.pirq);
		else if (rc) {
J
Joe Perches 已提交
799
			pr_warn("unmap irq failed %d\n", rc);
800 801 802
			goto out;
		}
	}
803

804
	xen_free_irq(irq);
805 806

out:
807
	mutex_unlock(&irq_mapping_update_lock);
808 809 810
	return rc;
}

811
int xen_irq_from_pirq(unsigned pirq)
812
{
813
	int irq;
814

815
	struct irq_info *info;
J
Jeremy Fitzhardinge 已提交
816

817
	mutex_lock(&irq_mapping_update_lock);
818 819

	list_for_each_entry(info, &xen_irq_list_head, list) {
820
		if (info->type != IRQT_PIRQ)
821 822 823 824 825 826 827
			continue;
		irq = info->irq;
		if (info->u.pirq.pirq == pirq)
			goto out;
	}
	irq = -1;
out:
828
	mutex_unlock(&irq_mapping_update_lock);
829 830

	return irq;
831 832
}

833 834 835 836 837 838

int xen_pirq_from_irq(unsigned irq)
{
	return pirq_from_irq(irq);
}
EXPORT_SYMBOL_GPL(xen_pirq_from_irq);
839

840
int bind_evtchn_to_irq(unsigned int evtchn)
J
Jeremy Fitzhardinge 已提交
841 842
{
	int irq;
843
	int ret;
J
Jeremy Fitzhardinge 已提交
844

845 846 847
	if (evtchn >= xen_evtchn_max_channels())
		return -ENOMEM;

848
	mutex_lock(&irq_mapping_update_lock);
J
Jeremy Fitzhardinge 已提交
849

850
	irq = get_evtchn_to_irq(evtchn);
J
Jeremy Fitzhardinge 已提交
851 852

	if (irq == -1) {
853
		irq = xen_allocate_irq_dynamic();
854
		if (irq < 0)
855
			goto out;
J
Jeremy Fitzhardinge 已提交
856

T
Thomas Gleixner 已提交
857
		irq_set_chip_and_handler_name(irq, &xen_dynamic_chip,
858
					      handle_edge_irq, "event");
J
Jeremy Fitzhardinge 已提交
859

860 861 862 863 864 865
		ret = xen_irq_info_evtchn_setup(irq, evtchn);
		if (ret < 0) {
			__unbind_from_irq(irq);
			irq = ret;
			goto out;
		}
866 867
		/* New interdomain events are bound to VCPU 0. */
		bind_evtchn_to_cpu(evtchn, 0);
868 869 870
	} else {
		struct irq_info *info = info_for_irq(irq);
		WARN_ON(info == NULL || info->type != IRQT_EVTCHN);
J
Jeremy Fitzhardinge 已提交
871 872
	}

873
out:
874
	mutex_unlock(&irq_mapping_update_lock);
J
Jeremy Fitzhardinge 已提交
875 876 877

	return irq;
}
878
EXPORT_SYMBOL_GPL(bind_evtchn_to_irq);
J
Jeremy Fitzhardinge 已提交
879

J
Jeremy Fitzhardinge 已提交
880 881 882 883
static int bind_ipi_to_irq(unsigned int ipi, unsigned int cpu)
{
	struct evtchn_bind_ipi bind_ipi;
	int evtchn, irq;
884
	int ret;
J
Jeremy Fitzhardinge 已提交
885

886
	mutex_lock(&irq_mapping_update_lock);
J
Jeremy Fitzhardinge 已提交
887 888

	irq = per_cpu(ipi_to_irq, cpu)[ipi];
889

J
Jeremy Fitzhardinge 已提交
890
	if (irq == -1) {
891
		irq = xen_allocate_irq_dynamic();
J
Jeremy Fitzhardinge 已提交
892 893 894
		if (irq < 0)
			goto out;

T
Thomas Gleixner 已提交
895
		irq_set_chip_and_handler_name(irq, &xen_percpu_chip,
896
					      handle_percpu_irq, "ipi");
J
Jeremy Fitzhardinge 已提交
897 898 899 900 901 902 903

		bind_ipi.vcpu = cpu;
		if (HYPERVISOR_event_channel_op(EVTCHNOP_bind_ipi,
						&bind_ipi) != 0)
			BUG();
		evtchn = bind_ipi.port;

904 905 906 907 908 909
		ret = xen_irq_info_ipi_setup(cpu, irq, evtchn, ipi);
		if (ret < 0) {
			__unbind_from_irq(irq);
			irq = ret;
			goto out;
		}
J
Jeremy Fitzhardinge 已提交
910
		bind_evtchn_to_cpu(evtchn, cpu);
911 912 913
	} else {
		struct irq_info *info = info_for_irq(irq);
		WARN_ON(info == NULL || info->type != IRQT_IPI);
J
Jeremy Fitzhardinge 已提交
914 915 916
	}

 out:
917
	mutex_unlock(&irq_mapping_update_lock);
J
Jeremy Fitzhardinge 已提交
918 919 920
	return irq;
}

921 922
int bind_interdomain_evtchn_to_irq(unsigned int remote_domain,
				   unsigned int remote_port)
923 924 925 926 927 928 929 930 931 932 933 934
{
	struct evtchn_bind_interdomain bind_interdomain;
	int err;

	bind_interdomain.remote_dom  = remote_domain;
	bind_interdomain.remote_port = remote_port;

	err = HYPERVISOR_event_channel_op(EVTCHNOP_bind_interdomain,
					  &bind_interdomain);

	return err ? : bind_evtchn_to_irq(bind_interdomain.local_port);
}
935
EXPORT_SYMBOL_GPL(bind_interdomain_evtchn_to_irq);
936

937 938 939 940 941 942
static int find_virq(unsigned int virq, unsigned int cpu)
{
	struct evtchn_status status;
	int port, rc = -ENOENT;

	memset(&status, 0, sizeof(status));
943
	for (port = 0; port < xen_evtchn_max_channels(); port++) {
944 945 946 947 948 949 950 951 952 953 954 955 956 957
		status.dom = DOMID_SELF;
		status.port = port;
		rc = HYPERVISOR_event_channel_op(EVTCHNOP_status, &status);
		if (rc < 0)
			continue;
		if (status.status != EVTCHNSTAT_virq)
			continue;
		if (status.u.virq == virq && status.vcpu == cpu) {
			rc = port;
			break;
		}
	}
	return rc;
}
J
Jeremy Fitzhardinge 已提交
958

959 960 961 962 963 964 965 966 967 968 969 970 971
/**
 * xen_evtchn_nr_channels - number of usable event channel ports
 *
 * This may be less than the maximum supported by the current
 * hypervisor ABI. Use xen_evtchn_max_channels() for the maximum
 * supported.
 */
unsigned xen_evtchn_nr_channels(void)
{
        return evtchn_ops->nr_channels();
}
EXPORT_SYMBOL_GPL(xen_evtchn_nr_channels);

972
int bind_virq_to_irq(unsigned int virq, unsigned int cpu, bool percpu)
J
Jeremy Fitzhardinge 已提交
973 974
{
	struct evtchn_bind_virq bind_virq;
975
	int evtchn, irq, ret;
J
Jeremy Fitzhardinge 已提交
976

977
	mutex_lock(&irq_mapping_update_lock);
J
Jeremy Fitzhardinge 已提交
978 979 980 981

	irq = per_cpu(virq_to_irq, cpu)[virq];

	if (irq == -1) {
982
		irq = xen_allocate_irq_dynamic();
983
		if (irq < 0)
984
			goto out;
985

986 987 988 989 990 991
		if (percpu)
			irq_set_chip_and_handler_name(irq, &xen_percpu_chip,
						      handle_percpu_irq, "virq");
		else
			irq_set_chip_and_handler_name(irq, &xen_dynamic_chip,
						      handle_edge_irq, "virq");
992

J
Jeremy Fitzhardinge 已提交
993 994
		bind_virq.virq = virq;
		bind_virq.vcpu = cpu;
995 996 997 998 999 1000 1001 1002 1003 1004
		ret = HYPERVISOR_event_channel_op(EVTCHNOP_bind_virq,
						&bind_virq);
		if (ret == 0)
			evtchn = bind_virq.port;
		else {
			if (ret == -EEXIST)
				ret = find_virq(virq, cpu);
			BUG_ON(ret < 0);
			evtchn = ret;
		}
J
Jeremy Fitzhardinge 已提交
1005

1006 1007 1008 1009 1010 1011
		ret = xen_irq_info_virq_setup(cpu, irq, evtchn, virq);
		if (ret < 0) {
			__unbind_from_irq(irq);
			irq = ret;
			goto out;
		}
J
Jeremy Fitzhardinge 已提交
1012 1013

		bind_evtchn_to_cpu(evtchn, cpu);
1014 1015 1016
	} else {
		struct irq_info *info = info_for_irq(irq);
		WARN_ON(info == NULL || info->type != IRQT_VIRQ);
J
Jeremy Fitzhardinge 已提交
1017 1018
	}

1019
out:
1020
	mutex_unlock(&irq_mapping_update_lock);
J
Jeremy Fitzhardinge 已提交
1021 1022 1023 1024 1025 1026

	return irq;
}

static void unbind_from_irq(unsigned int irq)
{
1027
	mutex_lock(&irq_mapping_update_lock);
1028
	__unbind_from_irq(irq);
1029
	mutex_unlock(&irq_mapping_update_lock);
J
Jeremy Fitzhardinge 已提交
1030 1031 1032
}

int bind_evtchn_to_irqhandler(unsigned int evtchn,
1033
			      irq_handler_t handler,
J
Jeremy Fitzhardinge 已提交
1034 1035 1036
			      unsigned long irqflags,
			      const char *devname, void *dev_id)
{
1037
	int irq, retval;
J
Jeremy Fitzhardinge 已提交
1038 1039

	irq = bind_evtchn_to_irq(evtchn);
1040 1041
	if (irq < 0)
		return irq;
J
Jeremy Fitzhardinge 已提交
1042 1043 1044 1045 1046 1047 1048 1049 1050 1051
	retval = request_irq(irq, handler, irqflags, devname, dev_id);
	if (retval != 0) {
		unbind_from_irq(irq);
		return retval;
	}

	return irq;
}
EXPORT_SYMBOL_GPL(bind_evtchn_to_irqhandler);

1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074
int bind_interdomain_evtchn_to_irqhandler(unsigned int remote_domain,
					  unsigned int remote_port,
					  irq_handler_t handler,
					  unsigned long irqflags,
					  const char *devname,
					  void *dev_id)
{
	int irq, retval;

	irq = bind_interdomain_evtchn_to_irq(remote_domain, remote_port);
	if (irq < 0)
		return irq;

	retval = request_irq(irq, handler, irqflags, devname, dev_id);
	if (retval != 0) {
		unbind_from_irq(irq);
		return retval;
	}

	return irq;
}
EXPORT_SYMBOL_GPL(bind_interdomain_evtchn_to_irqhandler);

J
Jeremy Fitzhardinge 已提交
1075
int bind_virq_to_irqhandler(unsigned int virq, unsigned int cpu,
1076
			    irq_handler_t handler,
J
Jeremy Fitzhardinge 已提交
1077 1078
			    unsigned long irqflags, const char *devname, void *dev_id)
{
1079
	int irq, retval;
J
Jeremy Fitzhardinge 已提交
1080

1081
	irq = bind_virq_to_irq(virq, cpu, irqflags & IRQF_PERCPU);
1082 1083
	if (irq < 0)
		return irq;
J
Jeremy Fitzhardinge 已提交
1084 1085 1086 1087 1088 1089 1090 1091 1092 1093
	retval = request_irq(irq, handler, irqflags, devname, dev_id);
	if (retval != 0) {
		unbind_from_irq(irq);
		return retval;
	}

	return irq;
}
EXPORT_SYMBOL_GPL(bind_virq_to_irqhandler);

J
Jeremy Fitzhardinge 已提交
1094 1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106
int bind_ipi_to_irqhandler(enum ipi_vector ipi,
			   unsigned int cpu,
			   irq_handler_t handler,
			   unsigned long irqflags,
			   const char *devname,
			   void *dev_id)
{
	int irq, retval;

	irq = bind_ipi_to_irq(ipi, cpu);
	if (irq < 0)
		return irq;

1107
	irqflags |= IRQF_NO_SUSPEND | IRQF_FORCE_RESUME | IRQF_EARLY_RESUME;
J
Jeremy Fitzhardinge 已提交
1108 1109 1110 1111 1112 1113 1114 1115 1116
	retval = request_irq(irq, handler, irqflags, devname, dev_id);
	if (retval != 0) {
		unbind_from_irq(irq);
		return retval;
	}

	return irq;
}

J
Jeremy Fitzhardinge 已提交
1117 1118
void unbind_from_irqhandler(unsigned int irq, void *dev_id)
{
1119 1120 1121 1122
	struct irq_info *info = irq_get_handler_data(irq);

	if (WARN_ON(!info))
		return;
J
Jeremy Fitzhardinge 已提交
1123 1124 1125 1126 1127
	free_irq(irq, dev_id);
	unbind_from_irq(irq);
}
EXPORT_SYMBOL_GPL(unbind_from_irqhandler);

1128 1129 1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144
/**
 * xen_set_irq_priority() - set an event channel priority.
 * @irq:irq bound to an event channel.
 * @priority: priority between XEN_IRQ_PRIORITY_MAX and XEN_IRQ_PRIORITY_MIN.
 */
int xen_set_irq_priority(unsigned irq, unsigned priority)
{
	struct evtchn_set_priority set_priority;

	set_priority.port = evtchn_from_irq(irq);
	set_priority.priority = priority;

	return HYPERVISOR_event_channel_op(EVTCHNOP_set_priority,
					   &set_priority);
}
EXPORT_SYMBOL_GPL(xen_set_irq_priority);

1145 1146
int evtchn_make_refcounted(unsigned int evtchn)
{
1147
	int irq = get_evtchn_to_irq(evtchn);
1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171
	struct irq_info *info;

	if (irq == -1)
		return -ENOENT;

	info = irq_get_handler_data(irq);

	if (!info)
		return -ENOENT;

	WARN_ON(info->refcnt != -1);

	info->refcnt = 1;

	return 0;
}
EXPORT_SYMBOL_GPL(evtchn_make_refcounted);

int evtchn_get(unsigned int evtchn)
{
	int irq;
	struct irq_info *info;
	int err = -ENOENT;

1172
	if (evtchn >= xen_evtchn_max_channels())
1173 1174
		return -EINVAL;

1175 1176
	mutex_lock(&irq_mapping_update_lock);

1177
	irq = get_evtchn_to_irq(evtchn);
1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200
	if (irq == -1)
		goto done;

	info = irq_get_handler_data(irq);

	if (!info)
		goto done;

	err = -EINVAL;
	if (info->refcnt <= 0)
		goto done;

	info->refcnt++;
	err = 0;
 done:
	mutex_unlock(&irq_mapping_update_lock);

	return err;
}
EXPORT_SYMBOL_GPL(evtchn_get);

void evtchn_put(unsigned int evtchn)
{
1201
	int irq = get_evtchn_to_irq(evtchn);
1202 1203 1204 1205 1206 1207
	if (WARN_ON(irq == -1))
		return;
	unbind_from_irq(irq);
}
EXPORT_SYMBOL_GPL(evtchn_put);

J
Jeremy Fitzhardinge 已提交
1208 1209
void xen_send_IPI_one(unsigned int cpu, enum ipi_vector vector)
{
1210 1211
	int irq;

1212
#ifdef CONFIG_X86
1213 1214 1215 1216 1217 1218
	if (unlikely(vector == XEN_NMI_VECTOR)) {
		int rc =  HYPERVISOR_vcpu_op(VCPUOP_send_nmi, cpu, NULL);
		if (rc < 0)
			printk(KERN_WARNING "Sending nmi to CPU%d failed (rc:%d)\n", cpu, rc);
		return;
	}
1219
#endif
1220
	irq = per_cpu(ipi_to_irq, cpu)[vector];
J
Jeremy Fitzhardinge 已提交
1221 1222 1223 1224
	BUG_ON(irq < 0);
	notify_remote_via_irq(irq);
}

1225 1226
static DEFINE_PER_CPU(unsigned, xed_nesting_count);

1227
static void __xen_evtchn_do_upcall(void)
J
Jeremy Fitzhardinge 已提交
1228
{
C
Christoph Lameter 已提交
1229
	struct vcpu_info *vcpu_info = __this_cpu_read(xen_vcpu);
1230
	int cpu = get_cpu();
1231
	unsigned count;
J
Jeremy Fitzhardinge 已提交
1232

1233 1234
	do {
		vcpu_info->evtchn_upcall_pending = 0;
J
Jeremy Fitzhardinge 已提交
1235

C
Christoph Lameter 已提交
1236
		if (__this_cpu_inc_return(xed_nesting_count) - 1)
1237
			goto out;
J
Jeremy Fitzhardinge 已提交
1238

1239
		xen_evtchn_handle_events(cpu);
J
Jeremy Fitzhardinge 已提交
1240

1241 1242
		BUG_ON(!irqs_disabled());

C
Christoph Lameter 已提交
1243 1244
		count = __this_cpu_read(xed_nesting_count);
		__this_cpu_write(xed_nesting_count, 0);
1245
	} while (count != 1 || vcpu_info->evtchn_upcall_pending);
1246 1247

out:
1248 1249 1250 1251 1252 1253 1254 1255

	put_cpu();
}

void xen_evtchn_do_upcall(struct pt_regs *regs)
{
	struct pt_regs *old_regs = set_irq_regs(regs);

1256
	irq_enter();
1257
#ifdef CONFIG_X86
1258
	exit_idle();
1259
	inc_irq_stat(irq_hv_callback_count);
1260
#endif
1261 1262 1263

	__xen_evtchn_do_upcall();

1264 1265
	irq_exit();
	set_irq_regs(old_regs);
1266
}
1267

1268 1269 1270
void xen_hvm_evtchn_do_upcall(void)
{
	__xen_evtchn_do_upcall();
J
Jeremy Fitzhardinge 已提交
1271
}
1272
EXPORT_SYMBOL_GPL(xen_hvm_evtchn_do_upcall);
J
Jeremy Fitzhardinge 已提交
1273

J
Jeremy Fitzhardinge 已提交
1274 1275 1276
/* Rebind a new event channel to an existing irq. */
void rebind_evtchn_irq(int evtchn, int irq)
{
J
Jeremy Fitzhardinge 已提交
1277 1278
	struct irq_info *info = info_for_irq(irq);

1279 1280 1281
	if (WARN_ON(!info))
		return;

J
Jeremy Fitzhardinge 已提交
1282 1283 1284 1285
	/* Make sure the irq is masked, since the new event channel
	   will also be masked. */
	disable_irq(irq);

1286
	mutex_lock(&irq_mapping_update_lock);
J
Jeremy Fitzhardinge 已提交
1287 1288

	/* After resume the irq<->evtchn mappings are all cleared out */
1289
	BUG_ON(get_evtchn_to_irq(evtchn) != -1);
J
Jeremy Fitzhardinge 已提交
1290
	/* Expect irq to have been bound before,
J
Jeremy Fitzhardinge 已提交
1291 1292
	   so there should be a proper type */
	BUG_ON(info->type == IRQT_UNBOUND);
J
Jeremy Fitzhardinge 已提交
1293

1294
	(void)xen_irq_info_evtchn_setup(irq, evtchn);
J
Jeremy Fitzhardinge 已提交
1295

1296
	mutex_unlock(&irq_mapping_update_lock);
J
Jeremy Fitzhardinge 已提交
1297

1298 1299 1300
        bind_evtchn_to_cpu(evtchn, info->cpu);
	/* This will be deferred until interrupt is processed */
	irq_set_affinity(irq, cpumask_of(info->cpu));
J
Jeremy Fitzhardinge 已提交
1301 1302 1303 1304 1305

	/* Unmask the event channel. */
	enable_irq(irq);
}

J
Jeremy Fitzhardinge 已提交
1306
/* Rebind an evtchn so that it gets delivered to a specific cpu */
1307
static int rebind_irq_to_cpu(unsigned irq, unsigned tcpu)
J
Jeremy Fitzhardinge 已提交
1308 1309 1310
{
	struct evtchn_bind_vcpu bind_vcpu;
	int evtchn = evtchn_from_irq(irq);
1311
	int masked;
J
Jeremy Fitzhardinge 已提交
1312

1313 1314 1315
	if (!VALID_EVTCHN(evtchn))
		return -1;

1316
	if (!xen_support_evtchn_rebind())
1317
		return -1;
J
Jeremy Fitzhardinge 已提交
1318 1319 1320 1321 1322

	/* Send future instances of this interrupt to other vcpu. */
	bind_vcpu.port = evtchn;
	bind_vcpu.vcpu = tcpu;

1323 1324 1325 1326
	/*
	 * Mask the event while changing the VCPU binding to prevent
	 * it being delivered on an unexpected VCPU.
	 */
1327
	masked = test_and_set_mask(evtchn);
1328

J
Jeremy Fitzhardinge 已提交
1329 1330 1331 1332 1333 1334 1335 1336
	/*
	 * If this fails, it usually just indicates that we're dealing with a
	 * virq or IPI channel, which don't actually need to be rebound. Ignore
	 * it, but don't do the xenlinux-level rebind in that case.
	 */
	if (HYPERVISOR_event_channel_op(EVTCHNOP_bind_vcpu, &bind_vcpu) >= 0)
		bind_evtchn_to_cpu(evtchn, tcpu);

1337 1338 1339
	if (!masked)
		unmask_evtchn(evtchn);

1340 1341
	return 0;
}
J
Jeremy Fitzhardinge 已提交
1342

1343 1344
static int set_affinity_irq(struct irq_data *data, const struct cpumask *dest,
			    bool force)
J
Jeremy Fitzhardinge 已提交
1345
{
1346
	unsigned tcpu = cpumask_first_and(dest, cpu_online_mask);
1347

1348
	return rebind_irq_to_cpu(data->irq, tcpu);
J
Jeremy Fitzhardinge 已提交
1349 1350
}

1351
static void enable_dynirq(struct irq_data *data)
J
Jeremy Fitzhardinge 已提交
1352
{
1353
	int evtchn = evtchn_from_irq(data->irq);
J
Jeremy Fitzhardinge 已提交
1354 1355 1356 1357 1358

	if (VALID_EVTCHN(evtchn))
		unmask_evtchn(evtchn);
}

1359
static void disable_dynirq(struct irq_data *data)
J
Jeremy Fitzhardinge 已提交
1360
{
1361
	int evtchn = evtchn_from_irq(data->irq);
J
Jeremy Fitzhardinge 已提交
1362 1363 1364 1365 1366

	if (VALID_EVTCHN(evtchn))
		mask_evtchn(evtchn);
}

1367
static void ack_dynirq(struct irq_data *data)
J
Jeremy Fitzhardinge 已提交
1368
{
1369
	int evtchn = evtchn_from_irq(data->irq);
J
Jeremy Fitzhardinge 已提交
1370

B
Boris Ostrovsky 已提交
1371 1372
	if (!VALID_EVTCHN(evtchn))
		return;
J
Jeremy Fitzhardinge 已提交
1373

1374 1375
	if (unlikely(irqd_is_setaffinity_pending(data)) &&
	    likely(!irqd_irq_disabled(data))) {
B
Boris Ostrovsky 已提交
1376 1377 1378 1379 1380 1381 1382 1383 1384
		int masked = test_and_set_mask(evtchn);

		clear_evtchn(evtchn);

		irq_move_masked_irq(data);

		if (!masked)
			unmask_evtchn(evtchn);
	} else
1385 1386 1387 1388 1389 1390 1391
		clear_evtchn(evtchn);
}

static void mask_ack_dynirq(struct irq_data *data)
{
	disable_dynirq(data);
	ack_dynirq(data);
J
Jeremy Fitzhardinge 已提交
1392 1393
}

1394
static int retrigger_dynirq(struct irq_data *data)
J
Jeremy Fitzhardinge 已提交
1395
{
1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406 1407
	unsigned int evtchn = evtchn_from_irq(data->irq);
	int masked;

	if (!VALID_EVTCHN(evtchn))
		return 0;

	masked = test_and_set_mask(evtchn);
	set_evtchn(evtchn);
	if (!masked)
		unmask_evtchn(evtchn);

	return 1;
J
Jeremy Fitzhardinge 已提交
1408 1409
}

1410
static void restore_pirqs(void)
1411 1412 1413
{
	int pirq, rc, irq, gsi;
	struct physdev_map_pirq map_irq;
1414
	struct irq_info *info;
1415

1416 1417
	list_for_each_entry(info, &xen_irq_list_head, list) {
		if (info->type != IRQT_PIRQ)
1418 1419
			continue;

1420 1421 1422 1423
		pirq = info->u.pirq.pirq;
		gsi = info->u.pirq.gsi;
		irq = info->irq;

1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435
		/* save/restore of PT devices doesn't work, so at this point the
		 * only devices present are GSI based emulated devices */
		if (!gsi)
			continue;

		map_irq.domid = DOMID_SELF;
		map_irq.type = MAP_PIRQ_TYPE_GSI;
		map_irq.index = gsi;
		map_irq.pirq = pirq;

		rc = HYPERVISOR_physdev_op(PHYSDEVOP_map_pirq, &map_irq);
		if (rc) {
J
Joe Perches 已提交
1436 1437
			pr_warn("xen map irq failed gsi=%d irq=%d pirq=%d rc=%d\n",
				gsi, irq, pirq, rc);
1438
			xen_free_irq(irq);
1439 1440 1441 1442 1443
			continue;
		}

		printk(KERN_DEBUG "xen: --> irq=%d, pirq=%d\n", irq, map_irq.pirq);

1444
		__startup_pirq(irq);
1445 1446 1447
	}
}

1448 1449 1450 1451 1452 1453 1454 1455 1456
static void restore_cpu_virqs(unsigned int cpu)
{
	struct evtchn_bind_virq bind_virq;
	int virq, irq, evtchn;

	for (virq = 0; virq < NR_VIRQS; virq++) {
		if ((irq = per_cpu(virq_to_irq, cpu)[virq]) == -1)
			continue;

1457
		BUG_ON(virq_from_irq(irq) != virq);
1458 1459 1460 1461 1462 1463 1464 1465 1466 1467

		/* Get a new binding from Xen. */
		bind_virq.virq = virq;
		bind_virq.vcpu = cpu;
		if (HYPERVISOR_event_channel_op(EVTCHNOP_bind_virq,
						&bind_virq) != 0)
			BUG();
		evtchn = bind_virq.port;

		/* Record the new mapping. */
1468
		(void)xen_irq_info_virq_setup(cpu, irq, evtchn, virq);
1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479 1480 1481
		bind_evtchn_to_cpu(evtchn, cpu);
	}
}

static void restore_cpu_ipis(unsigned int cpu)
{
	struct evtchn_bind_ipi bind_ipi;
	int ipi, irq, evtchn;

	for (ipi = 0; ipi < XEN_NR_IPIS; ipi++) {
		if ((irq = per_cpu(ipi_to_irq, cpu)[ipi]) == -1)
			continue;

1482
		BUG_ON(ipi_from_irq(irq) != ipi);
1483 1484 1485 1486 1487 1488 1489 1490 1491

		/* Get a new binding from Xen. */
		bind_ipi.vcpu = cpu;
		if (HYPERVISOR_event_channel_op(EVTCHNOP_bind_ipi,
						&bind_ipi) != 0)
			BUG();
		evtchn = bind_ipi.port;

		/* Record the new mapping. */
1492
		(void)xen_irq_info_ipi_setup(cpu, irq, evtchn, ipi);
1493 1494 1495 1496
		bind_evtchn_to_cpu(evtchn, cpu);
	}
}

1497 1498 1499 1500 1501 1502 1503 1504
/* Clear an irq's pending state, in preparation for polling on it */
void xen_clear_irq_pending(int irq)
{
	int evtchn = evtchn_from_irq(irq);

	if (VALID_EVTCHN(evtchn))
		clear_evtchn(evtchn);
}
1505
EXPORT_SYMBOL(xen_clear_irq_pending);
1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524
void xen_set_irq_pending(int irq)
{
	int evtchn = evtchn_from_irq(irq);

	if (VALID_EVTCHN(evtchn))
		set_evtchn(evtchn);
}

bool xen_test_irq_pending(int irq)
{
	int evtchn = evtchn_from_irq(irq);
	bool ret = false;

	if (VALID_EVTCHN(evtchn))
		ret = test_evtchn(evtchn);

	return ret;
}

1525 1526 1527
/* Poll waiting for an irq to become pending with timeout.  In the usual case,
 * the irq will be disabled so it won't deliver an interrupt. */
void xen_poll_irq_timeout(int irq, u64 timeout)
1528 1529 1530 1531 1532 1533 1534
{
	evtchn_port_t evtchn = evtchn_from_irq(irq);

	if (VALID_EVTCHN(evtchn)) {
		struct sched_poll poll;

		poll.nr_ports = 1;
1535
		poll.timeout = timeout;
1536
		set_xen_guest_handle(poll.ports, &evtchn);
1537 1538 1539 1540 1541

		if (HYPERVISOR_sched_op(SCHEDOP_poll, &poll) != 0)
			BUG();
	}
}
1542 1543 1544 1545 1546 1547 1548
EXPORT_SYMBOL(xen_poll_irq_timeout);
/* Poll waiting for an irq to become pending.  In the usual case, the
 * irq will be disabled so it won't deliver an interrupt. */
void xen_poll_irq(int irq)
{
	xen_poll_irq_timeout(irq, 0 /* no timeout */);
}
1549

1550 1551 1552 1553
/* Check whether the IRQ line is shared with other guests. */
int xen_test_irq_shared(int irq)
{
	struct irq_info *info = info_for_irq(irq);
1554 1555 1556 1557 1558 1559
	struct physdev_irq_status_query irq_status;

	if (WARN_ON(!info))
		return -ENOENT;

	irq_status.irq = info->u.pirq.pirq;
1560 1561 1562 1563 1564 1565 1566

	if (HYPERVISOR_physdev_op(PHYSDEVOP_irq_status_query, &irq_status))
		return 0;
	return !(irq_status.flags & XENIRQSTAT_shared);
}
EXPORT_SYMBOL_GPL(xen_test_irq_shared);

1567 1568
void xen_irq_resume(void)
{
1569
	unsigned int cpu;
1570
	struct irq_info *info;
1571 1572

	/* New event-channel space is not 'live' yet. */
1573
	xen_evtchn_mask_all();
1574
	xen_evtchn_resume();
1575 1576

	/* No IRQ <-> event-channel mappings. */
1577 1578
	list_for_each_entry(info, &xen_irq_list_head, list)
		info->evtchn = 0; /* zap event-channel binding */
1579

1580
	clear_evtchn_to_irq_all();
1581 1582 1583 1584 1585

	for_each_possible_cpu(cpu) {
		restore_cpu_virqs(cpu);
		restore_cpu_ipis(cpu);
	}
1586

1587
	restore_pirqs();
1588 1589
}

J
Jeremy Fitzhardinge 已提交
1590
static struct irq_chip xen_dynamic_chip __read_mostly = {
1591
	.name			= "xen-dyn",
J
Jeremy Fitzhardinge 已提交
1592

1593 1594 1595
	.irq_disable		= disable_dynirq,
	.irq_mask		= disable_dynirq,
	.irq_unmask		= enable_dynirq,
J
Jeremy Fitzhardinge 已提交
1596

1597 1598 1599
	.irq_ack		= ack_dynirq,
	.irq_mask_ack		= mask_ack_dynirq,

1600 1601
	.irq_set_affinity	= set_affinity_irq,
	.irq_retrigger		= retrigger_dynirq,
J
Jeremy Fitzhardinge 已提交
1602 1603
};

1604
static struct irq_chip xen_pirq_chip __read_mostly = {
1605
	.name			= "xen-pirq",
1606

1607 1608 1609 1610
	.irq_startup		= startup_pirq,
	.irq_shutdown		= shutdown_pirq,
	.irq_enable		= enable_pirq,
	.irq_disable		= disable_pirq,
1611

1612 1613 1614 1615 1616 1617
	.irq_mask		= disable_dynirq,
	.irq_unmask		= enable_dynirq,

	.irq_ack		= eoi_pirq,
	.irq_eoi		= eoi_pirq,
	.irq_mask_ack		= mask_ack_pirq,
1618

1619
	.irq_set_affinity	= set_affinity_irq,
1620

1621
	.irq_retrigger		= retrigger_dynirq,
1622 1623
};

1624
static struct irq_chip xen_percpu_chip __read_mostly = {
1625
	.name			= "xen-percpu",
1626

1627 1628 1629
	.irq_disable		= disable_dynirq,
	.irq_mask		= disable_dynirq,
	.irq_unmask		= enable_dynirq,
1630

1631
	.irq_ack		= ack_dynirq,
1632 1633
};

1634 1635 1636 1637 1638 1639 1640 1641 1642 1643
int xen_set_callback_via(uint64_t via)
{
	struct xen_hvm_param a;
	a.domid = DOMID_SELF;
	a.index = HVM_PARAM_CALLBACK_IRQ;
	a.value = via;
	return HYPERVISOR_hvm_op(HVMOP_set_param, &a);
}
EXPORT_SYMBOL_GPL(xen_set_callback_via);

1644
#ifdef CONFIG_XEN_PVHVM
1645 1646 1647 1648 1649 1650 1651 1652
/* Vector callbacks are better than PCI interrupts to receive event
 * channel notifications because we can receive vector callbacks on any
 * vcpu and we don't need PCI support or APIC interactions. */
void xen_callback_vector(void)
{
	int rc;
	uint64_t callback_via;
	if (xen_have_vector_callback) {
1653
		callback_via = HVM_CALLBACK_VECTOR(HYPERVISOR_CALLBACK_VECTOR);
1654 1655
		rc = xen_set_callback_via(callback_via);
		if (rc) {
J
Joe Perches 已提交
1656
			pr_err("Request for Xen HVM callback vector failed\n");
1657 1658 1659
			xen_have_vector_callback = 0;
			return;
		}
J
Joe Perches 已提交
1660
		pr_info("Xen HVM callback vector for event delivery is enabled\n");
1661
		/* in the restore case the vector has already been allocated */
1662 1663 1664
		if (!test_bit(HYPERVISOR_CALLBACK_VECTOR, used_vectors))
			alloc_intr_gate(HYPERVISOR_CALLBACK_VECTOR,
					xen_hvm_callback_vector);
1665 1666
	}
}
1667 1668 1669
#else
void xen_callback_vector(void) {}
#endif
1670

1671 1672 1673 1674 1675 1676
#undef MODULE_PARAM_PREFIX
#define MODULE_PARAM_PREFIX "xen."

static bool fifo_events = true;
module_param(fifo_events, bool, 0);

S
Stefano Stabellini 已提交
1677
void __init xen_init_IRQ(void)
J
Jeremy Fitzhardinge 已提交
1678
{
1679 1680 1681 1682 1683 1684
	int ret = -EINVAL;

	if (fifo_events)
		ret = xen_evtchn_fifo_init();
	if (ret < 0)
		xen_evtchn_2l_init();
1685

1686 1687
	evtchn_to_irq = kcalloc(EVTCHN_ROW(xen_evtchn_max_channels()),
				sizeof(*evtchn_to_irq), GFP_KERNEL);
1688
	BUG_ON(!evtchn_to_irq);
J
Jeremy Fitzhardinge 已提交
1689 1690

	/* No event channels are 'live' right now. */
1691
	xen_evtchn_mask_all();
J
Jeremy Fitzhardinge 已提交
1692

S
Stefano Stabellini 已提交
1693 1694
	pirq_needs_eoi = pirq_needs_eoi_flag;

1695
#ifdef CONFIG_X86
1696 1697 1698 1699 1700 1701
	if (xen_pv_domain()) {
		irq_ctx_init(smp_processor_id());
		if (xen_initial_domain())
			pci_xen_initial_domain();
	}
	if (xen_feature(XENFEAT_hvm_callback_vector))
1702
		xen_callback_vector();
1703 1704

	if (xen_hvm_domain()) {
1705
		native_init_IRQ();
1706 1707 1708
		/* pci_xen_hvm_init must be called after native_init_IRQ so that
		 * __acpi_register_gsi can point at the right function */
		pci_xen_hvm_init();
1709
	} else {
1710
		int rc;
S
Stefano Stabellini 已提交
1711 1712 1713
		struct physdev_pirq_eoi_gmfn eoi_gmfn;

		pirq_eoi_map = (void *)__get_free_page(GFP_KERNEL|__GFP_ZERO);
1714
		eoi_gmfn.gmfn = virt_to_gfn(pirq_eoi_map);
S
Stefano Stabellini 已提交
1715
		rc = HYPERVISOR_physdev_op(PHYSDEVOP_pirq_eoi_gmfn_v2, &eoi_gmfn);
1716
		/* TODO: No PVH support for PIRQ EOI */
S
Stefano Stabellini 已提交
1717 1718 1719 1720 1721
		if (rc != 0) {
			free_page((unsigned long) pirq_eoi_map);
			pirq_eoi_map = NULL;
		} else
			pirq_needs_eoi = pirq_check_eoi_map;
1722
	}
1723
#endif
J
Jeremy Fitzhardinge 已提交
1724
}