lapic.c 58.9 KB
Newer Older
E
Eddie Dong 已提交
1 2 3 4 5 6 7

/*
 * Local APIC virtualization
 *
 * Copyright (C) 2006 Qumranet, Inc.
 * Copyright (C) 2007 Novell
 * Copyright (C) 2007 Intel
N
Nicolas Kaiser 已提交
8
 * Copyright 2009 Red Hat, Inc. and/or its affiliates.
E
Eddie Dong 已提交
9 10 11 12 13 14 15 16 17 18 19 20
 *
 * Authors:
 *   Dor Laor <dor.laor@qumranet.com>
 *   Gregory Haskins <ghaskins@novell.com>
 *   Yaozu (Eddie) Dong <eddie.dong@intel.com>
 *
 * Based on Xen 3.1 code, Copyright (c) 2004, Intel Corporation.
 *
 * This work is licensed under the terms of the GNU GPL, version 2.  See
 * the COPYING file in the top-level directory.
 */

21
#include <linux/kvm_host.h>
E
Eddie Dong 已提交
22 23 24 25 26 27
#include <linux/kvm.h>
#include <linux/mm.h>
#include <linux/highmem.h>
#include <linux/smp.h>
#include <linux/hrtimer.h>
#include <linux/io.h>
28
#include <linux/export.h>
R
Roman Zippel 已提交
29
#include <linux/math64.h>
30
#include <linux/slab.h>
E
Eddie Dong 已提交
31 32 33 34 35
#include <asm/processor.h>
#include <asm/msr.h>
#include <asm/page.h>
#include <asm/current.h>
#include <asm/apicdef.h>
36
#include <asm/delay.h>
A
Arun Sharma 已提交
37
#include <linux/atomic.h>
38
#include <linux/jump_label.h>
39
#include "kvm_cache_regs.h"
E
Eddie Dong 已提交
40
#include "irq.h"
41
#include "trace.h"
42
#include "x86.h"
A
Avi Kivity 已提交
43
#include "cpuid.h"
44
#include "hyperv.h"
E
Eddie Dong 已提交
45

46 47 48 49 50 51
#ifndef CONFIG_X86_64
#define mod_64(x, y) ((x) - (y) * div64_u64(x, y))
#else
#define mod_64(x, y) ((x) % (y))
#endif

E
Eddie Dong 已提交
52 53 54 55 56 57 58 59 60 61 62
#define PRId64 "d"
#define PRIx64 "llx"
#define PRIu64 "u"
#define PRIo64 "o"

#define APIC_BUS_CYCLE_NS 1

/* #define apic_debug(fmt,arg...) printk(KERN_WARNING fmt,##arg) */
#define apic_debug(fmt, arg...)

/* 14 is the version for Xeon and Pentium 8.4.8*/
63
#define APIC_VERSION			(0x14UL | ((KVM_APIC_LVT_NUM - 1) << 16))
E
Eddie Dong 已提交
64 65 66 67 68 69
#define LAPIC_MMIO_LENGTH		(1 << 12)
/* followed define is not in apicdef.h */
#define APIC_SHORT_MASK			0xc0000
#define APIC_DEST_NOSHORT		0x0
#define APIC_DEST_MASK			0x800
#define MAX_APIC_VECTOR			256
70
#define APIC_VECTORS_PER_REG		32
E
Eddie Dong 已提交
71

72 73 74
#define APIC_BROADCAST			0xFF
#define X2APIC_BROADCAST		0xFFFFFFFFul

M
Michael S. Tsirkin 已提交
75 76 77 78 79
static inline int apic_test_vector(int vec, void *bitmap)
{
	return test_bit(VEC_POS(vec), (bitmap) + REG_POS(vec));
}

80 81 82 83 84 85 86 87
bool kvm_apic_pending_eoi(struct kvm_vcpu *vcpu, int vector)
{
	struct kvm_lapic *apic = vcpu->arch.apic;

	return apic_test_vector(vector, apic->regs + APIC_ISR) ||
		apic_test_vector(vector, apic->regs + APIC_IRR);
}

E
Eddie Dong 已提交
88 89 90 91 92
static inline void apic_clear_vector(int vec, void *bitmap)
{
	clear_bit(VEC_POS(vec), (bitmap) + REG_POS(vec));
}

M
Michael S. Tsirkin 已提交
93 94 95 96 97 98 99 100 101 102
static inline int __apic_test_and_set_vector(int vec, void *bitmap)
{
	return __test_and_set_bit(VEC_POS(vec), (bitmap) + REG_POS(vec));
}

static inline int __apic_test_and_clear_vector(int vec, void *bitmap)
{
	return __test_and_clear_bit(VEC_POS(vec), (bitmap) + REG_POS(vec));
}

103
struct static_key_deferred apic_hw_disabled __read_mostly;
104 105
struct static_key_deferred apic_sw_disabled __read_mostly;

E
Eddie Dong 已提交
106 107
static inline int apic_enabled(struct kvm_lapic *apic)
{
108
	return kvm_apic_sw_enabled(apic) &&	kvm_apic_hw_enabled(apic);
109 110
}

E
Eddie Dong 已提交
111 112 113 114 115 116 117
#define LVT_MASK	\
	(APIC_LVT_MASKED | APIC_SEND_PENDING | APIC_VECTOR_MASK)

#define LINT_MASK	\
	(LVT_MASK | APIC_MODE_MASK | APIC_INPUT_POLARITY | \
	 APIC_LVT_REMOTE_IRR | APIC_LVT_LEVEL_TRIGGER)

118 119 120 121 122
static inline bool kvm_apic_map_get_logical_dest(struct kvm_apic_map *map,
		u32 dest_id, struct kvm_lapic ***cluster, u16 *mask) {
	switch (map->mode) {
	case KVM_APIC_MODE_X2APIC: {
		u32 offset = (dest_id >> 16) * 16;
R
Radim Krčmář 已提交
123
		u32 max_apic_id = map->max_apic_id;
124 125 126 127 128 129 130 131 132

		if (offset <= max_apic_id) {
			u8 cluster_size = min(max_apic_id - offset + 1, 16U);

			*cluster = &map->phys_map[offset];
			*mask = dest_id & (0xffff >> (16 - cluster_size));
		} else {
			*mask = 0;
		}
133

134 135 136 137 138 139 140
		return true;
		}
	case KVM_APIC_MODE_XAPIC_FLAT:
		*cluster = map->xapic_flat_map;
		*mask = dest_id & 0xff;
		return true;
	case KVM_APIC_MODE_XAPIC_CLUSTER:
141
		*cluster = map->xapic_cluster_map[(dest_id >> 4) & 0xf];
142 143 144 145 146 147
		*mask = dest_id & 0xf;
		return true;
	default:
		/* Not optimized. */
		return false;
	}
148 149
}

150
static void kvm_apic_map_free(struct rcu_head *rcu)
151
{
152
	struct kvm_apic_map *map = container_of(rcu, struct kvm_apic_map, rcu);
153

154
	kvfree(map);
155 156
}

157 158 159 160 161
static void recalculate_apic_map(struct kvm *kvm)
{
	struct kvm_apic_map *new, *old = NULL;
	struct kvm_vcpu *vcpu;
	int i;
R
Radim Krčmář 已提交
162
	u32 max_id = 255;
163 164 165

	mutex_lock(&kvm->arch.apic_map_lock);

R
Radim Krčmář 已提交
166 167 168 169
	kvm_for_each_vcpu(i, vcpu, kvm)
		if (kvm_apic_present(vcpu))
			max_id = max(max_id, kvm_apic_id(vcpu->arch.apic));

170 171
	new = kvm_kvzalloc(sizeof(struct kvm_apic_map) +
	                   sizeof(struct kvm_lapic *) * ((u64)max_id + 1));
R
Radim Krčmář 已提交
172

173 174 175
	if (!new)
		goto out;

R
Radim Krčmář 已提交
176 177
	new->max_apic_id = max_id;

178 179
	kvm_for_each_vcpu(i, vcpu, kvm) {
		struct kvm_lapic *apic = vcpu->arch.apic;
180 181
		struct kvm_lapic **cluster;
		u16 mask;
182
		u32 ldr, aid;
183

184 185 186
		if (!kvm_apic_present(vcpu))
			continue;

187
		aid = kvm_apic_id(apic);
188
		ldr = kvm_lapic_get_reg(apic, APIC_LDR);
189

R
Radim Krčmář 已提交
190
		if (aid <= new->max_apic_id)
191
			new->phys_map[aid] = apic;
192

193 194 195 196
		if (apic_x2apic_mode(apic)) {
			new->mode |= KVM_APIC_MODE_X2APIC;
		} else if (ldr) {
			ldr = GET_APIC_LOGICAL_ID(ldr);
197
			if (kvm_lapic_get_reg(apic, APIC_DFR) == APIC_DFR_FLAT)
198 199 200 201 202
				new->mode |= KVM_APIC_MODE_XAPIC_FLAT;
			else
				new->mode |= KVM_APIC_MODE_XAPIC_CLUSTER;
		}

203
		if (!kvm_apic_map_get_logical_dest(new, ldr, &cluster, &mask))
204 205
			continue;

206 207
		if (mask)
			cluster[ffs(mask) - 1] = apic;
208 209 210 211 212 213 214 215
	}
out:
	old = rcu_dereference_protected(kvm->arch.apic_map,
			lockdep_is_held(&kvm->arch.apic_map_lock));
	rcu_assign_pointer(kvm->arch.apic_map, new);
	mutex_unlock(&kvm->arch.apic_map_lock);

	if (old)
216
		call_rcu(&old->rcu, kvm_apic_map_free);
217

218
	kvm_make_scan_ioapic_request(kvm);
219 220
}

221 222
static inline void apic_set_spiv(struct kvm_lapic *apic, u32 val)
{
223
	bool enabled = val & APIC_SPIV_APIC_ENABLED;
224

225
	kvm_lapic_set_reg(apic, APIC_SPIV, val);
226 227 228 229

	if (enabled != apic->sw_enabled) {
		apic->sw_enabled = enabled;
		if (enabled) {
230 231 232 233 234 235 236
			static_key_slow_dec_deferred(&apic_sw_disabled);
			recalculate_apic_map(apic->vcpu->kvm);
		} else
			static_key_slow_inc(&apic_sw_disabled.key);
	}
}

237
static inline void kvm_apic_set_xapic_id(struct kvm_lapic *apic, u8 id)
238
{
239
	kvm_lapic_set_reg(apic, APIC_ID, id << 24);
240 241 242 243 244
	recalculate_apic_map(apic->vcpu->kvm);
}

static inline void kvm_apic_set_ldr(struct kvm_lapic *apic, u32 id)
{
245
	kvm_lapic_set_reg(apic, APIC_LDR, id);
246 247 248
	recalculate_apic_map(apic->vcpu->kvm);
}

249
static inline void kvm_apic_set_x2apic_id(struct kvm_lapic *apic, u32 id)
250 251 252
{
	u32 ldr = ((id >> 4) << 16) | (1 << (id & 0xf));

253
	kvm_lapic_set_reg(apic, APIC_ID, id);
254
	kvm_lapic_set_reg(apic, APIC_LDR, ldr);
255 256 257
	recalculate_apic_map(apic->vcpu->kvm);
}

E
Eddie Dong 已提交
258 259
static inline int apic_lvt_enabled(struct kvm_lapic *apic, int lvt_type)
{
260
	return !(kvm_lapic_get_reg(apic, lvt_type) & APIC_LVT_MASKED);
E
Eddie Dong 已提交
261 262 263 264
}

static inline int apic_lvt_vector(struct kvm_lapic *apic, int lvt_type)
{
265
	return kvm_lapic_get_reg(apic, lvt_type) & APIC_VECTOR_MASK;
E
Eddie Dong 已提交
266 267
}

268 269
static inline int apic_lvtt_oneshot(struct kvm_lapic *apic)
{
270
	return apic->lapic_timer.timer_mode == APIC_LVT_TIMER_ONESHOT;
271 272
}

E
Eddie Dong 已提交
273 274
static inline int apic_lvtt_period(struct kvm_lapic *apic)
{
275
	return apic->lapic_timer.timer_mode == APIC_LVT_TIMER_PERIODIC;
276 277 278 279
}

static inline int apic_lvtt_tscdeadline(struct kvm_lapic *apic)
{
280
	return apic->lapic_timer.timer_mode == APIC_LVT_TIMER_TSCDEADLINE;
E
Eddie Dong 已提交
281 282
}

283 284 285 286 287
static inline int apic_lvt_nmi_mode(u32 lvt_val)
{
	return (lvt_val & (APIC_MODE_MASK | APIC_LVT_MASKED)) == APIC_DM_NMI;
}

288 289 290 291 292 293
void kvm_apic_set_version(struct kvm_vcpu *vcpu)
{
	struct kvm_lapic *apic = vcpu->arch.apic;
	struct kvm_cpuid_entry2 *feat;
	u32 v = APIC_VERSION;

294
	if (!lapic_in_kernel(vcpu))
295 296 297 298 299
		return;

	feat = kvm_find_cpuid_entry(apic->vcpu, 0x1, 0);
	if (feat && (feat->ecx & (1 << (X86_FEATURE_X2APIC & 31))))
		v |= APIC_LVR_DIRECTED_EOI;
300
	kvm_lapic_set_reg(apic, APIC_LVR, v);
301 302
}

