Pileus Git - ~andy/linux/blob - drivers/iommu/irq_remapping.c

   1 #include <linux/cpumask.h>
   2 #include <linux/kernel.h>
   3 #include <linux/string.h>
   4 #include <linux/cpumask.h>
   5 #include <linux/errno.h>
   6 #include <linux/msi.h>
   7 #include <linux/irq.h>
   8 #include <linux/pci.h>
   9
  10 #include <asm/hw_irq.h>
  11 #include <asm/irq_remapping.h>
  12 #include <asm/processor.h>
  13 #include <asm/x86_init.h>
  14 #include <asm/apic.h>
  15
  16 #include "irq_remapping.h"
  17
  18 int irq_remapping_enabled;
  19
  20 int disable_irq_remap;
  21 int disable_sourceid_checking;
  22 int no_x2apic_optout;
  23
  24 static struct irq_remap_ops *remap_ops;
  25
  26 static int msi_alloc_remapped_irq(struct pci_dev *pdev, int irq, int nvec);
  27 static int msi_setup_remapped_irq(struct pci_dev *pdev, unsigned int irq,
  28                                   int index, int sub_handle);
  29 static int set_remapped_irq_affinity(struct irq_data *data,
  30                                      const struct cpumask *mask,
  31                                      bool force);
  32
  33 static void irq_remapping_disable_io_apic(void)
  34 {
  35         /*
  36          * With interrupt-remapping, for now we will use virtual wire A
  37          * mode, as virtual wire B is little complex (need to configure
  38          * both IOAPIC RTE as well as interrupt-remapping table entry).
  39          * As this gets called during crash dump, keep this simple for
  40          * now.
  41          */
  42         if (cpu_has_apic || apic_from_smp_config())
  43                 disconnect_bsp_APIC(0);
  44 }
  45
  46 static int do_setup_msi_irqs(struct pci_dev *dev, int nvec)
  47 {
  48         int node, ret, sub_handle, index = 0;
  49         unsigned int irq;
  50         struct msi_desc *msidesc;
  51
  52         nvec = __roundup_pow_of_two(nvec);
  53
  54         WARN_ON(!list_is_singular(&dev->msi_list));
  55         msidesc = list_entry(dev->msi_list.next, struct msi_desc, list);
  56         WARN_ON(msidesc->irq);
  57         WARN_ON(msidesc->msi_attrib.multiple);
  58
  59         node = dev_to_node(&dev->dev);
  60         irq = __create_irqs(get_nr_irqs_gsi(), nvec, node);
  61         if (irq == 0)
  62                 return -ENOSPC;
  63
  64         msidesc->msi_attrib.multiple = ilog2(nvec);
  65         for (sub_handle = 0; sub_handle < nvec; sub_handle++) {
  66                 if (!sub_handle) {
  67                         index = msi_alloc_remapped_irq(dev, irq, nvec);
  68                         if (index < 0) {
  69                                 ret = index;
  70                                 goto error;
  71                         }
  72                 } else {
  73                         ret = msi_setup_remapped_irq(dev, irq + sub_handle,
  74                                                      index, sub_handle);
  75                         if (ret < 0)
  76                                 goto error;
  77                 }
  78                 ret = setup_msi_irq(dev, msidesc, irq, sub_handle);
  79                 if (ret < 0)
  80                         goto error;
  81         }
  82         return 0;
  83
  84 error:
  85         destroy_irqs(irq, nvec);
  86
  87         /*
  88          * Restore altered MSI descriptor fields and prevent just destroyed
  89          * IRQs from tearing down again in default_teardown_msi_irqs()
  90          */
  91         msidesc->irq = 0;
  92         msidesc->msi_attrib.multiple = 0;
  93
  94         return ret;
  95 }
  96
  97 static int do_setup_msix_irqs(struct pci_dev *dev, int nvec)
  98 {
  99         int node, ret, sub_handle, index = 0;
 100         struct msi_desc *msidesc;
 101         unsigned int irq;
 102
 103         node            = dev_to_node(&dev->dev);
 104         irq             = get_nr_irqs_gsi();
 105         sub_handle      = 0;
 106
 107         list_for_each_entry(msidesc, &dev->msi_list, list) {
 108
 109                 irq = create_irq_nr(irq, node);
 110                 if (irq == 0)
 111                         return -1;
 112
 113                 if (sub_handle == 0)
 114                         ret = index = msi_alloc_remapped_irq(dev, irq, nvec);
 115                 else
 116                         ret = msi_setup_remapped_irq(dev, irq, index, sub_handle);
 117
 118                 if (ret < 0)
 119                         goto error;
 120
 121                 ret = setup_msi_irq(dev, msidesc, irq, 0);
 122                 if (ret < 0)
 123                         goto error;
 124
 125                 sub_handle += 1;
 126                 irq        += 1;
 127         }
 128
 129         return 0;
 130
 131 error:
 132         destroy_irq(irq);
 133         return ret;
 134 }
 135
 136 static int irq_remapping_setup_msi_irqs(struct pci_dev *dev,
 137                                         int nvec, int type)
 138 {
 139         if (type == PCI_CAP_ID_MSI)
 140                 return do_setup_msi_irqs(dev, nvec);
 141         else
 142                 return do_setup_msix_irqs(dev, nvec);
 143 }
 144
 145 static void __init irq_remapping_modify_x86_ops(void)
 146 {
 147         x86_io_apic_ops.disable         = irq_remapping_disable_io_apic;
 148         x86_io_apic_ops.set_affinity    = set_remapped_irq_affinity;
 149         x86_io_apic_ops.setup_entry     = setup_ioapic_remapped_entry;
 150         x86_msi.setup_msi_irqs          = irq_remapping_setup_msi_irqs;
 151         x86_msi.setup_hpet_msi          = setup_hpet_msi_remapped;
 152 }
 153
 154 static __init int setup_nointremap(char *str)
 155 {
 156         disable_irq_remap = 1;
 157         return 0;
 158 }
 159 early_param("nointremap", setup_nointremap);
 160
 161 static __init int setup_irqremap(char *str)
 162 {
 163         if (!str)
 164                 return -EINVAL;
 165
 166         while (*str) {
 167                 if (!strncmp(str, "on", 2))
 168                         disable_irq_remap = 0;
 169                 else if (!strncmp(str, "off", 3))
 170                         disable_irq_remap = 1;
 171                 else if (!strncmp(str, "nosid", 5))
 172                         disable_sourceid_checking = 1;
 173                 else if (!strncmp(str, "no_x2apic_optout", 16))
 174                         no_x2apic_optout = 1;
 175
 176                 str += strcspn(str, ",");
 177                 while (*str == ',')
 178                         str++;
 179         }
 180
 181         return 0;
 182 }
 183 early_param("intremap", setup_irqremap);
 184
 185 void __init setup_irq_remapping_ops(void)
 186 {
 187         remap_ops = &intel_irq_remap_ops;
 188
 189 #ifdef CONFIG_AMD_IOMMU
 190         if (amd_iommu_irq_ops.prepare() == 0)
 191                 remap_ops = &amd_iommu_irq_ops;
 192 #endif
 193 }
 194
 195 int irq_remapping_supported(void)
 196 {
 197         if (disable_irq_remap)
 198                 return 0;
 199
 200         if (!remap_ops || !remap_ops->supported)
 201                 return 0;
 202
 203         return remap_ops->supported();
 204 }
 205
 206 int __init irq_remapping_prepare(void)
 207 {
 208         if (!remap_ops || !remap_ops->prepare)
 209                 return -ENODEV;
 210
 211         return remap_ops->prepare();
 212 }
 213
 214 int __init irq_remapping_enable(void)
 215 {
 216         int ret;
 217
 218         if (!remap_ops || !remap_ops->enable)
 219                 return -ENODEV;
 220
 221         ret = remap_ops->enable();
 222
 223         if (irq_remapping_enabled)
 224                 irq_remapping_modify_x86_ops();
 225
 226         return ret;
 227 }
 228
 229 void irq_remapping_disable(void)
 230 {
 231         if (!irq_remapping_enabled ||
 232             !remap_ops ||
 233             !remap_ops->disable)
 234                 return;
 235
 236         remap_ops->disable();
 237 }
 238
 239 int irq_remapping_reenable(int mode)
 240 {
 241         if (!irq_remapping_enabled ||
 242             !remap_ops ||
 243             !remap_ops->reenable)
 244                 return 0;
 245
 246         return remap_ops->reenable(mode);
 247 }
 248
 249 int __init irq_remap_enable_fault_handling(void)
 250 {
 251         if (!irq_remapping_enabled)
 252                 return 0;
 253
 254         if (!remap_ops || !remap_ops->enable_faulting)
 255                 return -ENODEV;
 256
 257         return remap_ops->enable_faulting();
 258 }
 259
 260 int setup_ioapic_remapped_entry(int irq,
 261                                 struct IO_APIC_route_entry *entry,
 262                                 unsigned int destination, int vector,
 263                                 struct io_apic_irq_attr *attr)
 264 {
 265         if (!remap_ops || !remap_ops->setup_ioapic_entry)
 266                 return -ENODEV;
 267
 268         return remap_ops->setup_ioapic_entry(irq, entry, destination,
 269                                              vector, attr);
 270 }
 271
 272 int set_remapped_irq_affinity(struct irq_data *data, const struct cpumask *mask,
 273                               bool force)
 274 {
 275         if (!config_enabled(CONFIG_SMP) || !remap_ops ||
 276             !remap_ops->set_affinity)
 277                 return 0;
 278
 279         return remap_ops->set_affinity(data, mask, force);
 280 }
 281
 282 void free_remapped_irq(int irq)
 283 {
 284         if (!remap_ops || !remap_ops->free_irq)
 285                 return;
 286
 287         remap_ops->free_irq(irq);
 288 }
 289
 290 void compose_remapped_msi_msg(struct pci_dev *pdev,
 291                               unsigned int irq, unsigned int dest,
 292                               struct msi_msg *msg, u8 hpet_id)
 293 {
 294         if (!remap_ops || !remap_ops->compose_msi_msg)
 295                 return;
 296
 297         remap_ops->compose_msi_msg(pdev, irq, dest, msg, hpet_id);
 298 }
 299
 300 static int msi_alloc_remapped_irq(struct pci_dev *pdev, int irq, int nvec)
 301 {
 302         if (!remap_ops || !remap_ops->msi_alloc_irq)
 303                 return -ENODEV;
 304
 305         return remap_ops->msi_alloc_irq(pdev, irq, nvec);
 306 }
 307
 308 static int msi_setup_remapped_irq(struct pci_dev *pdev, unsigned int irq,
 309                                   int index, int sub_handle)
 310 {
 311         if (!remap_ops || !remap_ops->msi_setup_irq)
 312                 return -ENODEV;
 313
 314         return remap_ops->msi_setup_irq(pdev, irq, index, sub_handle);
 315 }
 316
 317 int setup_hpet_msi_remapped(unsigned int irq, unsigned int id)
 318 {
 319         if (!remap_ops || !remap_ops->setup_hpet_msi)
 320                 return -ENODEV;
 321
 322         return remap_ops->setup_hpet_msi(irq, id);
 323 }
 324
 325 void panic_if_irq_remap(const char *msg)
 326 {
 327         if (irq_remapping_enabled)
 328                 panic(msg);
 329 }