events.c 37.5 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 24 25 26 27 28
 *
 * Jeremy Fitzhardinge <jeremy@xensource.com>, XenSource Inc, 2007
 */

#include <linux/linkage.h>
#include <linux/interrupt.h>
#include <linux/irq.h>
#include <linux/module.h>
#include <linux/string.h>
29
#include <linux/bootmem.h>
30
#include <linux/slab.h>
31
#include <linux/irqnr.h>
32
#include <linux/pci.h>
J
Jeremy Fitzhardinge 已提交
33

34
#include <asm/desc.h>
J
Jeremy Fitzhardinge 已提交
35 36
#include <asm/ptrace.h>
#include <asm/irq.h>
37
#include <asm/idle.h>
38
#include <asm/io_apic.h>
J
Jeremy Fitzhardinge 已提交
39
#include <asm/sync_bitops.h>
40
#include <asm/xen/pci.h>
J
Jeremy Fitzhardinge 已提交
41
#include <asm/xen/hypercall.h>
42
#include <asm/xen/hypervisor.h>
J
Jeremy Fitzhardinge 已提交
43

44 45
#include <xen/xen.h>
#include <xen/hvm.h>
46
#include <xen/xen-ops.h>
J
Jeremy Fitzhardinge 已提交
47 48 49
#include <xen/events.h>
#include <xen/interface/xen.h>
#include <xen/interface/event_channel.h>
50 51
#include <xen/interface/hvm/hvm_op.h>
#include <xen/interface/hvm/params.h>
J
Jeremy Fitzhardinge 已提交
52 53 54 55 56 57 58

/*
 * 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.
 */
static DEFINE_SPINLOCK(irq_mapping_update_lock);

59 60
static LIST_HEAD(xen_irq_list_head);

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

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

67 68
/* Interrupt types. */
enum xen_irq_type {
J
Jeremy Fitzhardinge 已提交
69
	IRQT_UNBOUND = 0,
J
Jeremy Fitzhardinge 已提交
70 71 72 73 74
	IRQT_PIRQ,
	IRQT_VIRQ,
	IRQT_IPI,
	IRQT_EVTCHN
};
J
Jeremy Fitzhardinge 已提交
75

76 77 78 79 80 81
/*
 * Packed IRQ information:
 * type - enum xen_irq_type
 * event channel - irq->event channel mapping
 * cpu - cpu this event channel is bound to
 * index - type-specific information:
82 83
 *    PIRQ - vector, with MSB being "needs EIO", or physical IRQ of the HVM
 *           guest, or GSI (real passthrough IRQ) of the device.
84 85 86 87 88 89
 *    VIRQ - virq number
 *    IPI - IPI vector
 *    EVTCHN -
 */
struct irq_info
{
90
	struct list_head list;
91
	enum xen_irq_type type;	/* type */
92
	unsigned irq;
93 94 95 96 97 98 99
	unsigned short evtchn;	/* event channel */
	unsigned short cpu;	/* cpu bound */

	union {
		unsigned short virq;
		enum ipi_vector ipi;
		struct {
S
Stefano Stabellini 已提交
100
			unsigned short pirq;
101
			unsigned short gsi;
102 103
			unsigned char vector;
			unsigned char flags;
104
			uint16_t domid;
105 106 107
		} pirq;
	} u;
};
108
#define PIRQ_NEEDS_EOI	(1 << 0)
109
#define PIRQ_SHAREABLE	(1 << 1)
110

111
static int *evtchn_to_irq;
112

113 114
static DEFINE_PER_CPU(unsigned long [NR_EVENT_CHANNELS/BITS_PER_LONG],
		      cpu_evtchn_mask);
J
Jeremy Fitzhardinge 已提交
115 116 117 118 119

/* Xen will never allocate port zero for any purpose. */
#define VALID_EVTCHN(chn)	((chn) != 0)

static struct irq_chip xen_dynamic_chip;
120
static struct irq_chip xen_percpu_chip;
121
static struct irq_chip xen_pirq_chip;
J
Jeremy Fitzhardinge 已提交
122

123 124
/* Get info for IRQ */
static struct irq_info *info_for_irq(unsigned irq)
125
{
T
Thomas Gleixner 已提交
126
	return irq_get_handler_data(irq);
127 128
}

129 130
/* Constructors for packed IRQ information. */
static void xen_irq_info_common_init(struct irq_info *info,
131
				     unsigned irq,
132 133 134
				     enum xen_irq_type type,
				     unsigned short evtchn,
				     unsigned short cpu)
135
{
136 137 138 139

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

	info->type = type;
140
	info->irq = irq;
141 142
	info->evtchn = evtchn;
	info->cpu = cpu;
143 144

	evtchn_to_irq[evtchn] = irq;
145 146
}

147 148
static void xen_irq_info_evtchn_init(unsigned irq,
				     unsigned short evtchn)
149
{
150 151
	struct irq_info *info = info_for_irq(irq);

152
	xen_irq_info_common_init(info, irq, IRQT_EVTCHN, evtchn, 0);
153 154
}

155 156
static void xen_irq_info_ipi_init(unsigned cpu,
				  unsigned irq,
157 158
				  unsigned short evtchn,
				  enum ipi_vector ipi)
J
Jeremy Fitzhardinge 已提交
159
{
160 161
	struct irq_info *info = info_for_irq(irq);

162
	xen_irq_info_common_init(info, irq, IRQT_IPI, evtchn, 0);
163 164

	info->u.ipi = ipi;
165 166

	per_cpu(ipi_to_irq, cpu)[ipi] = irq;
167 168
}

169 170
static void xen_irq_info_virq_init(unsigned cpu,
				   unsigned irq,
171 172
				   unsigned short evtchn,
				   unsigned short virq)