303
static const unsigned int apic_lvt_mask[KVM_APIC_LVT_NUM] = {
304
	LVT_MASK ,      /* part LVTT mask, timer mode mask added at runtime */
E
Eddie Dong 已提交
305 306 307 308 309 310 311 312
	LVT_MASK | APIC_MODE_MASK,	/* LVTTHMR */
	LVT_MASK | APIC_MODE_MASK,	/* LVTPC */
	LINT_MASK, LINT_MASK,	/* LVT0-1 */
	LVT_MASK		/* LVTERR */
};

static int find_highest_vector(void *bitmap)
{
313 314
	int vec;
	u32 *reg;
E
Eddie Dong 已提交
315

316 317 318 319 320 321
	for (vec = MAX_APIC_VECTOR - APIC_VECTORS_PER_REG;
	     vec >= 0; vec -= APIC_VECTORS_PER_REG) {
		reg = bitmap + REG_POS(vec);
		if (*reg)
			return fls(*reg) - 1 + vec;
	}
E
Eddie Dong 已提交
322

323
	return -1;
E
Eddie Dong 已提交
324 325
}

M
Michael S. Tsirkin 已提交
326 327
static u8 count_vectors(void *bitmap)
{
328 329
	int vec;
	u32 *reg;
M
Michael S. Tsirkin 已提交
330
	u8 count = 0;
331 332 333 334 335 336

	for (vec = 0; vec < MAX_APIC_VECTOR; vec += APIC_VECTORS_PER_REG) {
		reg = bitmap + REG_POS(vec);
		count += hweight32(*reg);
	}

M
Michael S. Tsirkin 已提交
337 338 339
	return count;
}

340
void __kvm_apic_update_irr(u32 *pir, void *regs)
341 342 343 344 345 346
{
	u32 i, pir_val;

	for (i = 0; i <= 7; i++) {
		pir_val = xchg(&pir[i], 0);
		if (pir_val)
347
			*((u32 *)(regs + APIC_IRR + i * 0x10)) |= pir_val;
348 349
	}
}
350 351 352 353 354 355 356
EXPORT_SYMBOL_GPL(__kvm_apic_update_irr);

void kvm_apic_update_irr(struct kvm_vcpu *vcpu, u32 *pir)
{
	struct kvm_lapic *apic = vcpu->arch.apic;

	__kvm_apic_update_irr(pir, apic->regs);
357 358

	kvm_make_request(KVM_REQ_EVENT, vcpu);
359
}
360 361
EXPORT_SYMBOL_GPL(kvm_apic_update_irr);

362
static inline int apic_search_irr(struct kvm_lapic *apic)
E
Eddie Dong 已提交
363
{
364
	return find_highest_vector(apic->regs + APIC_IRR);
E
Eddie Dong 已提交
365 366 367 368 369 370
}

static inline int apic_find_highest_irr(struct kvm_lapic *apic)
{
	int result;

371 372 373 374
	/*
	 * Note that irr_pending is just a hint. It will be always
	 * true with virtual interrupt delivery enabled.
	 */
375 376 377
	if (!apic->irr_pending)
		return -1;

378 379
	if (apic->vcpu->arch.apicv_active)
		kvm_x86_ops->sync_pir_to_irr(apic->vcpu);
380
	result = apic_search_irr(apic);
E
Eddie Dong 已提交
381 382 383 384 385
	ASSERT(result == -1 || result >= 16);

	return result;
}

386 387
static inline void apic_clear_irr(int vec, struct kvm_lapic *apic)
{
388 389 390 391
	struct kvm_vcpu *vcpu;

	vcpu = apic->vcpu;

392
	if (unlikely(vcpu->arch.apicv_active)) {
393
		/* try to update RVI */
394
		apic_clear_vector(vec, apic->regs + APIC_IRR);
395
		kvm_make_request(KVM_REQ_EVENT, vcpu);
396 397 398 399 400
	} else {
		apic->irr_pending = false;
		apic_clear_vector(vec, apic->regs + APIC_IRR);
		if (apic_search_irr(apic) != -1)
			apic->irr_pending = true;
401
	}
402 403
}

M
Michael S. Tsirkin 已提交
404 405
static inline void apic_set_isr(int vec, struct kvm_lapic *apic)
{
406 407 408 409 410 411
	struct kvm_vcpu *vcpu;

	if (__apic_test_and_set_vector(vec, apic->regs + APIC_ISR))
		return;

	vcpu = apic->vcpu;
412

M
Michael S. Tsirkin 已提交
413
	/*
414 415 416
	 * With APIC virtualization enabled, all caching is disabled
	 * because the processor can modify ISR under the hood.  Instead
	 * just set SVI.
M
Michael S. Tsirkin 已提交
417
	 */
418
	if (unlikely(vcpu->arch.apicv_active))
419
		kvm_x86_ops->hwapic_isr_update(vcpu, vec);
420 421 422 423 424 425 426 427 428 429
	else {
		++apic->isr_count;
		BUG_ON(apic->isr_count > MAX_APIC_VECTOR);
		/*
		 * ISR (in service register) bit is set when injecting an interrupt.
		 * The highest vector is injected. Thus the latest bit set matches
		 * the highest bit in ISR.
		 */
		apic->highest_isr_cache = vec;
	}
M
Michael S. Tsirkin 已提交
430 431
}

432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450
static inline int apic_find_highest_isr(struct kvm_lapic *apic)
{
	int result;

	/*
	 * Note that isr_count is always 1, and highest_isr_cache
	 * is always -1, with APIC virtualization enabled.
	 */
	if (!apic->isr_count)
		return -1;
	if (likely(apic->highest_isr_cache != -1))
		return apic->highest_isr_cache;

	result = find_highest_vector(apic->regs + APIC_ISR);
	ASSERT(result == -1 || result >= 16);

	return result;
}

M
Michael S. Tsirkin 已提交
451 452
static inline void apic_clear_isr(int vec, struct kvm_lapic *apic)
{
453 454 455 456 457 458 459 460 461 462 463 464 465
	struct kvm_vcpu *vcpu;
	if (!__apic_test_and_clear_vector(vec, apic->regs + APIC_ISR))
		return;

	vcpu = apic->vcpu;

	/*
	 * We do get here for APIC virtualization enabled if the guest
	 * uses the Hyper-V APIC enlightenment.  In this case we may need
	 * to trigger a new interrupt delivery by writing the SVI field;
	 * on the other hand isr_count and highest_isr_cache are unused
	 * and must be left alone.
	 */
466
	if (unlikely(vcpu->arch.apicv_active))
467
		kvm_x86_ops->hwapic_isr_update(vcpu,
468 469
					       apic_find_highest_isr(apic));
	else {
M
Michael S. Tsirkin 已提交
470
		--apic->isr_count;
471 472 473
		BUG_ON(apic->isr_count < 0);
		apic->highest_isr_cache = -1;
	}
M
Michael S. Tsirkin 已提交
474 475
}

476 477
int kvm_lapic_find_highest_irr(struct kvm_vcpu *vcpu)
{
478 479 480 481 482
	/* This may race with setting of irr in __apic_accept_irq() and
	 * value returned may be wrong, but kvm_vcpu_kick() in __apic_accept_irq
	 * will cause vmexit immediately and the value will be recalculated
	 * on the next vmentry.
	 */
483
	return apic_find_highest_irr(vcpu->arch.apic);
484 485
}

486
static int __apic_accept_irq(struct kvm_lapic *apic, int delivery_mode,
487
			     int vector, int level, int trig_mode,
488
			     struct dest_map *dest_map);
489

490
int kvm_apic_set_irq(struct kvm_vcpu *vcpu, struct kvm_lapic_irq *irq,
491
		     struct dest_map *dest_map)
E
Eddie Dong 已提交
492
{
493
	struct kvm_lapic *apic = vcpu->arch.apic;
494

495
	return __apic_accept_irq(apic, irq->delivery_mode, irq->vector,
496
			irq->level, irq->trig_mode, dest_map);
E
Eddie Dong 已提交
497 498
}

499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522
static int pv_eoi_put_user(struct kvm_vcpu *vcpu, u8 val)
{

	return kvm_write_guest_cached(vcpu->kvm, &vcpu->arch.pv_eoi.data, &val,
				      sizeof(val));
}

static int pv_eoi_get_user(struct kvm_vcpu *vcpu, u8 *val)
{

	return kvm_read_guest_cached(vcpu->kvm, &vcpu->arch.pv_eoi.data, val,
				      sizeof(*val));
}

static inline bool pv_eoi_enabled(struct kvm_vcpu *vcpu)
{
	return vcpu->arch.pv_eoi.msr_val & KVM_MSR_ENABLED;
}

static bool pv_eoi_get_pending(struct kvm_vcpu *vcpu)
{
	u8 val;
	if (pv_eoi_get_user(vcpu, &val) < 0)
		apic_debug("Can't read EOI MSR value: 0x%llx\n",
523
			   (unsigned long long)vcpu->arch.pv_eoi.msr_val);
524 525 526 527 528 529 530
	return val & 0x1;
}

static void pv_eoi_set_pending(struct kvm_vcpu *vcpu)
{
	if (pv_eoi_put_user(vcpu, KVM_PV_EOI_ENABLED) < 0) {
		apic_debug("Can't set EOI MSR value: 0x%llx\n",
531
			   (unsigned long long)vcpu->arch.pv_eoi.msr_val);
532 533 534 535 536 537 538 539 540
		return;
	}
	__set_bit(KVM_APIC_PV_EOI_PENDING, &vcpu->arch.apic_attention);
}

static void pv_eoi_clr_pending(struct kvm_vcpu *vcpu)
{
	if (pv_eoi_put_user(vcpu, KVM_PV_EOI_DISABLED) < 0) {
		apic_debug("Can't clear EOI MSR value: 0x%llx\n",
541
			   (unsigned long long)vcpu->arch.pv_eoi.msr_val);
542 543 544 545 546
		return;
	}
	__clear_bit(KVM_APIC_PV_EOI_PENDING, &vcpu->arch.apic_attention);
}

E
Eddie Dong 已提交
547 548
static void apic_update_ppr(struct kvm_lapic *apic)
{
549
	u32 tpr, isrv, ppr, old_ppr;
E
Eddie Dong 已提交
550 551
	int isr;

552 553
	old_ppr = kvm_lapic_get_reg(apic, APIC_PROCPRI);
	tpr = kvm_lapic_get_reg(apic, APIC_TASKPRI);
E
Eddie Dong 已提交
554 555 556 557 558 559 560 561 562 563 564
	isr = apic_find_highest_isr(apic);
	isrv = (isr != -1) ? isr : 0;

	if ((tpr & 0xf0) >= (isrv & 0xf0))
		ppr = tpr & 0xff;
	else
		ppr = isrv & 0xf0;

	apic_debug("vlapic %p, ppr 0x%x, isr 0x%x, isrv 0x%x",
		   apic, ppr, isr, isrv);

565
	if (old_ppr != ppr) {
566
		kvm_lapic_set_reg(apic, APIC_PROCPRI, ppr);
567 568
		if (ppr < old_ppr)
			kvm_make_request(KVM_REQ_EVENT, apic->vcpu);
569
	}
E
Eddie Dong 已提交
570 571 572 573
}

static void apic_set_tpr(struct kvm_lapic *apic, u32 tpr)
{
574
	kvm_lapic_set_reg(apic, APIC_TASKPRI, tpr);
E
Eddie Dong 已提交
575 576 577
	apic_update_ppr(apic);
}

578
static bool kvm_apic_broadcast(struct kvm_lapic *apic, u32 mda)
579
{
580 581 582 583
	if (apic_x2apic_mode(apic))
		return mda == X2APIC_BROADCAST;

	return GET_APIC_DEST_FIELD(mda) == APIC_BROADCAST;
584 585
}

586
static bool kvm_apic_match_physical_addr(struct kvm_lapic *apic, u32 mda)
E
Eddie Dong 已提交
587
{
588 589 590 591 592 593 594
	if (kvm_apic_broadcast(apic, mda))
		return true;

	if (apic_x2apic_mode(apic))
		return mda == kvm_apic_id(apic);

	return mda == SET_APIC_DEST_FIELD(kvm_apic_id(apic));
E
Eddie Dong 已提交
595 596
}

597
static bool kvm_apic_match_logical_addr(struct kvm_lapic *apic, u32 mda)
E
Eddie Dong 已提交
598
{
G
Gleb Natapov 已提交
599 600
	u32 logical_id;

601
	if (kvm_apic_broadcast(apic, mda))
602
		return true;
603

604
	logical_id = kvm_lapic_get_reg(apic, APIC_LDR);
E
Eddie Dong 已提交
605

606
	if (apic_x2apic_mode(apic))
607 608
		return ((logical_id >> 16) == (mda >> 16))
		       && (logical_id & mda & 0xffff) != 0;
E
Eddie Dong 已提交
609

610
	logical_id = GET_APIC_LOGICAL_ID(logical_id);
611
	mda = GET_APIC_DEST_FIELD(mda);
E
Eddie Dong 已提交
612

613
	switch (kvm_lapic_get_reg(apic, APIC_DFR)) {
E
Eddie Dong 已提交
614
	case APIC_DFR_FLAT:
615
		return (logical_id & mda) != 0;
E
Eddie Dong 已提交
616
	case APIC_DFR_CLUSTER:
617 618
		return ((logical_id >> 4) == (mda >> 4))
		       && (logical_id & mda & 0xf) != 0;
E
Eddie Dong 已提交
619
	default:
620
		apic_debug("Bad DFR vcpu %d: %08x\n",
621
			   apic->vcpu->vcpu_id, kvm_lapic_get_reg(apic, APIC_DFR));
622
		return false;
E
Eddie Dong 已提交
623 624 625
	}
}

