LXR linux/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 */
  29static 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 */
  49int 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;
  76out:
  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 */
  87int 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
 108int 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}
 129