173
{
174 175
	struct irq_info *info = info_for_irq(irq);

176
	xen_irq_info_common_init(info, irq, IRQT_VIRQ, evtchn, 0);
177 178

	info->u.virq = virq;
179 180

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

183 184 185 186 187
static void xen_irq_info_pirq_init(unsigned irq,
				   unsigned short evtchn,
				   unsigned short pirq,
				   unsigned short gsi,
				   unsigned short vector,
188
				   uint16_t domid,
189
				   unsigned char flags)
190
{
191 192
	struct irq_info *info = info_for_irq(irq);

193
	xen_irq_info_common_init(info, irq, IRQT_PIRQ, evtchn, 0);
194 195 196 197

	info->u.pirq.pirq = pirq;
	info->u.pirq.gsi = gsi;
	info->u.pirq.vector = vector;
198
	info->u.pirq.domid = domid;
199
	info->u.pirq.flags = flags;
J
Jeremy Fitzhardinge 已提交
200 201 202 203 204
}

/*
 * Accessors for packed IRQ information.
 */
205
static unsigned int evtchn_from_irq(unsigned irq)
J
Jeremy Fitzhardinge 已提交
206
{
207 208 209
	if (unlikely(WARN(irq < 0 || irq >= nr_irqs, "Invalid irq %d!\n", irq)))
		return 0;

210
	return info_for_irq(irq)->evtchn;
J
Jeremy Fitzhardinge 已提交
211 212
}

I
Ian Campbell 已提交
213 214 215 216 217 218
unsigned irq_from_evtchn(unsigned int evtchn)
{
	return evtchn_to_irq[evtchn];
}
EXPORT_SYMBOL_GPL(irq_from_evtchn);

219
static enum ipi_vector ipi_from_irq(unsigned irq)
J
Jeremy Fitzhardinge 已提交
220
{
221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238
	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 已提交
239 240 241 242 243 244 245 246 247 248
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;
}

249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267
static enum xen_irq_type type_from_irq(unsigned irq)
{
	return info_for_irq(irq)->type;
}

static unsigned cpu_from_irq(unsigned irq)
{
	return info_for_irq(irq)->cpu;
}

static unsigned int cpu_from_evtchn(unsigned int evtchn)
{
	int irq = evtchn_to_irq[evtchn];
	unsigned ret = 0;

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

	return ret;
J
Jeremy Fitzhardinge 已提交
268 269
}

270 271 272 273 274 275 276 277 278
static bool pirq_needs_eoi(unsigned irq)
{
	struct irq_info *info = info_for_irq(irq);

	BUG_ON(info->type != IRQT_PIRQ);

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

J
Jeremy Fitzhardinge 已提交
279 280 281 282 283
static inline unsigned long active_evtchns(unsigned int cpu,
					   struct shared_info *sh,
					   unsigned int idx)
{
	return (sh->evtchn_pending[idx] &
284
		per_cpu(cpu_evtchn_mask, cpu)[idx] &
J
Jeremy Fitzhardinge 已提交
285 286 287 288 289 290 291 292 293
		~sh->evtchn_mask[idx]);
}

static void bind_evtchn_to_cpu(unsigned int chn, unsigned int cpu)
{
	int irq = evtchn_to_irq[chn];

	BUG_ON(irq == -1);
#ifdef CONFIG_SMP
294
	cpumask_copy(irq_to_desc(irq)->irq_data.affinity, cpumask_of(cpu));
J
Jeremy Fitzhardinge 已提交
295 296
#endif

297 298
	clear_bit(chn, per_cpu(cpu_evtchn_mask, cpu_from_irq(irq)));
	set_bit(chn, per_cpu(cpu_evtchn_mask, cpu));
J
Jeremy Fitzhardinge 已提交
299

300
	info_for_irq(irq)->cpu = cpu;
J
Jeremy Fitzhardinge 已提交
301 302 303 304
}

static void init_evtchn_cpu_bindings(void)
{
305
	int i;
J
Jeremy Fitzhardinge 已提交
306
#ifdef CONFIG_SMP
307
	struct irq_info *info;
308

J
Jeremy Fitzhardinge 已提交
309
	/* By default all event channels notify CPU#0. */
310 311
	list_for_each_entry(info, &xen_irq_list_head, list) {
		struct irq_desc *desc = irq_to_desc(info->irq);
312
		cpumask_copy(desc->irq_data.affinity, cpumask_of(0));
313
	}
J
Jeremy Fitzhardinge 已提交
314 315
#endif

316
	for_each_possible_cpu(i)
317 318
		memset(per_cpu(cpu_evtchn_mask, i),
		       (i == 0) ? ~0 : 0, sizeof(*per_cpu(cpu_evtchn_mask, i)));
J
Jeremy Fitzhardinge 已提交
319 320 321 322 323 324 325 326 327 328 329 330 331 332
}

static inline void clear_evtchn(int port)
{
	struct shared_info *s = HYPERVISOR_shared_info;
	sync_clear_bit(port, &s->evtchn_pending[0]);
}

static inline void set_evtchn(int port)
{
	struct shared_info *s = HYPERVISOR_shared_info;
	sync_set_bit(port, &s->evtchn_pending[0]);
}

333 334 335 336 337 338
static inline int test_evtchn(int port)
{
	struct shared_info *s = HYPERVISOR_shared_info;
	return sync_test_bit(port, &s->evtchn_pending[0]);
}

J
Jeremy Fitzhardinge 已提交
339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374

/**
 * 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);

static void mask_evtchn(int port)
{
	struct shared_info *s = HYPERVISOR_shared_info;
	sync_set_bit(port, &s->evtchn_mask[0]);
}

static void unmask_evtchn(int port)
{
	struct shared_info *s = HYPERVISOR_shared_info;
	unsigned int cpu = get_cpu();

	BUG_ON(!irqs_disabled());

	/* Slow path (hypercall) if this is a non-local port. */
	if (unlikely(cpu != cpu_from_evtchn(port))) {
		struct evtchn_unmask unmask = { .port = port };
		(void)HYPERVISOR_event_channel_op(EVTCHNOP_unmask, &unmask);
	} else {
C
Christoph Lameter 已提交
375
		struct vcpu_info *vcpu_info = __this_cpu_read(xen_vcpu);
J
Jeremy Fitzhardinge 已提交
376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392

		sync_clear_bit(port, &s->evtchn_mask[0]);

		/*
		 * The following is basically the equivalent of
		 * 'hw_resend_irq'. Just like a real IO-APIC we 'lose
		 * the interrupt edge' if the channel is masked.
		 */
		if (sync_test_bit(port, &s->evtchn_pending[0]) &&
		    !sync_test_and_set_bit(port / BITS_PER_LONG,
					   &vcpu_info->evtchn_pending_sel))
			vcpu_info->evtchn_upcall_pending = 1;
	}

	put_cpu();
}

393 394 395 396 397
static void xen_irq_init(unsigned irq)
{
	struct irq_info *info;
	struct irq_desc *desc = irq_to_desc(irq);

398
#ifdef CONFIG_SMP
399 400
	/* By default all event channels notify CPU#0. */
	cpumask_copy(desc->irq_data.affinity, cpumask_of(0));
401
#endif
402

403 404 405
	info = kzalloc(sizeof(*info), GFP_KERNEL);
	if (info == NULL)
		panic("Unable to allocate metadata for IRQ%d\n", irq);
406 407 408

	info->type = IRQT_UNBOUND;

T
Thomas Gleixner 已提交
409
	irq_set_handler_data(irq, info);
410

411 412 413
	list_add_tail(&info->list, &xen_irq_list_head);
}

414
static int __must_check xen_allocate_irq_dynamic(void)
415
{
416 417
	int first = 0;
	int irq;
418 419

#ifdef CONFIG_X86_IO_APIC
420 421
	/*
	 * For an HVM guest or domain 0 which see "real" (emulated or
L
Lucas De Marchi 已提交
422
	 * actual respectively) GSIs we allocate dynamic IRQs
423 424 425 426 427 428
	 * e.g. those corresponding to event channels or MSIs
	 * etc. from the range above those "real" GSIs to avoid
	 * collisions.
	 */
	if (xen_initial_domain() || xen_hvm_domain())
		first = get_nr_irqs_gsi();
429 430
#endif

431
	irq = irq_alloc_desc_from(first, -1);
432

433
	xen_irq_init(irq);
434

J
Jeremy Fitzhardinge 已提交
435
	return irq;
436 437
}

438
static int __must_check xen_allocate_irq_gsi(unsigned gsi)
439 440 441
{
	int irq;

442 443 444 445 446 447 448
	/*
	 * 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())
449 450 451 452
		return xen_allocate_irq_dynamic();

	/* Legacy IRQ descriptors are already allocated by the arch. */
	if (gsi < NR_IRQS_LEGACY)
453 454 455
		irq = gsi;
	else
		irq = irq_alloc_desc_at(gsi, -1);
456

457
	xen_irq_init(irq);
458 459 460 461 462 463

	return irq;
}

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

	list_del(&info->list);
467

T
Thomas Gleixner 已提交
468
	irq_set_handler_data(irq, NULL);
469 470 471

	kfree(info);

472 473 474 475
	/* Legacy IRQ descriptors are managed by the arch. */
	if (irq < NR_IRQS_LEGACY)
		return;

476 477 478
	irq_free_desc(irq);
}