626 627 628 629 630 631 632 633 634 635 636 637 638 639 640
/* The KVM local APIC implementation has two quirks:
 *
 *  - the xAPIC MDA stores the destination at bits 24-31, while this
 *    is not true of struct kvm_lapic_irq's dest_id field.  This is
 *    just a quirk in the API and is not problematic.
 *
 *  - in-kernel IOAPIC messages have to be delivered directly to
 *    x2APIC, because the kernel does not support interrupt remapping.
 *    In order to support broadcast without interrupt remapping, x2APIC
 *    rewrites the destination of non-IPI messages from APIC_BROADCAST
 *    to X2APIC_BROADCAST.
 *
 * The broadcast quirk can be disabled with KVM_CAP_X2APIC_API.  This is
 * important when userspace wants to use x2APIC-format MSIs, because
 * APIC_BROADCAST (0xff) is a legal route for "cluster 0, CPUs 0-7".
641
 */
642 643
static u32 kvm_apic_mda(struct kvm_vcpu *vcpu, unsigned int dest_id,
		struct kvm_lapic *source, struct kvm_lapic *target)
644 645 646 647
{
	bool ipi = source != NULL;
	bool x2apic_mda = apic_x2apic_mode(ipi ? source : target);

648 649
	if (!vcpu->kvm->arch.x2apic_broadcast_quirk_disabled &&
	    !ipi && dest_id == APIC_BROADCAST && x2apic_mda)
650 651 652 653 654
		return X2APIC_BROADCAST;

	return x2apic_mda ? dest_id : SET_APIC_DEST_FIELD(dest_id);
}

655
bool kvm_apic_match_dest(struct kvm_vcpu *vcpu, struct kvm_lapic *source,
656
			   int short_hand, unsigned int dest, int dest_mode)
E
Eddie Dong 已提交
657
{
658
	struct kvm_lapic *target = vcpu->arch.apic;
659
	u32 mda = kvm_apic_mda(vcpu, dest, source, target);
E
Eddie Dong 已提交
660 661

	apic_debug("target %p, source %p, dest 0x%x, "
662
		   "dest_mode 0x%x, short_hand 0x%x\n",
E
Eddie Dong 已提交
663 664
		   target, source, dest, dest_mode, short_hand);

Z
Zachary Amsden 已提交
665
	ASSERT(target);
E
Eddie Dong 已提交
666 667
	switch (short_hand) {
	case APIC_DEST_NOSHORT:
668
		if (dest_mode == APIC_DEST_PHYSICAL)
669
			return kvm_apic_match_physical_addr(target, mda);
670
		else
671
			return kvm_apic_match_logical_addr(target, mda);
E
Eddie Dong 已提交
672
	case APIC_DEST_SELF:
673
		return target == source;
E
Eddie Dong 已提交
674
	case APIC_DEST_ALLINC:
675
		return true;
E
Eddie Dong 已提交
676
	case APIC_DEST_ALLBUT:
677
		return target != source;
E
Eddie Dong 已提交
678
	default:
679 680
		apic_debug("kvm: apic: Bad dest shorthand value %x\n",
			   short_hand);
681
		return false;
E
Eddie Dong 已提交
682 683
	}
}
684
EXPORT_SYMBOL_GPL(kvm_apic_match_dest);
E
Eddie Dong 已提交
685

686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701
int kvm_vector_to_index(u32 vector, u32 dest_vcpus,
		       const unsigned long *bitmap, u32 bitmap_size)
{
	u32 mod;
	int i, idx = -1;

	mod = vector % dest_vcpus;

	for (i = 0; i <= mod; i++) {
		idx = find_next_bit(bitmap, bitmap_size, idx + 1);
		BUG_ON(idx == bitmap_size);
	}

	return idx;
}

702 703 704 705 706 707 708 709 710
static void kvm_apic_disabled_lapic_found(struct kvm *kvm)
{
	if (!kvm->arch.disabled_lapic_found) {
		kvm->arch.disabled_lapic_found = true;
		printk(KERN_INFO
		       "Disabled LAPIC found during irq injection\n");
	}
}

711 712
static bool kvm_apic_is_broadcast_dest(struct kvm *kvm, struct kvm_lapic **src,
		struct kvm_lapic_irq *irq, struct kvm_apic_map *map)
713
{
714 715 716 717 718 719 720 721 722 723 724 725
	if (kvm->arch.x2apic_broadcast_quirk_disabled) {
		if ((irq->dest_id == APIC_BROADCAST &&
				map->mode != KVM_APIC_MODE_X2APIC))
			return true;
		if (irq->dest_id == X2APIC_BROADCAST)
			return true;
	} else {
		bool x2apic_ipi = src && *src && apic_x2apic_mode(*src);
		if (irq->dest_id == (x2apic_ipi ?
		                     X2APIC_BROADCAST : APIC_BROADCAST))
			return true;
	}
726

727 728
	return false;
}
729

730 731 732 733 734 735 736 737 738 739 740 741 742
/* Return true if the interrupt can be handled by using *bitmap as index mask
 * for valid destinations in *dst array.
 * Return false if kvm_apic_map_get_dest_lapic did nothing useful.
 * Note: we may have zero kvm_lapic destinations when we return true, which
 * means that the interrupt should be dropped.  In this case, *bitmap would be
 * zero and *dst undefined.
 */
static inline bool kvm_apic_map_get_dest_lapic(struct kvm *kvm,
		struct kvm_lapic **src, struct kvm_lapic_irq *irq,
		struct kvm_apic_map *map, struct kvm_lapic ***dst,
		unsigned long *bitmap)
{
	int i, lowest;
743

744 745 746 747 748
	if (irq->shorthand == APIC_DEST_SELF && src) {
		*dst = src;
		*bitmap = 1;
		return true;
	} else if (irq->shorthand)
749 750
		return false;

751
	if (!map || kvm_apic_is_broadcast_dest(kvm, src, irq, map))
752 753
		return false;

754
	if (irq->dest_mode == APIC_DEST_PHYSICAL) {
R
Radim Krčmář 已提交
755
		if (irq->dest_id > map->max_apic_id) {
756 757 758 759 760
			*bitmap = 0;
		} else {
			*dst = &map->phys_map[irq->dest_id];
			*bitmap = 1;
		}
761
		return true;
762
	}
763

764 765 766
	*bitmap = 0;
	if (!kvm_apic_map_get_logical_dest(map, irq->dest_id, dst,
				(u16 *)bitmap))
767
		return false;
768

769 770
	if (!kvm_lowest_prio_delivery(irq))
		return true;
771

772 773 774 775 776 777 778 779 780 781
	if (!kvm_vector_hashing_enabled()) {
		lowest = -1;
		for_each_set_bit(i, bitmap, 16) {
			if (!(*dst)[i])
				continue;
			if (lowest < 0)
				lowest = i;
			else if (kvm_apic_compare_prio((*dst)[i]->vcpu,
						(*dst)[lowest]->vcpu) < 0)
				lowest = i;
782
		}
783 784 785
	} else {
		if (!*bitmap)
			return true;
786

787 788
		lowest = kvm_vector_to_index(irq->vector, hweight16(*bitmap),
				bitmap, 16);
789

790 791 792 793 794 795
		if (!(*dst)[lowest]) {
			kvm_apic_disabled_lapic_found(kvm);
			*bitmap = 0;
			return true;
		}
	}
796

797
	*bitmap = (lowest >= 0) ? 1 << lowest : 0;
798

799 800
	return true;
}
801

802 803 804 805 806 807 808 809
bool kvm_irq_delivery_to_apic_fast(struct kvm *kvm, struct kvm_lapic *src,
		struct kvm_lapic_irq *irq, int *r, struct dest_map *dest_map)
{
	struct kvm_apic_map *map;
	unsigned long bitmap;
	struct kvm_lapic **dst = NULL;
	int i;
	bool ret;
810

811
	*r = -1;
812

813 814 815 816
	if (irq->shorthand == APIC_DEST_SELF) {
		*r = kvm_apic_set_irq(src->vcpu, irq, dest_map);
		return true;
	}
817

818 819
	rcu_read_lock();
	map = rcu_dereference(kvm->arch.apic_map);
820

821 822 823 824 825 826 827 828
	ret = kvm_apic_map_get_dest_lapic(kvm, &src, irq, map, &dst, &bitmap);
	if (ret)
		for_each_set_bit(i, &bitmap, 16) {
			if (!dst[i])
				continue;
			if (*r < 0)
				*r = 0;
			*r += kvm_apic_set_irq(dst[i]->vcpu, irq, dest_map);
829 830 831 832 833 834
		}

	rcu_read_unlock();
	return ret;
}

835 836 837 838 839 840 841 842 843 844 845 846 847 848
/*
 * This routine tries to handler interrupts in posted mode, here is how
 * it deals with different cases:
 * - For single-destination interrupts, handle it in posted mode
 * - Else if vector hashing is enabled and it is a lowest-priority
 *   interrupt, handle it in posted mode and use the following mechanism
 *   to find the destinaiton vCPU.
 *	1. For lowest-priority interrupts, store all the possible
 *	   destination vCPUs in an array.
 *	2. Use "guest vector % max number of destination vCPUs" to find
 *	   the right destination vCPU in the array for the lowest-priority
 *	   interrupt.
 * - Otherwise, use remapped mode to inject the interrupt.
 */
849 850 851 852
bool kvm_intr_is_single_vcpu_fast(struct kvm *kvm, struct kvm_lapic_irq *irq,
			struct kvm_vcpu **dest_vcpu)
{
	struct kvm_apic_map *map;
853 854
	unsigned long bitmap;
	struct kvm_lapic **dst = NULL;
855 856 857 858 859 860 861 862
	bool ret = false;

	if (irq->shorthand)
		return false;

	rcu_read_lock();
	map = rcu_dereference(kvm->arch.apic_map);

863 864 865
	if (kvm_apic_map_get_dest_lapic(kvm, NULL, irq, map, &dst, &bitmap) &&
			hweight16(bitmap) == 1) {
		unsigned long i = find_first_bit(&bitmap, 16);
866

867 868 869
		if (dst[i]) {
			*dest_vcpu = dst[i]->vcpu;
			ret = true;
870
		}
871 872 873 874 875 876
	}

	rcu_read_unlock();
	return ret;
}

E
Eddie Dong 已提交
877 878 879 880 881
/*
 * Add a pending IRQ into lapic.
 * Return 1 if successfully added and 0 if discarded.
 */
static int __apic_accept_irq(struct kvm_lapic *apic, int delivery_mode,
882
			     int vector, int level, int trig_mode,
883
			     struct dest_map *dest_map)
E
Eddie Dong 已提交
884
{
885
	int result = 0;
886
	struct kvm_vcpu *vcpu = apic->vcpu;
E
Eddie Dong 已提交
887

888 889
	trace_kvm_apic_accept_irq(vcpu->vcpu_id, delivery_mode,
				  trig_mode, vector);
E
Eddie Dong 已提交
890 891
	switch (delivery_mode) {
	case APIC_DM_LOWEST:
892 893
		vcpu->arch.apic_arb_prio++;
	case APIC_DM_FIXED:
894 895 896
		if (unlikely(trig_mode && !level))
			break;

E
Eddie Dong 已提交
897 898 899 900
		/* FIXME add logic for vcpu on reset */
		if (unlikely(!apic_enabled(apic)))
			break;

901 902
		result = 1;

903
		if (dest_map) {
904
			__set_bit(vcpu->vcpu_id, dest_map->map);
905 906
			dest_map->vectors[vcpu->vcpu_id] = vector;
		}
907

908 909
		if (apic_test_vector(vector, apic->regs + APIC_TMR) != !!trig_mode) {
			if (trig_mode)
910
				kvm_lapic_set_vector(vector, apic->regs + APIC_TMR);
911 912 913 914
			else
				apic_clear_vector(vector, apic->regs + APIC_TMR);
		}

915
		if (vcpu->arch.apicv_active)
916
			kvm_x86_ops->deliver_posted_interrupt(vcpu, vector);
917
		else {
918
			kvm_lapic_set_irr(vector, apic);
919 920 921 922

			kvm_make_request(KVM_REQ_EVENT, vcpu);
			kvm_vcpu_kick(vcpu);
		}
E
Eddie Dong 已提交
923 924 925
		break;

	case APIC_DM_REMRD:
926 927 928 929
		result = 1;
		vcpu->arch.pv.pv_unhalted = 1;
		kvm_make_request(KVM_REQ_EVENT, vcpu);
		kvm_vcpu_kick(vcpu);
E
Eddie Dong 已提交
930 931 932
		break;

	case APIC_DM_SMI:
P
Paolo Bonzini 已提交
933 934 935
		result = 1;
		kvm_make_request(KVM_REQ_SMI, vcpu);
		kvm_vcpu_kick(vcpu);
E
Eddie Dong 已提交
936
		break;
937

E
Eddie Dong 已提交
938
	case APIC_DM_NMI:
939
		result = 1;
940
		kvm_inject_nmi(vcpu);
J
Jan Kiszka 已提交
941
		kvm_vcpu_kick(vcpu);
E
Eddie Dong 已提交
942 943 944
		break;

	case APIC_DM_INIT:
945
		if (!trig_mode || level) {
946
			result = 1;
947 948 949 950 951
			/* assumes that there are only KVM_APIC_INIT/SIPI */
			apic->pending_events = (1UL << KVM_APIC_INIT);
			/* make sure pending_events is visible before sending
			 * the request */
			smp_wmb();
952
			kvm_make_request(KVM_REQ_EVENT, vcpu);
953 954
			kvm_vcpu_kick(vcpu);
		} else {
955 956
			apic_debug("Ignoring de-assert INIT to vcpu %d\n",
				   vcpu->vcpu_id);
957
		}
E
Eddie Dong 已提交
958 959 960
		break;

	case APIC_DM_STARTUP:
961 962
		apic_debug("SIPI to vcpu %d vector 0x%02x\n",
			   vcpu->vcpu_id, vector);
963 964 965 966 967 968 969
		result = 1;
		apic->sipi_vector = vector;
		/* make sure sipi_vector is visible for the receiver */
		smp_wmb();
		set_bit(KVM_APIC_SIPI, &apic->pending_events);
		kvm_make_request(KVM_REQ_EVENT, vcpu);
		kvm_vcpu_kick(vcpu);
E
Eddie Dong 已提交
970 971
		break;

972 973 974 975 976 977 978 979
	case APIC_DM_EXTINT:
		/*
		 * Should only be called by kvm_apic_local_deliver() with LVT0,
		 * before NMI watchdog was enabled. Already handled by
		 * kvm_apic_accept_pic_intr().
		 */
		break;

E
Eddie Dong 已提交
980 981 982 983 984 985 986 987
	default:
		printk(KERN_ERR "TODO: unsupported delivery mode %x\n",
		       delivery_mode);
		break;
	}
	return result;
}

