vlapic.c revision 270073
1/*-
2 * Copyright (c) 2011 NetApp, Inc.
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
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.
13 *
14 * THIS SOFTWARE IS PROVIDED BY NETAPP, INC ``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 NETAPP, INC 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
24 * SUCH DAMAGE.
25 *
26 * $FreeBSD: stable/10/sys/amd64/vmm/io/vlapic.c 270073 2014-08-17 01:16:40Z grehan $
27 */
28
29#include <sys/cdefs.h>
30__FBSDID("$FreeBSD: stable/10/sys/amd64/vmm/io/vlapic.c 270073 2014-08-17 01:16:40Z grehan $");
31
32#include <sys/param.h>
33#include <sys/lock.h>
34#include <sys/kernel.h>
35#include <sys/malloc.h>
36#include <sys/mutex.h>
37#include <sys/systm.h>
38#include <sys/smp.h>
39
40#include <x86/specialreg.h>
41#include <x86/apicreg.h>
42
43#include <machine/clock.h>
44#include <machine/smp.h>
45
46#include <machine/vmm.h>
47
48#include "vmm_ipi.h"
49#include "vmm_lapic.h"
50#include "vmm_ktr.h"
51#include "vmm_stat.h"
52
53#include "vlapic.h"
54#include "vlapic_priv.h"
55#include "vioapic.h"
56
57#define	PRIO(x)			((x) >> 4)
58
59#define VLAPIC_VERSION		(16)
60
61#define	x2apic(vlapic)	(((vlapic)->msr_apicbase & APICBASE_X2APIC) ? 1 : 0)
62
63/*
64 * The 'vlapic->timer_mtx' is used to provide mutual exclusion between the
65 * vlapic_callout_handler() and vcpu accesses to:
66 * - timer_freq_bt, timer_period_bt, timer_fire_bt
67 * - timer LVT register
68 */
69#define	VLAPIC_TIMER_LOCK(vlapic)	mtx_lock_spin(&((vlapic)->timer_mtx))
70#define	VLAPIC_TIMER_UNLOCK(vlapic)	mtx_unlock_spin(&((vlapic)->timer_mtx))
71#define	VLAPIC_TIMER_LOCKED(vlapic)	mtx_owned(&((vlapic)->timer_mtx))
72
73/*
74 * APIC timer frequency:
75 * - arbitrary but chosen to be in the ballpark of contemporary hardware.
76 * - power-of-two to avoid loss of precision when converted to a bintime.
77 */
78#define VLAPIC_BUS_FREQ		(128 * 1024 * 1024)
79
80static __inline uint32_t
81vlapic_get_id(struct vlapic *vlapic)
82{
83
84	if (x2apic(vlapic))
85		return (vlapic->vcpuid);
86	else
87		return (vlapic->vcpuid << 24);
88}
89
90static uint32_t
91x2apic_ldr(struct vlapic *vlapic)
92{
93	int apicid;
94	uint32_t ldr;
95
96	apicid = vlapic_get_id(vlapic);
97	ldr = 1 << (apicid & 0xf);
98	ldr |= (apicid & 0xffff0) << 12;
99	return (ldr);
100}
101
102void
103vlapic_dfr_write_handler(struct vlapic *vlapic)
104{
105	struct LAPIC *lapic;
106
107	lapic = vlapic->apic_page;
108	if (x2apic(vlapic)) {
109		VM_CTR1(vlapic->vm, "ignoring write to DFR in x2apic mode: %#x",
110		    lapic->dfr);
111		lapic->dfr = 0;
112		return;
113	}
114
115	lapic->dfr &= APIC_DFR_MODEL_MASK;
116	lapic->dfr |= APIC_DFR_RESERVED;
117
118	if ((lapic->dfr & APIC_DFR_MODEL_MASK) == APIC_DFR_MODEL_FLAT)
119		VLAPIC_CTR0(vlapic, "vlapic DFR in Flat Model");
120	else if ((lapic->dfr & APIC_DFR_MODEL_MASK) == APIC_DFR_MODEL_CLUSTER)
121		VLAPIC_CTR0(vlapic, "vlapic DFR in Cluster Model");
122	else
123		VLAPIC_CTR1(vlapic, "DFR in Unknown Model %#x", lapic->dfr);
124}
125
126void
127vlapic_ldr_write_handler(struct vlapic *vlapic)
128{
129	struct LAPIC *lapic;
130
131	lapic = vlapic->apic_page;
132
133	/* LDR is read-only in x2apic mode */
134	if (x2apic(vlapic)) {
135		VLAPIC_CTR1(vlapic, "ignoring write to LDR in x2apic mode: %#x",
136		    lapic->ldr);
137		lapic->ldr = x2apic_ldr(vlapic);
138	} else {
139		lapic->ldr &= ~APIC_LDR_RESERVED;
140		VLAPIC_CTR1(vlapic, "vlapic LDR set to %#x", lapic->ldr);
141	}
142}
143
144void
145vlapic_id_write_handler(struct vlapic *vlapic)
146{
147	struct LAPIC *lapic;
148
149	/*
150	 * We don't allow the ID register to be modified so reset it back to
151	 * its default value.
152	 */
153	lapic = vlapic->apic_page;
154	lapic->id = vlapic_get_id(vlapic);
155}
156
157static int
158vlapic_timer_divisor(uint32_t dcr)
159{
160	switch (dcr & 0xB) {
161	case APIC_TDCR_1:
162		return (1);
163	case APIC_TDCR_2:
164		return (2);
165	case APIC_TDCR_4:
166		return (4);
167	case APIC_TDCR_8:
168		return (8);
169	case APIC_TDCR_16:
170		return (16);
171	case APIC_TDCR_32:
172		return (32);
173	case APIC_TDCR_64:
174		return (64);
175	case APIC_TDCR_128:
176		return (128);
177	default:
178		panic("vlapic_timer_divisor: invalid dcr 0x%08x", dcr);
179	}
180}
181
182#if 0
183static inline void
184vlapic_dump_lvt(uint32_t offset, uint32_t *lvt)
185{
186	printf("Offset %x: lvt %08x (V:%02x DS:%x M:%x)\n", offset,
187	    *lvt, *lvt & APIC_LVTT_VECTOR, *lvt & APIC_LVTT_DS,
188	    *lvt & APIC_LVTT_M);
189}
190#endif
191
192static uint32_t
193vlapic_get_ccr(struct vlapic *vlapic)
194{
195	struct bintime bt_now, bt_rem;
196	struct LAPIC *lapic;
197	uint32_t ccr;
198
199	ccr = 0;
200	lapic = vlapic->apic_page;
201
202	VLAPIC_TIMER_LOCK(vlapic);
203	if (callout_active(&vlapic->callout)) {
204		/*
205		 * If the timer is scheduled to expire in the future then
206		 * compute the value of 'ccr' based on the remaining time.
207		 */
208		binuptime(&bt_now);
209		if (bintime_cmp(&vlapic->timer_fire_bt, &bt_now, >)) {
210			bt_rem = vlapic->timer_fire_bt;
211			bintime_sub(&bt_rem, &bt_now);
212			ccr += bt_rem.sec * BT2FREQ(&vlapic->timer_freq_bt);
213			ccr += bt_rem.frac / vlapic->timer_freq_bt.frac;
214		}
215	}
216	KASSERT(ccr <= lapic->icr_timer, ("vlapic_get_ccr: invalid ccr %#x, "
217	    "icr_timer is %#x", ccr, lapic->icr_timer));
218	VLAPIC_CTR2(vlapic, "vlapic ccr_timer = %#x, icr_timer = %#x",
219	    ccr, lapic->icr_timer);
220	VLAPIC_TIMER_UNLOCK(vlapic);
221	return (ccr);
222}
223
224void
225vlapic_dcr_write_handler(struct vlapic *vlapic)
226{
227	struct LAPIC *lapic;
228	int divisor;
229
230	lapic = vlapic->apic_page;
231	VLAPIC_TIMER_LOCK(vlapic);
232
233	divisor = vlapic_timer_divisor(lapic->dcr_timer);
234	VLAPIC_CTR2(vlapic, "vlapic dcr_timer=%#x, divisor=%d",
235	    lapic->dcr_timer, divisor);
236
237	/*
238	 * Update the timer frequency and the timer period.
239	 *
240	 * XXX changes to the frequency divider will not take effect until
241	 * the timer is reloaded.
242	 */
243	FREQ2BT(VLAPIC_BUS_FREQ / divisor, &vlapic->timer_freq_bt);
244	vlapic->timer_period_bt = vlapic->timer_freq_bt;
245	bintime_mul(&vlapic->timer_period_bt, lapic->icr_timer);
246
247	VLAPIC_TIMER_UNLOCK(vlapic);
248}
249
250void
251vlapic_esr_write_handler(struct vlapic *vlapic)
252{
253	struct LAPIC *lapic;
254
255	lapic = vlapic->apic_page;
256	lapic->esr = vlapic->esr_pending;
257	vlapic->esr_pending = 0;
258}
259
260int
261vlapic_set_intr_ready(struct vlapic *vlapic, int vector, bool level)
262{
263	struct LAPIC *lapic;
264	uint32_t *irrptr, *tmrptr, mask;
265	int idx;
266
267	KASSERT(vector >= 0 && vector < 256, ("invalid vector %d", vector));
268
269	lapic = vlapic->apic_page;
270	if (!(lapic->svr & APIC_SVR_ENABLE)) {
271		VLAPIC_CTR1(vlapic, "vlapic is software disabled, ignoring "
272		    "interrupt %d", vector);
273		return (0);
274	}
275
276	if (vector < 16) {
277		vlapic_set_error(vlapic, APIC_ESR_RECEIVE_ILLEGAL_VECTOR);
278		VLAPIC_CTR1(vlapic, "vlapic ignoring interrupt to vector %d",
279		    vector);
280		return (1);
281	}
282
283	if (vlapic->ops.set_intr_ready)
284		return ((*vlapic->ops.set_intr_ready)(vlapic, vector, level));
285
286	idx = (vector / 32) * 4;
287	mask = 1 << (vector % 32);
288
289	irrptr = &lapic->irr0;
290	atomic_set_int(&irrptr[idx], mask);
291
292	/*
293	 * Verify that the trigger-mode of the interrupt matches with
294	 * the vlapic TMR registers.
295	 */
296	tmrptr = &lapic->tmr0;
297	if ((tmrptr[idx] & mask) != (level ? mask : 0)) {
298		VLAPIC_CTR3(vlapic, "vlapic TMR[%d] is 0x%08x but "
299		    "interrupt is %s-triggered", idx / 4, tmrptr[idx],
300		    level ? "level" : "edge");
301	}
302
303	VLAPIC_CTR_IRR(vlapic, "vlapic_set_intr_ready");
304	return (1);
305}
306
307static __inline uint32_t *
308vlapic_get_lvtptr(struct vlapic *vlapic, uint32_t offset)
309{
310	struct LAPIC	*lapic = vlapic->apic_page;
311	int 		 i;
312
313	switch (offset) {
314	case APIC_OFFSET_CMCI_LVT:
315		return (&lapic->lvt_cmci);
316	case APIC_OFFSET_TIMER_LVT ... APIC_OFFSET_ERROR_LVT:
317		i = (offset - APIC_OFFSET_TIMER_LVT) >> 2;
318		return ((&lapic->lvt_timer) + i);;
319	default:
320		panic("vlapic_get_lvt: invalid LVT\n");
321	}
322}
323
324static __inline int
325lvt_off_to_idx(uint32_t offset)
326{
327	int index;
328
329	switch (offset) {
330	case APIC_OFFSET_CMCI_LVT:
331		index = APIC_LVT_CMCI;
332		break;
333	case APIC_OFFSET_TIMER_LVT:
334		index = APIC_LVT_TIMER;
335		break;
336	case APIC_OFFSET_THERM_LVT:
337		index = APIC_LVT_THERMAL;
338		break;
339	case APIC_OFFSET_PERF_LVT:
340		index = APIC_LVT_PMC;
341		break;
342	case APIC_OFFSET_LINT0_LVT:
343		index = APIC_LVT_LINT0;
344		break;
345	case APIC_OFFSET_LINT1_LVT:
346		index = APIC_LVT_LINT1;
347		break;
348	case APIC_OFFSET_ERROR_LVT:
349		index = APIC_LVT_ERROR;
350		break;
351	default:
352		index = -1;
353		break;
354	}
355	KASSERT(index >= 0 && index <= VLAPIC_MAXLVT_INDEX, ("lvt_off_to_idx: "
356	    "invalid lvt index %d for offset %#x", index, offset));
357
358	return (index);
359}
360
361static __inline uint32_t
362vlapic_get_lvt(struct vlapic *vlapic, uint32_t offset)
363{
364	int idx;
365	uint32_t val;
366
367	idx = lvt_off_to_idx(offset);
368	val = atomic_load_acq_32(&vlapic->lvt_last[idx]);
369	return (val);
370}
371
372void
373vlapic_lvt_write_handler(struct vlapic *vlapic, uint32_t offset)
374{
375	uint32_t *lvtptr, mask, val;
376	struct LAPIC *lapic;
377	int idx;
378
379	lapic = vlapic->apic_page;
380	lvtptr = vlapic_get_lvtptr(vlapic, offset);
381	val = *lvtptr;
382	idx = lvt_off_to_idx(offset);
383
384	if (!(lapic->svr & APIC_SVR_ENABLE))
385		val |= APIC_LVT_M;
386	mask = APIC_LVT_M | APIC_LVT_DS | APIC_LVT_VECTOR;
387	switch (offset) {
388	case APIC_OFFSET_TIMER_LVT:
389		mask |= APIC_LVTT_TM;
390		break;
391	case APIC_OFFSET_ERROR_LVT:
392		break;
393	case APIC_OFFSET_LINT0_LVT:
394	case APIC_OFFSET_LINT1_LVT:
395		mask |= APIC_LVT_TM | APIC_LVT_RIRR | APIC_LVT_IIPP;
396		/* FALLTHROUGH */
397	default:
398		mask |= APIC_LVT_DM;
399		break;
400	}
401	val &= mask;
402	*lvtptr = val;
403	atomic_store_rel_32(&vlapic->lvt_last[idx], val);
404}
405
406static void
407vlapic_mask_lvts(struct vlapic *vlapic)
408{
409	struct LAPIC *lapic = vlapic->apic_page;
410
411	lapic->lvt_cmci |= APIC_LVT_M;
412	vlapic_lvt_write_handler(vlapic, APIC_OFFSET_CMCI_LVT);
413
414	lapic->lvt_timer |= APIC_LVT_M;
415	vlapic_lvt_write_handler(vlapic, APIC_OFFSET_TIMER_LVT);
416
417	lapic->lvt_thermal |= APIC_LVT_M;
418	vlapic_lvt_write_handler(vlapic, APIC_OFFSET_THERM_LVT);
419
420	lapic->lvt_pcint |= APIC_LVT_M;
421	vlapic_lvt_write_handler(vlapic, APIC_OFFSET_PERF_LVT);
422
423	lapic->lvt_lint0 |= APIC_LVT_M;
424	vlapic_lvt_write_handler(vlapic, APIC_OFFSET_LINT0_LVT);
425
426	lapic->lvt_lint1 |= APIC_LVT_M;
427	vlapic_lvt_write_handler(vlapic, APIC_OFFSET_LINT1_LVT);
428
429	lapic->lvt_error |= APIC_LVT_M;
430	vlapic_lvt_write_handler(vlapic, APIC_OFFSET_ERROR_LVT);
431}
432
433static int
434vlapic_fire_lvt(struct vlapic *vlapic, uint32_t lvt)
435{
436	uint32_t vec, mode;
437
438	if (lvt & APIC_LVT_M)
439		return (0);
440
441	vec = lvt & APIC_LVT_VECTOR;
442	mode = lvt & APIC_LVT_DM;
443
444	switch (mode) {
445	case APIC_LVT_DM_FIXED:
446		if (vec < 16) {
447			vlapic_set_error(vlapic, APIC_ESR_SEND_ILLEGAL_VECTOR);
448			return (0);
449		}
450		if (vlapic_set_intr_ready(vlapic, vec, false))
451			vcpu_notify_event(vlapic->vm, vlapic->vcpuid, true);
452		break;
453	case APIC_LVT_DM_NMI:
454		vm_inject_nmi(vlapic->vm, vlapic->vcpuid);
455		break;
456	case APIC_LVT_DM_EXTINT:
457		vm_inject_extint(vlapic->vm, vlapic->vcpuid);
458		break;
459	default:
460		// Other modes ignored
461		return (0);
462	}
463	return (1);
464}
465
466#if 1
467static void
468dump_isrvec_stk(struct vlapic *vlapic)
469{
470	int i;
471	uint32_t *isrptr;
472
473	isrptr = &vlapic->apic_page->isr0;
474	for (i = 0; i < 8; i++)
475		printf("ISR%d 0x%08x\n", i, isrptr[i * 4]);
476
477	for (i = 0; i <= vlapic->isrvec_stk_top; i++)
478		printf("isrvec_stk[%d] = %d\n", i, vlapic->isrvec_stk[i]);
479}
480#endif
481
482/*
483 * Algorithm adopted from section "Interrupt, Task and Processor Priority"
484 * in Intel Architecture Manual Vol 3a.
485 */
486static void
487vlapic_update_ppr(struct vlapic *vlapic)
488{
489	int isrvec, tpr, ppr;
490
491	/*
492	 * Note that the value on the stack at index 0 is always 0.
493	 *
494	 * This is a placeholder for the value of ISRV when none of the
495	 * bits is set in the ISRx registers.
496	 */
497	isrvec = vlapic->isrvec_stk[vlapic->isrvec_stk_top];
498	tpr = vlapic->apic_page->tpr;
499
500#if 1
501	{
502		int i, lastprio, curprio, vector, idx;
503		uint32_t *isrptr;
504
505		if (vlapic->isrvec_stk_top == 0 && isrvec != 0)
506			panic("isrvec_stk is corrupted: %d", isrvec);
507
508		/*
509		 * Make sure that the priority of the nested interrupts is
510		 * always increasing.
511		 */
512		lastprio = -1;
513		for (i = 1; i <= vlapic->isrvec_stk_top; i++) {
514			curprio = PRIO(vlapic->isrvec_stk[i]);
515			if (curprio <= lastprio) {
516				dump_isrvec_stk(vlapic);
517				panic("isrvec_stk does not satisfy invariant");
518			}
519			lastprio = curprio;
520		}
521
522		/*
523		 * Make sure that each bit set in the ISRx registers has a
524		 * corresponding entry on the isrvec stack.
525		 */
526		i = 1;
527		isrptr = &vlapic->apic_page->isr0;
528		for (vector = 0; vector < 256; vector++) {
529			idx = (vector / 32) * 4;
530			if (isrptr[idx] & (1 << (vector % 32))) {
531				if (i > vlapic->isrvec_stk_top ||
532				    vlapic->isrvec_stk[i] != vector) {
533					dump_isrvec_stk(vlapic);
534					panic("ISR and isrvec_stk out of sync");
535				}
536				i++;
537			}
538		}
539	}
540#endif
541
542	if (PRIO(tpr) >= PRIO(isrvec))
543		ppr = tpr;
544	else
545		ppr = isrvec & 0xf0;
546
547	vlapic->apic_page->ppr = ppr;
548	VLAPIC_CTR1(vlapic, "vlapic_update_ppr 0x%02x", ppr);
549}
550
551static void
552vlapic_process_eoi(struct vlapic *vlapic)
553{
554	struct LAPIC	*lapic = vlapic->apic_page;
555	uint32_t	*isrptr, *tmrptr;
556	int		i, idx, bitpos, vector;
557
558	isrptr = &lapic->isr0;
559	tmrptr = &lapic->tmr0;
560
561	/*
562	 * The x86 architecture reserves the the first 32 vectors for use
563	 * by the processor.
564	 */
565	for (i = 7; i > 0; i--) {
566		idx = i * 4;
567		bitpos = fls(isrptr[idx]);
568		if (bitpos-- != 0) {
569			if (vlapic->isrvec_stk_top <= 0) {
570				panic("invalid vlapic isrvec_stk_top %d",
571				      vlapic->isrvec_stk_top);
572			}
573			isrptr[idx] &= ~(1 << bitpos);
574			VLAPIC_CTR_ISR(vlapic, "vlapic_process_eoi");
575			vlapic->isrvec_stk_top--;
576			vlapic_update_ppr(vlapic);
577			if ((tmrptr[idx] & (1 << bitpos)) != 0) {
578				vector = i * 32 + bitpos;
579				vioapic_process_eoi(vlapic->vm, vlapic->vcpuid,
580				    vector);
581			}
582			return;
583		}
584	}
585}
586
587static __inline int
588vlapic_get_lvt_field(uint32_t lvt, uint32_t mask)
589{
590
591	return (lvt & mask);
592}
593
594static __inline int
595vlapic_periodic_timer(struct vlapic *vlapic)
596{
597	uint32_t lvt;
598
599	lvt = vlapic_get_lvt(vlapic, APIC_OFFSET_TIMER_LVT);
600
601	return (vlapic_get_lvt_field(lvt, APIC_LVTT_TM_PERIODIC));
602}
603
604static VMM_STAT(VLAPIC_INTR_ERROR, "error interrupts generated by vlapic");
605
606void
607vlapic_set_error(struct vlapic *vlapic, uint32_t mask)
608{
609	uint32_t lvt;
610
611	vlapic->esr_pending |= mask;
612	if (vlapic->esr_firing)
613		return;
614	vlapic->esr_firing = 1;
615
616	// The error LVT always uses the fixed delivery mode.
617	lvt = vlapic_get_lvt(vlapic, APIC_OFFSET_ERROR_LVT);
618	if (vlapic_fire_lvt(vlapic, lvt | APIC_LVT_DM_FIXED)) {
619		vmm_stat_incr(vlapic->vm, vlapic->vcpuid, VLAPIC_INTR_ERROR, 1);
620	}
621	vlapic->esr_firing = 0;
622}
623
624static VMM_STAT(VLAPIC_INTR_TIMER, "timer interrupts generated by vlapic");
625
626static void
627vlapic_fire_timer(struct vlapic *vlapic)
628{
629	uint32_t lvt;
630
631	KASSERT(VLAPIC_TIMER_LOCKED(vlapic), ("vlapic_fire_timer not locked"));
632
633	// The timer LVT always uses the fixed delivery mode.
634	lvt = vlapic_get_lvt(vlapic, APIC_OFFSET_TIMER_LVT);
635	if (vlapic_fire_lvt(vlapic, lvt | APIC_LVT_DM_FIXED)) {
636		vmm_stat_incr(vlapic->vm, vlapic->vcpuid, VLAPIC_INTR_TIMER, 1);
637	}
638}
639
640static VMM_STAT(VLAPIC_INTR_CMC,
641    "corrected machine check interrupts generated by vlapic");
642
643void
644vlapic_fire_cmci(struct vlapic *vlapic)
645{
646	uint32_t lvt;
647
648	lvt = vlapic_get_lvt(vlapic, APIC_OFFSET_CMCI_LVT);
649	if (vlapic_fire_lvt(vlapic, lvt)) {
650		vmm_stat_incr(vlapic->vm, vlapic->vcpuid, VLAPIC_INTR_CMC, 1);
651	}
652}
653
654static VMM_STAT_ARRAY(LVTS_TRIGGERRED, VLAPIC_MAXLVT_INDEX + 1,
655    "lvts triggered");
656
657int
658vlapic_trigger_lvt(struct vlapic *vlapic, int vector)
659{
660	uint32_t lvt;
661
662	if (vlapic_enabled(vlapic) == false) {
663		/*
664		 * When the local APIC is global/hardware disabled,
665		 * LINT[1:0] pins are configured as INTR and NMI pins,
666		 * respectively.
667		*/
668		switch (vector) {
669			case APIC_LVT_LINT0:
670				vm_inject_extint(vlapic->vm, vlapic->vcpuid);
671				break;
672			case APIC_LVT_LINT1:
673				vm_inject_nmi(vlapic->vm, vlapic->vcpuid);
674				break;
675			default:
676				break;
677		}
678		return (0);
679	}
680
681	switch (vector) {
682	case APIC_LVT_LINT0:
683		lvt = vlapic_get_lvt(vlapic, APIC_OFFSET_LINT0_LVT);
684		break;
685	case APIC_LVT_LINT1:
686		lvt = vlapic_get_lvt(vlapic, APIC_OFFSET_LINT1_LVT);
687		break;
688	case APIC_LVT_TIMER:
689		lvt = vlapic_get_lvt(vlapic, APIC_OFFSET_TIMER_LVT);
690		lvt |= APIC_LVT_DM_FIXED;
691		break;
692	case APIC_LVT_ERROR:
693		lvt = vlapic_get_lvt(vlapic, APIC_OFFSET_ERROR_LVT);
694		lvt |= APIC_LVT_DM_FIXED;
695		break;
696	case APIC_LVT_PMC:
697		lvt = vlapic_get_lvt(vlapic, APIC_OFFSET_PERF_LVT);
698		break;
699	case APIC_LVT_THERMAL:
700		lvt = vlapic_get_lvt(vlapic, APIC_OFFSET_THERM_LVT);
701		break;
702	case APIC_LVT_CMCI:
703		lvt = vlapic_get_lvt(vlapic, APIC_OFFSET_CMCI_LVT);
704		break;
705	default:
706		return (EINVAL);
707	}
708	if (vlapic_fire_lvt(vlapic, lvt)) {
709		vmm_stat_array_incr(vlapic->vm, vlapic->vcpuid,
710		    LVTS_TRIGGERRED, vector, 1);
711	}
712	return (0);
713}
714
715static void
716vlapic_callout_handler(void *arg)
717{
718	struct vlapic *vlapic;
719	struct bintime bt, btnow;
720	sbintime_t rem_sbt;
721
722	vlapic = arg;
723
724	VLAPIC_TIMER_LOCK(vlapic);
725	if (callout_pending(&vlapic->callout))	/* callout was reset */
726		goto done;
727
728	if (!callout_active(&vlapic->callout))	/* callout was stopped */
729		goto done;
730
731	callout_deactivate(&vlapic->callout);
732
733	vlapic_fire_timer(vlapic);
734
735	if (vlapic_periodic_timer(vlapic)) {
736		binuptime(&btnow);
737		KASSERT(bintime_cmp(&btnow, &vlapic->timer_fire_bt, >=),
738		    ("vlapic callout at %#lx.%#lx, expected at %#lx.#%lx",
739		    btnow.sec, btnow.frac, vlapic->timer_fire_bt.sec,
740		    vlapic->timer_fire_bt.frac));
741
742		/*
743		 * Compute the delta between when the timer was supposed to
744		 * fire and the present time.
745		 */
746		bt = btnow;
747		bintime_sub(&bt, &vlapic->timer_fire_bt);
748
749		rem_sbt = bttosbt(vlapic->timer_period_bt);
750		if (bintime_cmp(&bt, &vlapic->timer_period_bt, <)) {
751			/*
752			 * Adjust the time until the next countdown downward
753			 * to account for the lost time.
754			 */
755			rem_sbt -= bttosbt(bt);
756		} else {
757			/*
758			 * If the delta is greater than the timer period then
759			 * just reset our time base instead of trying to catch
760			 * up.
761			 */
762			vlapic->timer_fire_bt = btnow;
763			VLAPIC_CTR2(vlapic, "vlapic timer lagging by %lu "
764			    "usecs, period is %lu usecs - resetting time base",
765			    bttosbt(bt) / SBT_1US,
766			    bttosbt(vlapic->timer_period_bt) / SBT_1US);
767		}
768
769		bintime_add(&vlapic->timer_fire_bt, &vlapic->timer_period_bt);
770		callout_reset_sbt(&vlapic->callout, rem_sbt, 0,
771		    vlapic_callout_handler, vlapic, 0);
772	}
773done:
774	VLAPIC_TIMER_UNLOCK(vlapic);
775}
776
777void
778vlapic_icrtmr_write_handler(struct vlapic *vlapic)
779{
780	struct LAPIC *lapic;
781	sbintime_t sbt;
782	uint32_t icr_timer;
783
784	VLAPIC_TIMER_LOCK(vlapic);
785
786	lapic = vlapic->apic_page;
787	icr_timer = lapic->icr_timer;
788
789	vlapic->timer_period_bt = vlapic->timer_freq_bt;
790	bintime_mul(&vlapic->timer_period_bt, icr_timer);
791
792	if (icr_timer != 0) {
793		binuptime(&vlapic->timer_fire_bt);
794		bintime_add(&vlapic->timer_fire_bt, &vlapic->timer_period_bt);
795
796		sbt = bttosbt(vlapic->timer_period_bt);
797		callout_reset_sbt(&vlapic->callout, sbt, 0,
798		    vlapic_callout_handler, vlapic, 0);
799	} else
800		callout_stop(&vlapic->callout);
801
802	VLAPIC_TIMER_UNLOCK(vlapic);
803}
804
805/*
806 * This function populates 'dmask' with the set of vcpus that match the
807 * addressing specified by the (dest, phys, lowprio) tuple.
808 *
809 * 'x2apic_dest' specifies whether 'dest' is interpreted as x2APIC (32-bit)
810 * or xAPIC (8-bit) destination field.
811 */
812static void
813vlapic_calcdest(struct vm *vm, cpuset_t *dmask, uint32_t dest, bool phys,
814    bool lowprio, bool x2apic_dest)
815{
816	struct vlapic *vlapic;
817	uint32_t dfr, ldr, ldest, cluster;
818	uint32_t mda_flat_ldest, mda_cluster_ldest, mda_ldest, mda_cluster_id;
819	cpuset_t amask;
820	int vcpuid;
821
822	if ((x2apic_dest && dest == 0xffffffff) ||
823	    (!x2apic_dest && dest == 0xff)) {
824		/*
825		 * Broadcast in both logical and physical modes.
826		 */
827		*dmask = vm_active_cpus(vm);
828		return;
829	}
830
831	if (phys) {
832		/*
833		 * Physical mode: destination is APIC ID.
834		 */
835		CPU_ZERO(dmask);
836		vcpuid = vm_apicid2vcpuid(vm, dest);
837		if (vcpuid < VM_MAXCPU)
838			CPU_SET(vcpuid, dmask);
839	} else {
840		/*
841		 * In the "Flat Model" the MDA is interpreted as an 8-bit wide
842		 * bitmask. This model is only avilable in the xAPIC mode.
843		 */
844		mda_flat_ldest = dest & 0xff;
845
846		/*
847		 * In the "Cluster Model" the MDA is used to identify a
848		 * specific cluster and a set of APICs in that cluster.
849		 */
850		if (x2apic_dest) {
851			mda_cluster_id = dest >> 16;
852			mda_cluster_ldest = dest & 0xffff;
853		} else {
854			mda_cluster_id = (dest >> 4) & 0xf;
855			mda_cluster_ldest = dest & 0xf;
856		}
857
858		/*
859		 * Logical mode: match each APIC that has a bit set
860		 * in it's LDR that matches a bit in the ldest.
861		 */
862		CPU_ZERO(dmask);
863		amask = vm_active_cpus(vm);
864		while ((vcpuid = CPU_FFS(&amask)) != 0) {
865			vcpuid--;
866			CPU_CLR(vcpuid, &amask);
867
868			vlapic = vm_lapic(vm, vcpuid);
869			dfr = vlapic->apic_page->dfr;
870			ldr = vlapic->apic_page->ldr;
871
872			if ((dfr & APIC_DFR_MODEL_MASK) ==
873			    APIC_DFR_MODEL_FLAT) {
874				ldest = ldr >> 24;
875				mda_ldest = mda_flat_ldest;
876			} else if ((dfr & APIC_DFR_MODEL_MASK) ==
877			    APIC_DFR_MODEL_CLUSTER) {
878				if (x2apic(vlapic)) {
879					cluster = ldr >> 16;
880					ldest = ldr & 0xffff;
881				} else {
882					cluster = ldr >> 28;
883					ldest = (ldr >> 24) & 0xf;
884				}
885				if (cluster != mda_cluster_id)
886					continue;
887				mda_ldest = mda_cluster_ldest;
888			} else {
889				/*
890				 * Guest has configured a bad logical
891				 * model for this vcpu - skip it.
892				 */
893				VLAPIC_CTR1(vlapic, "vlapic has bad logical "
894				    "model %x - cannot deliver interrupt", dfr);
895				continue;
896			}
897
898			if ((mda_ldest & ldest) != 0) {
899				CPU_SET(vcpuid, dmask);
900				if (lowprio)
901					break;
902			}
903		}
904	}
905}
906
907static VMM_STAT_ARRAY(IPIS_SENT, VM_MAXCPU, "ipis sent to vcpu");
908
909static void
910vlapic_set_tpr(struct vlapic *vlapic, uint8_t val)
911{
912	struct LAPIC *lapic = vlapic->apic_page;
913
914	lapic->tpr = val;
915	vlapic_update_ppr(vlapic);
916}
917
918static uint8_t
919vlapic_get_tpr(struct vlapic *vlapic)
920{
921	struct LAPIC *lapic = vlapic->apic_page;
922
923	return (lapic->tpr);
924}
925
926void
927vlapic_set_cr8(struct vlapic *vlapic, uint64_t val)
928{
929	uint8_t tpr;
930
931	if (val & ~0xf) {
932		vm_inject_gp(vlapic->vm, vlapic->vcpuid);
933		return;
934	}
935
936	tpr = val << 4;
937	vlapic_set_tpr(vlapic, tpr);
938}
939
940uint64_t
941vlapic_get_cr8(struct vlapic *vlapic)
942{
943	uint8_t tpr;
944
945	tpr = vlapic_get_tpr(vlapic);
946	return (tpr >> 4);
947}
948
949int
950vlapic_icrlo_write_handler(struct vlapic *vlapic, bool *retu)
951{
952	int i;
953	bool phys;
954	cpuset_t dmask;
955	uint64_t icrval;
956	uint32_t dest, vec, mode;
957	struct vlapic *vlapic2;
958	struct vm_exit *vmexit;
959	struct LAPIC *lapic;
960
961	lapic = vlapic->apic_page;
962	lapic->icr_lo &= ~APIC_DELSTAT_PEND;
963	icrval = ((uint64_t)lapic->icr_hi << 32) | lapic->icr_lo;
964
965	if (x2apic(vlapic))
966		dest = icrval >> 32;
967	else
968		dest = icrval >> (32 + 24);
969	vec = icrval & APIC_VECTOR_MASK;
970	mode = icrval & APIC_DELMODE_MASK;
971
972	if (mode == APIC_DELMODE_FIXED && vec < 16) {
973		vlapic_set_error(vlapic, APIC_ESR_SEND_ILLEGAL_VECTOR);
974		VLAPIC_CTR1(vlapic, "Ignoring invalid IPI %d", vec);
975		return (0);
976	}
977
978	VLAPIC_CTR2(vlapic, "icrlo 0x%016lx triggered ipi %d", icrval, vec);
979
980	if (mode == APIC_DELMODE_FIXED || mode == APIC_DELMODE_NMI) {
981		switch (icrval & APIC_DEST_MASK) {
982		case APIC_DEST_DESTFLD:
983			phys = ((icrval & APIC_DESTMODE_LOG) == 0);
984			vlapic_calcdest(vlapic->vm, &dmask, dest, phys, false,
985			    x2apic(vlapic));
986			break;
987		case APIC_DEST_SELF:
988			CPU_SETOF(vlapic->vcpuid, &dmask);
989			break;
990		case APIC_DEST_ALLISELF:
991			dmask = vm_active_cpus(vlapic->vm);
992			break;
993		case APIC_DEST_ALLESELF:
994			dmask = vm_active_cpus(vlapic->vm);
995			CPU_CLR(vlapic->vcpuid, &dmask);
996			break;
997		default:
998			CPU_ZERO(&dmask);	/* satisfy gcc */
999			break;
1000		}
1001
1002		while ((i = CPU_FFS(&dmask)) != 0) {
1003			i--;
1004			CPU_CLR(i, &dmask);
1005			if (mode == APIC_DELMODE_FIXED) {
1006				lapic_intr_edge(vlapic->vm, i, vec);
1007				vmm_stat_array_incr(vlapic->vm, vlapic->vcpuid,
1008						    IPIS_SENT, i, 1);
1009				VLAPIC_CTR2(vlapic, "vlapic sending ipi %d "
1010				    "to vcpuid %d", vec, i);
1011			} else {
1012				vm_inject_nmi(vlapic->vm, i);
1013				VLAPIC_CTR1(vlapic, "vlapic sending ipi nmi "
1014				    "to vcpuid %d", i);
1015			}
1016		}
1017
1018		return (0);	/* handled completely in the kernel */
1019	}
1020
1021	if (mode == APIC_DELMODE_INIT) {
1022		if ((icrval & APIC_LEVEL_MASK) == APIC_LEVEL_DEASSERT)
1023			return (0);
1024
1025		if (vlapic->vcpuid == 0 && dest != 0 && dest < VM_MAXCPU) {
1026			vlapic2 = vm_lapic(vlapic->vm, dest);
1027
1028			/* move from INIT to waiting-for-SIPI state */
1029			if (vlapic2->boot_state == BS_INIT) {
1030				vlapic2->boot_state = BS_SIPI;
1031			}
1032
1033			return (0);
1034		}
1035	}
1036
1037	if (mode == APIC_DELMODE_STARTUP) {
1038		if (vlapic->vcpuid == 0 && dest != 0 && dest < VM_MAXCPU) {
1039			vlapic2 = vm_lapic(vlapic->vm, dest);
1040
1041			/*
1042			 * Ignore SIPIs in any state other than wait-for-SIPI
1043			 */
1044			if (vlapic2->boot_state != BS_SIPI)
1045				return (0);
1046
1047			vlapic2->boot_state = BS_RUNNING;
1048
1049			*retu = true;
1050			vmexit = vm_exitinfo(vlapic->vm, vlapic->vcpuid);
1051			vmexit->exitcode = VM_EXITCODE_SPINUP_AP;
1052			vmexit->u.spinup_ap.vcpu = dest;
1053			vmexit->u.spinup_ap.rip = vec << PAGE_SHIFT;
1054
1055			return (0);
1056		}
1057	}
1058
1059	/*
1060	 * This will cause a return to userland.
1061	 */
1062	return (1);
1063}
1064
1065void
1066vlapic_self_ipi_handler(struct vlapic *vlapic, uint64_t val)
1067{
1068	int vec;
1069
1070	KASSERT(x2apic(vlapic), ("SELF_IPI does not exist in xAPIC mode"));
1071
1072	vec = val & 0xff;
1073	lapic_intr_edge(vlapic->vm, vlapic->vcpuid, vec);
1074	vmm_stat_array_incr(vlapic->vm, vlapic->vcpuid, IPIS_SENT,
1075	    vlapic->vcpuid, 1);
1076	VLAPIC_CTR1(vlapic, "vlapic self-ipi %d", vec);
1077}
1078
1079int
1080vlapic_pending_intr(struct vlapic *vlapic, int *vecptr)
1081{
1082	struct LAPIC	*lapic = vlapic->apic_page;
1083	int	  	 idx, i, bitpos, vector;
1084	uint32_t	*irrptr, val;
1085
1086	if (vlapic->ops.pending_intr)
1087		return ((*vlapic->ops.pending_intr)(vlapic, vecptr));
1088
1089	irrptr = &lapic->irr0;
1090
1091	/*
1092	 * The x86 architecture reserves the the first 32 vectors for use
1093	 * by the processor.
1094	 */
1095	for (i = 7; i > 0; i--) {
1096		idx = i * 4;
1097		val = atomic_load_acq_int(&irrptr[idx]);
1098		bitpos = fls(val);
1099		if (bitpos != 0) {
1100			vector = i * 32 + (bitpos - 1);
1101			if (PRIO(vector) > PRIO(lapic->ppr)) {
1102				VLAPIC_CTR1(vlapic, "pending intr %d", vector);
1103				if (vecptr != NULL)
1104					*vecptr = vector;
1105				return (1);
1106			} else
1107				break;
1108		}
1109	}
1110	return (0);
1111}
1112
1113void
1114vlapic_intr_accepted(struct vlapic *vlapic, int vector)
1115{
1116	struct LAPIC	*lapic = vlapic->apic_page;
1117	uint32_t	*irrptr, *isrptr;
1118	int		idx, stk_top;
1119
1120	if (vlapic->ops.intr_accepted)
1121		return ((*vlapic->ops.intr_accepted)(vlapic, vector));
1122
1123	/*
1124	 * clear the ready bit for vector being accepted in irr
1125	 * and set the vector as in service in isr.
1126	 */
1127	idx = (vector / 32) * 4;
1128
1129	irrptr = &lapic->irr0;
1130	atomic_clear_int(&irrptr[idx], 1 << (vector % 32));
1131	VLAPIC_CTR_IRR(vlapic, "vlapic_intr_accepted");
1132
1133	isrptr = &lapic->isr0;
1134	isrptr[idx] |= 1 << (vector % 32);
1135	VLAPIC_CTR_ISR(vlapic, "vlapic_intr_accepted");
1136
1137	/*
1138	 * Update the PPR
1139	 */
1140	vlapic->isrvec_stk_top++;
1141
1142	stk_top = vlapic->isrvec_stk_top;
1143	if (stk_top >= ISRVEC_STK_SIZE)
1144		panic("isrvec_stk_top overflow %d", stk_top);
1145
1146	vlapic->isrvec_stk[stk_top] = vector;
1147	vlapic_update_ppr(vlapic);
1148}
1149
1150void
1151vlapic_svr_write_handler(struct vlapic *vlapic)
1152{
1153	struct LAPIC *lapic;
1154	uint32_t old, new, changed;
1155
1156	lapic = vlapic->apic_page;
1157
1158	new = lapic->svr;
1159	old = vlapic->svr_last;
1160	vlapic->svr_last = new;
1161
1162	changed = old ^ new;
1163	if ((changed & APIC_SVR_ENABLE) != 0) {
1164		if ((new & APIC_SVR_ENABLE) == 0) {
1165			/*
1166			 * The apic is now disabled so stop the apic timer
1167			 * and mask all the LVT entries.
1168			 */
1169			VLAPIC_CTR0(vlapic, "vlapic is software-disabled");
1170			VLAPIC_TIMER_LOCK(vlapic);
1171			callout_stop(&vlapic->callout);
1172			VLAPIC_TIMER_UNLOCK(vlapic);
1173			vlapic_mask_lvts(vlapic);
1174		} else {
1175			/*
1176			 * The apic is now enabled so restart the apic timer
1177			 * if it is configured in periodic mode.
1178			 */
1179			VLAPIC_CTR0(vlapic, "vlapic is software-enabled");
1180			if (vlapic_periodic_timer(vlapic))
1181				vlapic_icrtmr_write_handler(vlapic);
1182		}
1183	}
1184}
1185
1186int
1187vlapic_read(struct vlapic *vlapic, int mmio_access, uint64_t offset,
1188    uint64_t *data, bool *retu)
1189{
1190	struct LAPIC	*lapic = vlapic->apic_page;
1191	uint32_t	*reg;
1192	int		 i;
1193
1194	/* Ignore MMIO accesses in x2APIC mode */
1195	if (x2apic(vlapic) && mmio_access) {
1196		VLAPIC_CTR1(vlapic, "MMIO read from offset %#lx in x2APIC mode",
1197		    offset);
1198		*data = 0;
1199		goto done;
1200	}
1201
1202	if (!x2apic(vlapic) && !mmio_access) {
1203		/*
1204		 * XXX Generate GP fault for MSR accesses in xAPIC mode
1205		 */
1206		VLAPIC_CTR1(vlapic, "x2APIC MSR read from offset %#lx in "
1207		    "xAPIC mode", offset);
1208		*data = 0;
1209		goto done;
1210	}
1211
1212	if (offset > sizeof(*lapic)) {
1213		*data = 0;
1214		goto done;
1215	}
1216
1217	offset &= ~3;
1218	switch(offset)
1219	{
1220		case APIC_OFFSET_ID:
1221			*data = lapic->id;
1222			break;
1223		case APIC_OFFSET_VER:
1224			*data = lapic->version;
1225			break;
1226		case APIC_OFFSET_TPR:
1227			*data = vlapic_get_tpr(vlapic);
1228			break;
1229		case APIC_OFFSET_APR:
1230			*data = lapic->apr;
1231			break;
1232		case APIC_OFFSET_PPR:
1233			*data = lapic->ppr;
1234			break;
1235		case APIC_OFFSET_EOI:
1236			*data = lapic->eoi;
1237			break;
1238		case APIC_OFFSET_LDR:
1239			*data = lapic->ldr;
1240			break;
1241		case APIC_OFFSET_DFR:
1242			*data = lapic->dfr;
1243			break;
1244		case APIC_OFFSET_SVR:
1245			*data = lapic->svr;
1246			break;
1247		case APIC_OFFSET_ISR0 ... APIC_OFFSET_ISR7:
1248			i = (offset - APIC_OFFSET_ISR0) >> 2;
1249			reg = &lapic->isr0;
1250			*data = *(reg + i);
1251			break;
1252		case APIC_OFFSET_TMR0 ... APIC_OFFSET_TMR7:
1253			i = (offset - APIC_OFFSET_TMR0) >> 2;
1254			reg = &lapic->tmr0;
1255			*data = *(reg + i);
1256			break;
1257		case APIC_OFFSET_IRR0 ... APIC_OFFSET_IRR7:
1258			i = (offset - APIC_OFFSET_IRR0) >> 2;
1259			reg = &lapic->irr0;
1260			*data = atomic_load_acq_int(reg + i);
1261			break;
1262		case APIC_OFFSET_ESR:
1263			*data = lapic->esr;
1264			break;
1265		case APIC_OFFSET_ICR_LOW:
1266			*data = lapic->icr_lo;
1267			if (x2apic(vlapic))
1268				*data |= (uint64_t)lapic->icr_hi << 32;
1269			break;
1270		case APIC_OFFSET_ICR_HI:
1271			*data = lapic->icr_hi;
1272			break;
1273		case APIC_OFFSET_CMCI_LVT:
1274		case APIC_OFFSET_TIMER_LVT ... APIC_OFFSET_ERROR_LVT:
1275			*data = vlapic_get_lvt(vlapic, offset);
1276#ifdef INVARIANTS
1277			reg = vlapic_get_lvtptr(vlapic, offset);
1278			KASSERT(*data == *reg, ("inconsistent lvt value at "
1279			    "offset %#lx: %#lx/%#x", offset, *data, *reg));
1280#endif
1281			break;
1282		case APIC_OFFSET_TIMER_ICR:
1283			*data = lapic->icr_timer;
1284			break;
1285		case APIC_OFFSET_TIMER_CCR:
1286			*data = vlapic_get_ccr(vlapic);
1287			break;
1288		case APIC_OFFSET_TIMER_DCR:
1289			*data = lapic->dcr_timer;
1290			break;
1291		case APIC_OFFSET_SELF_IPI:
1292			/*
1293			 * XXX generate a GP fault if vlapic is in x2apic mode
1294			 */
1295			*data = 0;
1296			break;
1297		case APIC_OFFSET_RRR:
1298		default:
1299			*data = 0;
1300			break;
1301	}
1302done:
1303	VLAPIC_CTR2(vlapic, "vlapic read offset %#x, data %#lx", offset, *data);
1304	return 0;
1305}
1306
1307int
1308vlapic_write(struct vlapic *vlapic, int mmio_access, uint64_t offset,
1309    uint64_t data, bool *retu)
1310{
1311	struct LAPIC	*lapic = vlapic->apic_page;
1312	uint32_t	*regptr;
1313	int		retval;
1314
1315	KASSERT((offset & 0xf) == 0 && offset < PAGE_SIZE,
1316	    ("vlapic_write: invalid offset %#lx", offset));
1317
1318	VLAPIC_CTR2(vlapic, "vlapic write offset %#lx, data %#lx",
1319	    offset, data);
1320
1321	if (offset > sizeof(*lapic))
1322		return (0);
1323
1324	/* Ignore MMIO accesses in x2APIC mode */
1325	if (x2apic(vlapic) && mmio_access) {
1326		VLAPIC_CTR2(vlapic, "MMIO write of %#lx to offset %#lx "
1327		    "in x2APIC mode", data, offset);
1328		return (0);
1329	}
1330
1331	/*
1332	 * XXX Generate GP fault for MSR accesses in xAPIC mode
1333	 */
1334	if (!x2apic(vlapic) && !mmio_access) {
1335		VLAPIC_CTR2(vlapic, "x2APIC MSR write of %#lx to offset %#lx "
1336		    "in xAPIC mode", data, offset);
1337		return (0);
1338	}
1339
1340	retval = 0;
1341	switch(offset)
1342	{
1343		case APIC_OFFSET_ID:
1344			lapic->id = data;
1345			vlapic_id_write_handler(vlapic);
1346			break;
1347		case APIC_OFFSET_TPR:
1348			vlapic_set_tpr(vlapic, data & 0xff);
1349			break;
1350		case APIC_OFFSET_EOI:
1351			vlapic_process_eoi(vlapic);
1352			break;
1353		case APIC_OFFSET_LDR:
1354			lapic->ldr = data;
1355			vlapic_ldr_write_handler(vlapic);
1356			break;
1357		case APIC_OFFSET_DFR:
1358			lapic->dfr = data;
1359			vlapic_dfr_write_handler(vlapic);
1360			break;
1361		case APIC_OFFSET_SVR:
1362			lapic->svr = data;
1363			vlapic_svr_write_handler(vlapic);
1364			break;
1365		case APIC_OFFSET_ICR_LOW:
1366			lapic->icr_lo = data;
1367			if (x2apic(vlapic))
1368				lapic->icr_hi = data >> 32;
1369			retval = vlapic_icrlo_write_handler(vlapic, retu);
1370			break;
1371		case APIC_OFFSET_ICR_HI:
1372			lapic->icr_hi = data;
1373			break;
1374		case APIC_OFFSET_CMCI_LVT:
1375		case APIC_OFFSET_TIMER_LVT ... APIC_OFFSET_ERROR_LVT:
1376			regptr = vlapic_get_lvtptr(vlapic, offset);
1377			*regptr = data;
1378			vlapic_lvt_write_handler(vlapic, offset);
1379			break;
1380		case APIC_OFFSET_TIMER_ICR:
1381			lapic->icr_timer = data;
1382			vlapic_icrtmr_write_handler(vlapic);
1383			break;
1384
1385		case APIC_OFFSET_TIMER_DCR:
1386			lapic->dcr_timer = data;
1387			vlapic_dcr_write_handler(vlapic);
1388			break;
1389
1390		case APIC_OFFSET_ESR:
1391			vlapic_esr_write_handler(vlapic);
1392			break;
1393
1394		case APIC_OFFSET_SELF_IPI:
1395			if (x2apic(vlapic))
1396				vlapic_self_ipi_handler(vlapic, data);
1397			break;
1398
1399		case APIC_OFFSET_VER:
1400		case APIC_OFFSET_APR:
1401		case APIC_OFFSET_PPR:
1402		case APIC_OFFSET_RRR:
1403		case APIC_OFFSET_ISR0 ... APIC_OFFSET_ISR7:
1404		case APIC_OFFSET_TMR0 ... APIC_OFFSET_TMR7:
1405		case APIC_OFFSET_IRR0 ... APIC_OFFSET_IRR7:
1406		case APIC_OFFSET_TIMER_CCR:
1407		default:
1408			// Read only.
1409			break;
1410	}
1411
1412	return (retval);
1413}
1414
1415static void
1416vlapic_reset(struct vlapic *vlapic)
1417{
1418	struct LAPIC *lapic;
1419
1420	lapic = vlapic->apic_page;
1421	bzero(lapic, sizeof(struct LAPIC));
1422
1423	lapic->id = vlapic_get_id(vlapic);
1424	lapic->version = VLAPIC_VERSION;
1425	lapic->version |= (VLAPIC_MAXLVT_INDEX << MAXLVTSHIFT);
1426	lapic->dfr = 0xffffffff;
1427	lapic->svr = APIC_SVR_VECTOR;
1428	vlapic_mask_lvts(vlapic);
1429	vlapic_reset_tmr(vlapic);
1430
1431	lapic->dcr_timer = 0;
1432	vlapic_dcr_write_handler(vlapic);
1433
1434	if (vlapic->vcpuid == 0)
1435		vlapic->boot_state = BS_RUNNING;	/* BSP */
1436	else
1437		vlapic->boot_state = BS_INIT;		/* AP */
1438
1439	vlapic->svr_last = lapic->svr;
1440}
1441
1442void
1443vlapic_init(struct vlapic *vlapic)
1444{
1445	KASSERT(vlapic->vm != NULL, ("vlapic_init: vm is not initialized"));
1446	KASSERT(vlapic->vcpuid >= 0 && vlapic->vcpuid < VM_MAXCPU,
1447	    ("vlapic_init: vcpuid is not initialized"));
1448	KASSERT(vlapic->apic_page != NULL, ("vlapic_init: apic_page is not "
1449	    "initialized"));
1450
1451	/*
1452	 * If the vlapic is configured in x2apic mode then it will be
1453	 * accessed in the critical section via the MSR emulation code.
1454	 *
1455	 * Therefore the timer mutex must be a spinlock because blockable
1456	 * mutexes cannot be acquired in a critical section.
1457	 */
1458	mtx_init(&vlapic->timer_mtx, "vlapic timer mtx", NULL, MTX_SPIN);
1459	callout_init(&vlapic->callout, 1);
1460
1461	vlapic->msr_apicbase = DEFAULT_APIC_BASE | APICBASE_ENABLED;
1462
1463	if (vlapic->vcpuid == 0)
1464		vlapic->msr_apicbase |= APICBASE_BSP;
1465
1466	vlapic_reset(vlapic);
1467}
1468
1469void
1470vlapic_cleanup(struct vlapic *vlapic)
1471{
1472
1473	callout_drain(&vlapic->callout);
1474}
1475
1476uint64_t
1477vlapic_get_apicbase(struct vlapic *vlapic)
1478{
1479
1480	return (vlapic->msr_apicbase);
1481}
1482
1483int
1484vlapic_set_apicbase(struct vlapic *vlapic, uint64_t new)
1485{
1486
1487	if (vlapic->msr_apicbase != new) {
1488		VLAPIC_CTR2(vlapic, "Changing APIC_BASE MSR from %#lx to %#lx "
1489		    "not supported", vlapic->msr_apicbase, new);
1490		return (-1);
1491	}
1492
1493	return (0);
1494}
1495
1496void
1497vlapic_set_x2apic_state(struct vm *vm, int vcpuid, enum x2apic_state state)
1498{
1499	struct vlapic *vlapic;
1500	struct LAPIC *lapic;
1501
1502	vlapic = vm_lapic(vm, vcpuid);
1503
1504	if (state == X2APIC_DISABLED)
1505		vlapic->msr_apicbase &= ~APICBASE_X2APIC;
1506	else
1507		vlapic->msr_apicbase |= APICBASE_X2APIC;
1508
1509	/*
1510	 * Reset the local APIC registers whose values are mode-dependent.
1511	 *
1512	 * XXX this works because the APIC mode can be changed only at vcpu
1513	 * initialization time.
1514	 */
1515	lapic = vlapic->apic_page;
1516	lapic->id = vlapic_get_id(vlapic);
1517	if (x2apic(vlapic)) {
1518		lapic->ldr = x2apic_ldr(vlapic);
1519		lapic->dfr = 0;
1520	} else {
1521		lapic->ldr = 0;
1522		lapic->dfr = 0xffffffff;
1523	}
1524
1525	if (state == X2APIC_ENABLED) {
1526		if (vlapic->ops.enable_x2apic_mode)
1527			(*vlapic->ops.enable_x2apic_mode)(vlapic);
1528	}
1529}
1530
1531void
1532vlapic_deliver_intr(struct vm *vm, bool level, uint32_t dest, bool phys,
1533    int delmode, int vec)
1534{
1535	bool lowprio;
1536	int vcpuid;
1537	cpuset_t dmask;
1538
1539	if (delmode != IOART_DELFIXED &&
1540	    delmode != IOART_DELLOPRI &&
1541	    delmode != IOART_DELEXINT) {
1542		VM_CTR1(vm, "vlapic intr invalid delmode %#x", delmode);
1543		return;
1544	}
1545	lowprio = (delmode == IOART_DELLOPRI);
1546
1547	/*
1548	 * We don't provide any virtual interrupt redirection hardware so
1549	 * all interrupts originating from the ioapic or MSI specify the
1550	 * 'dest' in the legacy xAPIC format.
1551	 */
1552	vlapic_calcdest(vm, &dmask, dest, phys, lowprio, false);
1553
1554	while ((vcpuid = CPU_FFS(&dmask)) != 0) {
1555		vcpuid--;
1556		CPU_CLR(vcpuid, &dmask);
1557		if (delmode == IOART_DELEXINT) {
1558			vm_inject_extint(vm, vcpuid);
1559		} else {
1560			lapic_set_intr(vm, vcpuid, vec, level);
1561		}
1562	}
1563}
1564
1565void
1566vlapic_post_intr(struct vlapic *vlapic, int hostcpu, int ipinum)
1567{
1568	/*
1569	 * Post an interrupt to the vcpu currently running on 'hostcpu'.
1570	 *
1571	 * This is done by leveraging features like Posted Interrupts (Intel)
1572	 * Doorbell MSR (AMD AVIC) that avoid a VM exit.
1573	 *
1574	 * If neither of these features are available then fallback to
1575	 * sending an IPI to 'hostcpu'.
1576	 */
1577	if (vlapic->ops.post_intr)
1578		(*vlapic->ops.post_intr)(vlapic, hostcpu);
1579	else
1580		ipi_cpu(hostcpu, ipinum);
1581}
1582
1583bool
1584vlapic_enabled(struct vlapic *vlapic)
1585{
1586	struct LAPIC *lapic = vlapic->apic_page;
1587
1588	if ((vlapic->msr_apicbase & APICBASE_ENABLED) != 0 &&
1589	    (lapic->svr & APIC_SVR_ENABLE) != 0)
1590		return (true);
1591	else
1592		return (false);
1593}
1594
1595static void
1596vlapic_set_tmr(struct vlapic *vlapic, int vector, bool level)
1597{
1598	struct LAPIC *lapic;
1599	uint32_t *tmrptr, mask;
1600	int idx;
1601
1602	lapic = vlapic->apic_page;
1603	tmrptr = &lapic->tmr0;
1604	idx = (vector / 32) * 4;
1605	mask = 1 << (vector % 32);
1606	if (level)
1607		tmrptr[idx] |= mask;
1608	else
1609		tmrptr[idx] &= ~mask;
1610
1611	if (vlapic->ops.set_tmr != NULL)
1612		(*vlapic->ops.set_tmr)(vlapic, vector, level);
1613}
1614
1615void
1616vlapic_reset_tmr(struct vlapic *vlapic)
1617{
1618	int vector;
1619
1620	VLAPIC_CTR0(vlapic, "vlapic resetting all vectors to edge-triggered");
1621
1622	for (vector = 0; vector <= 255; vector++)
1623		vlapic_set_tmr(vlapic, vector, false);
1624}
1625
1626void
1627vlapic_set_tmr_level(struct vlapic *vlapic, uint32_t dest, bool phys,
1628    int delmode, int vector)
1629{
1630	cpuset_t dmask;
1631	bool lowprio;
1632
1633	KASSERT(vector >= 0 && vector <= 255, ("invalid vector %d", vector));
1634
1635	/*
1636	 * A level trigger is valid only for fixed and lowprio delivery modes.
1637	 */
1638	if (delmode != APIC_DELMODE_FIXED && delmode != APIC_DELMODE_LOWPRIO) {
1639		VLAPIC_CTR1(vlapic, "Ignoring level trigger-mode for "
1640		    "delivery-mode %d", delmode);
1641		return;
1642	}
1643
1644	lowprio = (delmode == APIC_DELMODE_LOWPRIO);
1645	vlapic_calcdest(vlapic->vm, &dmask, dest, phys, lowprio, false);
1646
1647	if (!CPU_ISSET(vlapic->vcpuid, &dmask))
1648		return;
1649
1650	VLAPIC_CTR1(vlapic, "vector %d set to level-triggered", vector);
1651	vlapic_set_tmr(vlapic, vector, true);
1652}
1653