479 480
static void pirq_unmask_notify(int irq)
{
S
Stefano Stabellini 已提交
481
	struct physdev_eoi eoi = { .irq = pirq_from_irq(irq) };
482 483 484 485 486 487 488 489 490 491 492 493 494 495

	if (unlikely(pirq_needs_eoi(irq))) {
		int rc = HYPERVISOR_physdev_op(PHYSDEVOP_eoi, &eoi);
		WARN_ON(rc);
	}
}

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 已提交
496
	irq_status.irq = pirq_from_irq(irq);
497 498 499 500 501 502 503 504 505 506 507 508 509 510 511
	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;
}

static bool probing_irq(int irq)
{
	struct irq_desc *desc = irq_to_desc(irq);

	return desc && desc->action == NULL;
}

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

	BUG_ON(info->type != IRQT_PIRQ);

	if (VALID_EVTCHN(evtchn))
		goto out;

S
Stefano Stabellini 已提交
524
	bind_pirq.pirq = pirq_from_irq(irq);
525
	/* NB. We are happy to share unless we are probing. */
526 527 528 529
	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) {
530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549
		if (!probing_irq(irq))
			printk(KERN_INFO "Failed to obtain physical IRQ %d\n",
			       irq);
		return 0;
	}
	evtchn = bind_pirq.port;

	pirq_query_unmask(irq);

	evtchn_to_irq[evtchn] = irq;
	bind_evtchn_to_cpu(evtchn, 0);
	info->evtchn = evtchn;

out:
	unmask_evtchn(evtchn);
	pirq_unmask_notify(irq);

	return 0;
}

550 551 552 553 554 555
static unsigned int startup_pirq(struct irq_data *data)
{
	return __startup_pirq(data->irq);
}

static void shutdown_pirq(struct irq_data *data)
556 557
{
	struct evtchn_close close;
558
	unsigned int irq = data->irq;
559 560 561 562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577
	struct irq_info *info = info_for_irq(irq);
	int evtchn = evtchn_from_irq(irq);

	BUG_ON(info->type != IRQT_PIRQ);

	if (!VALID_EVTCHN(evtchn))
		return;

	mask_evtchn(evtchn);

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

	bind_evtchn_to_cpu(evtchn, 0);
	evtchn_to_irq[evtchn] = -1;
	info->evtchn = 0;
}

578
static void enable_pirq(struct irq_data *data)
579
{
580
	startup_pirq(data);
581 582
}

583
static void disable_pirq(struct irq_data *data)
584 585 586
{
}

587
static void ack_pirq(struct irq_data *data)
588
{
589
	int evtchn = evtchn_from_irq(data->irq);
590

591
	irq_move_irq(data);
592 593 594 595 596 597 598 599 600

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

static int find_irq_by_gsi(unsigned gsi)
{
601
	struct irq_info *info;
602

603 604
	list_for_each_entry(info, &xen_irq_list_head, list) {
		if (info->type != IRQT_PIRQ)
605 606
			continue;

607 608
		if (info->u.pirq.gsi == gsi)
			return info->irq;
609 610 611 612 613
	}

	return -1;
}

614
int xen_allocate_pirq_gsi(unsigned gsi)
S
Stefano Stabellini 已提交
615
{
616
	return gsi;
S
Stefano Stabellini 已提交
617 618
}

I
Ian Campbell 已提交
619 620 621
/*
 * Do not make any assumptions regarding the relationship between the
 * IRQ number returned here and the Xen pirq argument.
S
Stefano Stabellini 已提交
622 623 624
 *
 * 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.
625
 */
626 627
int xen_bind_pirq_gsi_to_irq(unsigned gsi,
			     unsigned pirq, int shareable, char *name)
628
{
629
	int irq = -1;
630 631 632 633 634 635
	struct physdev_irq irq_op;

	spin_lock(&irq_mapping_update_lock);

	irq = find_irq_by_gsi(gsi);
	if (irq != -1) {
S
Stefano Stabellini 已提交
636
		printk(KERN_INFO "xen_map_pirq_gsi: returning irq %d for gsi %u\n",
637 638 639 640
		       irq, gsi);
		goto out;	/* XXX need refcount? */
	}

641
	irq = xen_allocate_irq_gsi(gsi);
642 643
	if (irq < 0)
		goto out;
644

T
Thomas Gleixner 已提交
645 646
	irq_set_chip_and_handler_name(irq, &xen_pirq_chip, handle_level_irq,
				      name);
647 648

	irq_op.irq = irq;
649 650 651 652 653 654 655
	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)) {
656
		xen_free_irq(irq);
657 658 659 660
		irq = -ENOSPC;
		goto out;
	}

661
	xen_irq_info_pirq_init(irq, 0, pirq, gsi, irq_op.vector, DOMID_SELF,
662
			       shareable ? PIRQ_SHAREABLE : 0);
663 664 665 666 667 668 669

out:
	spin_unlock(&irq_mapping_update_lock);

	return irq;
}

