2 * Copyright (c) 2014 Roger Pau Monné <roger.pau@citrix.com>
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS AS IS'' AND
15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
27 #include <sys/cdefs.h>
28 __FBSDID("$FreeBSD$");
30 #include <sys/param.h>
32 #include <sys/kernel.h>
33 #include <sys/malloc.h>
36 #include <sys/systm.h>
41 #include <machine/cpufunc.h>
42 #include <machine/cpu.h>
43 #include <machine/intr_machdep.h>
44 #include <machine/md_var.h>
45 #include <machine/smp.h>
47 #include <x86/apicreg.h>
48 #include <x86/apicvar.h>
50 #include <xen/xen-os.h>
51 #include <xen/features.h>
52 #include <xen/gnttab.h>
53 #include <xen/hypervisor.h>
55 #include <xen/xen_intr.h>
57 #include <xen/interface/vcpu.h>
59 /*--------------------------------- Macros -----------------------------------*/
61 #define XEN_APIC_UNSUPPORTED \
62 panic("%s: not available in Xen PV port.", __func__)
65 /*--------------------------- Forward Declarations ---------------------------*/
67 static driver_filter_t xen_smp_rendezvous_action;
68 static driver_filter_t xen_invltlb;
69 static driver_filter_t xen_invlpg;
70 static driver_filter_t xen_invlrng;
71 static driver_filter_t xen_invlcache;
72 static driver_filter_t xen_ipi_bitmap_handler;
73 static driver_filter_t xen_cpustop_handler;
74 static driver_filter_t xen_cpususpend_handler;
77 /*---------------------------------- Macros ----------------------------------*/
78 #define IPI_TO_IDX(ipi) ((ipi) - APIC_IPI_INTS)
80 /*--------------------------------- Xen IPIs ---------------------------------*/
82 struct xen_ipi_handler
84 driver_filter_t *filter;
85 const char *description;
88 static struct xen_ipi_handler xen_ipis[] =
90 [IPI_TO_IDX(IPI_RENDEZVOUS)] = { xen_smp_rendezvous_action, "r" },
91 [IPI_TO_IDX(IPI_INVLTLB)] = { xen_invltlb, "itlb"},
92 [IPI_TO_IDX(IPI_INVLPG)] = { xen_invlpg, "ipg" },
93 [IPI_TO_IDX(IPI_INVLRNG)] = { xen_invlrng, "irg" },
94 [IPI_TO_IDX(IPI_INVLCACHE)] = { xen_invlcache, "ic" },
95 [IPI_TO_IDX(IPI_BITMAP_VECTOR)] = { xen_ipi_bitmap_handler, "b" },
96 [IPI_TO_IDX(IPI_STOP)] = { xen_cpustop_handler, "st" },
97 [IPI_TO_IDX(IPI_SUSPEND)] = { xen_cpususpend_handler, "sp" },
101 /*------------------------------- Per-CPU Data -------------------------------*/
103 DPCPU_DEFINE(xen_intr_handle_t, ipi_handle[nitems(xen_ipis)]);
106 /*------------------------------- Xen PV APIC --------------------------------*/
109 xen_pv_lapic_create(u_int apic_id, int boot_cpu)
112 cpu_add(apic_id, boot_cpu);
117 xen_pv_lapic_init(vm_paddr_t addr)
123 xen_pv_lapic_setup(int boot)
129 xen_pv_lapic_dump(const char *str)
132 printf("cpu%d %s XEN PV LAPIC\n", PCPU_GET(cpuid), str);
136 xen_pv_lapic_disable(void)
142 xen_pv_lapic_is_x2apic(void)
149 xen_pv_lapic_eoi(void)
152 XEN_APIC_UNSUPPORTED;
156 xen_pv_lapic_id(void)
159 return (PCPU_GET(apic_id));
163 xen_pv_lapic_intr_pending(u_int vector)
166 XEN_APIC_UNSUPPORTED;
171 xen_pv_apic_cpuid(u_int apic_id)
174 return (apic_cpuids[apic_id]);
181 xen_pv_apic_alloc_vector(u_int apic_id, u_int irq)
184 XEN_APIC_UNSUPPORTED;
189 xen_pv_apic_alloc_vectors(u_int apic_id, u_int *irqs, u_int count, u_int align)
192 XEN_APIC_UNSUPPORTED;
197 xen_pv_apic_disable_vector(u_int apic_id, u_int vector)
200 XEN_APIC_UNSUPPORTED;
204 xen_pv_apic_enable_vector(u_int apic_id, u_int vector)
207 XEN_APIC_UNSUPPORTED;
211 xen_pv_apic_free_vector(u_int apic_id, u_int vector, u_int irq)
214 XEN_APIC_UNSUPPORTED;
218 xen_pv_lapic_set_logical_id(u_int apic_id, u_int cluster, u_int cluster_id)
221 XEN_APIC_UNSUPPORTED;
225 xen_pv_lapic_enable_pmc(void)
228 XEN_APIC_UNSUPPORTED;
233 xen_pv_lapic_disable_pmc(void)
236 XEN_APIC_UNSUPPORTED;
240 xen_pv_lapic_reenable_pmc(void)
243 XEN_APIC_UNSUPPORTED;
247 xen_pv_lapic_enable_cmc(void)
254 xen_pv_lapic_ipi_raw(register_t icrlo, u_int dest)
257 XEN_APIC_UNSUPPORTED;
260 #define PCPU_ID_GET(id, field) (pcpu_find(id)->pc_##field)
267 * NMIs are not routed over event channels, and instead delivered as on
268 * native using the exception vector (#2). Triggering them can be done
269 * using the local APIC, or an hypercall as a shortcut like it's done
273 case APIC_IPI_DEST_SELF:
274 HYPERVISOR_vcpu_op(VCPUOP_send_nmi, PCPU_GET(vcpu_id), NULL);
276 case APIC_IPI_DEST_ALL:
278 HYPERVISOR_vcpu_op(VCPUOP_send_nmi,
279 PCPU_ID_GET(cpu, vcpu_id), NULL);
281 case APIC_IPI_DEST_OTHERS:
283 if (cpu != PCPU_GET(cpuid))
284 HYPERVISOR_vcpu_op(VCPUOP_send_nmi,
285 PCPU_ID_GET(cpu, vcpu_id), NULL);
288 HYPERVISOR_vcpu_op(VCPUOP_send_nmi,
289 PCPU_ID_GET(apic_cpuid(dest), vcpu_id), NULL);
296 xen_pv_lapic_ipi_vectored(u_int vector, int dest)
298 xen_intr_handle_t *ipi_handle;
299 int ipi_idx, to_cpu, self;
301 if (vector >= IPI_NMI_FIRST) {
306 ipi_idx = IPI_TO_IDX(vector);
307 if (ipi_idx >= nitems(xen_ipis))
308 panic("IPI out of range");
311 case APIC_IPI_DEST_SELF:
312 ipi_handle = DPCPU_GET(ipi_handle);
313 xen_intr_signal(ipi_handle[ipi_idx]);
315 case APIC_IPI_DEST_ALL:
316 CPU_FOREACH(to_cpu) {
317 ipi_handle = DPCPU_ID_GET(to_cpu, ipi_handle);
318 xen_intr_signal(ipi_handle[ipi_idx]);
321 case APIC_IPI_DEST_OTHERS:
322 self = PCPU_GET(cpuid);
323 CPU_FOREACH(to_cpu) {
324 if (to_cpu != self) {
325 ipi_handle = DPCPU_ID_GET(to_cpu, ipi_handle);
326 xen_intr_signal(ipi_handle[ipi_idx]);
331 to_cpu = apic_cpuid(dest);
332 ipi_handle = DPCPU_ID_GET(to_cpu, ipi_handle);
333 xen_intr_signal(ipi_handle[ipi_idx]);
339 xen_pv_lapic_ipi_wait(int delay)
342 XEN_APIC_UNSUPPORTED;
348 xen_pv_lapic_ipi_alloc(inthand_t *ipifunc)
351 XEN_APIC_UNSUPPORTED;
356 xen_pv_lapic_ipi_free(int vector)
359 XEN_APIC_UNSUPPORTED;
363 xen_pv_lapic_set_lvt_mask(u_int apic_id, u_int lvt, u_char masked)
366 XEN_APIC_UNSUPPORTED;
371 xen_pv_lapic_set_lvt_mode(u_int apic_id, u_int lvt, uint32_t mode)
374 XEN_APIC_UNSUPPORTED;
379 xen_pv_lapic_set_lvt_polarity(u_int apic_id, u_int lvt, enum intr_polarity pol)
382 XEN_APIC_UNSUPPORTED;
387 xen_pv_lapic_set_lvt_triggermode(u_int apic_id, u_int lvt,
388 enum intr_trigger trigger)
391 XEN_APIC_UNSUPPORTED;
395 /* Xen apic_ops implementation */
396 struct apic_ops xen_apic_ops = {
397 .create = xen_pv_lapic_create,
398 .init = xen_pv_lapic_init,
399 .xapic_mode = xen_pv_lapic_disable,
400 .is_x2apic = xen_pv_lapic_is_x2apic,
401 .setup = xen_pv_lapic_setup,
402 .dump = xen_pv_lapic_dump,
403 .disable = xen_pv_lapic_disable,
404 .eoi = xen_pv_lapic_eoi,
405 .id = xen_pv_lapic_id,
406 .intr_pending = xen_pv_lapic_intr_pending,
407 .set_logical_id = xen_pv_lapic_set_logical_id,
408 .cpuid = xen_pv_apic_cpuid,
409 .alloc_vector = xen_pv_apic_alloc_vector,
410 .alloc_vectors = xen_pv_apic_alloc_vectors,
411 .enable_vector = xen_pv_apic_enable_vector,
412 .disable_vector = xen_pv_apic_disable_vector,
413 .free_vector = xen_pv_apic_free_vector,
414 .enable_pmc = xen_pv_lapic_enable_pmc,
415 .disable_pmc = xen_pv_lapic_disable_pmc,
416 .reenable_pmc = xen_pv_lapic_reenable_pmc,
417 .enable_cmc = xen_pv_lapic_enable_cmc,
419 .ipi_raw = xen_pv_lapic_ipi_raw,
420 .ipi_vectored = xen_pv_lapic_ipi_vectored,
421 .ipi_wait = xen_pv_lapic_ipi_wait,
423 .ipi_alloc = xen_pv_lapic_ipi_alloc,
424 .ipi_free = xen_pv_lapic_ipi_free,
425 .set_lvt_mask = xen_pv_lapic_set_lvt_mask,
426 .set_lvt_mode = xen_pv_lapic_set_lvt_mode,
427 .set_lvt_polarity = xen_pv_lapic_set_lvt_polarity,
428 .set_lvt_triggermode = xen_pv_lapic_set_lvt_triggermode,
432 /*---------------------------- XEN PV IPI Handlers ---------------------------*/
434 * These are C clones of the ASM functions found in apic_vector.
437 xen_ipi_bitmap_handler(void *arg)
439 struct trapframe *frame;
442 ipi_bitmap_handler(*frame);
443 return (FILTER_HANDLED);
447 xen_smp_rendezvous_action(void *arg)
450 (*ipi_rendezvous_counts[PCPU_GET(cpuid)])++;
451 #endif /* COUNT_IPIS */
453 smp_rendezvous_action();
454 return (FILTER_HANDLED);
458 xen_invltlb(void *arg)
462 return (FILTER_HANDLED);
467 xen_invltlb_invpcid(void *arg)
470 invltlb_invpcid_handler();
471 return (FILTER_HANDLED);
475 xen_invltlb_pcid(void *arg)
478 invltlb_pcid_handler();
479 return (FILTER_HANDLED);
483 xen_invltlb_invpcid_pti(void *arg)
486 invltlb_invpcid_pti_handler();
487 return (FILTER_HANDLED);
491 xen_invlpg_invpcid_handler(void *arg)
494 invlpg_invpcid_handler();
495 return (FILTER_HANDLED);
499 xen_invlpg_pcid_handler(void *arg)
502 invlpg_pcid_handler();
503 return (FILTER_HANDLED);
507 xen_invlrng_invpcid_handler(void *arg)
510 invlrng_invpcid_handler();
511 return (FILTER_HANDLED);
515 xen_invlrng_pcid_handler(void *arg)
518 invlrng_pcid_handler();
519 return (FILTER_HANDLED);
524 xen_invlpg(void *arg)
528 return (FILTER_HANDLED);
532 xen_invlrng(void *arg)
536 return (FILTER_HANDLED);
540 xen_invlcache(void *arg)
544 return (FILTER_HANDLED);
548 xen_cpustop_handler(void *arg)
552 return (FILTER_HANDLED);
556 xen_cpususpend_handler(void *arg)
559 cpususpend_handler();
560 return (FILTER_HANDLED);
563 /*----------------------------- XEN PV IPI setup -----------------------------*/
565 * Those functions are provided outside of the Xen PV APIC implementation
566 * so PVHVM guests can also use PV IPIs without having an actual Xen PV APIC,
567 * because on PVHVM there's an emulated LAPIC provided by Xen.
570 xen_cpu_ipi_init(int cpu)
572 xen_intr_handle_t *ipi_handle;
573 const struct xen_ipi_handler *ipi;
576 ipi_handle = DPCPU_ID_GET(cpu, ipi_handle);
578 for (ipi = xen_ipis, idx = 0; idx < nitems(xen_ipis); ipi++, idx++) {
580 if (ipi->filter == NULL) {
581 ipi_handle[idx] = NULL;
585 rc = xen_intr_alloc_and_bind_ipi(cpu, ipi->filter,
586 INTR_TYPE_TTY, &ipi_handle[idx]);
588 panic("Unable to allocate a XEN IPI port");
589 xen_intr_describe(ipi_handle[idx], "%s", ipi->description);
598 if (!xen_vector_callback_enabled)
602 if (pmap_pcid_enabled) {
604 xen_ipis[IPI_TO_IDX(IPI_INVLTLB)].filter =
605 invpcid_works ? xen_invltlb_invpcid_pti :
608 xen_ipis[IPI_TO_IDX(IPI_INVLTLB)].filter =
609 invpcid_works ? xen_invltlb_invpcid :
611 xen_ipis[IPI_TO_IDX(IPI_INVLPG)].filter = invpcid_works ?
612 xen_invlpg_invpcid_handler : xen_invlpg_pcid_handler;
613 xen_ipis[IPI_TO_IDX(IPI_INVLRNG)].filter = invpcid_works ?
614 xen_invlrng_invpcid_handler : xen_invlrng_pcid_handler;
620 /* Set the xen pv ipi ops to replace the native ones */
621 if (xen_hvm_domain())
622 apic_ops.ipi_vectored = xen_pv_lapic_ipi_vectored;
625 /* Switch to using PV IPIs as soon as the vcpu_id is set. */
626 SYSINIT(xen_setup_cpus, SI_SUB_SMP, SI_ORDER_SECOND, xen_setup_cpus, NULL);