988
int kvm_apic_compare_prio(struct kvm_vcpu *vcpu1, struct kvm_vcpu *vcpu2)
989
{
990
	return vcpu1->arch.apic_arb_prio - vcpu2->arch.apic_arb_prio;
991 992
}

993 994
static bool kvm_ioapic_handles_vector(struct kvm_lapic *apic, int vector)
{
995
	return test_bit(vector, apic->vcpu->arch.ioapic_handled_vectors);
996 997
}

998 999
static void kvm_ioapic_send_eoi(struct kvm_lapic *apic, int vector)
{
1000 1001 1002 1003 1004
	int trigger_mode;

	/* Eoi the ioapic only if the ioapic doesn't own the vector. */
	if (!kvm_ioapic_handles_vector(apic, vector))
		return;
1005

1006 1007 1008 1009 1010
	/* Request a KVM exit to inform the userspace IOAPIC. */
	if (irqchip_split(apic->vcpu->kvm)) {
		apic->vcpu->arch.pending_ioapic_eoi = vector;
		kvm_make_request(KVM_REQ_IOAPIC_EOI_EXIT, apic->vcpu);
		return;
1011
	}
1012 1013 1014 1015 1016 1017 1018

	if (apic_test_vector(vector, apic->regs + APIC_TMR))
		trigger_mode = IOAPIC_LEVEL_TRIG;
	else
		trigger_mode = IOAPIC_EDGE_TRIG;

	kvm_ioapic_update_eoi(apic->vcpu, vector, trigger_mode);
1019 1020
}

1021
static int apic_set_eoi(struct kvm_lapic *apic)
E
Eddie Dong 已提交
1022 1023
{
	int vector = apic_find_highest_isr(apic);
1024 1025 1026

	trace_kvm_eoi(apic, vector);

E
Eddie Dong 已提交
1027 1028 1029 1030 1031
	/*
	 * Not every write EOI will has corresponding ISR,
	 * one example is when Kernel check timer on setup_IO_APIC
	 */
	if (vector == -1)
1032
		return vector;
E
Eddie Dong 已提交
1033

M
Michael S. Tsirkin 已提交
1034
	apic_clear_isr(vector, apic);
E
Eddie Dong 已提交
1035 1036
	apic_update_ppr(apic);

1037 1038 1039
	if (test_bit(vector, vcpu_to_synic(apic->vcpu)->vec_bitmap))
		kvm_hv_synic_send_eoi(apic->vcpu, vector);

1040
	kvm_ioapic_send_eoi(apic, vector);
1041
	kvm_make_request(KVM_REQ_EVENT, apic->vcpu);
1042
	return vector;
E
Eddie Dong 已提交
1043 1044
}

1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057 1058 1059
/*
 * this interface assumes a trap-like exit, which has already finished
 * desired side effect including vISR and vPPR update.
 */
void kvm_apic_set_eoi_accelerated(struct kvm_vcpu *vcpu, int vector)
{
	struct kvm_lapic *apic = vcpu->arch.apic;

	trace_kvm_eoi(apic, vector);

	kvm_ioapic_send_eoi(apic, vector);
	kvm_make_request(KVM_REQ_EVENT, apic->vcpu);
}
EXPORT_SYMBOL_GPL(kvm_apic_set_eoi_accelerated);

E
Eddie Dong 已提交
1060 1061
static void apic_send_ipi(struct kvm_lapic *apic)
{
1062 1063
	u32 icr_low = kvm_lapic_get_reg(apic, APIC_ICR);
	u32 icr_high = kvm_lapic_get_reg(apic, APIC_ICR2);
1064
	struct kvm_lapic_irq irq;
E
Eddie Dong 已提交
1065

1066 1067 1068
	irq.vector = icr_low & APIC_VECTOR_MASK;
	irq.delivery_mode = icr_low & APIC_MODE_MASK;
	irq.dest_mode = icr_low & APIC_DEST_MASK;
1069
	irq.level = (icr_low & APIC_INT_ASSERT) != 0;
1070 1071
	irq.trig_mode = icr_low & APIC_INT_LEVELTRIG;
	irq.shorthand = icr_low & APIC_SHORT_MASK;
1072
	irq.msi_redir_hint = false;
G
Gleb Natapov 已提交
1073 1074 1075 1076
	if (apic_x2apic_mode(apic))
		irq.dest_id = icr_high;
	else
		irq.dest_id = GET_APIC_DEST_FIELD(icr_high);
E
Eddie Dong 已提交
1077

1078 1079
	trace_kvm_apic_ipi(icr_low, irq.dest_id);

E
Eddie Dong 已提交
1080 1081
	apic_debug("icr_high 0x%x, icr_low 0x%x, "
		   "short_hand 0x%x, dest 0x%x, trig_mode 0x%x, level 0x%x, "
1082 1083
		   "dest_mode 0x%x, delivery_mode 0x%x, vector 0x%x, "
		   "msi_redir_hint 0x%x\n",
G
Glauber Costa 已提交
1084
		   icr_high, icr_low, irq.shorthand, irq.dest_id,
1085
		   irq.trig_mode, irq.level, irq.dest_mode, irq.delivery_mode,
1086
		   irq.vector, irq.msi_redir_hint);
1087

1088
	kvm_irq_delivery_to_apic(apic->vcpu->kvm, apic, &irq, NULL);
E
Eddie Dong 已提交
1089 1090 1091 1092
}

static u32 apic_get_tmcct(struct kvm_lapic *apic)
{
1093 1094
	ktime_t remaining;
	s64 ns;
1095
	u32 tmcct;
E
Eddie Dong 已提交
1096 1097 1098

	ASSERT(apic != NULL);

1099
	/* if initial count is 0, current count should also be 0 */
1100
	if (kvm_lapic_get_reg(apic, APIC_TMICT) == 0 ||
1101
		apic->lapic_timer.period == 0)
1102 1103
		return 0;

1104
	remaining = hrtimer_get_remaining(&apic->lapic_timer.timer);
1105 1106 1107
	if (ktime_to_ns(remaining) < 0)
		remaining = ktime_set(0, 0);

1108 1109 1110
	ns = mod_64(ktime_to_ns(remaining), apic->lapic_timer.period);
	tmcct = div64_u64(ns,
			 (APIC_BUS_CYCLE_NS * apic->divide_count));
E
Eddie Dong 已提交
1111 1112 1113 1114

	return tmcct;
}

1115 1116 1117 1118 1119
static void __report_tpr_access(struct kvm_lapic *apic, bool write)
{
	struct kvm_vcpu *vcpu = apic->vcpu;
	struct kvm_run *run = vcpu->run;

1120
	kvm_make_request(KVM_REQ_REPORT_TPR_ACCESS, vcpu);
1121
	run->tpr_access.rip = kvm_rip_read(vcpu);
1122 1123 1124 1125 1126 1127 1128 1129 1130
	run->tpr_access.is_write = write;
}

static inline void report_tpr_access(struct kvm_lapic *apic, bool write)
{
	if (apic->vcpu->arch.tpr_access_reporting)
		__report_tpr_access(apic, write);
}

E
Eddie Dong 已提交
1131 1132 1133 1134 1135 1136 1137 1138 1139
static u32 __apic_read(struct kvm_lapic *apic, unsigned int offset)
{
	u32 val = 0;

	if (offset >= LAPIC_MMIO_LENGTH)
		return 0;

	switch (offset) {
	case APIC_ARBPRI:
1140
		apic_debug("Access APIC ARBPRI register which is for P6\n");
E
Eddie Dong 已提交
1141 1142 1143
		break;

	case APIC_TMCCT:	/* Timer CCR */
1144 1145 1146
		if (apic_lvtt_tscdeadline(apic))
			return 0;

E
Eddie Dong 已提交
1147 1148
		val = apic_get_tmcct(apic);
		break;
1149 1150
	case APIC_PROCPRI:
		apic_update_ppr(apic);
1151
		val = kvm_lapic_get_reg(apic, offset);
1152
		break;
1153 1154 1155
	case APIC_TASKPRI:
		report_tpr_access(apic, false);
		/* fall thru */
E
Eddie Dong 已提交
1156
	default:
1157
		val = kvm_lapic_get_reg(apic, offset);
E
Eddie Dong 已提交
1158 1159 1160 1161 1162 1163
		break;
	}

	return val;
}

G
Gregory Haskins 已提交
1164 1165 1166 1167 1168
static inline struct kvm_lapic *to_lapic(struct kvm_io_device *dev)
{
	return container_of(dev, struct kvm_lapic, dev);
}

1169
int kvm_lapic_reg_read(struct kvm_lapic *apic, u32 offset, int len,
G
Gleb Natapov 已提交
1170
		void *data)
E
Eddie Dong 已提交
1171 1172 1173
{
	unsigned char alignment = offset & 0xf;
	u32 result;
G
Guo Chao 已提交
1174
	/* this bitmask has a bit cleared for each reserved register */
G
Gleb Natapov 已提交
1175
	static const u64 rmask = 0x43ff01ffffffe70cULL;
E
Eddie Dong 已提交
1176 1177

	if ((alignment + len) > 4) {
1178 1179
		apic_debug("KVM_APIC_READ: alignment error %x %d\n",
			   offset, len);
G
Gleb Natapov 已提交
1180
		return 1;
E
Eddie Dong 已提交
1181
	}
G
Gleb Natapov 已提交
1182 1183

	if (offset > 0x3f0 || !(rmask & (1ULL << (offset >> 4)))) {
1184 1185
		apic_debug("KVM_APIC_READ: read reserved register %x\n",
			   offset);
G
Gleb Natapov 已提交
1186 1187 1188
		return 1;
	}

E
Eddie Dong 已提交
1189 1190
	result = __apic_read(apic, offset & ~0xf);

1191 1192
	trace_kvm_apic_read(offset, result);

E
Eddie Dong 已提交
1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203
	switch (len) {
	case 1:
	case 2:
	case 4:
		memcpy(data, (char *)&result + alignment, len);
		break;
	default:
		printk(KERN_ERR "Local APIC read with len = %x, "
		       "should be 1,2, or 4 instead\n", len);
		break;
	}
1204
	return 0;
E
Eddie Dong 已提交
1205
}
1206
EXPORT_SYMBOL_GPL(kvm_lapic_reg_read);
E
Eddie Dong 已提交
1207

G
Gleb Natapov 已提交
1208 1209
static int apic_mmio_in_range(struct kvm_lapic *apic, gpa_t addr)
{
1210
	return kvm_apic_hw_enabled(apic) &&
G
Gleb Natapov 已提交
1211 1212 1213 1214
	    addr >= apic->base_address &&
	    addr < apic->base_address + LAPIC_MMIO_LENGTH;
}

1215
static int apic_mmio_read(struct kvm_vcpu *vcpu, struct kvm_io_device *this,
G
Gleb Natapov 已提交
1216 1217 1218 1219 1220 1221 1222 1223
			   gpa_t address, int len, void *data)
{
	struct kvm_lapic *apic = to_lapic(this);
	u32 offset = address - apic->base_address;

	if (!apic_mmio_in_range(apic, address))
		return -EOPNOTSUPP;

1224
	kvm_lapic_reg_read(apic, offset, len, data);
G
Gleb Natapov 已提交
1225 1226 1227 1228

	return 0;
}

E
Eddie Dong 已提交
1229 1230 1231 1232
static void update_divide_count(struct kvm_lapic *apic)
{
	u32 tmp1, tmp2, tdcr;

1233
	tdcr = kvm_lapic_get_reg(apic, APIC_TDCR);
E
Eddie Dong 已提交
1234 1235
	tmp1 = tdcr & 0xf;
	tmp2 = ((tmp1 & 0x3) | ((tmp1 & 0x8) >> 1)) + 1;
1236
	apic->divide_count = 0x1 << (tmp2 & 0x7);
E
Eddie Dong 已提交
1237 1238

	apic_debug("timer divide count is 0x%x\n",
G
Glauber Costa 已提交
1239
				   apic->divide_count);
E
Eddie Dong 已提交
1240 1241
}