670
#ifdef CONFIG_PCI_MSI
671
int xen_allocate_pirq_msi(struct pci_dev *dev, struct msi_desc *msidesc)
672
{
673
	int rc;
674 675
	struct physdev_get_free_pirq op_get_free_pirq;

676
	op_get_free_pirq.type = MAP_PIRQ_TYPE_MSI;
677 678
	rc = HYPERVISOR_physdev_op(PHYSDEVOP_get_free_pirq, &op_get_free_pirq);

679 680 681 682
	WARN_ONCE(rc == -ENOSYS,
		  "hypervisor does not support the PHYSDEVOP_get_free_pirq interface\n");

	return rc ? -1 : op_get_free_pirq.pirq;
683 684
}

685
int xen_bind_pirq_msi_to_irq(struct pci_dev *dev, struct msi_desc *msidesc,
686 687
			     int pirq, int vector, const char *name,
			     domid_t domid)
S
Stefano Stabellini 已提交
688
{
689
	int irq, ret;
690

S
Stefano Stabellini 已提交
691 692
	spin_lock(&irq_mapping_update_lock);

693 694
	irq = xen_allocate_irq_dynamic();
	if (irq == -1)
695
		goto out;
S
Stefano Stabellini 已提交
696

T
Thomas Gleixner 已提交
697 698
	irq_set_chip_and_handler_name(irq, &xen_pirq_chip, handle_level_irq,
				      name);
S
Stefano Stabellini 已提交
699

700
	xen_irq_info_pirq_init(irq, 0, pirq, 0, vector, domid, 0);
701
	ret = irq_set_msi_desc(irq, msidesc);
702 703
	if (ret < 0)
		goto error_irq;
S
Stefano Stabellini 已提交
704 705
out:
	spin_unlock(&irq_mapping_update_lock);
706
	return irq;
707 708 709 710
error_irq:
	spin_unlock(&irq_mapping_update_lock);
	xen_free_irq(irq);
	return -1;
S
Stefano Stabellini 已提交
711
}
712 713
#endif

714 715 716
int xen_destroy_irq(int irq)
{
	struct irq_desc *desc;
717 718
	struct physdev_unmap_pirq unmap_irq;
	struct irq_info *info = info_for_irq(irq);
719 720 721 722 723 724 725 726
	int rc = -ENOENT;

	spin_lock(&irq_mapping_update_lock);

	desc = irq_to_desc(irq);
	if (!desc)
		goto out;

727
	if (xen_initial_domain()) {
728
		unmap_irq.pirq = info->u.pirq.pirq;
729
		unmap_irq.domid = info->u.pirq.domid;
730 731 732 733 734 735
		rc = HYPERVISOR_physdev_op(PHYSDEVOP_unmap_pirq, &unmap_irq);
		if (rc) {
			printk(KERN_WARNING "unmap irq failed %d\n", rc);
			goto out;
		}
	}
736

737
	xen_free_irq(irq);
738 739 740 741 742 743

out:
	spin_unlock(&irq_mapping_update_lock);
	return rc;
}

744
int xen_irq_from_pirq(unsigned pirq)
745
{
746
	int irq;
747

748
	struct irq_info *info;
J
Jeremy Fitzhardinge 已提交
749

750 751 752 753 754 755 756 757 758 759 760
	spin_lock(&irq_mapping_update_lock);

	list_for_each_entry(info, &xen_irq_list_head, list) {
		if (info == NULL || info->type != IRQT_PIRQ)
			continue;
		irq = info->irq;
		if (info->u.pirq.pirq == pirq)
			goto out;
	}
	irq = -1;
out:
761
	spin_unlock(&irq_mapping_update_lock);
762 763

	return irq;
764 765
}

766
int bind_evtchn_to_irq(unsigned int evtchn)
J
Jeremy Fitzhardinge 已提交
767 768 769 770 771 772 773 774
{
	int irq;

	spin_lock(&irq_mapping_update_lock);

	irq = evtchn_to_irq[evtchn];

	if (irq == -1) {
775
		irq = xen_allocate_irq_dynamic();
776 777
		if (irq == -1)
			goto out;
J
Jeremy Fitzhardinge 已提交
778

T
Thomas Gleixner 已提交
779
		irq_set_chip_and_handler_name(irq, &xen_dynamic_chip,
780
					      handle_fasteoi_irq, "event");
J
Jeremy Fitzhardinge 已提交
781

782
		xen_irq_info_evtchn_init(irq, evtchn);
J
Jeremy Fitzhardinge 已提交
783 784
	}

785
out:
J
Jeremy Fitzhardinge 已提交
786 787 788 789
	spin_unlock(&irq_mapping_update_lock);

	return irq;
}
790
EXPORT_SYMBOL_GPL(bind_evtchn_to_irq);
J
Jeremy Fitzhardinge 已提交
791

J
Jeremy Fitzhardinge 已提交
792 793 794 795 796 797 798 799
static int bind_ipi_to_irq(unsigned int ipi, unsigned int cpu)
{
	struct evtchn_bind_ipi bind_ipi;
	int evtchn, irq;

	spin_lock(&irq_mapping_update_lock);

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

J
Jeremy Fitzhardinge 已提交
801
	if (irq == -1) {
802
		irq = xen_allocate_irq_dynamic();
J
Jeremy Fitzhardinge 已提交
803 804 805
		if (irq < 0)
			goto out;

T
Thomas Gleixner 已提交
806
		irq_set_chip_and_handler_name(irq, &xen_percpu_chip,
807
					      handle_percpu_irq, "ipi");
J
Jeremy Fitzhardinge 已提交
808 809 810 811 812 813 814

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

815
		xen_irq_info_ipi_init(cpu, irq, evtchn, ipi);
J
Jeremy Fitzhardinge 已提交
816 817 818 819 820 821 822 823 824

		bind_evtchn_to_cpu(evtchn, cpu);
	}

 out:
	spin_unlock(&irq_mapping_update_lock);
	return irq;
}

825 826 827 828 829 830 831 832 833 834 835 836 837 838 839
static int bind_interdomain_evtchn_to_irq(unsigned int remote_domain,
					  unsigned int remote_port)
{
	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);
}

J
Jeremy Fitzhardinge 已提交
840

