Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 | // SPDX-License-Identifier: GPL-2.0 #include <linux/init.h> #include <linux/thread_info.h> #include <asm/x86_init.h> #include <asm/apic.h> #include <asm/io_apic.h> #include <asm/xen/hypercall.h> #include <xen/xen.h> #include <xen/interface/physdev.h> #include "xen-ops.h" #include "pmu.h" #include "smp.h" static unsigned int xen_io_apic_read(unsigned apic, unsigned reg) { struct physdev_apic apic_op; int ret; apic_op.apic_physbase = mpc_ioapic_addr(apic); apic_op.reg = reg; ret = HYPERVISOR_physdev_op(PHYSDEVOP_apic_read, &apic_op); if (!ret) return apic_op.value; /* fallback to return an emulated IO_APIC values */ if (reg == 0x1) return 0x00170020; else if (reg == 0x0) return apic << 24; return 0xfd; } static u32 xen_set_apic_id(unsigned int x) { WARN_ON(1); return x; } static unsigned int xen_get_apic_id(unsigned long x) { return ((x)>>24) & 0xFFu; } static u32 xen_apic_read(u32 reg) { struct xen_platform_op op = { .cmd = XENPF_get_cpuinfo, .interface_version = XENPF_INTERFACE_VERSION, .u.pcpu_info.xen_cpuid = 0, }; int ret; /* Shouldn't need this as APIC is turned off for PV, and we only * get called on the bootup processor. But just in case. */ if (!xen_initial_domain() || smp_processor_id()) return 0; if (reg == APIC_LVR) return 0x14; if (reg != APIC_ID) return 0; ret = HYPERVISOR_platform_op(&op); if (ret) op.u.pcpu_info.apic_id = BAD_APICID; return op.u.pcpu_info.apic_id << 24; } static void xen_apic_write(u32 reg, u32 val) { if (reg == APIC_LVTPC) { (void)pmu_apic_update(reg); return; } /* Warn to see if there's any stray references */ WARN(1,"register: %x, value: %x\n", reg, val); } static void xen_apic_eoi(void) { WARN_ON_ONCE(1); } static u64 xen_apic_icr_read(void) { return 0; } static void xen_apic_icr_write(u32 low, u32 id) { /* Warn to see if there's any stray references */ WARN_ON(1); } static int xen_apic_probe_pv(void) { if (xen_pv_domain()) return 1; return 0; } static int xen_madt_oem_check(char *oem_id, char *oem_table_id) { return xen_pv_domain(); } static int xen_phys_pkg_id(int initial_apic_id, int index_msb) { return initial_apic_id >> index_msb; } static int xen_cpu_present_to_apicid(int cpu) { if (cpu_present(cpu)) return cpu_data(cpu).apicid; else return BAD_APICID; } static struct apic xen_pv_apic __ro_after_init = { .name = "Xen PV", .probe = xen_apic_probe_pv, .acpi_madt_oem_check = xen_madt_oem_check, /* .delivery_mode and .dest_mode_logical not used by XENPV */ .disable_esr = 0, .cpu_present_to_apicid = xen_cpu_present_to_apicid, .phys_pkg_id = xen_phys_pkg_id, /* detect_ht */ .max_apic_id = UINT_MAX, .get_apic_id = xen_get_apic_id, .set_apic_id = xen_set_apic_id, .calc_dest_apicid = apic_flat_calc_apicid, #ifdef CONFIG_SMP .send_IPI_mask = xen_send_IPI_mask, .send_IPI_mask_allbutself = xen_send_IPI_mask_allbutself, .send_IPI_allbutself = xen_send_IPI_allbutself, .send_IPI_all = xen_send_IPI_all, .send_IPI_self = xen_send_IPI_self, #endif .read = xen_apic_read, .write = xen_apic_write, .eoi = xen_apic_eoi, .icr_read = xen_apic_icr_read, .icr_write = xen_apic_icr_write, }; apic_driver(xen_pv_apic); void __init xen_init_apic(void) { x86_apic_ops.io_apic_read = xen_io_apic_read; } |