1242 1243
static void apic_update_lvtt(struct kvm_lapic *apic)
{
1244
	u32 timer_mode = kvm_lapic_get_reg(apic, APIC_LVTT) &
1245 1246 1247 1248 1249 1250 1251 1252
			apic->lapic_timer.timer_mode_mask;

	if (apic->lapic_timer.timer_mode != timer_mode) {
		apic->lapic_timer.timer_mode = timer_mode;
		hrtimer_cancel(&apic->lapic_timer.timer);
	}
}

1253 1254 1255
static void apic_timer_expired(struct kvm_lapic *apic)
{
	struct kvm_vcpu *vcpu = apic->vcpu;
1256
	struct swait_queue_head *q = &vcpu->wq;
1257
	struct kvm_timer *ktimer = &apic->lapic_timer;
1258 1259 1260 1261 1262

	if (atomic_read(&apic->lapic_timer.pending))
		return;

	atomic_inc(&apic->lapic_timer.pending);
1263
	kvm_set_pending_timer(vcpu);
1264

1265 1266
	if (swait_active(q))
		swake_up(q);
1267 1268 1269 1270 1271 1272 1273 1274 1275 1276 1277 1278 1279

	if (apic_lvtt_tscdeadline(apic))
		ktimer->expired_tscdeadline = ktimer->tscdeadline;
}

/*
 * On APICv, this test will cause a busy wait
 * during a higher-priority task.
 */

static bool lapic_timer_int_injected(struct kvm_vcpu *vcpu)
{
	struct kvm_lapic *apic = vcpu->arch.apic;
1280
	u32 reg = kvm_lapic_get_reg(apic, APIC_LVTT);
1281 1282 1283

	if (kvm_apic_hw_enabled(apic)) {
		int vec = reg & APIC_VECTOR_MASK;
1284
		void *bitmap = apic->regs + APIC_ISR;
1285

1286
		if (vcpu->arch.apicv_active)
1287 1288 1289 1290
			bitmap = apic->regs + APIC_IRR;

		if (apic_test_vector(vec, bitmap))
			return true;
1291 1292 1293 1294 1295 1296 1297 1298 1299
	}
	return false;
}

void wait_lapic_expire(struct kvm_vcpu *vcpu)
{
	struct kvm_lapic *apic = vcpu->arch.apic;
	u64 guest_tsc, tsc_deadline;

1300
	if (!lapic_in_kernel(vcpu))
1301 1302 1303 1304 1305 1306 1307 1308 1309 1310
		return;

	if (apic->lapic_timer.expired_tscdeadline == 0)
		return;

	if (!lapic_timer_int_injected(vcpu))
		return;

	tsc_deadline = apic->lapic_timer.expired_tscdeadline;
	apic->lapic_timer.expired_tscdeadline = 0;
1311
	guest_tsc = kvm_read_l1_tsc(vcpu, rdtsc());
1312
	trace_kvm_wait_lapic_expire(vcpu->vcpu_id, guest_tsc - tsc_deadline);
1313 1314 1315

	/* __delay is delay_tsc whenever the hardware has TSC, thus always.  */
	if (guest_tsc < tsc_deadline)
1316 1317
		__delay(min(tsc_deadline - guest_tsc,
			nsec_to_cycles(vcpu, lapic_timer_advance_ns)));
1318 1319
}

1320 1321 1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349
static void start_sw_tscdeadline(struct kvm_lapic *apic)
{
	u64 guest_tsc, tscdeadline = apic->lapic_timer.tscdeadline;
	u64 ns = 0;
	ktime_t expire;
	struct kvm_vcpu *vcpu = apic->vcpu;
	unsigned long this_tsc_khz = vcpu->arch.virtual_tsc_khz;
	unsigned long flags;
	ktime_t now;

	if (unlikely(!tscdeadline || !this_tsc_khz))
		return;

	local_irq_save(flags);

	now = apic->lapic_timer.timer.base->get_time();
	guest_tsc = kvm_read_l1_tsc(vcpu, rdtsc());
	if (likely(tscdeadline > guest_tsc)) {
		ns = (tscdeadline - guest_tsc) * 1000000ULL;
		do_div(ns, this_tsc_khz);
		expire = ktime_add_ns(now, ns);
		expire = ktime_sub_ns(expire, lapic_timer_advance_ns);
		hrtimer_start(&apic->lapic_timer.timer,
				expire, HRTIMER_MODE_ABS_PINNED);
	} else
		apic_timer_expired(apic);

	local_irq_restore(flags);
}

1350 1351
bool kvm_lapic_hv_timer_in_use(struct kvm_vcpu *vcpu)
{
1352 1353 1354
	if (!lapic_in_kernel(vcpu))
		return false;

1355 1356 1357 1358
	return vcpu->arch.apic->lapic_timer.hv_timer_in_use;
}
EXPORT_SYMBOL_GPL(kvm_lapic_hv_timer_in_use);

1359 1360 1361 1362 1363 1364
static void cancel_hv_tscdeadline(struct kvm_lapic *apic)
{
	kvm_x86_ops->cancel_hv_timer(apic->vcpu);
	apic->lapic_timer.hv_timer_in_use = false;
}

1365 1366 1367 1368 1369 1370
void kvm_lapic_expired_hv_timer(struct kvm_vcpu *vcpu)
{
	struct kvm_lapic *apic = vcpu->arch.apic;

	WARN_ON(!apic->lapic_timer.hv_timer_in_use);
	WARN_ON(swait_active(&vcpu->wq));
1371
	cancel_hv_tscdeadline(apic);
1372 1373 1374 1375
	apic_timer_expired(apic);
}
EXPORT_SYMBOL_GPL(kvm_lapic_expired_hv_timer);

1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386 1387 1388 1389 1390 1391 1392 1393 1394 1395 1396
static bool start_hv_tscdeadline(struct kvm_lapic *apic)
{
	u64 tscdeadline = apic->lapic_timer.tscdeadline;

	if (atomic_read(&apic->lapic_timer.pending) ||
		kvm_x86_ops->set_hv_timer(apic->vcpu, tscdeadline)) {
		if (apic->lapic_timer.hv_timer_in_use)
			cancel_hv_tscdeadline(apic);
	} else {
		apic->lapic_timer.hv_timer_in_use = true;
		hrtimer_cancel(&apic->lapic_timer.timer);

		/* In case the sw timer triggered in the window */
		if (atomic_read(&apic->lapic_timer.pending))
			cancel_hv_tscdeadline(apic);
	}
	trace_kvm_hv_timer_state(apic->vcpu->vcpu_id,
			apic->lapic_timer.hv_timer_in_use);
	return apic->lapic_timer.hv_timer_in_use;
}

1397 1398 1399 1400 1401 1402
void kvm_lapic_switch_to_hv_timer(struct kvm_vcpu *vcpu)
{
	struct kvm_lapic *apic = vcpu->arch.apic;

	WARN_ON(apic->lapic_timer.hv_timer_in_use);

1403 1404
	if (apic_lvtt_tscdeadline(apic))
		start_hv_tscdeadline(apic);
1405 1406 1407 1408 1409 1410 1411 1412 1413 1414 1415
}
EXPORT_SYMBOL_GPL(kvm_lapic_switch_to_hv_timer);

void kvm_lapic_switch_to_sw_timer(struct kvm_vcpu *vcpu)
{
	struct kvm_lapic *apic = vcpu->arch.apic;

	/* Possibly the TSC deadline timer is not enabled yet */
	if (!apic->lapic_timer.hv_timer_in_use)
		return;

1416
	cancel_hv_tscdeadline(apic);
1417 1418 1419 1420 1421 1422 1423 1424

	if (atomic_read(&apic->lapic_timer.pending))
		return;

	start_sw_tscdeadline(apic);
}
EXPORT_SYMBOL_GPL(kvm_lapic_switch_to_sw_timer);

E
Eddie Dong 已提交
1425 1426
static void start_apic_timer(struct kvm_lapic *apic)
{
1427
	ktime_t now;
1428

1429
	atomic_set(&apic->lapic_timer.pending, 0);
1430

1431
	if (apic_lvtt_period(apic) || apic_lvtt_oneshot(apic)) {
G
Guo Chao 已提交
1432
		/* lapic timer in oneshot or periodic mode */
1433
		now = apic->lapic_timer.timer.base->get_time();
1434
		apic->lapic_timer.period = (u64)kvm_lapic_get_reg(apic, APIC_TMICT)
1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454
			    * APIC_BUS_CYCLE_NS * apic->divide_count;

		if (!apic->lapic_timer.period)
			return;
		/*
		 * Do not allow the guest to program periodic timers with small
		 * interval, since the hrtimers are not throttled by the host
		 * scheduler.
		 */
		if (apic_lvtt_period(apic)) {
			s64 min_period = min_timer_period_us * 1000LL;

			if (apic->lapic_timer.period < min_period) {
				pr_info_ratelimited(
				    "kvm: vcpu %i: requested %lld ns "
				    "lapic timer period limited to %lld ns\n",
				    apic->vcpu->vcpu_id,
				    apic->lapic_timer.period, min_period);
				apic->lapic_timer.period = min_period;
			}
1455
		}
1456

1457 1458
		hrtimer_start(&apic->lapic_timer.timer,
			      ktime_add_ns(now, apic->lapic_timer.period),
1459
			      HRTIMER_MODE_ABS_PINNED);
E
Eddie Dong 已提交
1460

1461
		apic_debug("%s: bus cycle is %" PRId64 "ns, now 0x%016"
E
Eddie Dong 已提交
1462 1463
			   PRIx64 ", "
			   "timer initial count 0x%x, period %lldns, "
1464
			   "expire @ 0x%016" PRIx64 ".\n", __func__,
E
Eddie Dong 已提交
1465
			   APIC_BUS_CYCLE_NS, ktime_to_ns(now),
1466
			   kvm_lapic_get_reg(apic, APIC_TMICT),
1467
			   apic->lapic_timer.period,
E
Eddie Dong 已提交
1468
			   ktime_to_ns(ktime_add_ns(now,
1469
					apic->lapic_timer.period)));
1470
	} else if (apic_lvtt_tscdeadline(apic)) {
1471
		if (!(kvm_x86_ops->set_hv_timer && start_hv_tscdeadline(apic)))
1472
			start_sw_tscdeadline(apic);
1473
	}
E
Eddie Dong 已提交
1474 1475
}

1476 1477
static void apic_manage_nmi_watchdog(struct kvm_lapic *apic, u32 lvt0_val)
{
1478
	bool lvt0_in_nmi_mode = apic_lvt_nmi_mode(lvt0_val);
1479

1480 1481 1482
	if (apic->lvt0_in_nmi_mode != lvt0_in_nmi_mode) {
		apic->lvt0_in_nmi_mode = lvt0_in_nmi_mode;
		if (lvt0_in_nmi_mode) {
1483 1484
			apic_debug("Receive NMI setting on APIC_LVT0 "
				   "for cpu %d\n", apic->vcpu->vcpu_id);
1485
			atomic_inc(&apic->vcpu->kvm->arch.vapics_in_nmi_mode);
1486 1487 1488
		} else
			atomic_dec(&apic->vcpu->kvm->arch.vapics_in_nmi_mode);
	}
1489 1490
}

