1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * Copyright (C) 2015, 2016 ARM Ltd. 4 */ 5 6 #include <linux/kvm.h> 7 #include <linux/kvm_host.h> 8 #include <trace/events/kvm.h> 9 #include <kvm/arm_vgic.h> 10 #include "vgic.h" 11 12 /* 13 * vgic_irqfd_set_irq: inject the IRQ corresponding to the 14 * irqchip routing entry 15 * 16 * This is the entry point for irqfd IRQ injection 17 */ vgic_irqfd_set_irq(struct kvm_kernel_irq_routing_entry * e,struct kvm * kvm,int irq_source_id,int level,bool line_status)18 static int vgic_irqfd_set_irq(struct kvm_kernel_irq_routing_entry *e, 19 struct kvm *kvm, int irq_source_id, 20 int level, bool line_status) 21 { 22 unsigned int spi_id = e->irqchip.pin + VGIC_NR_PRIVATE_IRQS; 23 24 if (!vgic_valid_spi(kvm, spi_id)) 25 return -EINVAL; 26 return kvm_vgic_inject_irq(kvm, NULL, spi_id, level, NULL); 27 } 28 29 /** 30 * kvm_set_routing_entry: populate a kvm routing entry 31 * from a user routing entry 32 * 33 * @kvm: the VM this entry is applied to 34 * @e: kvm kernel routing entry handle 35 * @ue: user api routing entry handle 36 * return 0 on success, -EINVAL on errors. 37 */ kvm_set_routing_entry(struct kvm * kvm,struct kvm_kernel_irq_routing_entry * e,const struct kvm_irq_routing_entry * ue)38 int kvm_set_routing_entry(struct kvm *kvm, 39 struct kvm_kernel_irq_routing_entry *e, 40 const struct kvm_irq_routing_entry *ue) 41 { 42 int r = -EINVAL; 43 44 switch (ue->type) { 45 case KVM_IRQ_ROUTING_IRQCHIP: 46 e->set = vgic_irqfd_set_irq; 47 e->irqchip.irqchip = ue->u.irqchip.irqchip; 48 e->irqchip.pin = ue->u.irqchip.pin; 49 if ((e->irqchip.pin >= KVM_IRQCHIP_NUM_PINS) || 50 (e->irqchip.irqchip >= KVM_NR_IRQCHIPS)) 51 goto out; 52 break; 53 case KVM_IRQ_ROUTING_MSI: 54 e->set = kvm_set_msi; 55 e->msi.address_lo = ue->u.msi.address_lo; 56 e->msi.address_hi = ue->u.msi.address_hi; 57 e->msi.data = ue->u.msi.data; 58 e->msi.flags = ue->flags; 59 e->msi.devid = ue->u.msi.devid; 60 break; 61 default: 62 goto out; 63 } 64 r = 0; 65 out: 66 return r; 67 } 68 kvm_populate_msi(struct kvm_kernel_irq_routing_entry * e,struct kvm_msi * msi)69 static void kvm_populate_msi(struct kvm_kernel_irq_routing_entry *e, 70 struct kvm_msi *msi) 71 { 72 msi->address_lo = e->msi.address_lo; 73 msi->address_hi = e->msi.address_hi; 74 msi->data = e->msi.data; 75 msi->flags = e->msi.flags; 76 msi->devid = e->msi.devid; 77 } 78 79 /* 80 * kvm_set_msi: inject the MSI corresponding to the 81 * MSI routing entry 82 * 83 * This is the entry point for irqfd MSI injection 84 * and userspace MSI injection. 85 */ kvm_set_msi(struct kvm_kernel_irq_routing_entry * e,struct kvm * kvm,int irq_source_id,int level,bool line_status)86 int kvm_set_msi(struct kvm_kernel_irq_routing_entry *e, 87 struct kvm *kvm, int irq_source_id, 88 int level, bool line_status) 89 { 90 struct kvm_msi msi; 91 92 if (!vgic_has_its(kvm)) 93 return -ENODEV; 94 95 if (!level) 96 return -1; 97 98 kvm_populate_msi(e, &msi); 99 return vgic_its_inject_msi(kvm, &msi); 100 } 101 102 /* 103 * kvm_arch_set_irq_inatomic: fast-path for irqfd injection 104 */ kvm_arch_set_irq_inatomic(struct kvm_kernel_irq_routing_entry * e,struct kvm * kvm,int irq_source_id,int level,bool line_status)105 int kvm_arch_set_irq_inatomic(struct kvm_kernel_irq_routing_entry *e, 106 struct kvm *kvm, int irq_source_id, int level, 107 bool line_status) 108 { 109 if (!level) 110 return -EWOULDBLOCK; 111 112 switch (e->type) { 113 case KVM_IRQ_ROUTING_MSI: { 114 struct kvm_msi msi; 115 116 if (!vgic_has_its(kvm)) 117 break; 118 119 kvm_populate_msi(e, &msi); 120 return vgic_its_inject_cached_translation(kvm, &msi); 121 } 122 123 case KVM_IRQ_ROUTING_IRQCHIP: 124 /* 125 * Injecting SPIs is always possible in atomic context 126 * as long as the damn vgic is initialized. 127 */ 128 if (unlikely(!vgic_initialized(kvm))) 129 break; 130 return vgic_irqfd_set_irq(e, kvm, irq_source_id, 1, line_status); 131 } 132 133 return -EWOULDBLOCK; 134 } 135 kvm_vgic_setup_default_irq_routing(struct kvm * kvm)136 int kvm_vgic_setup_default_irq_routing(struct kvm *kvm) 137 { 138 struct kvm_irq_routing_entry *entries; 139 struct vgic_dist *dist = &kvm->arch.vgic; 140 u32 nr = dist->nr_spis; 141 int i, ret; 142 143 entries = kcalloc(nr, sizeof(*entries), GFP_KERNEL_ACCOUNT); 144 if (!entries) 145 return -ENOMEM; 146 147 for (i = 0; i < nr; i++) { 148 entries[i].gsi = i; 149 entries[i].type = KVM_IRQ_ROUTING_IRQCHIP; 150 entries[i].u.irqchip.irqchip = 0; 151 entries[i].u.irqchip.pin = i; 152 } 153 ret = kvm_set_irq_routing(kvm, entries, nr, 0); 154 kfree(entries); 155 return ret; 156 } 157