]> git.karo-electronics.de Git - linux-beck.git/blob - drivers/xen/events.c
xen: use PHYSDEVOP_get_free_pirq to implement find_unbound_pirq
[linux-beck.git] / drivers / xen / events.c
1 /*
2  * Xen event channels
3  *
4  * Xen models interrupts with abstract event channels.  Because each
5  * domain gets 1024 event channels, but NR_IRQ is not that large, we
6  * must dynamically map irqs<->event channels.  The event channels
7  * interface with the rest of the kernel by defining a xen interrupt
8  * chip.  When an event is recieved, it is mapped to an irq and sent
9  * through the normal interrupt processing path.
10  *
11  * There are four kinds of events which can be mapped to an event
12  * channel:
13  *
14  * 1. Inter-domain notifications.  This includes all the virtual
15  *    device events, since they're driven by front-ends in another domain
16  *    (typically dom0).
17  * 2. VIRQs, typically used for timers.  These are per-cpu events.
18  * 3. IPIs.
19  * 4. PIRQs - Hardware interrupts.
20  *
21  * Jeremy Fitzhardinge <jeremy@xensource.com>, XenSource Inc, 2007
22  */
23
24 #include <linux/linkage.h>
25 #include <linux/interrupt.h>
26 #include <linux/irq.h>
27 #include <linux/module.h>
28 #include <linux/string.h>
29 #include <linux/bootmem.h>
30 #include <linux/slab.h>
31 #include <linux/irqnr.h>
32 #include <linux/pci.h>
33
34 #include <asm/desc.h>
35 #include <asm/ptrace.h>
36 #include <asm/irq.h>
37 #include <asm/idle.h>
38 #include <asm/io_apic.h>
39 #include <asm/sync_bitops.h>
40 #include <asm/xen/pci.h>
41 #include <asm/xen/hypercall.h>
42 #include <asm/xen/hypervisor.h>
43
44 #include <xen/xen.h>
45 #include <xen/hvm.h>
46 #include <xen/xen-ops.h>
47 #include <xen/events.h>
48 #include <xen/interface/xen.h>
49 #include <xen/interface/event_channel.h>
50 #include <xen/interface/hvm/hvm_op.h>
51 #include <xen/interface/hvm/params.h>
52
53 /*
54  * This lock protects updates to the following mapping and reference-count
55  * arrays. The lock does not need to be acquired to read the mapping tables.
56  */
57 static DEFINE_SPINLOCK(irq_mapping_update_lock);
58
59 /* IRQ <-> VIRQ mapping. */
60 static DEFINE_PER_CPU(int [NR_VIRQS], virq_to_irq) = {[0 ... NR_VIRQS-1] = -1};
61
62 /* IRQ <-> IPI mapping */
63 static DEFINE_PER_CPU(int [XEN_NR_IPIS], ipi_to_irq) = {[0 ... XEN_NR_IPIS-1] = -1};
64
65 /* Interrupt types. */
66 enum xen_irq_type {
67         IRQT_UNBOUND = 0,
68         IRQT_PIRQ,
69         IRQT_VIRQ,
70         IRQT_IPI,
71         IRQT_EVTCHN
72 };
73
74 /*
75  * Packed IRQ information:
76  * type - enum xen_irq_type
77  * event channel - irq->event channel mapping
78  * cpu - cpu this event channel is bound to
79  * index - type-specific information:
80  *    PIRQ - vector, with MSB being "needs EIO", or physical IRQ of the HVM
81  *           guest, or GSI (real passthrough IRQ) of the device.
82  *    VIRQ - virq number
83  *    IPI - IPI vector
84  *    EVTCHN -
85  */
86 struct irq_info
87 {
88         enum xen_irq_type type; /* type */
89         unsigned short evtchn;  /* event channel */
90         unsigned short cpu;     /* cpu bound */
91
92         union {
93                 unsigned short virq;
94                 enum ipi_vector ipi;
95                 struct {
96                         unsigned short pirq;
97                         unsigned short gsi;
98                         unsigned char vector;
99                         unsigned char flags;
100                 } pirq;
101         } u;
102 };
103 #define PIRQ_NEEDS_EOI  (1 << 0)
104 #define PIRQ_SHAREABLE  (1 << 1)
105
106 static struct irq_info *irq_info;
107 static int *pirq_to_irq;
108
109 static int *evtchn_to_irq;
110 struct cpu_evtchn_s {
111         unsigned long bits[NR_EVENT_CHANNELS/BITS_PER_LONG];
112 };
113
114 static __initdata struct cpu_evtchn_s init_evtchn_mask = {
115         .bits[0 ... (NR_EVENT_CHANNELS/BITS_PER_LONG)-1] = ~0ul,
116 };
117 static struct cpu_evtchn_s *cpu_evtchn_mask_p = &init_evtchn_mask;
118
119 static inline unsigned long *cpu_evtchn_mask(int cpu)
120 {
121         return cpu_evtchn_mask_p[cpu].bits;
122 }
123
124 /* Xen will never allocate port zero for any purpose. */
125 #define VALID_EVTCHN(chn)       ((chn) != 0)
126
127 static struct irq_chip xen_dynamic_chip;
128 static struct irq_chip xen_percpu_chip;
129 static struct irq_chip xen_pirq_chip;
130
131 /* Constructor for packed IRQ information. */
132 static struct irq_info mk_unbound_info(void)
133 {
134         return (struct irq_info) { .type = IRQT_UNBOUND };
135 }
136
137 static struct irq_info mk_evtchn_info(unsigned short evtchn)
138 {
139         return (struct irq_info) { .type = IRQT_EVTCHN, .evtchn = evtchn,
140                         .cpu = 0 };
141 }
142
143 static struct irq_info mk_ipi_info(unsigned short evtchn, enum ipi_vector ipi)
144 {
145         return (struct irq_info) { .type = IRQT_IPI, .evtchn = evtchn,
146                         .cpu = 0, .u.ipi = ipi };
147 }
148
149 static struct irq_info mk_virq_info(unsigned short evtchn, unsigned short virq)
150 {
151         return (struct irq_info) { .type = IRQT_VIRQ, .evtchn = evtchn,
152                         .cpu = 0, .u.virq = virq };
153 }
154
155 static struct irq_info mk_pirq_info(unsigned short evtchn, unsigned short pirq,
156                                     unsigned short gsi, unsigned short vector)
157 {
158         return (struct irq_info) { .type = IRQT_PIRQ, .evtchn = evtchn,
159                         .cpu = 0,
160                         .u.pirq = { .pirq = pirq, .gsi = gsi, .vector = vector } };
161 }
162
163 /*
164  * Accessors for packed IRQ information.
165  */
166 static struct irq_info *info_for_irq(unsigned irq)
167 {
168         return &irq_info[irq];
169 }
170
171 static unsigned int evtchn_from_irq(unsigned irq)
172 {
173         return info_for_irq(irq)->evtchn;
174 }
175
176 unsigned irq_from_evtchn(unsigned int evtchn)
177 {
178         return evtchn_to_irq[evtchn];
179 }
180 EXPORT_SYMBOL_GPL(irq_from_evtchn);
181
182 static enum ipi_vector ipi_from_irq(unsigned irq)
183 {
184         struct irq_info *info = info_for_irq(irq);
185
186         BUG_ON(info == NULL);
187         BUG_ON(info->type != IRQT_IPI);
188
189         return info->u.ipi;
190 }
191
192 static unsigned virq_from_irq(unsigned irq)
193 {
194         struct irq_info *info = info_for_irq(irq);
195
196         BUG_ON(info == NULL);
197         BUG_ON(info->type != IRQT_VIRQ);
198
199         return info->u.virq;
200 }
201
202 static unsigned pirq_from_irq(unsigned irq)
203 {
204         struct irq_info *info = info_for_irq(irq);
205
206         BUG_ON(info == NULL);
207         BUG_ON(info->type != IRQT_PIRQ);
208
209         return info->u.pirq.pirq;
210 }
211
212 static unsigned gsi_from_irq(unsigned irq)
213 {
214         struct irq_info *info = info_for_irq(irq);
215
216         BUG_ON(info == NULL);
217         BUG_ON(info->type != IRQT_PIRQ);
218
219         return info->u.pirq.gsi;
220 }
221
222 static unsigned vector_from_irq(unsigned irq)
223 {
224         struct irq_info *info = info_for_irq(irq);
225
226         BUG_ON(info == NULL);
227         BUG_ON(info->type != IRQT_PIRQ);
228
229         return info->u.pirq.vector;
230 }
231
232 static enum xen_irq_type type_from_irq(unsigned irq)
233 {
234         return info_for_irq(irq)->type;
235 }
236
237 static unsigned cpu_from_irq(unsigned irq)
238 {
239         return info_for_irq(irq)->cpu;
240 }
241
242 static unsigned int cpu_from_evtchn(unsigned int evtchn)
243 {
244         int irq = evtchn_to_irq[evtchn];
245         unsigned ret = 0;
246
247         if (irq != -1)
248                 ret = cpu_from_irq(irq);
249
250         return ret;
251 }
252
253 static bool pirq_needs_eoi(unsigned irq)
254 {
255         struct irq_info *info = info_for_irq(irq);
256
257         BUG_ON(info->type != IRQT_PIRQ);
258
259         return info->u.pirq.flags & PIRQ_NEEDS_EOI;
260 }
261
262 static inline unsigned long active_evtchns(unsigned int cpu,
263                                            struct shared_info *sh,
264                                            unsigned int idx)
265 {
266         return (sh->evtchn_pending[idx] &
267                 cpu_evtchn_mask(cpu)[idx] &
268                 ~sh->evtchn_mask[idx]);
269 }
270
271 static void bind_evtchn_to_cpu(unsigned int chn, unsigned int cpu)
272 {
273         int irq = evtchn_to_irq[chn];
274
275         BUG_ON(irq == -1);
276 #ifdef CONFIG_SMP
277         cpumask_copy(irq_to_desc(irq)->affinity, cpumask_of(cpu));
278 #endif
279
280         clear_bit(chn, cpu_evtchn_mask(cpu_from_irq(irq)));
281         set_bit(chn, cpu_evtchn_mask(cpu));
282
283         irq_info[irq].cpu = cpu;
284 }
285
286 static void init_evtchn_cpu_bindings(void)
287 {
288         int i;
289 #ifdef CONFIG_SMP
290         struct irq_desc *desc;
291
292         /* By default all event channels notify CPU#0. */
293         for_each_irq_desc(i, desc) {
294                 cpumask_copy(desc->affinity, cpumask_of(0));
295         }
296 #endif
297
298         for_each_possible_cpu(i)
299                 memset(cpu_evtchn_mask(i),
300                        (i == 0) ? ~0 : 0, sizeof(struct cpu_evtchn_s));
301
302 }
303
304 static inline void clear_evtchn(int port)
305 {
306         struct shared_info *s = HYPERVISOR_shared_info;
307         sync_clear_bit(port, &s->evtchn_pending[0]);
308 }
309
310 static inline void set_evtchn(int port)
311 {
312         struct shared_info *s = HYPERVISOR_shared_info;
313         sync_set_bit(port, &s->evtchn_pending[0]);
314 }
315
316 static inline int test_evtchn(int port)
317 {
318         struct shared_info *s = HYPERVISOR_shared_info;
319         return sync_test_bit(port, &s->evtchn_pending[0]);
320 }
321
322
323 /**
324  * notify_remote_via_irq - send event to remote end of event channel via irq
325  * @irq: irq of event channel to send event to
326  *
327  * Unlike notify_remote_via_evtchn(), this is safe to use across
328  * save/restore. Notifications on a broken connection are silently
329  * dropped.
330  */
331 void notify_remote_via_irq(int irq)
332 {
333         int evtchn = evtchn_from_irq(irq);
334
335         if (VALID_EVTCHN(evtchn))
336                 notify_remote_via_evtchn(evtchn);
337 }
338 EXPORT_SYMBOL_GPL(notify_remote_via_irq);
339
340 static void mask_evtchn(int port)
341 {
342         struct shared_info *s = HYPERVISOR_shared_info;
343         sync_set_bit(port, &s->evtchn_mask[0]);
344 }
345
346 static void unmask_evtchn(int port)
347 {
348         struct shared_info *s = HYPERVISOR_shared_info;
349         unsigned int cpu = get_cpu();
350
351         BUG_ON(!irqs_disabled());
352
353         /* Slow path (hypercall) if this is a non-local port. */
354         if (unlikely(cpu != cpu_from_evtchn(port))) {
355                 struct evtchn_unmask unmask = { .port = port };
356                 (void)HYPERVISOR_event_channel_op(EVTCHNOP_unmask, &unmask);
357         } else {
358                 struct vcpu_info *vcpu_info = __get_cpu_var(xen_vcpu);
359
360                 sync_clear_bit(port, &s->evtchn_mask[0]);
361
362                 /*
363                  * The following is basically the equivalent of
364                  * 'hw_resend_irq'. Just like a real IO-APIC we 'lose
365                  * the interrupt edge' if the channel is masked.
366                  */
367                 if (sync_test_bit(port, &s->evtchn_pending[0]) &&
368                     !sync_test_and_set_bit(port / BITS_PER_LONG,
369                                            &vcpu_info->evtchn_pending_sel))
370                         vcpu_info->evtchn_upcall_pending = 1;
371         }
372
373         put_cpu();
374 }
375
376 static int get_nr_hw_irqs(void)
377 {
378         int ret = 1;
379
380 #ifdef CONFIG_X86_IO_APIC
381         ret = get_nr_irqs_gsi();
382 #endif
383
384         return ret;
385 }
386
387 static int find_unbound_pirq(int type)
388 {
389         int rc, i;
390         struct physdev_get_free_pirq op_get_free_pirq;
391         op_get_free_pirq.type = type;
392
393         rc = HYPERVISOR_physdev_op(PHYSDEVOP_get_free_pirq, &op_get_free_pirq);
394         if (!rc)
395                 return op_get_free_pirq.pirq;
396
397         for (i = 0; i < nr_irqs; i++) {
398                 if (pirq_to_irq[i] < 0)
399                         return i;
400         }
401         return -1;
402 }
403
404 static int find_unbound_irq(void)
405 {
406         struct irq_data *data;
407         int irq, res;
408         int start = get_nr_hw_irqs();
409
410         if (start == nr_irqs)
411                 goto no_irqs;
412
413         /* nr_irqs is a magic value. Must not use it.*/
414         for (irq = nr_irqs-1; irq > start; irq--) {
415                 data = irq_get_irq_data(irq);
416                 /* only 0->15 have init'd desc; handle irq > 16 */
417                 if (!data)
418                         break;
419                 if (data->chip == &no_irq_chip)
420                         break;
421                 if (data->chip != &xen_dynamic_chip)
422                         continue;
423                 if (irq_info[irq].type == IRQT_UNBOUND)
424                         return irq;
425         }
426
427         if (irq == start)
428                 goto no_irqs;
429
430         res = irq_alloc_desc_at(irq, 0);
431
432         if (WARN_ON(res != irq))
433                 return -1;
434
435         return irq;
436
437 no_irqs:
438         panic("No available IRQ to bind to: increase nr_irqs!\n");
439 }
440
441 static bool identity_mapped_irq(unsigned irq)
442 {
443         /* identity map all the hardware irqs */
444         return irq < get_nr_hw_irqs();
445 }
446
447 static void pirq_unmask_notify(int irq)
448 {
449         struct physdev_eoi eoi = { .irq = pirq_from_irq(irq) };
450
451         if (unlikely(pirq_needs_eoi(irq))) {
452                 int rc = HYPERVISOR_physdev_op(PHYSDEVOP_eoi, &eoi);
453                 WARN_ON(rc);
454         }
455 }
456
457 static void pirq_query_unmask(int irq)
458 {
459         struct physdev_irq_status_query irq_status;
460         struct irq_info *info = info_for_irq(irq);
461
462         BUG_ON(info->type != IRQT_PIRQ);
463
464         irq_status.irq = pirq_from_irq(irq);
465         if (HYPERVISOR_physdev_op(PHYSDEVOP_irq_status_query, &irq_status))
466                 irq_status.flags = 0;
467
468         info->u.pirq.flags &= ~PIRQ_NEEDS_EOI;
469         if (irq_status.flags & XENIRQSTAT_needs_eoi)
470                 info->u.pirq.flags |= PIRQ_NEEDS_EOI;
471 }
472
473 static bool probing_irq(int irq)
474 {
475         struct irq_desc *desc = irq_to_desc(irq);
476
477         return desc && desc->action == NULL;
478 }
479
480 static unsigned int startup_pirq(unsigned int irq)
481 {
482         struct evtchn_bind_pirq bind_pirq;
483         struct irq_info *info = info_for_irq(irq);
484         int evtchn = evtchn_from_irq(irq);
485         int rc;
486
487         BUG_ON(info->type != IRQT_PIRQ);
488
489         if (VALID_EVTCHN(evtchn))
490                 goto out;
491
492         bind_pirq.pirq = pirq_from_irq(irq);
493         /* NB. We are happy to share unless we are probing. */
494         bind_pirq.flags = info->u.pirq.flags & PIRQ_SHAREABLE ?
495                                         BIND_PIRQ__WILL_SHARE : 0;
496         rc = HYPERVISOR_event_channel_op(EVTCHNOP_bind_pirq, &bind_pirq);
497         if (rc != 0) {
498                 if (!probing_irq(irq))
499                         printk(KERN_INFO "Failed to obtain physical IRQ %d\n",
500                                irq);
501                 return 0;
502         }
503         evtchn = bind_pirq.port;
504
505         pirq_query_unmask(irq);
506
507         evtchn_to_irq[evtchn] = irq;
508         bind_evtchn_to_cpu(evtchn, 0);
509         info->evtchn = evtchn;
510
511 out:
512         unmask_evtchn(evtchn);
513         pirq_unmask_notify(irq);
514
515         return 0;
516 }
517
518 static void shutdown_pirq(unsigned int irq)
519 {
520         struct evtchn_close close;
521         struct irq_info *info = info_for_irq(irq);
522         int evtchn = evtchn_from_irq(irq);
523
524         BUG_ON(info->type != IRQT_PIRQ);
525
526         if (!VALID_EVTCHN(evtchn))
527                 return;
528
529         mask_evtchn(evtchn);
530
531         close.port = evtchn;
532         if (HYPERVISOR_event_channel_op(EVTCHNOP_close, &close) != 0)
533                 BUG();
534
535         bind_evtchn_to_cpu(evtchn, 0);
536         evtchn_to_irq[evtchn] = -1;
537         info->evtchn = 0;
538 }
539
540 static void enable_pirq(unsigned int irq)
541 {
542         startup_pirq(irq);
543 }
544
545 static void disable_pirq(unsigned int irq)
546 {
547 }
548
549 static void ack_pirq(unsigned int irq)
550 {
551         int evtchn = evtchn_from_irq(irq);
552
553         move_native_irq(irq);
554
555         if (VALID_EVTCHN(evtchn)) {
556                 mask_evtchn(evtchn);
557                 clear_evtchn(evtchn);
558         }
559 }
560
561 static void end_pirq(unsigned int irq)
562 {
563         int evtchn = evtchn_from_irq(irq);
564         struct irq_desc *desc = irq_to_desc(irq);
565
566         if (WARN_ON(!desc))
567                 return;
568
569         if ((desc->status & (IRQ_DISABLED|IRQ_PENDING)) ==
570             (IRQ_DISABLED|IRQ_PENDING)) {
571                 shutdown_pirq(irq);
572         } else if (VALID_EVTCHN(evtchn)) {
573                 unmask_evtchn(evtchn);
574                 pirq_unmask_notify(irq);
575         }
576 }
577
578 static int find_irq_by_gsi(unsigned gsi)
579 {
580         int irq;
581
582         for (irq = 0; irq < nr_irqs; irq++) {
583                 struct irq_info *info = info_for_irq(irq);
584
585                 if (info == NULL || info->type != IRQT_PIRQ)
586                         continue;
587
588                 if (gsi_from_irq(irq) == gsi)
589                         return irq;
590         }
591
592         return -1;
593 }
594
595 int xen_allocate_pirq(unsigned gsi, int shareable, char *name)
596 {
597         return xen_map_pirq_gsi(gsi, gsi, shareable, name);
598 }
599
600 /* xen_map_pirq_gsi might allocate irqs from the top down, as a
601  * consequence don't assume that the irq number returned has a low value
602  * or can be used as a pirq number unless you know otherwise.
603  *
604  * One notable exception is when xen_map_pirq_gsi is called passing an
605  * hardware gsi as argument, in that case the irq number returned
606  * matches the gsi number passed as second argument.
607  *
608  * Note: We don't assign an event channel until the irq actually started
609  * up.  Return an existing irq if we've already got one for the gsi.
610  */
611 int xen_map_pirq_gsi(unsigned pirq, unsigned gsi, int shareable, char *name)
612 {
613         int irq = 0;
614         struct physdev_irq irq_op;
615
616         spin_lock(&irq_mapping_update_lock);
617
618         if ((pirq > nr_irqs) || (gsi > nr_irqs)) {
619                 printk(KERN_WARNING "xen_map_pirq_gsi: %s %s is incorrect!\n",
620                         pirq > nr_irqs ? "pirq" :"",
621                         gsi > nr_irqs ? "gsi" : "");
622                 goto out;
623         }
624
625         irq = find_irq_by_gsi(gsi);
626         if (irq != -1) {
627                 printk(KERN_INFO "xen_map_pirq_gsi: returning irq %d for gsi %u\n",
628                        irq, gsi);
629                 goto out;       /* XXX need refcount? */
630         }
631
632         /* If we are a PV guest, we don't have GSIs (no ACPI passed). Therefore
633          * we are using the !xen_initial_domain() to drop in the function.*/
634         if (identity_mapped_irq(gsi) || (!xen_initial_domain() &&
635                                 xen_pv_domain())) {
636                 irq = gsi;
637                 irq_alloc_desc_at(irq, 0);
638         } else
639                 irq = find_unbound_irq();
640
641         set_irq_chip_and_handler_name(irq, &xen_pirq_chip,
642                                       handle_level_irq, name);
643
644         irq_op.irq = irq;
645         irq_op.vector = 0;
646
647         /* Only the privileged domain can do this. For non-priv, the pcifront
648          * driver provides a PCI bus that does the call to do exactly
649          * this in the priv domain. */
650         if (xen_initial_domain() &&
651             HYPERVISOR_physdev_op(PHYSDEVOP_alloc_irq_vector, &irq_op)) {
652                 irq_free_desc(irq);
653                 irq = -ENOSPC;
654                 goto out;
655         }
656
657         irq_info[irq] = mk_pirq_info(0, pirq, gsi, irq_op.vector);
658         irq_info[irq].u.pirq.flags |= shareable ? PIRQ_SHAREABLE : 0;
659         pirq_to_irq[pirq] = irq;
660
661 out:
662         spin_unlock(&irq_mapping_update_lock);
663
664         return irq;
665 }
666
667 #ifdef CONFIG_PCI_MSI
668 #include <linux/msi.h>
669 #include "../pci/msi.h"
670
671 void xen_allocate_pirq_msi(char *name, int *irq, int *pirq)
672 {
673         spin_lock(&irq_mapping_update_lock);
674
675         *irq = find_unbound_irq();
676         if (*irq == -1)
677                 goto out;
678
679         *pirq = find_unbound_pirq(MAP_PIRQ_TYPE_MSI);
680         if (*pirq == -1)
681                 goto out;
682
683         set_irq_chip_and_handler_name(*irq, &xen_pirq_chip,
684                                       handle_level_irq, name);
685
686         irq_info[*irq] = mk_pirq_info(0, *pirq, 0, 0);
687         pirq_to_irq[*pirq] = *irq;
688
689 out:
690         spin_unlock(&irq_mapping_update_lock);
691 }
692
693 int xen_create_msi_irq(struct pci_dev *dev, struct msi_desc *msidesc, int type)
694 {
695         int irq = -1;
696         struct physdev_map_pirq map_irq;
697         int rc;
698         int pos;
699         u32 table_offset, bir;
700
701         memset(&map_irq, 0, sizeof(map_irq));
702         map_irq.domid = DOMID_SELF;
703         map_irq.type = MAP_PIRQ_TYPE_MSI;
704         map_irq.index = -1;
705         map_irq.pirq = -1;
706         map_irq.bus = dev->bus->number;
707         map_irq.devfn = dev->devfn;
708
709         if (type == PCI_CAP_ID_MSIX) {
710                 pos = pci_find_capability(dev, PCI_CAP_ID_MSIX);
711
712                 pci_read_config_dword(dev, msix_table_offset_reg(pos),
713                                         &table_offset);
714                 bir = (u8)(table_offset & PCI_MSIX_FLAGS_BIRMASK);
715
716                 map_irq.table_base = pci_resource_start(dev, bir);
717                 map_irq.entry_nr = msidesc->msi_attrib.entry_nr;
718         }
719
720         spin_lock(&irq_mapping_update_lock);
721
722         irq = find_unbound_irq();
723
724         if (irq == -1)
725                 goto out;
726
727         rc = HYPERVISOR_physdev_op(PHYSDEVOP_map_pirq, &map_irq);
728         if (rc) {
729                 printk(KERN_WARNING "xen map irq failed %d\n", rc);
730
731                 irq_free_desc(irq);
732
733                 irq = -1;
734                 goto out;
735         }
736         irq_info[irq] = mk_pirq_info(0, map_irq.pirq, 0, map_irq.index);
737
738         set_irq_chip_and_handler_name(irq, &xen_pirq_chip,
739                         handle_level_irq,
740                         (type == PCI_CAP_ID_MSIX) ? "msi-x":"msi");
741
742 out:
743         spin_unlock(&irq_mapping_update_lock);
744         return irq;
745 }
746 #endif
747
748 int xen_destroy_irq(int irq)
749 {
750         struct irq_desc *desc;
751         struct physdev_unmap_pirq unmap_irq;
752         struct irq_info *info = info_for_irq(irq);
753         int rc = -ENOENT;
754
755         spin_lock(&irq_mapping_update_lock);
756
757         desc = irq_to_desc(irq);
758         if (!desc)
759                 goto out;
760
761         if (xen_initial_domain()) {
762                 unmap_irq.pirq = info->u.pirq.pirq;
763                 unmap_irq.domid = DOMID_SELF;
764                 rc = HYPERVISOR_physdev_op(PHYSDEVOP_unmap_pirq, &unmap_irq);
765                 if (rc) {
766                         printk(KERN_WARNING "unmap irq failed %d\n", rc);
767                         goto out;
768                 }
769         }
770         irq_info[irq] = mk_unbound_info();
771
772         irq_free_desc(irq);
773
774 out:
775         spin_unlock(&irq_mapping_update_lock);
776         return rc;
777 }
778
779 int xen_vector_from_irq(unsigned irq)
780 {
781         return vector_from_irq(irq);
782 }
783
784 int xen_gsi_from_irq(unsigned irq)
785 {
786         return gsi_from_irq(irq);
787 }
788
789 int bind_evtchn_to_irq(unsigned int evtchn)
790 {
791         int irq;
792
793         spin_lock(&irq_mapping_update_lock);
794
795         irq = evtchn_to_irq[evtchn];
796
797         if (irq == -1) {
798                 irq = find_unbound_irq();
799
800                 set_irq_chip_and_handler_name(irq, &xen_dynamic_chip,
801                                               handle_fasteoi_irq, "event");
802
803                 evtchn_to_irq[evtchn] = irq;
804                 irq_info[irq] = mk_evtchn_info(evtchn);
805         }
806
807         spin_unlock(&irq_mapping_update_lock);
808
809         return irq;
810 }
811 EXPORT_SYMBOL_GPL(bind_evtchn_to_irq);
812
813 static int bind_ipi_to_irq(unsigned int ipi, unsigned int cpu)
814 {
815         struct evtchn_bind_ipi bind_ipi;
816         int evtchn, irq;
817
818         spin_lock(&irq_mapping_update_lock);
819
820         irq = per_cpu(ipi_to_irq, cpu)[ipi];
821
822         if (irq == -1) {
823                 irq = find_unbound_irq();
824                 if (irq < 0)
825                         goto out;
826
827                 set_irq_chip_and_handler_name(irq, &xen_percpu_chip,
828                                               handle_percpu_irq, "ipi");
829
830                 bind_ipi.vcpu = cpu;
831                 if (HYPERVISOR_event_channel_op(EVTCHNOP_bind_ipi,
832                                                 &bind_ipi) != 0)
833                         BUG();
834                 evtchn = bind_ipi.port;
835
836                 evtchn_to_irq[evtchn] = irq;
837                 irq_info[irq] = mk_ipi_info(evtchn, ipi);
838                 per_cpu(ipi_to_irq, cpu)[ipi] = irq;
839
840                 bind_evtchn_to_cpu(evtchn, cpu);
841         }
842
843  out:
844         spin_unlock(&irq_mapping_update_lock);
845         return irq;
846 }
847
848
849 int bind_virq_to_irq(unsigned int virq, unsigned int cpu)
850 {
851         struct evtchn_bind_virq bind_virq;
852         int evtchn, irq;
853
854         spin_lock(&irq_mapping_update_lock);
855
856         irq = per_cpu(virq_to_irq, cpu)[virq];
857
858         if (irq == -1) {
859                 irq = find_unbound_irq();
860
861                 set_irq_chip_and_handler_name(irq, &xen_percpu_chip,
862                                               handle_percpu_irq, "virq");
863
864                 bind_virq.virq = virq;
865                 bind_virq.vcpu = cpu;
866                 if (HYPERVISOR_event_channel_op(EVTCHNOP_bind_virq,
867                                                 &bind_virq) != 0)
868                         BUG();
869                 evtchn = bind_virq.port;
870
871                 evtchn_to_irq[evtchn] = irq;
872                 irq_info[irq] = mk_virq_info(evtchn, virq);
873
874                 per_cpu(virq_to_irq, cpu)[virq] = irq;
875
876                 bind_evtchn_to_cpu(evtchn, cpu);
877         }
878
879         spin_unlock(&irq_mapping_update_lock);
880
881         return irq;
882 }
883
884 static void unbind_from_irq(unsigned int irq)
885 {
886         struct evtchn_close close;
887         int evtchn = evtchn_from_irq(irq);
888
889         spin_lock(&irq_mapping_update_lock);
890
891         if (VALID_EVTCHN(evtchn)) {
892                 close.port = evtchn;
893                 if (HYPERVISOR_event_channel_op(EVTCHNOP_close, &close) != 0)
894                         BUG();
895
896                 switch (type_from_irq(irq)) {
897                 case IRQT_VIRQ:
898                         per_cpu(virq_to_irq, cpu_from_evtchn(evtchn))
899                                 [virq_from_irq(irq)] = -1;
900                         break;
901                 case IRQT_IPI:
902                         per_cpu(ipi_to_irq, cpu_from_evtchn(evtchn))
903                                 [ipi_from_irq(irq)] = -1;
904                         break;
905                 default:
906                         break;
907                 }
908
909                 /* Closed ports are implicitly re-bound to VCPU0. */
910                 bind_evtchn_to_cpu(evtchn, 0);
911
912                 evtchn_to_irq[evtchn] = -1;
913         }
914
915         if (irq_info[irq].type != IRQT_UNBOUND) {
916                 irq_info[irq] = mk_unbound_info();
917
918                 irq_free_desc(irq);
919         }
920
921         spin_unlock(&irq_mapping_update_lock);
922 }
923
924 int bind_evtchn_to_irqhandler(unsigned int evtchn,
925                               irq_handler_t handler,
926                               unsigned long irqflags,
927                               const char *devname, void *dev_id)
928 {
929         unsigned int irq;
930         int retval;
931
932         irq = bind_evtchn_to_irq(evtchn);
933         retval = request_irq(irq, handler, irqflags, devname, dev_id);
934         if (retval != 0) {
935                 unbind_from_irq(irq);
936                 return retval;
937         }
938
939         return irq;
940 }
941 EXPORT_SYMBOL_GPL(bind_evtchn_to_irqhandler);
942
943 int bind_virq_to_irqhandler(unsigned int virq, unsigned int cpu,
944                             irq_handler_t handler,
945                             unsigned long irqflags, const char *devname, void *dev_id)
946 {
947         unsigned int irq;
948         int retval;
949
950         irq = bind_virq_to_irq(virq, cpu);
951         retval = request_irq(irq, handler, irqflags, devname, dev_id);
952         if (retval != 0) {
953                 unbind_from_irq(irq);
954                 return retval;
955         }
956
957         return irq;
958 }
959 EXPORT_SYMBOL_GPL(bind_virq_to_irqhandler);
960
961 int bind_ipi_to_irqhandler(enum ipi_vector ipi,
962                            unsigned int cpu,
963                            irq_handler_t handler,
964                            unsigned long irqflags,
965                            const char *devname,
966                            void *dev_id)
967 {
968         int irq, retval;
969
970         irq = bind_ipi_to_irq(ipi, cpu);
971         if (irq < 0)
972                 return irq;
973
974         irqflags |= IRQF_NO_SUSPEND;
975         retval = request_irq(irq, handler, irqflags, devname, dev_id);
976         if (retval != 0) {
977                 unbind_from_irq(irq);
978                 return retval;
979         }
980
981         return irq;
982 }
983
984 void unbind_from_irqhandler(unsigned int irq, void *dev_id)
985 {
986         free_irq(irq, dev_id);
987         unbind_from_irq(irq);
988 }
989 EXPORT_SYMBOL_GPL(unbind_from_irqhandler);
990
991 void xen_send_IPI_one(unsigned int cpu, enum ipi_vector vector)
992 {
993         int irq = per_cpu(ipi_to_irq, cpu)[vector];
994         BUG_ON(irq < 0);
995         notify_remote_via_irq(irq);
996 }
997
998 irqreturn_t xen_debug_interrupt(int irq, void *dev_id)
999 {
1000         struct shared_info *sh = HYPERVISOR_shared_info;
1001         int cpu = smp_processor_id();
1002         unsigned long *cpu_evtchn = cpu_evtchn_mask(cpu);
1003         int i;
1004         unsigned long flags;
1005         static DEFINE_SPINLOCK(debug_lock);
1006         struct vcpu_info *v;
1007
1008         spin_lock_irqsave(&debug_lock, flags);
1009
1010         printk("\nvcpu %d\n  ", cpu);
1011
1012         for_each_online_cpu(i) {
1013                 int pending;
1014                 v = per_cpu(xen_vcpu, i);
1015                 pending = (get_irq_regs() && i == cpu)
1016                         ? xen_irqs_disabled(get_irq_regs())
1017                         : v->evtchn_upcall_mask;
1018                 printk("%d: masked=%d pending=%d event_sel %0*lx\n  ", i,
1019                        pending, v->evtchn_upcall_pending,
1020                        (int)(sizeof(v->evtchn_pending_sel)*2),
1021                        v->evtchn_pending_sel);
1022         }
1023         v = per_cpu(xen_vcpu, cpu);
1024
1025         printk("\npending:\n   ");
1026         for (i = ARRAY_SIZE(sh->evtchn_pending)-1; i >= 0; i--)
1027                 printk("%0*lx%s", (int)sizeof(sh->evtchn_pending[0])*2,
1028                        sh->evtchn_pending[i],
1029                        i % 8 == 0 ? "\n   " : " ");
1030         printk("\nglobal mask:\n   ");
1031         for (i = ARRAY_SIZE(sh->evtchn_mask)-1; i >= 0; i--)
1032                 printk("%0*lx%s",
1033                        (int)(sizeof(sh->evtchn_mask[0])*2),
1034                        sh->evtchn_mask[i],
1035                        i % 8 == 0 ? "\n   " : " ");
1036
1037         printk("\nglobally unmasked:\n   ");
1038         for (i = ARRAY_SIZE(sh->evtchn_mask)-1; i >= 0; i--)
1039                 printk("%0*lx%s", (int)(sizeof(sh->evtchn_mask[0])*2),
1040                        sh->evtchn_pending[i] & ~sh->evtchn_mask[i],
1041                        i % 8 == 0 ? "\n   " : " ");
1042
1043         printk("\nlocal cpu%d mask:\n   ", cpu);
1044         for (i = (NR_EVENT_CHANNELS/BITS_PER_LONG)-1; i >= 0; i--)
1045                 printk("%0*lx%s", (int)(sizeof(cpu_evtchn[0])*2),
1046                        cpu_evtchn[i],
1047                        i % 8 == 0 ? "\n   " : " ");
1048
1049         printk("\nlocally unmasked:\n   ");
1050         for (i = ARRAY_SIZE(sh->evtchn_mask)-1; i >= 0; i--) {
1051                 unsigned long pending = sh->evtchn_pending[i]
1052                         & ~sh->evtchn_mask[i]
1053                         & cpu_evtchn[i];
1054                 printk("%0*lx%s", (int)(sizeof(sh->evtchn_mask[0])*2),
1055                        pending, i % 8 == 0 ? "\n   " : " ");
1056         }
1057
1058         printk("\npending list:\n");
1059         for (i = 0; i < NR_EVENT_CHANNELS; i++) {
1060                 if (sync_test_bit(i, sh->evtchn_pending)) {
1061                         int word_idx = i / BITS_PER_LONG;
1062                         printk("  %d: event %d -> irq %d%s%s%s\n",
1063                                cpu_from_evtchn(i), i,
1064                                evtchn_to_irq[i],
1065                                sync_test_bit(word_idx, &v->evtchn_pending_sel)
1066                                              ? "" : " l2-clear",
1067                                !sync_test_bit(i, sh->evtchn_mask)
1068                                              ? "" : " globally-masked",
1069                                sync_test_bit(i, cpu_evtchn)
1070                                              ? "" : " locally-masked");
1071                 }
1072         }
1073
1074         spin_unlock_irqrestore(&debug_lock, flags);
1075
1076         return IRQ_HANDLED;
1077 }
1078
1079 static DEFINE_PER_CPU(unsigned, xed_nesting_count);
1080
1081 /*
1082  * Search the CPUs pending events bitmasks.  For each one found, map
1083  * the event number to an irq, and feed it into do_IRQ() for
1084  * handling.
1085  *
1086  * Xen uses a two-level bitmap to speed searching.  The first level is
1087  * a bitset of words which contain pending event bits.  The second
1088  * level is a bitset of pending events themselves.
1089  */
1090 static void __xen_evtchn_do_upcall(void)
1091 {
1092         int cpu = get_cpu();
1093         struct shared_info *s = HYPERVISOR_shared_info;
1094         struct vcpu_info *vcpu_info = __get_cpu_var(xen_vcpu);
1095         unsigned count;
1096
1097         do {
1098                 unsigned long pending_words;
1099
1100                 vcpu_info->evtchn_upcall_pending = 0;
1101
1102                 if (__get_cpu_var(xed_nesting_count)++)
1103                         goto out;
1104
1105 #ifndef CONFIG_X86 /* No need for a barrier -- XCHG is a barrier on x86. */
1106                 /* Clear master flag /before/ clearing selector flag. */
1107                 wmb();
1108 #endif
1109                 pending_words = xchg(&vcpu_info->evtchn_pending_sel, 0);
1110                 while (pending_words != 0) {
1111                         unsigned long pending_bits;
1112                         int word_idx = __ffs(pending_words);
1113                         pending_words &= ~(1UL << word_idx);
1114
1115                         while ((pending_bits = active_evtchns(cpu, s, word_idx)) != 0) {
1116                                 int bit_idx = __ffs(pending_bits);
1117                                 int port = (word_idx * BITS_PER_LONG) + bit_idx;
1118                                 int irq = evtchn_to_irq[port];
1119                                 struct irq_desc *desc;
1120
1121                                 mask_evtchn(port);
1122                                 clear_evtchn(port);
1123
1124                                 if (irq != -1) {
1125                                         desc = irq_to_desc(irq);
1126                                         if (desc)
1127                                                 generic_handle_irq_desc(irq, desc);
1128                                 }
1129                         }
1130                 }
1131
1132                 BUG_ON(!irqs_disabled());
1133
1134                 count = __get_cpu_var(xed_nesting_count);
1135                 __get_cpu_var(xed_nesting_count) = 0;
1136         } while (count != 1 || vcpu_info->evtchn_upcall_pending);
1137
1138 out:
1139
1140         put_cpu();
1141 }
1142
1143 void xen_evtchn_do_upcall(struct pt_regs *regs)
1144 {
1145         struct pt_regs *old_regs = set_irq_regs(regs);
1146
1147         exit_idle();
1148         irq_enter();
1149
1150         __xen_evtchn_do_upcall();
1151
1152         irq_exit();
1153         set_irq_regs(old_regs);
1154 }
1155
1156 void xen_hvm_evtchn_do_upcall(void)
1157 {
1158         __xen_evtchn_do_upcall();
1159 }
1160 EXPORT_SYMBOL_GPL(xen_hvm_evtchn_do_upcall);
1161
1162 /* Rebind a new event channel to an existing irq. */
1163 void rebind_evtchn_irq(int evtchn, int irq)
1164 {
1165         struct irq_info *info = info_for_irq(irq);
1166
1167         /* Make sure the irq is masked, since the new event channel
1168            will also be masked. */
1169         disable_irq(irq);
1170
1171         spin_lock(&irq_mapping_update_lock);
1172
1173         /* After resume the irq<->evtchn mappings are all cleared out */
1174         BUG_ON(evtchn_to_irq[evtchn] != -1);
1175         /* Expect irq to have been bound before,
1176            so there should be a proper type */
1177         BUG_ON(info->type == IRQT_UNBOUND);
1178
1179         evtchn_to_irq[evtchn] = irq;
1180         irq_info[irq] = mk_evtchn_info(evtchn);
1181
1182         spin_unlock(&irq_mapping_update_lock);
1183
1184         /* new event channels are always bound to cpu 0 */
1185         irq_set_affinity(irq, cpumask_of(0));
1186
1187         /* Unmask the event channel. */
1188         enable_irq(irq);
1189 }
1190
1191 /* Rebind an evtchn so that it gets delivered to a specific cpu */
1192 static int rebind_irq_to_cpu(unsigned irq, unsigned tcpu)
1193 {
1194         struct evtchn_bind_vcpu bind_vcpu;
1195         int evtchn = evtchn_from_irq(irq);
1196
1197         /* events delivered via platform PCI interrupts are always
1198          * routed to vcpu 0 */
1199         if (!VALID_EVTCHN(evtchn) ||
1200                 (xen_hvm_domain() && !xen_have_vector_callback))
1201                 return -1;
1202
1203         /* Send future instances of this interrupt to other vcpu. */
1204         bind_vcpu.port = evtchn;
1205         bind_vcpu.vcpu = tcpu;
1206
1207         /*
1208          * If this fails, it usually just indicates that we're dealing with a
1209          * virq or IPI channel, which don't actually need to be rebound. Ignore
1210          * it, but don't do the xenlinux-level rebind in that case.
1211          */
1212         if (HYPERVISOR_event_channel_op(EVTCHNOP_bind_vcpu, &bind_vcpu) >= 0)
1213                 bind_evtchn_to_cpu(evtchn, tcpu);
1214
1215         return 0;
1216 }
1217
1218 static int set_affinity_irq(unsigned irq, const struct cpumask *dest)
1219 {
1220         unsigned tcpu = cpumask_first(dest);
1221
1222         return rebind_irq_to_cpu(irq, tcpu);
1223 }
1224
1225 int resend_irq_on_evtchn(unsigned int irq)
1226 {
1227         int masked, evtchn = evtchn_from_irq(irq);
1228         struct shared_info *s = HYPERVISOR_shared_info;
1229
1230         if (!VALID_EVTCHN(evtchn))
1231                 return 1;
1232
1233         masked = sync_test_and_set_bit(evtchn, s->evtchn_mask);
1234         sync_set_bit(evtchn, s->evtchn_pending);
1235         if (!masked)
1236                 unmask_evtchn(evtchn);
1237
1238         return 1;
1239 }
1240
1241 static void enable_dynirq(unsigned int irq)
1242 {
1243         int evtchn = evtchn_from_irq(irq);
1244
1245         if (VALID_EVTCHN(evtchn))
1246                 unmask_evtchn(evtchn);
1247 }
1248
1249 static void disable_dynirq(unsigned int irq)
1250 {
1251         int evtchn = evtchn_from_irq(irq);
1252
1253         if (VALID_EVTCHN(evtchn))
1254                 mask_evtchn(evtchn);
1255 }
1256
1257 static void ack_dynirq(unsigned int irq)
1258 {
1259         int evtchn = evtchn_from_irq(irq);
1260
1261         move_masked_irq(irq);
1262
1263         if (VALID_EVTCHN(evtchn))
1264                 unmask_evtchn(evtchn);
1265 }
1266
1267 static int retrigger_dynirq(unsigned int irq)
1268 {
1269         int evtchn = evtchn_from_irq(irq);
1270         struct shared_info *sh = HYPERVISOR_shared_info;
1271         int ret = 0;
1272
1273         if (VALID_EVTCHN(evtchn)) {
1274                 int masked;
1275
1276                 masked = sync_test_and_set_bit(evtchn, sh->evtchn_mask);
1277                 sync_set_bit(evtchn, sh->evtchn_pending);
1278                 if (!masked)
1279                         unmask_evtchn(evtchn);
1280                 ret = 1;
1281         }
1282
1283         return ret;
1284 }
1285
1286 static void restore_cpu_virqs(unsigned int cpu)
1287 {
1288         struct evtchn_bind_virq bind_virq;
1289         int virq, irq, evtchn;
1290
1291         for (virq = 0; virq < NR_VIRQS; virq++) {
1292                 if ((irq = per_cpu(virq_to_irq, cpu)[virq]) == -1)
1293                         continue;
1294
1295                 BUG_ON(virq_from_irq(irq) != virq);
1296
1297                 /* Get a new binding from Xen. */
1298                 bind_virq.virq = virq;
1299                 bind_virq.vcpu = cpu;
1300                 if (HYPERVISOR_event_channel_op(EVTCHNOP_bind_virq,
1301                                                 &bind_virq) != 0)
1302                         BUG();
1303                 evtchn = bind_virq.port;
1304
1305                 /* Record the new mapping. */
1306                 evtchn_to_irq[evtchn] = irq;
1307                 irq_info[irq] = mk_virq_info(evtchn, virq);
1308                 bind_evtchn_to_cpu(evtchn, cpu);
1309         }
1310 }
1311
1312 static void restore_cpu_ipis(unsigned int cpu)
1313 {
1314         struct evtchn_bind_ipi bind_ipi;
1315         int ipi, irq, evtchn;
1316
1317         for (ipi = 0; ipi < XEN_NR_IPIS; ipi++) {
1318                 if ((irq = per_cpu(ipi_to_irq, cpu)[ipi]) == -1)
1319                         continue;
1320
1321                 BUG_ON(ipi_from_irq(irq) != ipi);
1322
1323                 /* Get a new binding from Xen. */
1324                 bind_ipi.vcpu = cpu;
1325                 if (HYPERVISOR_event_channel_op(EVTCHNOP_bind_ipi,
1326                                                 &bind_ipi) != 0)
1327                         BUG();
1328                 evtchn = bind_ipi.port;
1329
1330                 /* Record the new mapping. */
1331                 evtchn_to_irq[evtchn] = irq;
1332                 irq_info[irq] = mk_ipi_info(evtchn, ipi);
1333                 bind_evtchn_to_cpu(evtchn, cpu);
1334         }
1335 }
1336
1337 /* Clear an irq's pending state, in preparation for polling on it */
1338 void xen_clear_irq_pending(int irq)
1339 {
1340         int evtchn = evtchn_from_irq(irq);
1341
1342         if (VALID_EVTCHN(evtchn))
1343                 clear_evtchn(evtchn);
1344 }
1345 EXPORT_SYMBOL(xen_clear_irq_pending);
1346 void xen_set_irq_pending(int irq)
1347 {
1348         int evtchn = evtchn_from_irq(irq);
1349
1350         if (VALID_EVTCHN(evtchn))
1351                 set_evtchn(evtchn);
1352 }
1353
1354 bool xen_test_irq_pending(int irq)
1355 {
1356         int evtchn = evtchn_from_irq(irq);
1357         bool ret = false;
1358
1359         if (VALID_EVTCHN(evtchn))
1360                 ret = test_evtchn(evtchn);
1361
1362         return ret;
1363 }
1364
1365 /* Poll waiting for an irq to become pending with timeout.  In the usual case,
1366  * the irq will be disabled so it won't deliver an interrupt. */
1367 void xen_poll_irq_timeout(int irq, u64 timeout)
1368 {
1369         evtchn_port_t evtchn = evtchn_from_irq(irq);
1370
1371         if (VALID_EVTCHN(evtchn)) {
1372                 struct sched_poll poll;
1373
1374                 poll.nr_ports = 1;
1375                 poll.timeout = timeout;
1376                 set_xen_guest_handle(poll.ports, &evtchn);
1377
1378                 if (HYPERVISOR_sched_op(SCHEDOP_poll, &poll) != 0)
1379                         BUG();
1380         }
1381 }
1382 EXPORT_SYMBOL(xen_poll_irq_timeout);
1383 /* Poll waiting for an irq to become pending.  In the usual case, the
1384  * irq will be disabled so it won't deliver an interrupt. */
1385 void xen_poll_irq(int irq)
1386 {
1387         xen_poll_irq_timeout(irq, 0 /* no timeout */);
1388 }
1389
1390 void xen_irq_resume(void)
1391 {
1392         unsigned int cpu, irq, evtchn;
1393         struct irq_desc *desc;
1394
1395         init_evtchn_cpu_bindings();
1396
1397         /* New event-channel space is not 'live' yet. */
1398         for (evtchn = 0; evtchn < NR_EVENT_CHANNELS; evtchn++)
1399                 mask_evtchn(evtchn);
1400
1401         /* No IRQ <-> event-channel mappings. */
1402         for (irq = 0; irq < nr_irqs; irq++)
1403                 irq_info[irq].evtchn = 0; /* zap event-channel binding */
1404
1405         for (evtchn = 0; evtchn < NR_EVENT_CHANNELS; evtchn++)
1406                 evtchn_to_irq[evtchn] = -1;
1407
1408         for_each_possible_cpu(cpu) {
1409                 restore_cpu_virqs(cpu);
1410                 restore_cpu_ipis(cpu);
1411         }
1412
1413         /*
1414          * Unmask any IRQF_NO_SUSPEND IRQs which are enabled. These
1415          * are not handled by the IRQ core.
1416          */
1417         for_each_irq_desc(irq, desc) {
1418                 if (!desc->action || !(desc->action->flags & IRQF_NO_SUSPEND))
1419                         continue;
1420                 if (desc->status & IRQ_DISABLED)
1421                         continue;
1422
1423                 evtchn = evtchn_from_irq(irq);
1424                 if (evtchn == -1)
1425                         continue;
1426
1427                 unmask_evtchn(evtchn);
1428         }
1429 }
1430
1431 static struct irq_chip xen_dynamic_chip __read_mostly = {
1432         .name           = "xen-dyn",
1433
1434         .disable        = disable_dynirq,
1435         .mask           = disable_dynirq,
1436         .unmask         = enable_dynirq,
1437
1438         .eoi            = ack_dynirq,
1439         .set_affinity   = set_affinity_irq,
1440         .retrigger      = retrigger_dynirq,
1441 };
1442
1443 static struct irq_chip xen_pirq_chip __read_mostly = {
1444         .name           = "xen-pirq",
1445
1446         .startup        = startup_pirq,
1447         .shutdown       = shutdown_pirq,
1448
1449         .enable         = enable_pirq,
1450         .unmask         = enable_pirq,
1451
1452         .disable        = disable_pirq,
1453         .mask           = disable_pirq,
1454
1455         .ack            = ack_pirq,
1456         .end            = end_pirq,
1457
1458         .set_affinity   = set_affinity_irq,
1459
1460         .retrigger      = retrigger_dynirq,
1461 };
1462
1463 static struct irq_chip xen_percpu_chip __read_mostly = {
1464         .name           = "xen-percpu",
1465
1466         .disable        = disable_dynirq,
1467         .mask           = disable_dynirq,
1468         .unmask         = enable_dynirq,
1469
1470         .ack            = ack_dynirq,
1471 };
1472
1473 int xen_set_callback_via(uint64_t via)
1474 {
1475         struct xen_hvm_param a;
1476         a.domid = DOMID_SELF;
1477         a.index = HVM_PARAM_CALLBACK_IRQ;
1478         a.value = via;
1479         return HYPERVISOR_hvm_op(HVMOP_set_param, &a);
1480 }
1481 EXPORT_SYMBOL_GPL(xen_set_callback_via);
1482
1483 #ifdef CONFIG_XEN_PVHVM
1484 /* Vector callbacks are better than PCI interrupts to receive event
1485  * channel notifications because we can receive vector callbacks on any
1486  * vcpu and we don't need PCI support or APIC interactions. */
1487 void xen_callback_vector(void)
1488 {
1489         int rc;
1490         uint64_t callback_via;
1491         if (xen_have_vector_callback) {
1492                 callback_via = HVM_CALLBACK_VECTOR(XEN_HVM_EVTCHN_CALLBACK);
1493                 rc = xen_set_callback_via(callback_via);
1494                 if (rc) {
1495                         printk(KERN_ERR "Request for Xen HVM callback vector"
1496                                         " failed.\n");
1497                         xen_have_vector_callback = 0;
1498                         return;
1499                 }
1500                 printk(KERN_INFO "Xen HVM callback vector for event delivery is "
1501                                 "enabled\n");
1502                 /* in the restore case the vector has already been allocated */
1503                 if (!test_bit(XEN_HVM_EVTCHN_CALLBACK, used_vectors))
1504                         alloc_intr_gate(XEN_HVM_EVTCHN_CALLBACK, xen_hvm_callback_vector);
1505         }
1506 }
1507 #else
1508 void xen_callback_vector(void) {}
1509 #endif
1510
1511 void __init xen_init_IRQ(void)
1512 {
1513         int i;
1514
1515         cpu_evtchn_mask_p = kcalloc(nr_cpu_ids, sizeof(struct cpu_evtchn_s),
1516                                     GFP_KERNEL);
1517         irq_info = kcalloc(nr_irqs, sizeof(*irq_info), GFP_KERNEL);
1518
1519         /* We are using nr_irqs as the maximum number of pirq available but
1520          * that number is actually chosen by Xen and we don't know exactly
1521          * what it is. Be careful choosing high pirq numbers. */
1522         pirq_to_irq = kcalloc(nr_irqs, sizeof(*pirq_to_irq), GFP_KERNEL);
1523         for (i = 0; i < nr_irqs; i++)
1524                 pirq_to_irq[i] = -1;
1525
1526         evtchn_to_irq = kcalloc(NR_EVENT_CHANNELS, sizeof(*evtchn_to_irq),
1527                                     GFP_KERNEL);
1528         for (i = 0; i < NR_EVENT_CHANNELS; i++)
1529                 evtchn_to_irq[i] = -1;
1530
1531         init_evtchn_cpu_bindings();
1532
1533         /* No event channels are 'live' right now. */
1534         for (i = 0; i < NR_EVENT_CHANNELS; i++)
1535                 mask_evtchn(i);
1536
1537         if (xen_hvm_domain()) {
1538                 xen_callback_vector();
1539                 native_init_IRQ();
1540                 /* pci_xen_hvm_init must be called after native_init_IRQ so that
1541                  * __acpi_register_gsi can point at the right function */
1542                 pci_xen_hvm_init();
1543         } else {
1544                 irq_ctx_init(smp_processor_id());
1545                 if (xen_initial_domain())
1546                         xen_setup_pirqs();
1547         }
1548 }