1491
int kvm_lapic_reg_write(struct kvm_lapic *apic, u32 reg, u32 val)
E
Eddie Dong 已提交
1492
{
G
Gleb Natapov 已提交
1493
	int ret = 0;
E
Eddie Dong 已提交
1494

G
Gleb Natapov 已提交
1495
	trace_kvm_apic_write(reg, val);
E
Eddie Dong 已提交
1496

G
Gleb Natapov 已提交
1497
	switch (reg) {
E
Eddie Dong 已提交
1498
	case APIC_ID:		/* Local APIC ID */
G
Gleb Natapov 已提交
1499
		if (!apic_x2apic_mode(apic))
1500
			kvm_apic_set_xapic_id(apic, val >> 24);
G
Gleb Natapov 已提交
1501 1502
		else
			ret = 1;
E
Eddie Dong 已提交
1503 1504 1505
		break;

	case APIC_TASKPRI:
1506
		report_tpr_access(apic, true);
E
Eddie Dong 已提交
1507 1508 1509 1510 1511 1512 1513 1514
		apic_set_tpr(apic, val & 0xff);
		break;

	case APIC_EOI:
		apic_set_eoi(apic);
		break;

	case APIC_LDR:
G
Gleb Natapov 已提交
1515
		if (!apic_x2apic_mode(apic))
1516
			kvm_apic_set_ldr(apic, val & APIC_LDR_MASK);
G
Gleb Natapov 已提交
1517 1518
		else
			ret = 1;
E
Eddie Dong 已提交
1519 1520 1521
		break;

	case APIC_DFR:
1522
		if (!apic_x2apic_mode(apic)) {
1523
			kvm_lapic_set_reg(apic, APIC_DFR, val | 0x0FFFFFFF);
1524 1525
			recalculate_apic_map(apic->vcpu->kvm);
		} else
G
Gleb Natapov 已提交
1526
			ret = 1;
E
Eddie Dong 已提交
1527 1528
		break;

1529 1530
	case APIC_SPIV: {
		u32 mask = 0x3ff;
1531
		if (kvm_lapic_get_reg(apic, APIC_LVR) & APIC_LVR_DIRECTED_EOI)
1532
			mask |= APIC_SPIV_DIRECTED_EOI;
1533
		apic_set_spiv(apic, val & mask);
E
Eddie Dong 已提交
1534 1535 1536 1537
		if (!(val & APIC_SPIV_APIC_ENABLED)) {
			int i;
			u32 lvt_val;

1538
			for (i = 0; i < KVM_APIC_LVT_NUM; i++) {
1539
				lvt_val = kvm_lapic_get_reg(apic,
E
Eddie Dong 已提交
1540
						       APIC_LVTT + 0x10 * i);
1541
				kvm_lapic_set_reg(apic, APIC_LVTT + 0x10 * i,
E
Eddie Dong 已提交
1542 1543
					     lvt_val | APIC_LVT_MASKED);
			}
1544
			apic_update_lvtt(apic);
1545
			atomic_set(&apic->lapic_timer.pending, 0);
E
Eddie Dong 已提交
1546 1547 1548

		}
		break;
1549
	}
E
Eddie Dong 已提交
1550 1551
	case APIC_ICR:
		/* No delay here, so we always clear the pending bit */
1552
		kvm_lapic_set_reg(apic, APIC_ICR, val & ~(1 << 12));
E
Eddie Dong 已提交
1553 1554 1555 1556
		apic_send_ipi(apic);
		break;

	case APIC_ICR2:
G
Gleb Natapov 已提交
1557 1558
		if (!apic_x2apic_mode(apic))
			val &= 0xff000000;
1559
		kvm_lapic_set_reg(apic, APIC_ICR2, val);
E
Eddie Dong 已提交
1560 1561
		break;

1562
	case APIC_LVT0:
1563
		apic_manage_nmi_watchdog(apic, val);
E
Eddie Dong 已提交
1564 1565 1566 1567 1568
	case APIC_LVTTHMR:
	case APIC_LVTPC:
	case APIC_LVT1:
	case APIC_LVTERR:
		/* TODO: Check vector */
1569
		if (!kvm_apic_sw_enabled(apic))
E
Eddie Dong 已提交
1570 1571
			val |= APIC_LVT_MASKED;

G
Gleb Natapov 已提交
1572
		val &= apic_lvt_mask[(reg - APIC_LVTT) >> 4];
1573
		kvm_lapic_set_reg(apic, reg, val);
E
Eddie Dong 已提交
1574 1575 1576

		break;

1577
	case APIC_LVTT:
1578
		if (!kvm_apic_sw_enabled(apic))
1579 1580
			val |= APIC_LVT_MASKED;
		val &= (apic_lvt_mask[0] | apic->lapic_timer.timer_mode_mask);
1581
		kvm_lapic_set_reg(apic, APIC_LVTT, val);
1582
		apic_update_lvtt(apic);
1583 1584
		break;

E
Eddie Dong 已提交
1585
	case APIC_TMICT:
1586 1587 1588
		if (apic_lvtt_tscdeadline(apic))
			break;

1589
		hrtimer_cancel(&apic->lapic_timer.timer);
1590
		kvm_lapic_set_reg(apic, APIC_TMICT, val);
E
Eddie Dong 已提交
1591
		start_apic_timer(apic);
G
Gleb Natapov 已提交
1592
		break;
E
Eddie Dong 已提交
1593 1594 1595

	case APIC_TDCR:
		if (val & 4)
1596
			apic_debug("KVM_WRITE:TDCR %x\n", val);
1597
		kvm_lapic_set_reg(apic, APIC_TDCR, val);
E
Eddie Dong 已提交
1598 1599 1600
		update_divide_count(apic);
		break;

G
Gleb Natapov 已提交
1601 1602
	case APIC_ESR:
		if (apic_x2apic_mode(apic) && val != 0) {
1603
			apic_debug("KVM_WRITE:ESR not zero %x\n", val);
G
Gleb Natapov 已提交
1604 1605 1606 1607 1608 1609
			ret = 1;
		}
		break;

	case APIC_SELF_IPI:
		if (apic_x2apic_mode(apic)) {
1610
			kvm_lapic_reg_write(apic, APIC_ICR, 0x40000 | (val & 0xff));
G
Gleb Natapov 已提交
1611 1612 1613
		} else
			ret = 1;
		break;
E
Eddie Dong 已提交
1614
	default:
G
Gleb Natapov 已提交
1615
		ret = 1;
E
Eddie Dong 已提交
1616 1617
		break;
	}
G
Gleb Natapov 已提交
1618 1619 1620 1621
	if (ret)
		apic_debug("Local APIC Write to read-only register %x\n", reg);
	return ret;
}
1622
EXPORT_SYMBOL_GPL(kvm_lapic_reg_write);
G
Gleb Natapov 已提交
1623

1624
static int apic_mmio_write(struct kvm_vcpu *vcpu, struct kvm_io_device *this,
G
Gleb Natapov 已提交
1625 1626 1627 1628 1629 1630 1631 1632 1633 1634 1635 1636 1637 1638 1639 1640 1641
			    gpa_t address, int len, const void *data)
{
	struct kvm_lapic *apic = to_lapic(this);
	unsigned int offset = address - apic->base_address;
	u32 val;

	if (!apic_mmio_in_range(apic, address))
		return -EOPNOTSUPP;

	/*
	 * APIC register must be aligned on 128-bits boundary.
	 * 32/64/128 bits registers must be accessed thru 32 bits.
	 * Refer SDM 8.4.1
	 */
	if (len != 4 || (offset & 0xf)) {
		/* Don't shout loud, $infamous_os would cause only noise. */
		apic_debug("apic write: bad size=%d %lx\n", len, (long)address);
1642
		return 0;
G
Gleb Natapov 已提交
1643 1644 1645 1646 1647 1648 1649 1650 1651
	}

	val = *(u32*)data;

	/* too common printing */
	if (offset != APIC_EOI)
		apic_debug("%s: offset 0x%x with length 0x%x, and value is "
			   "0x%x\n", __func__, offset, len, val);

1652
	kvm_lapic_reg_write(apic, offset & 0xff0, val);
G
Gleb Natapov 已提交
1653

1654
	return 0;
E
Eddie Dong 已提交
1655 1656
}

1657 1658
void kvm_lapic_set_eoi(struct kvm_vcpu *vcpu)
{
1659
	kvm_lapic_reg_write(vcpu->arch.apic, APIC_EOI, 0);
1660 1661 1662
}
EXPORT_SYMBOL_GPL(kvm_lapic_set_eoi);

1663 1664 1665 1666 1667 1668 1669 1670
/* emulate APIC access in a trap manner */
void kvm_apic_write_nodecode(struct kvm_vcpu *vcpu, u32 offset)
{
	u32 val = 0;

	/* hw has done the conditional check and inst decode */
	offset &= 0xff0;

1671
	kvm_lapic_reg_read(vcpu->arch.apic, offset, 4, &val);
1672 1673

	/* TODO: optimize to just emulate side effect w/o one more write */
1674
	kvm_lapic_reg_write(vcpu->arch.apic, offset, val);
1675 1676 1677
}
EXPORT_SYMBOL_GPL(kvm_apic_write_nodecode);

1678
void kvm_free_lapic(struct kvm_vcpu *vcpu)
E
Eddie Dong 已提交
1679
{
1680 1681
	struct kvm_lapic *apic = vcpu->arch.apic;

1682
	if (!vcpu->arch.apic)
E
Eddie Dong 已提交
1683 1684
		return;

1685
	hrtimer_cancel(&apic->lapic_timer.timer);
E
Eddie Dong 已提交
1686

1687 1688 1689
	if (!(vcpu->arch.apic_base & MSR_IA32_APICBASE_ENABLE))
		static_key_slow_dec_deferred(&apic_hw_disabled);

1690
	if (!apic->sw_enabled)
1691
		static_key_slow_dec_deferred(&apic_sw_disabled);
E
Eddie Dong 已提交
1692

1693 1694 1695 1696
	if (apic->regs)
		free_page((unsigned long)apic->regs);

	kfree(apic);
E
Eddie Dong 已提交
1697 1698 1699 1700 1701 1702 1703 1704
}

/*
 *----------------------------------------------------------------------
 * LAPIC interface
 *----------------------------------------------------------------------
 */

1705 1706 1707 1708
u64 kvm_get_lapic_tscdeadline_msr(struct kvm_vcpu *vcpu)
{
	struct kvm_lapic *apic = vcpu->arch.apic;

1709
	if (!lapic_in_kernel(vcpu) || apic_lvtt_oneshot(apic) ||
1710
			apic_lvtt_period(apic))
1711 1712 1713 1714 1715 1716 1717 1718 1719
		return 0;

	return apic->lapic_timer.tscdeadline;
}

void kvm_set_lapic_tscdeadline_msr(struct kvm_vcpu *vcpu, u64 data)
{
	struct kvm_lapic *apic = vcpu->arch.apic;

1720
	if (!lapic_in_kernel(vcpu) || apic_lvtt_oneshot(apic) ||
1721
			apic_lvtt_period(apic))
1722 1723 1724 1725 1726 1727 1728
		return;

	hrtimer_cancel(&apic->lapic_timer.timer);
	apic->lapic_timer.tscdeadline = data;
	start_apic_timer(apic);
}

E
Eddie Dong 已提交
1729 1730
void kvm_lapic_set_tpr(struct kvm_vcpu *vcpu, unsigned long cr8)
{
1731
	struct kvm_lapic *apic = vcpu->arch.apic;
E
Eddie Dong 已提交
1732

A
Avi Kivity 已提交
1733
	apic_set_tpr(apic, ((cr8 & 0x0f) << 4)
1734
		     | (kvm_lapic_get_reg(apic, APIC_TASKPRI) & 4));
E
Eddie Dong 已提交
1735 1736 1737 1738 1739 1740
}

u64 kvm_lapic_get_cr8(struct kvm_vcpu *vcpu)
{
	u64 tpr;

1741
	tpr = (u64) kvm_lapic_get_reg(vcpu->arch.apic, APIC_TASKPRI);
E
Eddie Dong 已提交
1742 1743 1744 1745 1746 1747

	return (tpr & 0xf0) >> 4;
}

void kvm_lapic_set_base(struct kvm_vcpu *vcpu, u64 value)
{
1748
	u64 old_value = vcpu->arch.apic_base;
1749
	struct kvm_lapic *apic = vcpu->arch.apic;
E
Eddie Dong 已提交
1750 1751 1752

	if (!apic) {
		value |= MSR_IA32_APICBASE_BSP;
1753
		vcpu->arch.apic_base = value;
E
Eddie Dong 已提交
1754 1755
		return;
	}
1756

1757 1758
	vcpu->arch.apic_base = value;

1759
	/* update jump label if enable bit changes */
1760
	if ((old_value ^ value) & MSR_IA32_APICBASE_ENABLE) {
1761 1762
		if (value & MSR_IA32_APICBASE_ENABLE) {
			kvm_apic_set_xapic_id(apic, vcpu->vcpu_id);
1763
			static_key_slow_dec_deferred(&apic_hw_disabled);
1764
		} else {
1765
			static_key_slow_inc(&apic_hw_disabled.key);
1766 1767
			recalculate_apic_map(vcpu->kvm);
		}
1768 1769
	}

1770 1771
	if ((old_value ^ value) & X2APIC_ENABLE) {
		if (value & X2APIC_ENABLE) {
1772
			kvm_apic_set_x2apic_id(apic, vcpu->vcpu_id);
1773 1774 1775
			kvm_x86_ops->set_virtual_x2apic_mode(vcpu, true);
		} else
			kvm_x86_ops->set_virtual_x2apic_mode(vcpu, false);
G
Gleb Natapov 已提交
1776
	}
1777

1778
	apic->base_address = apic->vcpu->arch.apic_base &
E
Eddie Dong 已提交
1779 1780
			     MSR_IA32_APICBASE_BASE;

1781 1782 1783 1784
	if ((value & MSR_IA32_APICBASE_ENABLE) &&
	     apic->base_address != APIC_DEFAULT_PHYS_BASE)
		pr_warn_once("APIC base relocation is unsupported by KVM");

E
Eddie Dong 已提交
1785 1786
	/* with FSB delivery interrupt, we can restart APIC functionality */
	apic_debug("apic base msr is 0x%016" PRIx64 ", and base address is "
1787
		   "0x%lx.\n", apic->vcpu->arch.apic_base, apic->base_address);
E
Eddie Dong 已提交
1788 1789 1790

}

