Linux-libre 5.3.12-gnu
[librecmc/linux-libre.git] / virt / kvm / arm / vgic / vgic-irqfd.c
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  */
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, 0, 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  */
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
69 /**
70  * kvm_set_msi: inject the MSI corresponding to the
71  * MSI routing entry
72  *
73  * This is the entry point for irqfd MSI injection
74  * and userspace MSI injection.
75  */
76 int kvm_set_msi(struct kvm_kernel_irq_routing_entry *e,
77                 struct kvm *kvm, int irq_source_id,
78                 int level, bool line_status)
79 {
80         struct kvm_msi msi;
81
82         msi.address_lo = e->msi.address_lo;
83         msi.address_hi = e->msi.address_hi;
84         msi.data = e->msi.data;
85         msi.flags = e->msi.flags;
86         msi.devid = e->msi.devid;
87
88         if (!vgic_has_its(kvm))
89                 return -ENODEV;
90
91         if (!level)
92                 return -1;
93
94         return vgic_its_inject_msi(kvm, &msi);
95 }
96
97 int kvm_vgic_setup_default_irq_routing(struct kvm *kvm)
98 {
99         struct kvm_irq_routing_entry *entries;
100         struct vgic_dist *dist = &kvm->arch.vgic;
101         u32 nr = dist->nr_spis;
102         int i, ret;
103
104         entries = kcalloc(nr, sizeof(*entries), GFP_KERNEL);
105         if (!entries)
106                 return -ENOMEM;
107
108         for (i = 0; i < nr; i++) {
109                 entries[i].gsi = i;
110                 entries[i].type = KVM_IRQ_ROUTING_IRQCHIP;
111                 entries[i].u.irqchip.irqchip = 0;
112                 entries[i].u.irqchip.pin = i;
113         }
114         ret = kvm_set_irq_routing(kvm, entries, nr, 0);
115         kfree(entries);
116         return ret;
117 }