841
int bind_virq_to_irq(unsigned int virq, unsigned int cpu)
J
Jeremy Fitzhardinge 已提交
842 843 844 845 846 847 848 849 850
{
	struct evtchn_bind_virq bind_virq;
	int evtchn, irq;

	spin_lock(&irq_mapping_update_lock);

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

	if (irq == -1) {
851
		irq = xen_allocate_irq_dynamic();
852 853
		if (irq == -1)
			goto out;
854

T
Thomas Gleixner 已提交
855
		irq_set_chip_and_handler_name(irq, &xen_percpu_chip,
856 857
					      handle_percpu_irq, "virq");

J
Jeremy Fitzhardinge 已提交
858 859 860 861 862 863 864
		bind_virq.virq = virq;
		bind_virq.vcpu = cpu;
		if (HYPERVISOR_event_channel_op(EVTCHNOP_bind_virq,
						&bind_virq) != 0)
			BUG();
		evtchn = bind_virq.port;

865
		xen_irq_info_virq_init(cpu, irq, evtchn, virq);
J
Jeremy Fitzhardinge 已提交
866 867 868 869

		bind_evtchn_to_cpu(evtchn, cpu);
	}

870
out:
J
Jeremy Fitzhardinge 已提交
871 872 873 874 875 876 877 878 879 880 881 882
	spin_unlock(&irq_mapping_update_lock);

	return irq;
}

static void unbind_from_irq(unsigned int irq)
{
	struct evtchn_close close;
	int evtchn = evtchn_from_irq(irq);

	spin_lock(&irq_mapping_update_lock);

J
Jeremy Fitzhardinge 已提交
883
	if (VALID_EVTCHN(evtchn)) {
J
Jeremy Fitzhardinge 已提交
884 885 886 887 888 889 890
		close.port = evtchn;
		if (HYPERVISOR_event_channel_op(EVTCHNOP_close, &close) != 0)
			BUG();

		switch (type_from_irq(irq)) {
		case IRQT_VIRQ:
			per_cpu(virq_to_irq, cpu_from_evtchn(evtchn))
891
				[virq_from_irq(irq)] = -1;
J
Jeremy Fitzhardinge 已提交
892
			break;
A
Alex Nixon 已提交
893 894
		case IRQT_IPI:
			per_cpu(ipi_to_irq, cpu_from_evtchn(evtchn))
895
				[ipi_from_irq(irq)] = -1;
A
Alex Nixon 已提交
896
			break;
J
Jeremy Fitzhardinge 已提交
897 898 899 900 901 902 903 904
		default:
			break;
		}

		/* Closed ports are implicitly re-bound to VCPU0. */
		bind_evtchn_to_cpu(evtchn, 0);

		evtchn_to_irq[evtchn] = -1;
905 906
	}

907
	BUG_ON(info_for_irq(irq)->type == IRQT_UNBOUND);
J
Jeremy Fitzhardinge 已提交
908

909
	xen_free_irq(irq);
J
Jeremy Fitzhardinge 已提交
910 911 912 913 914

	spin_unlock(&irq_mapping_update_lock);
}

int bind_evtchn_to_irqhandler(unsigned int evtchn,
915
			      irq_handler_t handler,
J
Jeremy Fitzhardinge 已提交
916 917 918 919 920 921 922
			      unsigned long irqflags,
			      const char *devname, void *dev_id)
{
	unsigned int irq;
	int retval;

	irq = bind_evtchn_to_irq(evtchn);
923 924
	if (irq < 0)
		return irq;
J
Jeremy Fitzhardinge 已提交
925 926 927 928 929 930 931 932 933 934
	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);

935 936 937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957
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 已提交
958
int bind_virq_to_irqhandler(unsigned int virq, unsigned int cpu,
959
			    irq_handler_t handler,
J
Jeremy Fitzhardinge 已提交
960 961 962 963 964 965
			    unsigned long irqflags, const char *devname, void *dev_id)
{
	unsigned int irq;
	int retval;

	irq = bind_virq_to_irq(virq, cpu);
966 967
	if (irq < 0)
		return irq;
J
Jeremy Fitzhardinge 已提交
968 969 970 971 972 973 974 975 976 977
	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 已提交
978 979 980 981 982 983 984 985 986 987 988 989 990
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;

T
Thomas Gleixner 已提交
991
	irqflags |= IRQF_NO_SUSPEND | IRQF_FORCE_RESUME;
J
Jeremy Fitzhardinge 已提交
992 993 994 995 996 997 998 999 1000
	retval = request_irq(irq, handler, irqflags, devname, dev_id);
	if (retval != 0) {
		unbind_from_irq(irq);
		return retval;
	}

	return irq;
}

J
Jeremy Fitzhardinge 已提交
1001 1002 1003 1004 1005 1006 1007
void unbind_from_irqhandler(unsigned int irq, void *dev_id)
{
	free_irq(irq, dev_id);
	unbind_from_irq(irq);
}
EXPORT_SYMBOL_GPL(unbind_from_irqhandler);

J
Jeremy Fitzhardinge 已提交
1008 1009 1010 1011 1012 1013 1014
void xen_send_IPI_one(unsigned int cpu, enum ipi_vector vector)
{
	int irq = per_cpu(ipi_to_irq, cpu)[vector];
	BUG_ON(irq < 0);
	notify_remote_via_irq(irq);
}

1015 1016 1017 1018
irqreturn_t xen_debug_interrupt(int irq, void *dev_id)
{
	struct shared_info *sh = HYPERVISOR_shared_info;
	int cpu = smp_processor_id();
1019
	unsigned long *cpu_evtchn = per_cpu(cpu_evtchn_mask, cpu);
1020 1021 1022
	int i;
	unsigned long flags;
	static DEFINE_SPINLOCK(debug_lock);
1023
	struct vcpu_info *v;
1024 1025 1026

	spin_lock_irqsave(&debug_lock, flags);

1027
	printk("\nvcpu %d\n  ", cpu);
1028 1029

	for_each_online_cpu(i) {
1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072
		int pending;
		v = per_cpu(xen_vcpu, i);
		pending = (get_irq_regs() && i == cpu)
			? xen_irqs_disabled(get_irq_regs())
			: v->evtchn_upcall_mask;
		printk("%d: masked=%d pending=%d event_sel %0*lx\n  ", i,
		       pending, v->evtchn_upcall_pending,
		       (int)(sizeof(v->evtchn_pending_sel)*2),
		       v->evtchn_pending_sel);
	}
	v = per_cpu(xen_vcpu, cpu);

	printk("\npending:\n   ");
	for (i = ARRAY_SIZE(sh->evtchn_pending)-1; i >= 0; i--)
		printk("%0*lx%s", (int)sizeof(sh->evtchn_pending[0])*2,
		       sh->evtchn_pending[i],
		       i % 8 == 0 ? "\n   " : " ");
	printk("\nglobal mask:\n   ");
	for (i = ARRAY_SIZE(sh->evtchn_mask)-1; i >= 0; i--)
		printk("%0*lx%s",
		       (int)(sizeof(sh->evtchn_mask[0])*2),
		       sh->evtchn_mask[i],
		       i % 8 == 0 ? "\n   " : " ");

	printk("\nglobally unmasked:\n   ");
	for (i = ARRAY_SIZE(sh->evtchn_mask)-1; i >= 0; i--)
		printk("%0*lx%s", (int)(sizeof(sh->evtchn_mask[0])*2),
		       sh->evtchn_pending[i] & ~sh->evtchn_mask[i],
		       i % 8 == 0 ? "\n   " : " ");

	printk("\nlocal cpu%d mask:\n   ", cpu);
	for (i = (NR_EVENT_CHANNELS/BITS_PER_LONG)-1; i >= 0; i--)
		printk("%0*lx%s", (int)(sizeof(cpu_evtchn[0])*2),
		       cpu_evtchn[i],
		       i % 8 == 0 ? "\n   " : " ");

	printk("\nlocally unmasked:\n   ");
	for (i = ARRAY_SIZE(sh->evtchn_mask)-1; i >= 0; i--) {
		unsigned long pending = sh->evtchn_pending[i]
			& ~sh->evtchn_mask[i]
			& cpu_evtchn[i];
		printk("%0*lx%s", (int)(sizeof(sh->evtchn_mask[0])*2),
		       pending, i % 8 == 0 ? "\n   " : " ");
1073 1074 1075
	}

	printk("\npending list:\n");
1076
	for (i = 0; i < NR_EVENT_CHANNELS; i++) {
1077
		if (sync_test_bit(i, sh->evtchn_pending)) {
1078 1079
			int word_idx = i / BITS_PER_LONG;
			printk("  %d: event %d -> irq %d%s%s%s\n",
1080
			       cpu_from_evtchn(i), i,
1081 1082 1083 1084 1085 1086 1087
			       evtchn_to_irq[i],
			       sync_test_bit(word_idx, &v->evtchn_pending_sel)
					     ? "" : " l2-clear",
			       !sync_test_bit(i, sh->evtchn_mask)
					     ? "" : " globally-masked",
			       sync_test_bit(i, cpu_evtchn)
					     ? "" : " locally-masked");
1088 1089 1090 1091 1092 1093 1094 1095
		}
	}

	spin_unlock_irqrestore(&debug_lock, flags);

	return IRQ_HANDLED;
}

