1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * Copyright (C) 2020-2022 Loongson Technology Corporation Limited
4 */
5
6 #include <linux/kvm_host.h>
7 #include <trace/events/kvm.h>
8 #include "intc/ls7a_irq.h"
9
kvm_ls7a_set_ioapic_irq(struct kvm_kernel_irq_routing_entry *e, struct kvm *kvm, int irq_source_id, int level, bool line_status)10 static int kvm_ls7a_set_ioapic_irq(struct kvm_kernel_irq_routing_entry *e,
11 struct kvm *kvm, int irq_source_id,
12 int level, bool line_status)
13 {
14 /* ioapic pin (0 ~ 64) <---> gsi(0 ~ 64) */
15 u32 irq = e->irqchip.pin;
16 unsigned long flags;
17 int ret;
18
19 if (!ls7a_ioapic_in_kernel(kvm))
20 return -ENXIO;
21
22 ls7a_ioapic_lock(ls7a_ioapic_irqchip(kvm), &flags);
23 ret = kvm_ls7a_ioapic_set_irq(kvm, irq, level);
24 ls7a_ioapic_unlock(ls7a_ioapic_irqchip(kvm), &flags);
25
26 return ret;
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 = kvm_ls7a_set_ioapic_irq;
47
48 e->irqchip.irqchip = ue->u.irqchip.irqchip;
49 e->irqchip.pin = ue->u.irqchip.pin;
50
51 if (e->irqchip.pin >= LS7A_APIC_NUM_PINS)
52 goto out;
53 break;
54 case KVM_IRQ_ROUTING_MSI:
55 e->set = kvm_set_msi;
56 e->msi.address_lo = ue->u.msi.address_lo;
57 e->msi.address_hi = ue->u.msi.address_hi;
58 e->msi.data = ue->u.msi.data;
59 /*
60 * linux4.19 kernel have flags and devid
61 * e->msi.flags = ue->flags;
62 * e->msi.devid = ue->u.msi.devid;
63 */
64 break;
65 default:
66 goto out;
67 }
68 r = 0;
69 out:
70 return r;
71 }
72
kvm_arch_set_irq_inatomic(struct kvm_kernel_irq_routing_entry *e, struct kvm *kvm, int irq_source_id, int level, bool line_status)73 int kvm_arch_set_irq_inatomic(struct kvm_kernel_irq_routing_entry *e,
74 struct kvm *kvm, int irq_source_id,
75 int level, bool line_status)
76 {
77 if (e->type == KVM_IRQ_ROUTING_MSI)
78 return kvm_ls7a_set_msi(e, kvm, irq_source_id, 1, false);
79
80 return -EWOULDBLOCK;
81 }
82
83 /**
84 * kvm_set_msi: inject the MSI corresponding to the
85 * MSI routing entry
86 *
87 * This is the entry point for irqfd MSI injection
88 * and userspace MSI injection.
89 */
kvm_set_msi(struct kvm_kernel_irq_routing_entry *e, struct kvm *kvm, int irq_source_id, int level, bool line_status)90 int kvm_set_msi(struct kvm_kernel_irq_routing_entry *e,
91 struct kvm *kvm, int irq_source_id,
92 int level, bool line_status)
93 {
94 unsigned int ret;
95
96 if (!level)
97 return -1;
98
99 ret = kvm_ls7a_set_msi(e, kvm, irq_source_id, 1, false);
100 return ret;
101 }
102
kvm_ls7a_setup_default_irq_routing(struct kvm *kvm)103 int kvm_ls7a_setup_default_irq_routing(struct kvm *kvm)
104 {
105 struct kvm_irq_routing_entry *entries;
106
107 u32 nr = LS7A_APIC_NUM_PINS;
108 int i, ret;
109
110 entries = kcalloc(nr, sizeof(*entries), GFP_KERNEL);
111 if (!entries)
112 return -ENOMEM;
113
114 for (i = 0; i < nr; i++) {
115 entries[i].gsi = i;
116 entries[i].type = KVM_IRQ_ROUTING_IRQCHIP;
117 entries[i].u.irqchip.irqchip = 0;
118 entries[i].u.irqchip.pin = i;
119 }
120 ret = kvm_set_irq_routing(kvm, entries, nr, 0);
121 kfree(entries);
122
123 return 0;
124 }
125