virt/kvm/arm/vgic/vgic-irqfd.c

   1 /*
   2  * Copyright (C) 2015, 2016 ARM Ltd.
   3  *
   4  * This program is free software; you can redistribute it and/or modify
   5  * it under the terms of the GNU General Public License version 2 as
   6  * published by the Free Software Foundation.
   7  *
   8  * This program is distributed in the hope that it will be useful,
   9  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  10  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  11  * GNU General Public License for more details.
  12  *
  13  * You should have received a copy of the GNU General Public License
  14  * along with this program.  If not, see <http://www.gnu.org/licenses/>.
  15  */
  16
  17 #include <linux/kvm.h>
  18 #include <linux/kvm_host.h>
  19 #include <trace/events/kvm.h>
  20 #include <kvm/arm_vgic.h>
  21 #include "vgic.h"
  22
  23 /**
  24  * vgic_irqfd_set_irq: inject the IRQ corresponding to the
  25  * irqchip routing entry
  26  *
  27  * This is the entry point for irqfd IRQ injection
  28  */
  29 static int vgic_irqfd_set_irq(struct kvm_kernel_irq_routing_entry *e,
  30                         struct kvm *kvm, int irq_source_id,
  31                         int level, bool line_status)
  32 {
  33         unsigned int spi_id = e->irqchip.pin + VGIC_NR_PRIVATE_IRQS;
  34
  35         if (!vgic_valid_spi(kvm, spi_id))
  36                 return -EINVAL;
  37         return kvm_vgic_inject_irq(kvm, 0, spi_id, level, NULL);
  38 }
  39
  40 /**
  41  * kvm_set_routing_entry: populate a kvm routing entry
  42  * from a user routing entry
  43  *
  44  * @kvm: the VM this entry is applied to
  45  * @e: kvm kernel routing entry handle
  46  * @ue: user api routing entry handle
  47  * return 0 on success, -EINVAL on errors.
  48  */
  49 int kvm_set_routing_entry(struct kvm *kvm,
  50                           struct kvm_kernel_irq_routing_entry *e,
  51                           const struct kvm_irq_routing_entry *ue)
  52 {
  53         int r = -EINVAL;
  54
  55         switch (ue->type) {
  56         case KVM_IRQ_ROUTING_IRQCHIP:
  57                 e->set = vgic_irqfd_set_irq;
  58                 e->irqchip.irqchip = ue->u.irqchip.irqchip;
  59                 e->irqchip.pin = ue->u.irqchip.pin;
  60                 if ((e->irqchip.pin >= KVM_IRQCHIP_NUM_PINS) ||
  61                     (e->irqchip.irqchip >= KVM_NR_IRQCHIPS))
  62                         goto out;
  63                 break;
  64         case KVM_IRQ_ROUTING_MSI:
  65                 e->set = kvm_set_msi;
  66                 e->msi.address_lo = ue->u.msi.address_lo;
  67                 e->msi.address_hi = ue->u.msi.address_hi;
  68                 e->msi.data = ue->u.msi.data;
  69                 e->msi.flags = ue->flags;
  70                 e->msi.devid = ue->u.msi.devid;
  71                 break;
  72         default:
  73                 goto out;
  74         }
  75         r = 0;
  76 out:
  77         return r;
  78 }
  79
  80 /**
  81  * kvm_set_msi: inject the MSI corresponding to the
  82  * MSI routing entry
  83  *
  84  * This is the entry point for irqfd MSI injection
  85  * and userspace MSI injection.
  86  */
  87 int kvm_set_msi(struct kvm_kernel_irq_routing_entry *e,
  88                 struct kvm *kvm, int irq_source_id,
  89                 int level, bool line_status)
  90 {
  91         struct kvm_msi msi;
  92
  93         msi.address_lo = e->msi.address_lo;
  94         msi.address_hi = e->msi.address_hi;
  95         msi.data = e->msi.data;
  96         msi.flags = e->msi.flags;
  97         msi.devid = e->msi.devid;
  98
  99         if (!vgic_has_its(kvm))
 100                 return -ENODEV;
 101
 102         if (!level)
 103                 return -1;
 104
 105         return vgic_its_inject_msi(kvm, &msi);
 106 }
 107
 108 int kvm_vgic_setup_default_irq_routing(struct kvm *kvm)
 109 {
 110         struct kvm_irq_routing_entry *entries;
 111         struct vgic_dist *dist = &kvm->arch.vgic;
 112         u32 nr = dist->nr_spis;
 113         int i, ret;
 114
 115         entries = kcalloc(nr, sizeof(*entries), GFP_KERNEL);
 116         if (!entries)
 117                 return -ENOMEM;
 118
 119         for (i = 0; i < nr; i++) {
 120                 entries[i].gsi = i;
 121                 entries[i].type = KVM_IRQ_ROUTING_IRQCHIP;
 122                 entries[i].u.irqchip.irqchip = 0;
 123                 entries[i].u.irqchip.pin = i;
 124         }
 125         ret = kvm_set_irq_routing(kvm, entries, nr, 0);
 126         kfree(entries);
 127         return ret;
 128 }