1096
static DEFINE_PER_CPU(unsigned, xed_nesting_count);
1097 1098
static DEFINE_PER_CPU(unsigned int, current_word_idx);
static DEFINE_PER_CPU(unsigned int, current_bit_idx);
1099

1100 1101 1102 1103
/*
 * Mask out the i least significant bits of w
 */
#define MASK_LSBS(w, i) (w & ((~0UL) << i))
1104

J
Jeremy Fitzhardinge 已提交
1105 1106 1107 1108 1109 1110 1111 1112 1113
/*
 * Search the CPUs pending events bitmasks.  For each one found, map
 * the event number to an irq, and feed it into do_IRQ() for
 * handling.
 *
 * Xen uses a two-level bitmap to speed searching.  The first level is
 * a bitset of words which contain pending event bits.  The second
 * level is a bitset of pending events themselves.
 */
1114
static void __xen_evtchn_do_upcall(void)
J
Jeremy Fitzhardinge 已提交
1115
{
1116
	int start_word_idx, start_bit_idx;
1117
	int word_idx, bit_idx;
1118
	int i;
J
Jeremy Fitzhardinge 已提交
1119 1120
	int cpu = get_cpu();
	struct shared_info *s = HYPERVISOR_shared_info;
C
Christoph Lameter 已提交
1121
	struct vcpu_info *vcpu_info = __this_cpu_read(xen_vcpu);
1122
 	unsigned count;
J
Jeremy Fitzhardinge 已提交
1123

1124 1125
	do {
		unsigned long pending_words;
J
Jeremy Fitzhardinge 已提交
1126

1127
		vcpu_info->evtchn_upcall_pending = 0;
J
Jeremy Fitzhardinge 已提交
1128

C
Christoph Lameter 已提交
1129
		if (__this_cpu_inc_return(xed_nesting_count) - 1)
1130
			goto out;
J
Jeremy Fitzhardinge 已提交
1131

1132 1133
#ifndef CONFIG_X86 /* No need for a barrier -- XCHG is a barrier on x86. */
		/* Clear master flag /before/ clearing selector flag. */
1134
		wmb();
1135
#endif
1136
		pending_words = xchg(&vcpu_info->evtchn_pending_sel, 0);
1137

1138 1139 1140 1141
		start_word_idx = __this_cpu_read(current_word_idx);
		start_bit_idx = __this_cpu_read(current_bit_idx);

		word_idx = start_word_idx;
1142

1143
		for (i = 0; pending_words != 0; i++) {
1144
			unsigned long pending_bits;
1145
			unsigned long words;
1146

1147 1148 1149
			words = MASK_LSBS(pending_words, word_idx);

			/*
1150
			 * If we masked out all events, wrap to beginning.
1151 1152
			 */
			if (words == 0) {
1153 1154
				word_idx = 0;
				bit_idx = 0;
1155 1156 1157
				continue;
			}
			word_idx = __ffs(words);
1158

1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170
			pending_bits = active_evtchns(cpu, s, word_idx);
			bit_idx = 0; /* usually scan entire word from start */
			if (word_idx == start_word_idx) {
				/* We scan the starting word in two parts */
				if (i == 0)
					/* 1st time: start in the middle */
					bit_idx = start_bit_idx;
				else
					/* 2nd time: mask bits done already */
					bit_idx &= (1UL << start_bit_idx) - 1;
			}

1171 1172 1173
			do {
				unsigned long bits;
				int port, irq;
1174
				struct irq_desc *desc;
1175

1176 1177 1178
				bits = MASK_LSBS(pending_bits, bit_idx);

				/* If we masked out all events, move on. */
1179
				if (bits == 0)
1180 1181 1182 1183 1184 1185 1186 1187
					break;

				bit_idx = __ffs(bits);

				/* Process port. */
				port = (word_idx * BITS_PER_LONG) + bit_idx;
				irq = evtchn_to_irq[port];

1188 1189 1190
				mask_evtchn(port);
				clear_evtchn(port);

1191 1192 1193 1194 1195
				if (irq != -1) {
					desc = irq_to_desc(irq);
					if (desc)
						generic_handle_irq_desc(irq, desc);
				}
1196

1197 1198 1199 1200 1201 1202 1203 1204
				bit_idx = (bit_idx + 1) % BITS_PER_LONG;

				/* Next caller starts at last processed + 1 */
				__this_cpu_write(current_word_idx,
						 bit_idx ? word_idx :
						 (word_idx+1) % BITS_PER_LONG);
				__this_cpu_write(current_bit_idx, bit_idx);
			} while (bit_idx != 0);
1205

1206 1207
			/* Scan start_l1i twice; all others once. */
			if ((word_idx != start_word_idx) || (i != 0))
1208
				pending_words &= ~(1UL << word_idx);
1209 1210

			word_idx = (word_idx + 1) % BITS_PER_LONG;
J
Jeremy Fitzhardinge 已提交
1211 1212
		}

1213 1214
		BUG_ON(!irqs_disabled());

C
Christoph Lameter 已提交
1215 1216
		count = __this_cpu_read(xed_nesting_count);
		__this_cpu_write(xed_nesting_count, 0);
1217
	} while (count != 1 || vcpu_info->evtchn_upcall_pending);
1218 1219

out:
1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231 1232

	put_cpu();
}

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

	exit_idle();
	irq_enter();

	__xen_evtchn_do_upcall();

