|
@@ -17,36 +17,116 @@
|
|
|
#include <linux/kvm.h>
|
|
|
#include <linux/kvm_host.h>
|
|
|
#include <trace/events/kvm.h>
|
|
|
+#include <kvm/arm_vgic.h>
|
|
|
+#include "vgic.h"
|
|
|
|
|
|
-int kvm_irq_map_gsi(struct kvm *kvm,
|
|
|
- struct kvm_kernel_irq_routing_entry *entries,
|
|
|
- int gsi)
|
|
|
+/**
|
|
|
+ * vgic_irqfd_set_irq: inject the IRQ corresponding to the
|
|
|
+ * irqchip routing entry
|
|
|
+ *
|
|
|
+ * This is the entry point for irqfd IRQ injection
|
|
|
+ */
|
|
|
+static int vgic_irqfd_set_irq(struct kvm_kernel_irq_routing_entry *e,
|
|
|
+ struct kvm *kvm, int irq_source_id,
|
|
|
+ int level, bool line_status)
|
|
|
{
|
|
|
- return 0;
|
|
|
+ unsigned int spi_id = e->irqchip.pin + VGIC_NR_PRIVATE_IRQS;
|
|
|
+
|
|
|
+ if (!vgic_valid_spi(kvm, spi_id))
|
|
|
+ return -EINVAL;
|
|
|
+ return kvm_vgic_inject_irq(kvm, 0, spi_id, level);
|
|
|
}
|
|
|
|
|
|
-int kvm_irq_map_chip_pin(struct kvm *kvm, unsigned int irqchip,
|
|
|
- unsigned int pin)
|
|
|
+/**
|
|
|
+ * kvm_set_routing_entry: populate a kvm routing entry
|
|
|
+ * from a user routing entry
|
|
|
+ *
|
|
|
+ * @kvm: the VM this entry is applied to
|
|
|
+ * @e: kvm kernel routing entry handle
|
|
|
+ * @ue: user api routing entry handle
|
|
|
+ * return 0 on success, -EINVAL on errors.
|
|
|
+ */
|
|
|
+#ifdef KVM_CAP_X2APIC_API
|
|
|
+int kvm_set_routing_entry(struct kvm *kvm,
|
|
|
+ struct kvm_kernel_irq_routing_entry *e,
|
|
|
+ const struct kvm_irq_routing_entry *ue)
|
|
|
+#else
|
|
|
+/* Remove this version and the ifdefery once merged into 4.8 */
|
|
|
+int kvm_set_routing_entry(struct kvm_kernel_irq_routing_entry *e,
|
|
|
+ const struct kvm_irq_routing_entry *ue)
|
|
|
+#endif
|
|
|
{
|
|
|
- return pin;
|
|
|
+ int r = -EINVAL;
|
|
|
+
|
|
|
+ switch (ue->type) {
|
|
|
+ case KVM_IRQ_ROUTING_IRQCHIP:
|
|
|
+ e->set = vgic_irqfd_set_irq;
|
|
|
+ e->irqchip.irqchip = ue->u.irqchip.irqchip;
|
|
|
+ e->irqchip.pin = ue->u.irqchip.pin;
|
|
|
+ if ((e->irqchip.pin >= KVM_IRQCHIP_NUM_PINS) ||
|
|
|
+ (e->irqchip.irqchip >= KVM_NR_IRQCHIPS))
|
|
|
+ goto out;
|
|
|
+ break;
|
|
|
+ case KVM_IRQ_ROUTING_MSI:
|
|
|
+ e->set = kvm_set_msi;
|
|
|
+ e->msi.address_lo = ue->u.msi.address_lo;
|
|
|
+ e->msi.address_hi = ue->u.msi.address_hi;
|
|
|
+ e->msi.data = ue->u.msi.data;
|
|
|
+ e->msi.flags = ue->flags;
|
|
|
+ e->msi.devid = ue->u.msi.devid;
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ goto out;
|
|
|
+ }
|
|
|
+ r = 0;
|
|
|
+out:
|
|
|
+ return r;
|
|
|
}
|
|
|
|
|
|
-int kvm_set_irq(struct kvm *kvm, int irq_source_id,
|
|
|
- u32 irq, int level, bool line_status)
|
|
|
+/**
|
|
|
+ * kvm_set_msi: inject the MSI corresponding to the
|
|
|
+ * MSI routing entry
|
|
|
+ *
|
|
|
+ * This is the entry point for irqfd MSI injection
|
|
|
+ * and userspace MSI injection.
|
|
|
+ */
|
|
|
+int kvm_set_msi(struct kvm_kernel_irq_routing_entry *e,
|
|
|
+ struct kvm *kvm, int irq_source_id,
|
|
|
+ int level, bool line_status)
|
|
|
{
|
|
|
- unsigned int spi = irq + VGIC_NR_PRIVATE_IRQS;
|
|
|
+ struct kvm_msi msi;
|
|
|
|
|
|
- trace_kvm_set_irq(irq, level, irq_source_id);
|
|
|
+ msi.address_lo = e->msi.address_lo;
|
|
|
+ msi.address_hi = e->msi.address_hi;
|
|
|
+ msi.data = e->msi.data;
|
|
|
+ msi.flags = e->msi.flags;
|
|
|
+ msi.devid = e->msi.devid;
|
|
|
|
|
|
- BUG_ON(!vgic_initialized(kvm));
|
|
|
+ if (!vgic_has_its(kvm))
|
|
|
+ return -ENODEV;
|
|
|
|
|
|
- return kvm_vgic_inject_irq(kvm, 0, spi, level);
|
|
|
+ return vgic_its_inject_msi(kvm, &msi);
|
|
|
}
|
|
|
|
|
|
-/* MSI not implemented yet */
|
|
|
-int kvm_set_msi(struct kvm_kernel_irq_routing_entry *e,
|
|
|
- struct kvm *kvm, int irq_source_id,
|
|
|
- int level, bool line_status)
|
|
|
+int kvm_vgic_setup_default_irq_routing(struct kvm *kvm)
|
|
|
{
|
|
|
- return 0;
|
|
|
+ struct kvm_irq_routing_entry *entries;
|
|
|
+ struct vgic_dist *dist = &kvm->arch.vgic;
|
|
|
+ u32 nr = dist->nr_spis;
|
|
|
+ int i, ret;
|
|
|
+
|
|
|
+ entries = kcalloc(nr, sizeof(struct kvm_kernel_irq_routing_entry),
|
|
|
+ GFP_KERNEL);
|
|
|
+ if (!entries)
|
|
|
+ return -ENOMEM;
|
|
|
+
|
|
|
+ for (i = 0; i < nr; i++) {
|
|
|
+ entries[i].gsi = i;
|
|
|
+ entries[i].type = KVM_IRQ_ROUTING_IRQCHIP;
|
|
|
+ entries[i].u.irqchip.irqchip = 0;
|
|
|
+ entries[i].u.irqchip.pin = i;
|
|
|
+ }
|
|
|
+ ret = kvm_set_irq_routing(kvm, entries, nr, 0);
|
|
|
+ kfree(entries);
|
|
|
+ return ret;
|
|
|
}
|