1791
void kvm_lapic_reset(struct kvm_vcpu *vcpu, bool init_event)
E
Eddie Dong 已提交
1792 1793 1794 1795
{
	struct kvm_lapic *apic;
	int i;

1796
	apic_debug("%s\n", __func__);
E
Eddie Dong 已提交
1797 1798

	ASSERT(vcpu);
1799
	apic = vcpu->arch.apic;
E
Eddie Dong 已提交
1800 1801 1802
	ASSERT(apic != NULL);

	/* Stop the timer in case it's a reset to an active apic */
1803
	hrtimer_cancel(&apic->lapic_timer.timer);
E
Eddie Dong 已提交
1804

1805 1806 1807
	if (!init_event) {
		kvm_lapic_set_base(vcpu, APIC_DEFAULT_PHYS_BASE |
		                         MSR_IA32_APICBASE_ENABLE);
1808
		kvm_apic_set_xapic_id(apic, vcpu->vcpu_id);
1809
	}
1810
	kvm_apic_set_version(apic->vcpu);
E
Eddie Dong 已提交
1811

1812 1813
	for (i = 0; i < KVM_APIC_LVT_NUM; i++)
		kvm_lapic_set_reg(apic, APIC_LVTT + 0x10 * i, APIC_LVT_MASKED);
1814
	apic_update_lvtt(apic);
1815
	if (kvm_check_has_quirk(vcpu->kvm, KVM_X86_QUIRK_LINT0_REENABLED))
1816
		kvm_lapic_set_reg(apic, APIC_LVT0,
1817
			     SET_APIC_DELIVERY_MODE(0, APIC_MODE_EXTINT));
1818
	apic_manage_nmi_watchdog(apic, kvm_lapic_get_reg(apic, APIC_LVT0));
E
Eddie Dong 已提交
1819

1820
	kvm_lapic_set_reg(apic, APIC_DFR, 0xffffffffU);
1821
	apic_set_spiv(apic, 0xff);
1822
	kvm_lapic_set_reg(apic, APIC_TASKPRI, 0);
1823 1824
	if (!apic_x2apic_mode(apic))
		kvm_apic_set_ldr(apic, 0);
1825 1826 1827 1828 1829
	kvm_lapic_set_reg(apic, APIC_ESR, 0);
	kvm_lapic_set_reg(apic, APIC_ICR, 0);
	kvm_lapic_set_reg(apic, APIC_ICR2, 0);
	kvm_lapic_set_reg(apic, APIC_TDCR, 0);
	kvm_lapic_set_reg(apic, APIC_TMICT, 0);
E
Eddie Dong 已提交
1830
	for (i = 0; i < 8; i++) {
1831 1832 1833
		kvm_lapic_set_reg(apic, APIC_IRR + 0x10 * i, 0);
		kvm_lapic_set_reg(apic, APIC_ISR + 0x10 * i, 0);
		kvm_lapic_set_reg(apic, APIC_TMR + 0x10 * i, 0);
E
Eddie Dong 已提交
1834
	}
1835 1836
	apic->irr_pending = vcpu->arch.apicv_active;
	apic->isr_count = vcpu->arch.apicv_active ? 1 : 0;
M
Michael S. Tsirkin 已提交
1837
	apic->highest_isr_cache = -1;
1838
	update_divide_count(apic);
1839
	atomic_set(&apic->lapic_timer.pending, 0);
1840
	if (kvm_vcpu_is_bsp(vcpu))
1841 1842
		kvm_lapic_set_base(vcpu,
				vcpu->arch.apic_base | MSR_IA32_APICBASE_BSP);
1843
	vcpu->arch.pv_eoi.msr_val = 0;
E
Eddie Dong 已提交
1844 1845
	apic_update_ppr(apic);

1846
	vcpu->arch.apic_arb_prio = 0;
1847
	vcpu->arch.apic_attention = 0;
1848

N
Nadav Amit 已提交
1849
	apic_debug("%s: vcpu=%p, id=%d, base_msr="
1850
		   "0x%016" PRIx64 ", base_address=0x%0lx.\n", __func__,
E
Eddie Dong 已提交
1851
		   vcpu, kvm_apic_id(apic),
1852
		   vcpu->arch.apic_base, apic->base_address);
E
Eddie Dong 已提交
1853 1854 1855 1856 1857 1858 1859
}

/*
 *----------------------------------------------------------------------
 * timer interface
 *----------------------------------------------------------------------
 */
1860

A
Avi Kivity 已提交
1861
static bool lapic_is_periodic(struct kvm_lapic *apic)
E
Eddie Dong 已提交
1862
{
1863
	return apic_lvtt_period(apic);
E
Eddie Dong 已提交
1864 1865
}

1866 1867
int apic_has_pending_timer(struct kvm_vcpu *vcpu)
{
1868
	struct kvm_lapic *apic = vcpu->arch.apic;
1869

1870
	if (apic_enabled(apic) && apic_lvt_enabled(apic, APIC_LVTT))
1871
		return atomic_read(&apic->lapic_timer.pending);
1872 1873 1874 1875

	return 0;
}

A
Avi Kivity 已提交
1876
int kvm_apic_local_deliver(struct kvm_lapic *apic, int lvt_type)
1877
{
1878
	u32 reg = kvm_lapic_get_reg(apic, lvt_type);
1879 1880
	int vector, mode, trig_mode;

1881
	if (kvm_apic_hw_enabled(apic) && !(reg & APIC_LVT_MASKED)) {
1882 1883 1884
		vector = reg & APIC_VECTOR_MASK;
		mode = reg & APIC_MODE_MASK;
		trig_mode = reg & APIC_LVT_LEVEL_TRIGGER;
1885 1886
		return __apic_accept_irq(apic, mode, vector, 1, trig_mode,
					NULL);
1887 1888 1889
	}
	return 0;
}
1890

1891
void kvm_apic_nmi_wd_deliver(struct kvm_vcpu *vcpu)
1892
{
1893 1894 1895 1896
	struct kvm_lapic *apic = vcpu->arch.apic;

	if (apic)
		kvm_apic_local_deliver(apic, APIC_LVT0);
1897 1898
}

G
Gregory Haskins 已提交
1899 1900 1901 1902 1903
static const struct kvm_io_device_ops apic_mmio_ops = {
	.read     = apic_mmio_read,
	.write    = apic_mmio_write,
};

1904 1905 1906
static enum hrtimer_restart apic_timer_fn(struct hrtimer *data)
{
	struct kvm_timer *ktimer = container_of(data, struct kvm_timer, timer);
A
Avi Kivity 已提交
1907
	struct kvm_lapic *apic = container_of(ktimer, struct kvm_lapic, lapic_timer);
1908

1909
	apic_timer_expired(apic);
1910

A
Avi Kivity 已提交
1911
	if (lapic_is_periodic(apic)) {
1912 1913 1914 1915 1916 1917
		hrtimer_add_expires_ns(&ktimer->timer, ktimer->period);
		return HRTIMER_RESTART;
	} else
		return HRTIMER_NORESTART;
}

E
Eddie Dong 已提交
1918 1919 1920 1921 1922 1923 1924 1925 1926 1927 1928
int kvm_create_lapic(struct kvm_vcpu *vcpu)
{
	struct kvm_lapic *apic;

	ASSERT(vcpu != NULL);
	apic_debug("apic_init %d\n", vcpu->vcpu_id);

	apic = kzalloc(sizeof(*apic), GFP_KERNEL);
	if (!apic)
		goto nomem;

1929
	vcpu->arch.apic = apic;
E
Eddie Dong 已提交
1930

1931 1932
	apic->regs = (void *)get_zeroed_page(GFP_KERNEL);
	if (!apic->regs) {
E
Eddie Dong 已提交
1933 1934
		printk(KERN_ERR "malloc apic regs error for vcpu %x\n",
		       vcpu->vcpu_id);
1935
		goto nomem_free_apic;
E
Eddie Dong 已提交
1936 1937 1938
	}
	apic->vcpu = vcpu;

1939
	hrtimer_init(&apic->lapic_timer.timer, CLOCK_MONOTONIC,
1940
		     HRTIMER_MODE_ABS_PINNED);
1941
	apic->lapic_timer.timer.function = apic_timer_fn;
1942

1943 1944 1945 1946 1947
	/*
	 * APIC is created enabled. This will prevent kvm_lapic_set_base from
	 * thinking that APIC satet has changed.
	 */
	vcpu->arch.apic_base = MSR_IA32_APICBASE_ENABLE;
1948
	static_key_slow_inc(&apic_sw_disabled.key); /* sw disabled at reset */
1949
	kvm_lapic_reset(vcpu, false);
G
Gregory Haskins 已提交
1950
	kvm_iodevice_init(&apic->dev, &apic_mmio_ops);
E
Eddie Dong 已提交
1951 1952

	return 0;
1953 1954
nomem_free_apic:
	kfree(apic);
E
Eddie Dong 已提交
1955 1956 1957 1958 1959 1960
nomem:
	return -ENOMEM;
}

int kvm_apic_has_interrupt(struct kvm_vcpu *vcpu)
{
1961
	struct kvm_lapic *apic = vcpu->arch.apic;
E
Eddie Dong 已提交
1962 1963
	int highest_irr;

1964
	if (!apic_enabled(apic))
E
Eddie Dong 已提交
1965 1966
		return -1;

1967
	apic_update_ppr(apic);
E
Eddie Dong 已提交
1968 1969
	highest_irr = apic_find_highest_irr(apic);
	if ((highest_irr == -1) ||
1970
	    ((highest_irr & 0xF0) <= kvm_lapic_get_reg(apic, APIC_PROCPRI)))
E
Eddie Dong 已提交
1971 1972 1973 1974
		return -1;
	return highest_irr;
}

Q
Qing He 已提交
1975 1976
int kvm_apic_accept_pic_intr(struct kvm_vcpu *vcpu)
{
1977
	u32 lvt0 = kvm_lapic_get_reg(vcpu->arch.apic, APIC_LVT0);
Q
Qing He 已提交
1978 1979
	int r = 0;

1980
	if (!kvm_apic_hw_enabled(vcpu->arch.apic))
1981 1982 1983 1984
		r = 1;
	if ((lvt0 & APIC_LVT_MASKED) == 0 &&
	    GET_APIC_DELIVERY_MODE(lvt0) == APIC_MODE_EXTINT)
		r = 1;
Q
Qing He 已提交
1985 1986 1987
	return r;
}

1988 1989
void kvm_inject_apic_timer_irqs(struct kvm_vcpu *vcpu)
{
1990
	struct kvm_lapic *apic = vcpu->arch.apic;
1991

1992
	if (atomic_read(&apic->lapic_timer.pending) > 0) {
1993
		kvm_apic_local_deliver(apic, APIC_LVTT);
1994 1995
		if (apic_lvtt_tscdeadline(apic))
			apic->lapic_timer.tscdeadline = 0;
1996
		atomic_set(&apic->lapic_timer.pending, 0);
1997 1998 1999
	}
}

E
Eddie Dong 已提交
2000 2001 2002
int kvm_get_apic_interrupt(struct kvm_vcpu *vcpu)
{
	int vector = kvm_apic_has_interrupt(vcpu);
2003
	struct kvm_lapic *apic = vcpu->arch.apic;
E
Eddie Dong 已提交
2004 2005 2006 2007

	if (vector == -1)
		return -1;

2008 2009 2010 2011 2012 2013 2014
	/*
	 * We get here even with APIC virtualization enabled, if doing
	 * nested virtualization and L1 runs with the "acknowledge interrupt
	 * on exit" mode.  Then we cannot inject the interrupt via RVI,
	 * because the process would deliver it through the IDT.
	 */

M
Michael S. Tsirkin 已提交
2015
	apic_set_isr(vector, apic);
E
Eddie Dong 已提交
2016 2017
	apic_update_ppr(apic);
	apic_clear_irr(vector, apic);
2018 2019 2020 2021 2022 2023

	if (test_bit(vector, vcpu_to_synic(vcpu)->auto_eoi_bitmap)) {
		apic_clear_isr(vector, apic);
		apic_update_ppr(apic);
	}

E
Eddie Dong 已提交
2024 2025
	return vector;
}
2026

2027 2028 2029 2030 2031 2032
static int kvm_apic_state_fixup(struct kvm_vcpu *vcpu,
		struct kvm_lapic_state *s, bool set)
{
	if (apic_x2apic_mode(vcpu->arch.apic)) {
		u32 *id = (u32 *)(s->regs + APIC_ID);

2033 2034 2035 2036 2037 2038 2039 2040 2041
		if (vcpu->kvm->arch.x2apic_format) {
			if (*id != vcpu->vcpu_id)
				return -EINVAL;
		} else {
			if (set)
				*id >>= 24;
			else
				*id <<= 24;
		}
2042 2043 2044 2045 2046 2047 2048 2049 2050 2051 2052 2053
	}

	return 0;
}

int kvm_apic_get_state(struct kvm_vcpu *vcpu, struct kvm_lapic_state *s)
{
	memcpy(s->regs, vcpu->arch.apic->regs, sizeof(*s));
	return kvm_apic_state_fixup(vcpu, s, false);
}

int kvm_apic_set_state(struct kvm_vcpu *vcpu, struct kvm_lapic_state *s)
2054
{
2055
	struct kvm_lapic *apic = vcpu->arch.apic;
2056 2057
	int r;

2058

2059
	kvm_lapic_set_base(vcpu, vcpu->arch.apic_base);
2060 2061
	/* set SPIV separately to get count of SW disabled APICs right */
	apic_set_spiv(apic, *((u32 *)(s->regs + APIC_SPIV)));
2062 2063 2064 2065

	r = kvm_apic_state_fixup(vcpu, s, true);
	if (r)
		return r;
2066
	memcpy(vcpu->arch.apic->regs, s->regs, sizeof *s);
2067 2068

	recalculate_apic_map(vcpu->kvm);
2069 2070
	kvm_apic_set_version(vcpu);

2071
	apic_update_ppr(apic);
2072
	hrtimer_cancel(&apic->lapic_timer.timer);
2073
	apic_update_lvtt(apic);
2074
	apic_manage_nmi_watchdog(apic, kvm_lapic_get_reg(apic, APIC_LVT0));
2075 2076
	update_divide_count(apic);
	start_apic_timer(apic);
2077
	apic->irr_pending = true;
2078
	apic->isr_count = vcpu->arch.apicv_active ?
2079
				1 : count_vectors(apic->regs + APIC_ISR);
M
Michael S. Tsirkin 已提交
2080
	apic->highest_isr_cache = -1;
2081
	if (vcpu->arch.apicv_active) {
2082 2083
		if (kvm_x86_ops->apicv_post_state_restore)
			kvm_x86_ops->apicv_post_state_restore(vcpu);
W
Wei Wang 已提交
2084 2085
		kvm_x86_ops->hwapic_irr_update(vcpu,
				apic_find_highest_irr(apic));
2086
		kvm_x86_ops->hwapic_isr_update(vcpu,
2087
				apic_find_highest_isr(apic));
2088
	}
2089
	kvm_make_request(KVM_REQ_EVENT, vcpu);
2090 2091
	if (ioapic_in_kernel(vcpu->kvm))
		kvm_rtc_eoi_tracking_restore_one(vcpu);
2092 2093

	vcpu->arch.apic_arb_prio = 0;
2094 2095

	return 0;
2096
}
2097