1233 1234
	irq_exit();
	set_irq_regs(old_regs);
1235
}
1236

1237 1238 1239
void xen_hvm_evtchn_do_upcall(void)
{
	__xen_evtchn_do_upcall();
J
Jeremy Fitzhardinge 已提交
1240
}
1241
EXPORT_SYMBOL_GPL(xen_hvm_evtchn_do_upcall);
J
Jeremy Fitzhardinge 已提交
1242

J
Jeremy Fitzhardinge 已提交
1243 1244 1245
/* Rebind a new event channel to an existing irq. */
void rebind_evtchn_irq(int evtchn, int irq)
{
J
Jeremy Fitzhardinge 已提交
1246 1247
	struct irq_info *info = info_for_irq(irq);

J
Jeremy Fitzhardinge 已提交
1248 1249 1250 1251 1252 1253 1254 1255 1256
	/* Make sure the irq is masked, since the new event channel
	   will also be masked. */
	disable_irq(irq);

	spin_lock(&irq_mapping_update_lock);

	/* After resume the irq<->evtchn mappings are all cleared out */
	BUG_ON(evtchn_to_irq[evtchn] != -1);
	/* Expect irq to have been bound before,
J
Jeremy Fitzhardinge 已提交
1257 1258
	   so there should be a proper type */
	BUG_ON(info->type == IRQT_UNBOUND);
J
Jeremy Fitzhardinge 已提交
1259

1260
	xen_irq_info_evtchn_init(irq, evtchn);
J
Jeremy Fitzhardinge 已提交
1261 1262 1263 1264

	spin_unlock(&irq_mapping_update_lock);

	/* new event channels are always bound to cpu 0 */
1265
	irq_set_affinity(irq, cpumask_of(0));
J
Jeremy Fitzhardinge 已提交
1266 1267 1268 1269 1270

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

J
Jeremy Fitzhardinge 已提交
1271
/* Rebind an evtchn so that it gets delivered to a specific cpu */
1272
static int rebind_irq_to_cpu(unsigned irq, unsigned tcpu)
J
Jeremy Fitzhardinge 已提交
1273 1274 1275 1276
{
	struct evtchn_bind_vcpu bind_vcpu;
	int evtchn = evtchn_from_irq(irq);

1277 1278 1279 1280 1281 1282 1283 1284
	if (!VALID_EVTCHN(evtchn))
		return -1;

	/*
	 * Events delivered via platform PCI interrupts are always
	 * routed to vcpu 0 and hence cannot be rebound.
	 */
	if (xen_hvm_domain() && !xen_have_vector_callback)
1285
		return -1;
J
Jeremy Fitzhardinge 已提交
1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298

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

	/*
	 * 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);

1299 1300
	return 0;
}
J
Jeremy Fitzhardinge 已提交
1301

1302 1303
static int set_affinity_irq(struct irq_data *data, const struct cpumask *dest,
			    bool force)
J
Jeremy Fitzhardinge 已提交
1304
{
1305
	unsigned tcpu = cpumask_first(dest);
1306

1307
	return rebind_irq_to_cpu(data->irq, tcpu);
J
Jeremy Fitzhardinge 已提交
1308 1309
}

1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324 1325
int resend_irq_on_evtchn(unsigned int irq)
{
	int masked, evtchn = evtchn_from_irq(irq);
	struct shared_info *s = HYPERVISOR_shared_info;

	if (!VALID_EVTCHN(evtchn))
		return 1;

	masked = sync_test_and_set_bit(evtchn, s->evtchn_mask);
	sync_set_bit(evtchn, s->evtchn_pending);
	if (!masked)
		unmask_evtchn(evtchn);

	return 1;
}

1326
static void enable_dynirq(struct irq_data *data)
J
Jeremy Fitzhardinge 已提交
1327
{
1328
	int evtchn = evtchn_from_irq(data->irq);
J
Jeremy Fitzhardinge 已提交
1329 1330 1331 1332 1333

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

1334
static void disable_dynirq(struct irq_data *data)
J
Jeremy Fitzhardinge 已提交
1335
{
1336
	int evtchn = evtchn_from_irq(data->irq);
J
Jeremy Fitzhardinge 已提交
1337 1338 1339 1340 1341

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

1342
static void ack_dynirq(struct irq_data *data)
J
Jeremy Fitzhardinge 已提交
1343
{
1344
	int evtchn = evtchn_from_irq(data->irq);
J
Jeremy Fitzhardinge 已提交
1345

1346
	irq_move_masked_irq(data);
J
Jeremy Fitzhardinge 已提交
1347 1348

	if (VALID_EVTCHN(evtchn))
1349
		unmask_evtchn(evtchn);
J
Jeremy Fitzhardinge 已提交
1350 1351
}

1352
static int retrigger_dynirq(struct irq_data *data)
J
Jeremy Fitzhardinge 已提交
1353
{
1354
	int evtchn = evtchn_from_irq(data->irq);
1355
	struct shared_info *sh = HYPERVISOR_shared_info;
J
Jeremy Fitzhardinge 已提交
1356 1357 1358
	int ret = 0;

	if (VALID_EVTCHN(evtchn)) {
1359 1360 1361 1362 1363 1364
		int masked;

		masked = sync_test_and_set_bit(evtchn, sh->evtchn_mask);
		sync_set_bit(evtchn, sh->evtchn_pending);
		if (!masked)
			unmask_evtchn(evtchn);
J
Jeremy Fitzhardinge 已提交
1365 1366 1367 1368 1369 1370
		ret = 1;
	}

	return ret;
}

1371
static void restore_pirqs(void)
1372 1373 1374
{
	int pirq, rc, irq, gsi;
	struct physdev_map_pirq map_irq;
1375
	struct irq_info *info;
1376

1377 1378
	list_for_each_entry(info, &xen_irq_list_head, list) {
		if (info->type != IRQT_PIRQ)
1379 1380
			continue;

1381 1382 1383 1384
		pirq = info->u.pirq.pirq;
		gsi = info->u.pirq.gsi;
		irq = info->irq;

1385 1386 1387 1388 1389 1390 1391 1392 1393 1394 1395 1396 1397 1398
		/* 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) {
			printk(KERN_WARNING "xen map irq failed gsi=%d irq=%d pirq=%d rc=%d\n",
					gsi, irq, pirq, rc);
1399
			xen_free_irq(irq);
1400 1401 1402 1403 1404
			continue;
		}

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

1405
		__startup_pirq(irq);
1406 1407 1408
	}
}

1409 1410 1411 1412 1413 1414 1415 1416 1417
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;

1418
		BUG_ON(virq_from_irq(irq) != virq);
1419 1420 1421 1422 1423 1424 1425 1426 1427 1428

		/* 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. */
1429
		xen_irq_info_virq_init(cpu, irq, evtchn, virq);
1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442
		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;

1443
		BUG_ON(ipi_from_irq(irq) != ipi);
1444 1445 1446 1447 1448 1449 1450 1451 1452

		/* 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. */
1453
		xen_irq_info_ipi_init(cpu, irq, evtchn, ipi);
1454 1455 1456 1457
		bind_evtchn_to_cpu(evtchn, cpu);
	}
}

