1 /* SPDX-License-Identifier: GPL-2.0-or-later */ 2 /* 3 * LoongArch EXTIOI interrupt kvm support 4 * 5 * Copyright (C) 2025 Loongson Technology Corporation Limited 6 */ 7 8 #include "qemu/osdep.h" 9 #include "qemu/typedefs.h" 10 #include "hw/intc/loongarch_extioi.h" 11 #include "linux/kvm.h" 12 #include "qapi/error.h" 13 #include "system/kvm.h" 14 15 static void kvm_extioi_access_reg(int fd, uint64_t addr, void *val, bool write) 16 { 17 kvm_device_access(fd, KVM_DEV_LOONGARCH_EXTIOI_GRP_REGS, 18 addr, val, write, &error_abort); 19 } 20 21 static void kvm_extioi_access_sw_state(int fd, uint64_t addr, 22 void *val, bool write) 23 { 24 kvm_device_access(fd, KVM_DEV_LOONGARCH_EXTIOI_GRP_SW_STATUS, 25 addr, val, write, &error_abort); 26 } 27 28 static void kvm_extioi_access_sw_status(void *opaque, bool write) 29 { 30 LoongArchExtIOICommonState *lecs = LOONGARCH_EXTIOI_COMMON(opaque); 31 LoongArchExtIOIState *les = LOONGARCH_EXTIOI(opaque); 32 int addr; 33 34 addr = KVM_DEV_LOONGARCH_EXTIOI_SW_STATUS_STATE; 35 kvm_extioi_access_sw_state(les->dev_fd, addr, &lecs->status, write); 36 } 37 38 static void kvm_extioi_access_regs(void *opaque, bool write) 39 { 40 LoongArchExtIOICommonState *lecs = LOONGARCH_EXTIOI_COMMON(opaque); 41 LoongArchExtIOIState *les = LOONGARCH_EXTIOI(opaque); 42 int fd = les->dev_fd; 43 int addr, offset, cpu; 44 45 for (addr = EXTIOI_NODETYPE_START; addr < EXTIOI_NODETYPE_END; addr += 4) { 46 offset = (addr - EXTIOI_NODETYPE_START) / 4; 47 kvm_extioi_access_reg(fd, addr, &lecs->nodetype[offset], write); 48 } 49 50 for (addr = EXTIOI_IPMAP_START; addr < EXTIOI_IPMAP_END; addr += 4) { 51 offset = (addr - EXTIOI_IPMAP_START) / 4; 52 kvm_extioi_access_reg(fd, addr, &lecs->ipmap[offset], write); 53 } 54 55 for (addr = EXTIOI_ENABLE_START; addr < EXTIOI_ENABLE_END; addr += 4) { 56 offset = (addr - EXTIOI_ENABLE_START) / 4; 57 kvm_extioi_access_reg(fd, addr, &lecs->enable[offset], write); 58 } 59 60 for (addr = EXTIOI_BOUNCE_START; addr < EXTIOI_BOUNCE_END; addr += 4) { 61 offset = (addr - EXTIOI_BOUNCE_START) / 4; 62 kvm_extioi_access_reg(fd, addr, &lecs->bounce[offset], write); 63 } 64 65 for (addr = EXTIOI_ISR_START; addr < EXTIOI_ISR_END; addr += 4) { 66 offset = (addr - EXTIOI_ISR_START) / 4; 67 kvm_extioi_access_reg(fd, addr, &lecs->isr[offset], write); 68 } 69 70 for (addr = EXTIOI_COREMAP_START; addr < EXTIOI_COREMAP_END; addr += 4) { 71 offset = (addr - EXTIOI_COREMAP_START) / 4; 72 kvm_extioi_access_reg(fd, addr, &lecs->coremap[offset], write); 73 } 74 75 for (cpu = 0; cpu < lecs->num_cpu; cpu++) { 76 for (addr = EXTIOI_COREISR_START; 77 addr < EXTIOI_COREISR_END; addr += 4) { 78 offset = (addr - EXTIOI_COREISR_START) / 4; 79 kvm_extioi_access_reg(fd, (cpu << 16) | addr, 80 &lecs->cpu[cpu].coreisr[offset], write); 81 } 82 } 83 } 84 85 int kvm_extioi_get(void *opaque) 86 { 87 kvm_extioi_access_regs(opaque, false); 88 kvm_extioi_access_sw_status(opaque, false); 89 return 0; 90 } 91 92 int kvm_extioi_put(void *opaque, int version_id) 93 { 94 LoongArchExtIOIState *les = LOONGARCH_EXTIOI(opaque); 95 int fd = les->dev_fd; 96 97 if (fd == 0) { 98 return 0; 99 } 100 101 kvm_extioi_access_regs(opaque, true); 102 kvm_extioi_access_sw_status(opaque, true); 103 kvm_device_access(fd, KVM_DEV_LOONGARCH_EXTIOI_GRP_CTRL, 104 KVM_DEV_LOONGARCH_EXTIOI_CTRL_LOAD_FINISHED, 105 NULL, true, &error_abort); 106 return 0; 107 } 108 109 void kvm_extioi_realize(DeviceState *dev, Error **errp) 110 { 111 LoongArchExtIOICommonState *lecs = LOONGARCH_EXTIOI_COMMON(dev); 112 LoongArchExtIOIState *les = LOONGARCH_EXTIOI(dev); 113 int ret; 114 115 ret = kvm_create_device(kvm_state, KVM_DEV_TYPE_LOONGARCH_EIOINTC, false); 116 if (ret < 0) { 117 fprintf(stderr, "create KVM_LOONGARCH_EIOINTC failed: %s\n", 118 strerror(-ret)); 119 abort(); 120 } 121 122 les->dev_fd = ret; 123 ret = kvm_device_access(les->dev_fd, KVM_DEV_LOONGARCH_EXTIOI_GRP_CTRL, 124 KVM_DEV_LOONGARCH_EXTIOI_CTRL_INIT_NUM_CPU, 125 &lecs->num_cpu, true, NULL); 126 if (ret < 0) { 127 fprintf(stderr, "KVM_LOONGARCH_EXTIOI_INIT_NUM_CPU failed: %s\n", 128 strerror(-ret)); 129 abort(); 130 } 131 132 ret = kvm_device_access(les->dev_fd, KVM_DEV_LOONGARCH_EXTIOI_GRP_CTRL, 133 KVM_DEV_LOONGARCH_EXTIOI_CTRL_INIT_FEATURE, 134 &lecs->features, true, NULL); 135 if (ret < 0) { 136 fprintf(stderr, "KVM_LOONGARCH_EXTIOI_INIT_FEATURE failed: %s\n", 137 strerror(-ret)); 138 abort(); 139 } 140 } 141