2098
void __kvm_migrate_apic_timer(struct kvm_vcpu *vcpu)
2099 2100 2101
{
	struct hrtimer *timer;

2102
	if (!lapic_in_kernel(vcpu))
2103 2104
		return;

2105
	timer = &vcpu->arch.apic->lapic_timer.timer;
2106
	if (hrtimer_cancel(timer))
2107
		hrtimer_start_expires(timer, HRTIMER_MODE_ABS_PINNED);
2108
}
A
Avi Kivity 已提交
2109

2110 2111 2112 2113 2114 2115 2116 2117 2118 2119 2120 2121 2122 2123 2124 2125 2126 2127 2128 2129 2130 2131 2132 2133 2134 2135 2136 2137 2138 2139 2140 2141 2142 2143 2144 2145 2146
/*
 * apic_sync_pv_eoi_from_guest - called on vmexit or cancel interrupt
 *
 * Detect whether guest triggered PV EOI since the
 * last entry. If yes, set EOI on guests's behalf.
 * Clear PV EOI in guest memory in any case.
 */
static void apic_sync_pv_eoi_from_guest(struct kvm_vcpu *vcpu,
					struct kvm_lapic *apic)
{
	bool pending;
	int vector;
	/*
	 * PV EOI state is derived from KVM_APIC_PV_EOI_PENDING in host
	 * and KVM_PV_EOI_ENABLED in guest memory as follows:
	 *
	 * KVM_APIC_PV_EOI_PENDING is unset:
	 * 	-> host disabled PV EOI.
	 * KVM_APIC_PV_EOI_PENDING is set, KVM_PV_EOI_ENABLED is set:
	 * 	-> host enabled PV EOI, guest did not execute EOI yet.
	 * KVM_APIC_PV_EOI_PENDING is set, KVM_PV_EOI_ENABLED is unset:
	 * 	-> host enabled PV EOI, guest executed EOI.
	 */
	BUG_ON(!pv_eoi_enabled(vcpu));
	pending = pv_eoi_get_pending(vcpu);
	/*
	 * Clear pending bit in any case: it will be set again on vmentry.
	 * While this might not be ideal from performance point of view,
	 * this makes sure pv eoi is only enabled when we know it's safe.
	 */
	pv_eoi_clr_pending(vcpu);
	if (pending)
		return;
	vector = apic_set_eoi(apic);
	trace_kvm_pv_eoi(apic, vector);
}

A
Avi Kivity 已提交
2147 2148 2149 2150
void kvm_lapic_sync_from_vapic(struct kvm_vcpu *vcpu)
{
	u32 data;

2151 2152 2153
	if (test_bit(KVM_APIC_PV_EOI_PENDING, &vcpu->arch.apic_attention))
		apic_sync_pv_eoi_from_guest(vcpu, vcpu->arch.apic);

2154
	if (!test_bit(KVM_APIC_CHECK_VAPIC, &vcpu->arch.apic_attention))
A
Avi Kivity 已提交
2155 2156
		return;

2157 2158 2159
	if (kvm_read_guest_cached(vcpu->kvm, &vcpu->arch.apic->vapic_cache, &data,
				  sizeof(u32)))
		return;
A
Avi Kivity 已提交
2160 2161 2162 2163

	apic_set_tpr(vcpu->arch.apic, data & 0xff);
}

2164 2165 2166 2167 2168 2169 2170 2171 2172 2173 2174 2175 2176 2177 2178
/*
 * apic_sync_pv_eoi_to_guest - called before vmentry
 *
 * Detect whether it's safe to enable PV EOI and
 * if yes do so.
 */
static void apic_sync_pv_eoi_to_guest(struct kvm_vcpu *vcpu,
					struct kvm_lapic *apic)
{
	if (!pv_eoi_enabled(vcpu) ||
	    /* IRR set or many bits in ISR: could be nested. */
	    apic->irr_pending ||
	    /* Cache not set: could be safe but we don't bother. */
	    apic->highest_isr_cache == -1 ||
	    /* Need EOI to update ioapic. */
2179
	    kvm_ioapic_handles_vector(apic, apic->highest_isr_cache)) {
2180 2181 2182 2183 2184 2185 2186 2187 2188 2189
		/*
		 * PV EOI was disabled by apic_sync_pv_eoi_from_guest
		 * so we need not do anything here.
		 */
		return;
	}

	pv_eoi_set_pending(apic->vcpu);
}

A
Avi Kivity 已提交
2190 2191 2192 2193
void kvm_lapic_sync_to_vapic(struct kvm_vcpu *vcpu)
{
	u32 data, tpr;
	int max_irr, max_isr;
2194
	struct kvm_lapic *apic = vcpu->arch.apic;
A
Avi Kivity 已提交
2195

2196 2197
	apic_sync_pv_eoi_to_guest(vcpu, apic);

2198
	if (!test_bit(KVM_APIC_CHECK_VAPIC, &vcpu->arch.apic_attention))
A
Avi Kivity 已提交
2199 2200
		return;

2201
	tpr = kvm_lapic_get_reg(apic, APIC_TASKPRI) & 0xff;
A
Avi Kivity 已提交
2202 2203 2204 2205 2206 2207 2208 2209
	max_irr = apic_find_highest_irr(apic);
	if (max_irr < 0)
		max_irr = 0;
	max_isr = apic_find_highest_isr(apic);
	if (max_isr < 0)
		max_isr = 0;
	data = (tpr & 0xff) | ((max_isr & 0xf0) << 8) | (max_irr << 24);

2210 2211
	kvm_write_guest_cached(vcpu->kvm, &vcpu->arch.apic->vapic_cache, &data,
				sizeof(u32));
A
Avi Kivity 已提交
2212 2213
}

2214
int kvm_lapic_set_vapic_addr(struct kvm_vcpu *vcpu, gpa_t vapic_addr)
A
Avi Kivity 已提交
2215
{
2216 2217 2218 2219 2220
	if (vapic_addr) {
		if (kvm_gfn_to_hva_cache_init(vcpu->kvm,
					&vcpu->arch.apic->vapic_cache,
					vapic_addr, sizeof(u32)))
			return -EINVAL;
2221
		__set_bit(KVM_APIC_CHECK_VAPIC, &vcpu->arch.apic_attention);
2222
	} else {
2223
		__clear_bit(KVM_APIC_CHECK_VAPIC, &vcpu->arch.apic_attention);
2224 2225 2226 2227
	}

	vcpu->arch.apic->vapic_addr = vapic_addr;
	return 0;
A
Avi Kivity 已提交
2228
}
G
Gleb Natapov 已提交
2229 2230 2231 2232 2233 2234

int kvm_x2apic_msr_write(struct kvm_vcpu *vcpu, u32 msr, u64 data)
{
	struct kvm_lapic *apic = vcpu->arch.apic;
	u32 reg = (msr - APIC_BASE_MSR) << 4;

2235
	if (!lapic_in_kernel(vcpu) || !apic_x2apic_mode(apic))
G
Gleb Natapov 已提交
2236 2237
		return 1;

2238 2239 2240
	if (reg == APIC_ICR2)
		return 1;

G
Gleb Natapov 已提交
2241
	/* if this is ICR write vector before command */
2242
	if (reg == APIC_ICR)
2243 2244
		kvm_lapic_reg_write(apic, APIC_ICR2, (u32)(data >> 32));
	return kvm_lapic_reg_write(apic, reg, (u32)data);
G
Gleb Natapov 已提交
2245 2246 2247 2248 2249 2250 2251
}

int kvm_x2apic_msr_read(struct kvm_vcpu *vcpu, u32 msr, u64 *data)
{
	struct kvm_lapic *apic = vcpu->arch.apic;
	u32 reg = (msr - APIC_BASE_MSR) << 4, low, high = 0;

2252
	if (!lapic_in_kernel(vcpu) || !apic_x2apic_mode(apic))
G
Gleb Natapov 已提交
2253 2254
		return 1;

2255 2256 2257 2258 2259 2260
	if (reg == APIC_DFR || reg == APIC_ICR2) {
		apic_debug("KVM_APIC_READ: read x2apic reserved register %x\n",
			   reg);
		return 1;
	}

2261
	if (kvm_lapic_reg_read(apic, reg, 4, &low))
G
Gleb Natapov 已提交
2262
		return 1;
2263
	if (reg == APIC_ICR)
2264
		kvm_lapic_reg_read(apic, APIC_ICR2, 4, &high);
G
Gleb Natapov 已提交
2265 2266 2267 2268 2269

	*data = (((u64)high) << 32) | low;

	return 0;
}
G
Gleb Natapov 已提交
2270 2271 2272 2273 2274

int kvm_hv_vapic_msr_write(struct kvm_vcpu *vcpu, u32 reg, u64 data)
{
	struct kvm_lapic *apic = vcpu->arch.apic;

2275
	if (!lapic_in_kernel(vcpu))
G
Gleb Natapov 已提交
2276 2277 2278 2279
		return 1;

	/* if this is ICR write vector before command */
	if (reg == APIC_ICR)
2280 2281
		kvm_lapic_reg_write(apic, APIC_ICR2, (u32)(data >> 32));
	return kvm_lapic_reg_write(apic, reg, (u32)data);
G
Gleb Natapov 已提交
2282 2283 2284 2285 2286 2287 2288
}

int kvm_hv_vapic_msr_read(struct kvm_vcpu *vcpu, u32 reg, u64 *data)
{
	struct kvm_lapic *apic = vcpu->arch.apic;
	u32 low, high = 0;

2289
	if (!lapic_in_kernel(vcpu))
G
Gleb Natapov 已提交
2290 2291
		return 1;

2292
	if (kvm_lapic_reg_read(apic, reg, 4, &low))
G
Gleb Natapov 已提交
2293 2294
		return 1;
	if (reg == APIC_ICR)
2295
		kvm_lapic_reg_read(apic, APIC_ICR2, 4, &high);
G
Gleb Natapov 已提交
2296 2297 2298 2299 2300

	*data = (((u64)high) << 32) | low;

	return 0;
}
2301 2302 2303 2304 2305 2306 2307 2308 2309 2310 2311

int kvm_lapic_enable_pv_eoi(struct kvm_vcpu *vcpu, u64 data)
{
	u64 addr = data & ~KVM_MSR_ENABLED;
	if (!IS_ALIGNED(addr, 4))
		return 1;

	vcpu->arch.pv_eoi.msr_val = data;
	if (!pv_eoi_enabled(vcpu))
		return 0;
	return kvm_gfn_to_hva_cache_init(vcpu->kvm, &vcpu->arch.pv_eoi.data,
2312
					 addr, sizeof(u8));
2313
}
2314

2315 2316 2317
void kvm_apic_accept_events(struct kvm_vcpu *vcpu)
{
	struct kvm_lapic *apic = vcpu->arch.apic;
2318
	u8 sipi_vector;
2319
	unsigned long pe;
2320

2321
	if (!lapic_in_kernel(vcpu) || !apic->pending_events)
2322 2323
		return;

2324 2325 2326 2327 2328 2329 2330 2331 2332 2333 2334
	/*
	 * INITs are latched while in SMM.  Because an SMM CPU cannot
	 * be in KVM_MP_STATE_INIT_RECEIVED state, just eat SIPIs
	 * and delay processing of INIT until the next RSM.
	 */
	if (is_smm(vcpu)) {
		WARN_ON_ONCE(vcpu->arch.mp_state == KVM_MP_STATE_INIT_RECEIVED);
		if (test_bit(KVM_APIC_SIPI, &apic->pending_events))
			clear_bit(KVM_APIC_SIPI, &apic->pending_events);
		return;
	}
2335

2336
	pe = xchg(&apic->pending_events, 0);
2337
	if (test_bit(KVM_APIC_INIT, &pe)) {
2338 2339
		kvm_lapic_reset(vcpu, true);
		kvm_vcpu_reset(vcpu, true);
2340 2341 2342 2343 2344
		if (kvm_vcpu_is_bsp(apic->vcpu))
			vcpu->arch.mp_state = KVM_MP_STATE_RUNNABLE;
		else
			vcpu->arch.mp_state = KVM_MP_STATE_INIT_RECEIVED;
	}
2345
	if (test_bit(KVM_APIC_SIPI, &pe) &&
2346 2347 2348 2349
	    vcpu->arch.mp_state == KVM_MP_STATE_INIT_RECEIVED) {
		/* evaluate pending_events before reading the vector */
		smp_rmb();
		sipi_vector = apic->sipi_vector;
N
Nadav Amit 已提交
2350
		apic_debug("vcpu %d received sipi with vector # %x\n",
2351 2352 2353 2354 2355 2356
			 vcpu->vcpu_id, sipi_vector);
		kvm_vcpu_deliver_sipi_vector(vcpu, sipi_vector);
		vcpu->arch.mp_state = KVM_MP_STATE_RUNNABLE;
	}
}

2357 2358 2359 2360
void kvm_lapic_init(void)
{
	/* do not patch jump label more than once per second */
	jump_label_rate_limit(&apic_hw_disabled, HZ);
2361
	jump_label_rate_limit(&apic_sw_disabled, HZ);
2362
}