1458 1459 1460 1461 1462 1463 1464 1465
/* 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);
}
1466
EXPORT_SYMBOL(xen_clear_irq_pending);
1467 1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479 1480 1481 1482 1483 1484 1485
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;
}

1486 1487 1488
/* 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)
1489 1490 1491 1492 1493 1494 1495
{
	evtchn_port_t evtchn = evtchn_from_irq(irq);

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

		poll.nr_ports = 1;
1496
		poll.timeout = timeout;
1497
		set_xen_guest_handle(poll.ports, &evtchn);
1498 1499 1500 1501 1502

		if (HYPERVISOR_sched_op(SCHEDOP_poll, &poll) != 0)
			BUG();
	}
}
1503 1504 1505 1506 1507 1508 1509
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 */);
}
1510

1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522
/* 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);
	struct physdev_irq_status_query irq_status = { .irq = info->u.pirq.pirq };

	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);

1523 1524
void xen_irq_resume(void)
{
1525 1526
	unsigned int cpu, evtchn;
	struct irq_info *info;
1527 1528 1529 1530 1531 1532 1533 1534

	init_evtchn_cpu_bindings();

	/* New event-channel space is not 'live' yet. */
	for (evtchn = 0; evtchn < NR_EVENT_CHANNELS; evtchn++)
		mask_evtchn(evtchn);

	/* No IRQ <-> event-channel mappings. */
1535 1536
	list_for_each_entry(info, &xen_irq_list_head, list)
		info->evtchn = 0; /* zap event-channel binding */
1537 1538 1539 1540 1541 1542 1543 1544

	for (evtchn = 0; evtchn < NR_EVENT_CHANNELS; evtchn++)
		evtchn_to_irq[evtchn] = -1;

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

1546
	restore_pirqs();
1547 1548
}

J
Jeremy Fitzhardinge 已提交
1549
static struct irq_chip xen_dynamic_chip __read_mostly = {
1550
	.name			= "xen-dyn",
J
Jeremy Fitzhardinge 已提交
1551

1552 1553 1554
	.irq_disable		= disable_dynirq,
	.irq_mask		= disable_dynirq,
	.irq_unmask		= enable_dynirq,
J
Jeremy Fitzhardinge 已提交
1555

1556 1557 1558
	.irq_eoi		= ack_dynirq,
	.irq_set_affinity	= set_affinity_irq,
	.irq_retrigger		= retrigger_dynirq,
J
Jeremy Fitzhardinge 已提交
1559 1560
};

1561
static struct irq_chip xen_pirq_chip __read_mostly = {
1562
	.name			= "xen-pirq",
1563

1564 1565
	.irq_startup		= startup_pirq,
	.irq_shutdown		= shutdown_pirq,
1566

1567 1568
	.irq_enable		= enable_pirq,
	.irq_unmask		= enable_pirq,
1569

1570 1571
	.irq_disable		= disable_pirq,
	.irq_mask		= disable_pirq,
1572

1573
	.irq_ack		= ack_pirq,
1574

1575
	.irq_set_affinity	= set_affinity_irq,
1576

1577
	.irq_retrigger		= retrigger_dynirq,
1578 1579
};

1580
static struct irq_chip xen_percpu_chip __read_mostly = {
1581
	.name			= "xen-percpu",
1582

1583 1584 1585
	.irq_disable		= disable_dynirq,
	.irq_mask		= disable_dynirq,
	.irq_unmask		= enable_dynirq,
1586

1587
	.irq_ack		= ack_dynirq,
1588 1589
};

1590 1591 1592 1593 1594 1595 1596 1597 1598 1599
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);

1600
#ifdef CONFIG_XEN_PVHVM
1601 1602 1603 1604 1605 1606 1607 1608 1609 1610 1611 1612 1613 1614 1615 1616 1617 1618 1619 1620 1621 1622 1623
/* 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) {
		callback_via = HVM_CALLBACK_VECTOR(XEN_HVM_EVTCHN_CALLBACK);
		rc = xen_set_callback_via(callback_via);
		if (rc) {
			printk(KERN_ERR "Request for Xen HVM callback vector"
					" failed.\n");
			xen_have_vector_callback = 0;
			return;
		}
		printk(KERN_INFO "Xen HVM callback vector for event delivery is "
				"enabled\n");
		/* in the restore case the vector has already been allocated */
		if (!test_bit(XEN_HVM_EVTCHN_CALLBACK, used_vectors))
			alloc_intr_gate(XEN_HVM_EVTCHN_CALLBACK, xen_hvm_callback_vector);
	}
}
1624 1625 1626
#else
void xen_callback_vector(void) {}
#endif
1627

J
Jeremy Fitzhardinge 已提交
1628 1629
void __init xen_init_IRQ(void)
{
1630
	int i;
1631

1632 1633 1634 1635
	evtchn_to_irq = kcalloc(NR_EVENT_CHANNELS, sizeof(*evtchn_to_irq),
				    GFP_KERNEL);
	for (i = 0; i < NR_EVENT_CHANNELS; i++)
		evtchn_to_irq[i] = -1;
J
Jeremy Fitzhardinge 已提交
1636 1637 1638 1639 1640 1641 1642

	init_evtchn_cpu_bindings();

	/* No event channels are 'live' right now. */
	for (i = 0; i < NR_EVENT_CHANNELS; i++)
		mask_evtchn(i);

1643 1644 1645
	if (xen_hvm_domain()) {
		xen_callback_vector();
		native_init_IRQ();
1646 1647 1648
		/* 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();
1649 1650
	} else {
		irq_ctx_init(smp_processor_id());
1651 1652
		if (xen_initial_domain())
			xen_setup_pirqs();
1653
	}
J
Jeremy Fitzhardinge 已提交
1654
}