18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 28c2ecf20Sopenharmony_ci/* 38c2ecf20Sopenharmony_ci * Copyright (C) 2020-2022 Loongson Technology Corporation Limited 48c2ecf20Sopenharmony_ci */ 58c2ecf20Sopenharmony_ci 68c2ecf20Sopenharmony_ci#include <linux/kvm_host.h> 78c2ecf20Sopenharmony_ci#include <trace/events/kvm.h> 88c2ecf20Sopenharmony_ci#include "intc/ls7a_irq.h" 98c2ecf20Sopenharmony_ci 108c2ecf20Sopenharmony_cistatic int kvm_ls7a_set_ioapic_irq(struct kvm_kernel_irq_routing_entry *e, 118c2ecf20Sopenharmony_ci struct kvm *kvm, int irq_source_id, 128c2ecf20Sopenharmony_ci int level, bool line_status) 138c2ecf20Sopenharmony_ci{ 148c2ecf20Sopenharmony_ci /* ioapic pin (0 ~ 64) <---> gsi(0 ~ 64) */ 158c2ecf20Sopenharmony_ci u32 irq = e->irqchip.pin; 168c2ecf20Sopenharmony_ci unsigned long flags; 178c2ecf20Sopenharmony_ci int ret; 188c2ecf20Sopenharmony_ci 198c2ecf20Sopenharmony_ci if (!ls7a_ioapic_in_kernel(kvm)) 208c2ecf20Sopenharmony_ci return -ENXIO; 218c2ecf20Sopenharmony_ci 228c2ecf20Sopenharmony_ci ls7a_ioapic_lock(ls7a_ioapic_irqchip(kvm), &flags); 238c2ecf20Sopenharmony_ci ret = kvm_ls7a_ioapic_set_irq(kvm, irq, level); 248c2ecf20Sopenharmony_ci ls7a_ioapic_unlock(ls7a_ioapic_irqchip(kvm), &flags); 258c2ecf20Sopenharmony_ci 268c2ecf20Sopenharmony_ci return ret; 278c2ecf20Sopenharmony_ci} 288c2ecf20Sopenharmony_ci 298c2ecf20Sopenharmony_ci/** 308c2ecf20Sopenharmony_ci * kvm_set_routing_entry: populate a kvm routing entry 318c2ecf20Sopenharmony_ci * from a user routing entry 328c2ecf20Sopenharmony_ci * 338c2ecf20Sopenharmony_ci * @kvm: the VM this entry is applied to 348c2ecf20Sopenharmony_ci * @e: kvm kernel routing entry handle 358c2ecf20Sopenharmony_ci * @ue: user api routing entry handle 368c2ecf20Sopenharmony_ci * return 0 on success, -EINVAL on errors. 378c2ecf20Sopenharmony_ci */ 388c2ecf20Sopenharmony_ciint kvm_set_routing_entry(struct kvm *kvm, 398c2ecf20Sopenharmony_ci struct kvm_kernel_irq_routing_entry *e, 408c2ecf20Sopenharmony_ci const struct kvm_irq_routing_entry *ue) 418c2ecf20Sopenharmony_ci{ 428c2ecf20Sopenharmony_ci int r = -EINVAL; 438c2ecf20Sopenharmony_ci 448c2ecf20Sopenharmony_ci switch (ue->type) { 458c2ecf20Sopenharmony_ci case KVM_IRQ_ROUTING_IRQCHIP: 468c2ecf20Sopenharmony_ci e->set = kvm_ls7a_set_ioapic_irq; 478c2ecf20Sopenharmony_ci 488c2ecf20Sopenharmony_ci e->irqchip.irqchip = ue->u.irqchip.irqchip; 498c2ecf20Sopenharmony_ci e->irqchip.pin = ue->u.irqchip.pin; 508c2ecf20Sopenharmony_ci 518c2ecf20Sopenharmony_ci if (e->irqchip.pin >= LS7A_APIC_NUM_PINS) 528c2ecf20Sopenharmony_ci goto out; 538c2ecf20Sopenharmony_ci break; 548c2ecf20Sopenharmony_ci case KVM_IRQ_ROUTING_MSI: 558c2ecf20Sopenharmony_ci e->set = kvm_set_msi; 568c2ecf20Sopenharmony_ci e->msi.address_lo = ue->u.msi.address_lo; 578c2ecf20Sopenharmony_ci e->msi.address_hi = ue->u.msi.address_hi; 588c2ecf20Sopenharmony_ci e->msi.data = ue->u.msi.data; 598c2ecf20Sopenharmony_ci /* 608c2ecf20Sopenharmony_ci * linux4.19 kernel have flags and devid 618c2ecf20Sopenharmony_ci * e->msi.flags = ue->flags; 628c2ecf20Sopenharmony_ci * e->msi.devid = ue->u.msi.devid; 638c2ecf20Sopenharmony_ci */ 648c2ecf20Sopenharmony_ci break; 658c2ecf20Sopenharmony_ci default: 668c2ecf20Sopenharmony_ci goto out; 678c2ecf20Sopenharmony_ci } 688c2ecf20Sopenharmony_ci r = 0; 698c2ecf20Sopenharmony_ciout: 708c2ecf20Sopenharmony_ci return r; 718c2ecf20Sopenharmony_ci} 728c2ecf20Sopenharmony_ci 738c2ecf20Sopenharmony_ciint kvm_arch_set_irq_inatomic(struct kvm_kernel_irq_routing_entry *e, 748c2ecf20Sopenharmony_ci struct kvm *kvm, int irq_source_id, 758c2ecf20Sopenharmony_ci int level, bool line_status) 768c2ecf20Sopenharmony_ci{ 778c2ecf20Sopenharmony_ci if (e->type == KVM_IRQ_ROUTING_MSI) 788c2ecf20Sopenharmony_ci return kvm_ls7a_set_msi(e, kvm, irq_source_id, 1, false); 798c2ecf20Sopenharmony_ci 808c2ecf20Sopenharmony_ci return -EWOULDBLOCK; 818c2ecf20Sopenharmony_ci} 828c2ecf20Sopenharmony_ci 838c2ecf20Sopenharmony_ci/** 848c2ecf20Sopenharmony_ci * kvm_set_msi: inject the MSI corresponding to the 858c2ecf20Sopenharmony_ci * MSI routing entry 868c2ecf20Sopenharmony_ci * 878c2ecf20Sopenharmony_ci * This is the entry point for irqfd MSI injection 888c2ecf20Sopenharmony_ci * and userspace MSI injection. 898c2ecf20Sopenharmony_ci */ 908c2ecf20Sopenharmony_ciint kvm_set_msi(struct kvm_kernel_irq_routing_entry *e, 918c2ecf20Sopenharmony_ci struct kvm *kvm, int irq_source_id, 928c2ecf20Sopenharmony_ci int level, bool line_status) 938c2ecf20Sopenharmony_ci{ 948c2ecf20Sopenharmony_ci unsigned int ret; 958c2ecf20Sopenharmony_ci 968c2ecf20Sopenharmony_ci if (!level) 978c2ecf20Sopenharmony_ci return -1; 988c2ecf20Sopenharmony_ci 998c2ecf20Sopenharmony_ci ret = kvm_ls7a_set_msi(e, kvm, irq_source_id, 1, false); 1008c2ecf20Sopenharmony_ci return ret; 1018c2ecf20Sopenharmony_ci} 1028c2ecf20Sopenharmony_ci 1038c2ecf20Sopenharmony_ciint kvm_ls7a_setup_default_irq_routing(struct kvm *kvm) 1048c2ecf20Sopenharmony_ci{ 1058c2ecf20Sopenharmony_ci struct kvm_irq_routing_entry *entries; 1068c2ecf20Sopenharmony_ci 1078c2ecf20Sopenharmony_ci u32 nr = LS7A_APIC_NUM_PINS; 1088c2ecf20Sopenharmony_ci int i, ret; 1098c2ecf20Sopenharmony_ci 1108c2ecf20Sopenharmony_ci entries = kcalloc(nr, sizeof(*entries), GFP_KERNEL); 1118c2ecf20Sopenharmony_ci if (!entries) 1128c2ecf20Sopenharmony_ci return -ENOMEM; 1138c2ecf20Sopenharmony_ci 1148c2ecf20Sopenharmony_ci for (i = 0; i < nr; i++) { 1158c2ecf20Sopenharmony_ci entries[i].gsi = i; 1168c2ecf20Sopenharmony_ci entries[i].type = KVM_IRQ_ROUTING_IRQCHIP; 1178c2ecf20Sopenharmony_ci entries[i].u.irqchip.irqchip = 0; 1188c2ecf20Sopenharmony_ci entries[i].u.irqchip.pin = i; 1198c2ecf20Sopenharmony_ci } 1208c2ecf20Sopenharmony_ci ret = kvm_set_irq_routing(kvm, entries, nr, 0); 1218c2ecf20Sopenharmony_ci kfree(entries); 1228c2ecf20Sopenharmony_ci 1238c2ecf20Sopenharmony_ci return 0; 1248c2ecf20Sopenharmony_ci} 125