drivers/iommu/irq_remapping.c

   1 #include <linux/seq_file.h>
   2 #include <linux/cpumask.h>
   3 #include <linux/kernel.h>
   4 #include <linux/string.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 #include <asm/hpet.h>
  16
  17 #include "irq_remapping.h"
  18
  19 int irq_remapping_enabled;
  20
  21 int disable_irq_remap;
  22 int irq_remap_broken;
  23 int disable_sourceid_checking;
  24 int no_x2apic_optout;
  25
  26 static struct irq_remap_ops *remap_ops;
  27
  28 static int msi_alloc_remapped_irq(struct pci_dev *pdev, int irq, int nvec);
  29 static int msi_setup_remapped_irq(struct pci_dev *pdev, unsigned int irq,
  30                                   int index, int sub_handle);
  31 static int set_remapped_irq_affinity(struct irq_data *data,
  32                                      const struct cpumask *mask,
  33                                      bool force);
  34
  35 static bool irq_remapped(struct irq_cfg *cfg)
  36 {
  37         return (cfg->remapped == 1);
  38 }
  39
  40 static void irq_remapping_disable_io_apic(void)
  41 {
  42         /*
  43          * With interrupt-remapping, for now we will use virtual wire A
  44          * mode, as virtual wire B is little complex (need to configure
  45          * both IOAPIC RTE as well as interrupt-remapping table entry).
  46          * As this gets called during crash dump, keep this simple for
  47          * now.
  48          */
  49         if (cpu_has_apic || apic_from_smp_config())
  50                 disconnect_bsp_APIC(0);
  51 }
  52
  53 static int do_setup_msi_irqs(struct pci_dev *dev, int nvec)
  54 {
  55         int ret, sub_handle, nvec_pow2, index = 0;
  56         unsigned int irq;
  57         struct msi_desc *msidesc;
  58
  59         msidesc = list_entry(dev->msi_list.next, struct msi_desc, list);
  60
  61         irq = irq_alloc_hwirqs(nvec, dev_to_node(&dev->dev));
  62         if (irq == 0)
  63                 return -ENOSPC;
  64
  65         nvec_pow2 = __roundup_pow_of_two(nvec);
  66         for (sub_handle = 0; sub_handle < nvec; sub_handle++) {
  67                 if (!sub_handle) {
  68                         index = msi_alloc_remapped_irq(dev, irq, nvec_pow2);
  69                         if (index < 0) {
  70                                 ret = index;
  71                                 goto error;
  72                         }
  73                 } else {
  74                         ret = msi_setup_remapped_irq(dev, irq + sub_handle,
  75                                                      index, sub_handle);
  76                         if (ret < 0)
  77                                 goto error;
  78                 }
  79                 ret = setup_msi_irq(dev, msidesc, irq, sub_handle);
  80                 if (ret < 0)
  81                         goto error;
  82         }
  83         return 0;
  84
  85 error:
  86         irq_free_hwirqs(irq, nvec);
  87
  88         /*
  89          * Restore altered MSI descriptor fields and prevent just destroyed
  90          * IRQs from tearing down again in default_teardown_msi_irqs()
  91          */
  92         msidesc->irq = 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         sub_handle      = 0;
 105
 106         list_for_each_entry(msidesc, &dev->msi_list, list) {
 107
 108                 irq = irq_alloc_hwirq(node);
 109                 if (irq == 0)
 110                         return -1;
 111
 112                 if (sub_handle == 0)
 113                         ret = index = msi_alloc_remapped_irq(dev, irq, nvec);
 114                 else
 115                         ret = msi_setup_remapped_irq(dev, irq, index, sub_handle);
 116
 117                 if (ret < 0)
 118                         goto error;
 119
 120                 ret = setup_msi_irq(dev, msidesc, irq, 0);
 121                 if (ret < 0)
 122                         goto error;
 123
 124                 sub_handle += 1;
 125                 irq        += 1;
 126         }
 127
 128         return 0;
 129
 130 error:
 131         irq_free_hwirq(irq);
 132         return ret;
 133 }
 134
 135 static int irq_remapping_setup_msi_irqs(struct pci_dev *dev,
 136                                         int nvec, int type)
 137 {
 138         if (type == PCI_CAP_ID_MSI)
 139                 return do_setup_msi_irqs(dev, nvec);
 140         else
 141                 return do_setup_msix_irqs(dev, nvec);
 142 }
 143
 144 static void eoi_ioapic_pin_remapped(int apic, int pin, int vector)
 145 {
 146         /*
 147          * Intr-remapping uses pin number as the virtual vector
 148          * in the RTE. Actual vector is programmed in
 149          * intr-remapping table entry. Hence for the io-apic
 150          * EOI we use the pin number.
 151          */
 152         io_apic_eoi(apic, pin);
 153 }
 154
 155 static void __init irq_remapping_modify_x86_ops(void)
 156 {
 157         x86_io_apic_ops.disable         = irq_remapping_disable_io_apic;
 158         x86_io_apic_ops.set_affinity    = set_remapped_irq_affinity;
 159         x86_io_apic_ops.setup_entry     = setup_ioapic_remapped_entry;
 160         x86_io_apic_ops.eoi_ioapic_pin  = eoi_ioapic_pin_remapped;
 161         x86_msi.setup_msi_irqs          = irq_remapping_setup_msi_irqs;
 162         x86_msi.setup_hpet_msi          = setup_hpet_msi_remapped;
 163         x86_msi.compose_msi_msg         = compose_remapped_msi_msg;
 164 }
 165
 166 static __init int setup_nointremap(char *str)
 167 {
 168         disable_irq_remap = 1;
 169         return 0;
 170 }
 171 early_param("nointremap", setup_nointremap);
 172
 173 static __init int setup_irqremap(char *str)
 174 {
 175         if (!str)
 176                 return -EINVAL;
 177
 178         while (*str) {
 179                 if (!strncmp(str, "on", 2))
 180                         disable_irq_remap = 0;
 181                 else if (!strncmp(str, "off", 3))
 182                         disable_irq_remap = 1;
 183                 else if (!strncmp(str, "nosid", 5))
 184                         disable_sourceid_checking = 1;
 185                 else if (!strncmp(str, "no_x2apic_optout", 16))
 186                         no_x2apic_optout = 1;
 187
 188                 str += strcspn(str, ",");
 189                 while (*str == ',')
 190                         str++;
 191         }
 192
 193         return 0;
 194 }
 195 early_param("intremap", setup_irqremap);
 196
 197 void __init setup_irq_remapping_ops(void)
 198 {
 199         remap_ops = &intel_irq_remap_ops;
 200
 201 #ifdef CONFIG_AMD_IOMMU
 202         if (amd_iommu_irq_ops.prepare() == 0)
 203                 remap_ops = &amd_iommu_irq_ops;
 204 #endif
 205 }
 206
 207 void set_irq_remapping_broken(void)
 208 {
 209         irq_remap_broken = 1;
 210 }
 211
 212 int irq_remapping_supported(void)
 213 {
 214         if (disable_irq_remap)
 215                 return 0;
 216
 217         if (!remap_ops || !remap_ops->supported)
 218                 return 0;
 219
 220         return remap_ops->supported();
 221 }
 222
 223 int __init irq_remapping_prepare(void)
 224 {
 225         if (!remap_ops || !remap_ops->prepare)
 226                 return -ENODEV;
 227
 228         return remap_ops->prepare();
 229 }
 230
 231 int __init irq_remapping_enable(void)
 232 {
 233         int ret;
 234
 235         if (!remap_ops || !remap_ops->enable)
 236                 return -ENODEV;
 237
 238         ret = remap_ops->enable();
 239
 240         if (irq_remapping_enabled)
 241                 irq_remapping_modify_x86_ops();
 242
 243         return ret;
 244 }
 245
 246 void irq_remapping_disable(void)
 247 {
 248         if (!irq_remapping_enabled ||
 249             !remap_ops ||
 250             !remap_ops->disable)
 251                 return;
 252
 253         remap_ops->disable();
 254 }
 255
 256 int irq_remapping_reenable(int mode)
 257 {
 258         if (!irq_remapping_enabled ||
 259             !remap_ops ||
 260             !remap_ops->reenable)
 261                 return 0;
 262
 263         return remap_ops->reenable(mode);
 264 }
 265
 266 int __init irq_remap_enable_fault_handling(void)
 267 {
 268         if (!irq_remapping_enabled)
 269                 return 0;
 270
 271         if (!remap_ops || !remap_ops->enable_faulting)
 272                 return -ENODEV;
 273
 274         return remap_ops->enable_faulting();
 275 }
 276
 277 int setup_ioapic_remapped_entry(int irq,
 278                                 struct IO_APIC_route_entry *entry,
 279                                 unsigned int destination, int vector,
 280                                 struct io_apic_irq_attr *attr)
 281 {
 282         if (!remap_ops || !remap_ops->setup_ioapic_entry)
 283                 return -ENODEV;
 284
 285         return remap_ops->setup_ioapic_entry(irq, entry, destination,
 286                                              vector, attr);
 287 }
 288
 289 static int set_remapped_irq_affinity(struct irq_data *data,
 290                                      const struct cpumask *mask, bool force)
 291 {
 292         if (!config_enabled(CONFIG_SMP) || !remap_ops ||
 293             !remap_ops->set_affinity)
 294                 return 0;
 295
 296         return remap_ops->set_affinity(data, mask, force);
 297 }
 298
 299 void free_remapped_irq(int irq)
 300 {
 301         struct irq_cfg *cfg = irq_cfg(irq);
 302
 303         if (!remap_ops || !remap_ops->free_irq)
 304                 return;
 305
 306         if (irq_remapped(cfg))
 307                 remap_ops->free_irq(irq);
 308 }
 309
 310 void compose_remapped_msi_msg(struct pci_dev *pdev,
 311                               unsigned int irq, unsigned int dest,
 312                               struct msi_msg *msg, u8 hpet_id)
 313 {
 314         struct irq_cfg *cfg = irq_cfg(irq);
 315
 316         if (!irq_remapped(cfg))
 317                 native_compose_msi_msg(pdev, irq, dest, msg, hpet_id);
 318         else if (remap_ops && remap_ops->compose_msi_msg)
 319                 remap_ops->compose_msi_msg(pdev, irq, dest, msg, hpet_id);
 320 }
 321
 322 static int msi_alloc_remapped_irq(struct pci_dev *pdev, int irq, int nvec)
 323 {
 324         if (!remap_ops || !remap_ops->msi_alloc_irq)
 325                 return -ENODEV;
 326
 327         return remap_ops->msi_alloc_irq(pdev, irq, nvec);
 328 }
 329
 330 static int msi_setup_remapped_irq(struct pci_dev *pdev, unsigned int irq,
 331                                   int index, int sub_handle)
 332 {
 333         if (!remap_ops || !remap_ops->msi_setup_irq)
 334                 return -ENODEV;
 335
 336         return remap_ops->msi_setup_irq(pdev, irq, index, sub_handle);
 337 }
 338
 339 int setup_hpet_msi_remapped(unsigned int irq, unsigned int id)
 340 {
 341         int ret;
 342
 343         if (!remap_ops || !remap_ops->alloc_hpet_msi)
 344                 return -ENODEV;
 345
 346         ret = remap_ops->alloc_hpet_msi(irq, id);
 347         if (ret)
 348                 return -EINVAL;
 349
 350         return default_setup_hpet_msi(irq, id);
 351 }
 352
 353 void panic_if_irq_remap(const char *msg)
 354 {
 355         if (irq_remapping_enabled)
 356                 panic(msg);
 357 }
 358
 359 static void ir_ack_apic_edge(struct irq_data *data)
 360 {
 361         ack_APIC_irq();
 362 }
 363
 364 static void ir_ack_apic_level(struct irq_data *data)
 365 {
 366         ack_APIC_irq();
 367         eoi_ioapic_irq(data->irq, irqd_cfg(data));
 368 }
 369
 370 static void ir_print_prefix(struct irq_data *data, struct seq_file *p)
 371 {
 372         seq_printf(p, " IR-%s", data->chip->name);
 373 }
 374
 375 void irq_remap_modify_chip_defaults(struct irq_chip *chip)
 376 {
 377         chip->irq_print_chip = ir_print_prefix;
 378         chip->irq_ack = ir_ack_apic_edge;
 379         chip->irq_eoi = ir_ack_apic_level;
 380         chip->irq_set_affinity = x86_io_apic_ops.set_affinity;
 381 }
 382
 383 bool setup_remapped_irq(int irq, struct irq_cfg *cfg, struct irq_chip *chip)
 384 {
 385         if (!irq_remapped(cfg))
 386                 return false;
 387         irq_set_status_flags(irq, IRQ_MOVE_PCNTXT);
 388         irq_remap_modify_chip_defaults(chip);
 389         return true;
 390 }