lapic.c 70.9 KB
Newer Older
1
// SPDX-License-Identifier: GPL-2.0-only
E
Eddie Dong 已提交
2 3 4 5 6 7 8

/*
 * Local APIC virtualization
 *
 * Copyright (C) 2006 Qumranet, Inc.
 * Copyright (C) 2007 Novell
 * Copyright (C) 2007 Intel
N
Nicolas Kaiser 已提交
9
 * Copyright 2009 Red Hat, Inc. and/or its affiliates.
E
Eddie Dong 已提交
10 11 12 13 14 15 16 17 18
 *
 * 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.
 */

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

44 45 46 47 48 49
#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 已提交
50 51 52 53 54 55
#define PRId64 "d"
#define PRIx64 "llx"
#define PRIu64 "u"
#define PRIo64 "o"

/* #define apic_debug(fmt,arg...) printk(KERN_WARNING fmt,##arg) */
Y
Yi Wang 已提交
56
#define apic_debug(fmt, arg...) do {} while (0)
E
Eddie Dong 已提交
57 58

/* 14 is the version for Xeon and Pentium 8.4.8*/
59
#define APIC_VERSION			(0x14UL | ((KVM_APIC_LVT_NUM - 1) << 16))
E
Eddie Dong 已提交
60 61 62 63 64 65
#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
66
#define APIC_VECTORS_PER_REG		32
E
Eddie Dong 已提交
67

68 69 70
#define APIC_BROADCAST			0xFF
#define X2APIC_BROADCAST		0xFFFFFFFFul

71
#define LAPIC_TIMER_ADVANCE_ADJUST_DONE 100
72
#define LAPIC_TIMER_ADVANCE_ADJUST_INIT 1000
73 74 75
/* step-by-step approximation to mitigate fluctuation */
#define LAPIC_TIMER_ADVANCE_ADJUST_STEP 8

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

81 82 83 84 85 86 87 88
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);
}

M
Michael S. Tsirkin 已提交
89 90 91 92 93 94 95 96 97 98
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));
}

99
struct static_key_deferred apic_hw_disabled __read_mostly;
100 101
struct static_key_deferred apic_sw_disabled __read_mostly;

E
Eddie Dong 已提交
102 103
static inline int apic_enabled(struct kvm_lapic *apic)
{
104
	return kvm_apic_sw_enabled(apic) &&	kvm_apic_hw_enabled(apic);
105 106
}

E
Eddie Dong 已提交
107 108 109 110 111 112 113
#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)

114 115 116 117 118 119 120 121 122 123
static inline u8 kvm_xapic_id(struct kvm_lapic *apic)
{
	return kvm_lapic_get_reg(apic, APIC_ID) >> 24;
}

static inline u32 kvm_x2apic_id(struct kvm_lapic *apic)
{
	return apic->vcpu->vcpu_id;
}

124 125 126 127 128
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ář 已提交
129
		u32 max_apic_id = map->max_apic_id;
130 131 132 133

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

P
Paolo Bonzini 已提交
134
			offset = array_index_nospec(offset, map->max_apic_id + 1);
135 136 137 138 139
			*cluster = &map->phys_map[offset];
			*mask = dest_id & (0xffff >> (16 - cluster_size));
		} else {
			*mask = 0;
		}
140

141 142 143 144 145 146 147
		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:
148
		*cluster = map->xapic_cluster_map[(dest_id >> 4) & 0xf];
149 150 151 152 153 154
		*mask = dest_id & 0xf;
		return true;
	default:
		/* Not optimized. */
		return false;
	}
155 156
}

157
static void kvm_apic_map_free(struct rcu_head *rcu)
158
{
159
	struct kvm_apic_map *map = container_of(rcu, struct kvm_apic_map, rcu);
160

161
	kvfree(map);
162 163
}

164 165 166 167 168
static void recalculate_apic_map(struct kvm *kvm)
{
	struct kvm_apic_map *new, *old = NULL;
	struct kvm_vcpu *vcpu;
	int i;
169
	u32 max_id = 255; /* enough space for any xAPIC ID */
170 171 172

	mutex_lock(&kvm->arch.apic_map_lock);

R
Radim Krčmář 已提交
173 174
	kvm_for_each_vcpu(i, vcpu, kvm)
		if (kvm_apic_present(vcpu))
175
			max_id = max(max_id, kvm_x2apic_id(vcpu->arch.apic));
R
Radim Krčmář 已提交
176

M
Michal Hocko 已提交
177
	new = kvzalloc(sizeof(struct kvm_apic_map) +
178 179
	                   sizeof(struct kvm_lapic *) * ((u64)max_id + 1),
			   GFP_KERNEL_ACCOUNT);
R
Radim Krčmář 已提交
180

181 182 183
	if (!new)
		goto out;

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

186 187
	kvm_for_each_vcpu(i, vcpu, kvm) {
		struct kvm_lapic *apic = vcpu->arch.apic;
188 189
		struct kvm_lapic **cluster;
		u16 mask;
190 191 192
		u32 ldr;
		u8 xapic_id;
		u32 x2apic_id;
193

194 195 196
		if (!kvm_apic_present(vcpu))
			continue;

197 198 199 200 201 202 203 204 205 206 207 208 209
		xapic_id = kvm_xapic_id(apic);
		x2apic_id = kvm_x2apic_id(apic);

		/* Hotplug hack: see kvm_apic_match_physical_addr(), ... */
		if ((apic_x2apic_mode(apic) || x2apic_id > 0xff) &&
				x2apic_id <= new->max_apic_id)
			new->phys_map[x2apic_id] = apic;
		/*
		 * ... xAPIC ID of VCPUs with APIC ID > 0xff will wrap-around,
		 * prevent them from masking VCPUs with APIC ID <= 0xff.
		 */
		if (!apic_x2apic_mode(apic) && !new->phys_map[xapic_id])
			new->phys_map[xapic_id] = apic;
210

211 212
		ldr = kvm_lapic_get_reg(apic, APIC_LDR);

213 214 215 216
		if (apic_x2apic_mode(apic)) {
			new->mode |= KVM_APIC_MODE_X2APIC;
		} else if (ldr) {
			ldr = GET_APIC_LOGICAL_ID(ldr);
217
			if (kvm_lapic_get_reg(apic, APIC_DFR) == APIC_DFR_FLAT)
218 219 220 221 222
				new->mode |= KVM_APIC_MODE_XAPIC_FLAT;
			else
				new->mode |= KVM_APIC_MODE_XAPIC_CLUSTER;
		}

223
		if (!kvm_apic_map_get_logical_dest(new, ldr, &cluster, &mask))
224 225
			continue;

226 227
		if (mask)
			cluster[ffs(mask) - 1] = apic;
228 229 230 231 232 233 234 235
	}
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)
236
		call_rcu(&old->rcu, kvm_apic_map_free);
237

238
	kvm_make_scan_ioapic_request(kvm);
239 240
}

241 242
static inline void apic_set_spiv(struct kvm_lapic *apic, u32 val)
{
243
	bool enabled = val & APIC_SPIV_APIC_ENABLED;
244

245
	kvm_lapic_set_reg(apic, APIC_SPIV, val);
246 247 248

	if (enabled != apic->sw_enabled) {
		apic->sw_enabled = enabled;
249
		if (enabled)
250
			static_key_slow_dec_deferred(&apic_sw_disabled);
251
		else
252 253 254 255
			static_key_slow_inc(&apic_sw_disabled.key);
	}
}

256
static inline void kvm_apic_set_xapic_id(struct kvm_lapic *apic, u8 id)
257
{
258
	kvm_lapic_set_reg(apic, APIC_ID, id << 24);
259 260 261 262 263
	recalculate_apic_map(apic->vcpu->kvm);
}

static inline void kvm_apic_set_ldr(struct kvm_lapic *apic, u32 id)
{
264
	kvm_lapic_set_reg(apic, APIC_LDR, id);
265 266 267
	recalculate_apic_map(apic->vcpu->kvm);
}

268 269 270 271 272
static inline u32 kvm_apic_calc_x2apic_ldr(u32 id)
{
	return ((id >> 4) << 16) | (1 << (id & 0xf));
}

273
static inline void kvm_apic_set_x2apic_id(struct kvm_lapic *apic, u32 id)
274
{
275
	u32 ldr = kvm_apic_calc_x2apic_ldr(id);
276

277 278
	WARN_ON_ONCE(id != apic->vcpu->vcpu_id);

279
	kvm_lapic_set_reg(apic, APIC_ID, id);
280
	kvm_lapic_set_reg(apic, APIC_LDR, ldr);
281 282 283
	recalculate_apic_map(apic->vcpu->kvm);
}

E
Eddie Dong 已提交
284 285
static inline int apic_lvt_enabled(struct kvm_lapic *apic, int lvt_type)
{
286
	return !(kvm_lapic_get_reg(apic, lvt_type) & APIC_LVT_MASKED);
E
Eddie Dong 已提交
287 288 289 290
}

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

294 295
static inline int apic_lvtt_oneshot(struct kvm_lapic *apic)
{
296
	return apic->lapic_timer.timer_mode == APIC_LVT_TIMER_ONESHOT;
297 298
}

E
Eddie Dong 已提交
299 300
static inline int apic_lvtt_period(struct kvm_lapic *apic)
{
301
	return apic->lapic_timer.timer_mode == APIC_LVT_TIMER_PERIODIC;
302 303 304 305
}

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

309 310 311 312 313
static inline int apic_lvt_nmi_mode(u32 lvt_val)
{
	return (lvt_val & (APIC_MODE_MASK | APIC_LVT_MASKED)) == APIC_DM_NMI;
}

314 315 316 317 318 319
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;

320
	if (!lapic_in_kernel(vcpu))
321 322
		return;

323 324 325 326 327 328 329
	/*
	 * KVM emulates 82093AA datasheet (with in-kernel IOAPIC implementation)
	 * which doesn't have EOI register; Some buggy OSes (e.g. Windows with
	 * Hyper-V role) disable EOI broadcast in lapic not checking for IOAPIC
	 * version first and level-triggered interrupts never get EOIed in
	 * IOAPIC.
	 */
330
	feat = kvm_find_cpuid_entry(apic->vcpu, 0x1, 0);
331 332
	if (feat && (feat->ecx & (1 << (X86_FEATURE_X2APIC & 31))) &&
	    !ioapic_in_kernel(vcpu->kvm))
333
		v |= APIC_LVR_DIRECTED_EOI;
334
	kvm_lapic_set_reg(apic, APIC_LVR, v);
335 336
}

337
static const unsigned int apic_lvt_mask[KVM_APIC_LVT_NUM] = {
338
	LVT_MASK ,      /* part LVTT mask, timer mode mask added at runtime */
E
Eddie Dong 已提交
339 340 341 342 343 344 345 346
	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)
{
347 348
	int vec;
	u32 *reg;
E
Eddie Dong 已提交
349

350 351 352 353
	for (vec = MAX_APIC_VECTOR - APIC_VECTORS_PER_REG;
	     vec >= 0; vec -= APIC_VECTORS_PER_REG) {
		reg = bitmap + REG_POS(vec);
		if (*reg)
354
			return __fls(*reg) + vec;
355
	}
E
Eddie Dong 已提交
356

357
	return -1;
E
Eddie Dong 已提交
358 359
}

M
Michael S. Tsirkin 已提交
360 361
static u8 count_vectors(void *bitmap)
{
362 363
	int vec;
	u32 *reg;
M
Michael S. Tsirkin 已提交
364
	u8 count = 0;
365 366 367 368 369 370

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

M
Michael S. Tsirkin 已提交
371 372 373
	return count;
}

374
bool __kvm_apic_update_irr(u32 *pir, void *regs, int *max_irr)
375
{
376
	u32 i, vec;
377 378 379 380 381
	u32 pir_val, irr_val, prev_irr_val;
	int max_updated_irr;

	max_updated_irr = -1;
	*max_irr = -1;
382

383
	for (i = vec = 0; i <= 7; i++, vec += 32) {
384
		pir_val = READ_ONCE(pir[i]);
385
		irr_val = *((u32 *)(regs + APIC_IRR + i * 0x10));
386
		if (pir_val) {
387
			prev_irr_val = irr_val;
388 389
			irr_val |= xchg(&pir[i], 0);
			*((u32 *)(regs + APIC_IRR + i * 0x10)) = irr_val;
390 391 392 393
			if (prev_irr_val != irr_val) {
				max_updated_irr =
					__fls(irr_val ^ prev_irr_val) + vec;
			}
394
		}
395
		if (irr_val)
396
			*max_irr = __fls(irr_val) + vec;
397
	}
398

399 400
	return ((max_updated_irr != -1) &&
		(max_updated_irr == *max_irr));
401
}
402 403
EXPORT_SYMBOL_GPL(__kvm_apic_update_irr);

404
bool kvm_apic_update_irr(struct kvm_vcpu *vcpu, u32 *pir, int *max_irr)
405 406 407
{
	struct kvm_lapic *apic = vcpu->arch.apic;

408
	return __kvm_apic_update_irr(pir, apic->regs, max_irr);
409
}
410 411
EXPORT_SYMBOL_GPL(kvm_apic_update_irr);

412
static inline int apic_search_irr(struct kvm_lapic *apic)
E
Eddie Dong 已提交
413
{
414
	return find_highest_vector(apic->regs + APIC_IRR);
E
Eddie Dong 已提交
415 416 417 418 419 420
}

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

421 422 423 424
	/*
	 * Note that irr_pending is just a hint. It will be always
	 * true with virtual interrupt delivery enabled.
	 */
425 426 427 428
	if (!apic->irr_pending)
		return -1;

	result = apic_search_irr(apic);
E
Eddie Dong 已提交
429 430 431 432 433
	ASSERT(result == -1 || result >= 16);

	return result;
}

434 435
static inline void apic_clear_irr(int vec, struct kvm_lapic *apic)
{
436 437 438 439
	struct kvm_vcpu *vcpu;

	vcpu = apic->vcpu;

440
	if (unlikely(vcpu->arch.apicv_active)) {
441
		/* need to update RVI */
442
		kvm_lapic_clear_vector(vec, apic->regs + APIC_IRR);
443 444
		kvm_x86_ops->hwapic_irr_update(vcpu,
				apic_find_highest_irr(apic));
445 446
	} else {
		apic->irr_pending = false;
447
		kvm_lapic_clear_vector(vec, apic->regs + APIC_IRR);
448 449
		if (apic_search_irr(apic) != -1)
			apic->irr_pending = true;
450
	}
451 452
}

M
Michael S. Tsirkin 已提交
453 454
static inline void apic_set_isr(int vec, struct kvm_lapic *apic)
{
455 456 457 458 459 460
	struct kvm_vcpu *vcpu;

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

	vcpu = apic->vcpu;
461

M
Michael S. Tsirkin 已提交
462
	/*
463 464 465
	 * 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 已提交
466
	 */
467
	if (unlikely(vcpu->arch.apicv_active))
468
		kvm_x86_ops->hwapic_isr_update(vcpu, vec);
469 470 471 472 473 474 475 476 477 478
	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 已提交
479 480
}

481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499
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 已提交
500 501
static inline void apic_clear_isr(int vec, struct kvm_lapic *apic)
{
502 503 504 505 506 507 508 509 510 511 512 513 514
	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.
	 */
515
	if (unlikely(vcpu->arch.apicv_active))
516
		kvm_x86_ops->hwapic_isr_update(vcpu,
517 518
					       apic_find_highest_isr(apic));
	else {
M
Michael S. Tsirkin 已提交
519
		--apic->isr_count;
520 521 522
		BUG_ON(apic->isr_count < 0);
		apic->highest_isr_cache = -1;
	}
M
Michael S. Tsirkin 已提交
523 524
}

525 526
int kvm_lapic_find_highest_irr(struct kvm_vcpu *vcpu)
{
527 528 529 530 531
	/* 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.
	 */
532
	return apic_find_highest_irr(vcpu->arch.apic);
533
}
534
EXPORT_SYMBOL_GPL(kvm_lapic_find_highest_irr);
535

536
static int __apic_accept_irq(struct kvm_lapic *apic, int delivery_mode,
537
			     int vector, int level, int trig_mode,
538
			     struct dest_map *dest_map);
539

540
int kvm_apic_set_irq(struct kvm_vcpu *vcpu, struct kvm_lapic_irq *irq,
541
		     struct dest_map *dest_map)
E
Eddie Dong 已提交
542
{
543
	struct kvm_lapic *apic = vcpu->arch.apic;
544

545
	return __apic_accept_irq(apic, irq->delivery_mode, irq->vector,
546
			irq->level, irq->trig_mode, dest_map);
E
Eddie Dong 已提交
547 548
}

549
int kvm_pv_send_ipi(struct kvm *kvm, unsigned long ipi_bitmap_low,
550
		    unsigned long ipi_bitmap_high, u32 min,
551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572
		    unsigned long icr, int op_64_bit)
{
	int i;
	struct kvm_apic_map *map;
	struct kvm_vcpu *vcpu;
	struct kvm_lapic_irq irq = {0};
	int cluster_size = op_64_bit ? 64 : 32;
	int count = 0;

	irq.vector = icr & APIC_VECTOR_MASK;
	irq.delivery_mode = icr & APIC_MODE_MASK;
	irq.level = (icr & APIC_INT_ASSERT) != 0;
	irq.trig_mode = icr & APIC_INT_LEVELTRIG;

	if (icr & APIC_DEST_MASK)
		return -KVM_EINVAL;
	if (icr & APIC_SHORT_MASK)
		return -KVM_EINVAL;

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

573 574 575 576 577
	if (unlikely(!map)) {
		count = -EOPNOTSUPP;
		goto out;
	}

578 579
	if (min > map->max_apic_id)
		goto out;
580
	/* Bits above cluster_size are masked in the caller.  */
581 582 583 584 585 586
	for_each_set_bit(i, &ipi_bitmap_low,
		min((u32)BITS_PER_LONG, (map->max_apic_id - min + 1))) {
		if (map->phys_map[min + i]) {
			vcpu = map->phys_map[min + i]->vcpu;
			count += kvm_apic_set_irq(vcpu, &irq, NULL);
		}
587 588 589
	}

	min += cluster_size;
590 591 592 593 594 595 596 597 598 599

	if (min > map->max_apic_id)
		goto out;

	for_each_set_bit(i, &ipi_bitmap_high,
		min((u32)BITS_PER_LONG, (map->max_apic_id - min + 1))) {
		if (map->phys_map[min + i]) {
			vcpu = map->phys_map[min + i]->vcpu;
			count += kvm_apic_set_irq(vcpu, &irq, NULL);
		}
600 601
	}

602
out:
603 604 605 606
	rcu_read_unlock();
	return count;
}

607 608
static int pv_eoi_put_user(struct kvm_vcpu *vcpu, u8 val)
{
609 610 611

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

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

	return kvm_read_guest_cached(vcpu->kvm, &vcpu->arch.pv_eoi.data, val,
				      sizeof(*val));
619 620 621 622 623 624 625 626 627 628 629 630
}

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",
631
			   (unsigned long long)vcpu->arch.pv_eoi.msr_val);
632 633 634 635 636 637 638
	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",
639
			   (unsigned long long)vcpu->arch.pv_eoi.msr_val);
640 641 642 643 644 645 646 647 648
		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",
649
			   (unsigned long long)vcpu->arch.pv_eoi.msr_val);
650 651 652 653 654
		return;
	}
	__clear_bit(KVM_APIC_PV_EOI_PENDING, &vcpu->arch.apic_attention);
}

655 656
static int apic_has_interrupt_for_ppr(struct kvm_lapic *apic, u32 ppr)
{
657
	int highest_irr;
658
	if (apic->vcpu->arch.apicv_active)
659 660 661
		highest_irr = kvm_x86_ops->sync_pir_to_irr(apic->vcpu);
	else
		highest_irr = apic_find_highest_irr(apic);
662 663 664 665 666 667
	if (highest_irr == -1 || (highest_irr & 0xF0) <= ppr)
		return -1;
	return highest_irr;
}

static bool __apic_update_ppr(struct kvm_lapic *apic, u32 *new_ppr)
E
Eddie Dong 已提交
668
{
669
	u32 tpr, isrv, ppr, old_ppr;
E
Eddie Dong 已提交
670 671
	int isr;

672 673
	old_ppr = kvm_lapic_get_reg(apic, APIC_PROCPRI);
	tpr = kvm_lapic_get_reg(apic, APIC_TASKPRI);
E
Eddie Dong 已提交
674 675 676 677 678 679 680 681 682 683 684
	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);

685 686
	*new_ppr = ppr;
	if (old_ppr != ppr)
687
		kvm_lapic_set_reg(apic, APIC_PROCPRI, ppr);
688 689 690 691 692 693 694 695

	return ppr < old_ppr;
}

static void apic_update_ppr(struct kvm_lapic *apic)
{
	u32 ppr;

696 697
	if (__apic_update_ppr(apic, &ppr) &&
	    apic_has_interrupt_for_ppr(apic, ppr) != -1)
698
		kvm_make_request(KVM_REQ_EVENT, apic->vcpu);
E
Eddie Dong 已提交
699 700
}

701 702 703 704 705 706
void kvm_apic_update_ppr(struct kvm_vcpu *vcpu)
{
	apic_update_ppr(vcpu->arch.apic);
}
EXPORT_SYMBOL_GPL(kvm_apic_update_ppr);

E
Eddie Dong 已提交
707 708
static void apic_set_tpr(struct kvm_lapic *apic, u32 tpr)
{
709
	kvm_lapic_set_reg(apic, APIC_TASKPRI, tpr);
E
Eddie Dong 已提交
710 711 712
	apic_update_ppr(apic);
}

713
static bool kvm_apic_broadcast(struct kvm_lapic *apic, u32 mda)
714
{
715 716
	return mda == (apic_x2apic_mode(apic) ?
			X2APIC_BROADCAST : APIC_BROADCAST);
717 718
}

719
static bool kvm_apic_match_physical_addr(struct kvm_lapic *apic, u32 mda)
E
Eddie Dong 已提交
720
{
721 722 723 724
	if (kvm_apic_broadcast(apic, mda))
		return true;

	if (apic_x2apic_mode(apic))
725
		return mda == kvm_x2apic_id(apic);
726

727 728 729 730 731 732 733 734 735
	/*
	 * Hotplug hack: Make LAPIC in xAPIC mode also accept interrupts as if
	 * it were in x2APIC mode.  Hotplugged VCPUs start in xAPIC mode and
	 * this allows unique addressing of VCPUs with APIC ID over 0xff.
	 * The 0xff condition is needed because writeable xAPIC ID.
	 */
	if (kvm_x2apic_id(apic) > 0xff && mda == kvm_x2apic_id(apic))
		return true;

736
	return mda == kvm_xapic_id(apic);
E
Eddie Dong 已提交
737 738
}

739
static bool kvm_apic_match_logical_addr(struct kvm_lapic *apic, u32 mda)
E
Eddie Dong 已提交
740
{
G
Gleb Natapov 已提交
741 742
	u32 logical_id;

743
	if (kvm_apic_broadcast(apic, mda))
744
		return true;
745

746
	logical_id = kvm_lapic_get_reg(apic, APIC_LDR);
E
Eddie Dong 已提交
747

748
	if (apic_x2apic_mode(apic))
749 750
		return ((logical_id >> 16) == (mda >> 16))
		       && (logical_id & mda & 0xffff) != 0;
E
Eddie Dong 已提交
751

752
	logical_id = GET_APIC_LOGICAL_ID(logical_id);
E
Eddie Dong 已提交
753

754
	switch (kvm_lapic_get_reg(apic, APIC_DFR)) {
E
Eddie Dong 已提交
755
	case APIC_DFR_FLAT:
756
		return (logical_id & mda) != 0;
E
Eddie Dong 已提交
757
	case APIC_DFR_CLUSTER:
758 759
		return ((logical_id >> 4) == (mda >> 4))
		       && (logical_id & mda & 0xf) != 0;
E
Eddie Dong 已提交
760
	default:
761
		apic_debug("Bad DFR vcpu %d: %08x\n",
762
			   apic->vcpu->vcpu_id, kvm_lapic_get_reg(apic, APIC_DFR));
763
		return false;
E
Eddie Dong 已提交
764 765 766
	}
}

767 768
/* The KVM local APIC implementation has two quirks:
 *
769 770 771
 *  - Real hardware delivers interrupts destined to x2APIC ID > 0xff to LAPICs
 *    in xAPIC mode if the "destination & 0xff" matches its xAPIC ID.
 *    KVM doesn't do that aliasing.
772 773 774 775 776 777 778 779 780 781
 *
 *  - 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".
782
 */
783 784
static u32 kvm_apic_mda(struct kvm_vcpu *vcpu, unsigned int dest_id,
		struct kvm_lapic *source, struct kvm_lapic *target)
785 786 787
{
	bool ipi = source != NULL;

788
	if (!vcpu->kvm->arch.x2apic_broadcast_quirk_disabled &&
789
	    !ipi && dest_id == APIC_BROADCAST && apic_x2apic_mode(target))
790 791
		return X2APIC_BROADCAST;

792
	return dest_id;
793 794
}

795
bool kvm_apic_match_dest(struct kvm_vcpu *vcpu, struct kvm_lapic *source,
796
			   int short_hand, unsigned int dest, int dest_mode)
E
Eddie Dong 已提交
797
{
798
	struct kvm_lapic *target = vcpu->arch.apic;
799
	u32 mda = kvm_apic_mda(vcpu, dest, source, target);
E
Eddie Dong 已提交
800 801

	apic_debug("target %p, source %p, dest 0x%x, "
802
		   "dest_mode 0x%x, short_hand 0x%x\n",
E
Eddie Dong 已提交
803 804
		   target, source, dest, dest_mode, short_hand);

Z
Zachary Amsden 已提交
805
	ASSERT(target);
E
Eddie Dong 已提交
806 807
	switch (short_hand) {
	case APIC_DEST_NOSHORT:
808
		if (dest_mode == APIC_DEST_PHYSICAL)
809
			return kvm_apic_match_physical_addr(target, mda);
810
		else
811
			return kvm_apic_match_logical_addr(target, mda);
E
Eddie Dong 已提交
812
	case APIC_DEST_SELF:
813
		return target == source;
E
Eddie Dong 已提交
814
	case APIC_DEST_ALLINC:
815
		return true;
E
Eddie Dong 已提交
816
	case APIC_DEST_ALLBUT:
817
		return target != source;
E
Eddie Dong 已提交
818
	default:
819 820
		apic_debug("kvm: apic: Bad dest shorthand value %x\n",
			   short_hand);
821
		return false;
E
Eddie Dong 已提交
822 823
	}
}
824
EXPORT_SYMBOL_GPL(kvm_apic_match_dest);
E
Eddie Dong 已提交
825

826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841
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;
}

842 843 844 845 846 847 848 849 850
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");
	}
}

851 852
static bool kvm_apic_is_broadcast_dest(struct kvm *kvm, struct kvm_lapic **src,
		struct kvm_lapic_irq *irq, struct kvm_apic_map *map)
853
{
854 855 856 857 858 859 860 861 862 863 864 865
	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;
	}
866

867 868
	return false;
}
869

870 871 872 873 874 875 876 877 878 879 880 881 882
/* 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;
883

884 885 886 887 888
	if (irq->shorthand == APIC_DEST_SELF && src) {
		*dst = src;
		*bitmap = 1;
		return true;
	} else if (irq->shorthand)
889 890
		return false;

891
	if (!map || kvm_apic_is_broadcast_dest(kvm, src, irq, map))
892 893
		return false;

894
	if (irq->dest_mode == APIC_DEST_PHYSICAL) {
R
Radim Krčmář 已提交
895
		if (irq->dest_id > map->max_apic_id) {
896 897
			*bitmap = 0;
		} else {
P
Paolo Bonzini 已提交
898 899
			u32 dest_id = array_index_nospec(irq->dest_id, map->max_apic_id + 1);
			*dst = &map->phys_map[dest_id];
900 901
			*bitmap = 1;
		}
902
		return true;
903
	}
904

905 906 907
	*bitmap = 0;
	if (!kvm_apic_map_get_logical_dest(map, irq->dest_id, dst,
				(u16 *)bitmap))
908
		return false;
909

910 911
	if (!kvm_lowest_prio_delivery(irq))
		return true;
912

913 914 915 916 917 918 919 920 921 922
	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;
923
		}
924 925 926
	} else {
		if (!*bitmap)
			return true;
927

928 929
		lowest = kvm_vector_to_index(irq->vector, hweight16(*bitmap),
				bitmap, 16);
930

931 932 933 934 935 936
		if (!(*dst)[lowest]) {
			kvm_apic_disabled_lapic_found(kvm);
			*bitmap = 0;
			return true;
		}
	}
937

938
	*bitmap = (lowest >= 0) ? 1 << lowest : 0;
939

940 941
	return true;
}
942

943 944 945 946 947 948 949 950
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;
951

952
	*r = -1;
953

954 955 956 957
	if (irq->shorthand == APIC_DEST_SELF) {
		*r = kvm_apic_set_irq(src->vcpu, irq, dest_map);
		return true;
	}
958

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

962
	ret = kvm_apic_map_get_dest_lapic(kvm, &src, irq, map, &dst, &bitmap);
963 964
	if (ret) {
		*r = 0;
965 966 967 968
		for_each_set_bit(i, &bitmap, 16) {
			if (!dst[i])
				continue;
			*r += kvm_apic_set_irq(dst[i]->vcpu, irq, dest_map);
969
		}
970
	}
971 972 973 974 975

	rcu_read_unlock();
	return ret;
}

976 977 978 979 980 981 982 983 984 985 986 987 988 989
/*
 * 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.
 */
990 991 992 993
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;
994 995
	unsigned long bitmap;
	struct kvm_lapic **dst = NULL;
996 997 998 999 1000 1001 1002 1003
	bool ret = false;

	if (irq->shorthand)
		return false;

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

1004 1005 1006
	if (kvm_apic_map_get_dest_lapic(kvm, NULL, irq, map, &dst, &bitmap) &&
			hweight16(bitmap) == 1) {
		unsigned long i = find_first_bit(&bitmap, 16);
1007

1008 1009 1010
		if (dst[i]) {
			*dest_vcpu = dst[i]->vcpu;
			ret = true;
1011
		}
1012 1013 1014 1015 1016 1017
	}

	rcu_read_unlock();
	return ret;
}

E
Eddie Dong 已提交
1018 1019 1020 1021 1022
/*
 * 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,
1023
			     int vector, int level, int trig_mode,
1024
			     struct dest_map *dest_map)
E
Eddie Dong 已提交
1025
{
1026
	int result = 0;
1027
	struct kvm_vcpu *vcpu = apic->vcpu;
E
Eddie Dong 已提交
1028

1029 1030
	trace_kvm_apic_accept_irq(vcpu->vcpu_id, delivery_mode,
				  trig_mode, vector);
E
Eddie Dong 已提交
1031 1032
	switch (delivery_mode) {
	case APIC_DM_LOWEST:
1033
		vcpu->arch.apic_arb_prio++;
1034
		/* fall through */
1035
	case APIC_DM_FIXED:
1036 1037 1038
		if (unlikely(trig_mode && !level))
			break;

E
Eddie Dong 已提交
1039 1040 1041 1042
		/* FIXME add logic for vcpu on reset */
		if (unlikely(!apic_enabled(apic)))
			break;

1043 1044
		result = 1;

1045
		if (dest_map) {
1046
			__set_bit(vcpu->vcpu_id, dest_map->map);
1047 1048
			dest_map->vectors[vcpu->vcpu_id] = vector;
		}
1049

1050 1051
		if (apic_test_vector(vector, apic->regs + APIC_TMR) != !!trig_mode) {
			if (trig_mode)
1052 1053
				kvm_lapic_set_vector(vector,
						     apic->regs + APIC_TMR);
1054
			else
1055 1056
				kvm_lapic_clear_vector(vector,
						       apic->regs + APIC_TMR);
1057 1058
		}

1059
		if (vcpu->arch.apicv_active)
1060
			kvm_x86_ops->deliver_posted_interrupt(vcpu, vector);
1061
		else {
1062
			kvm_lapic_set_irr(vector, apic);
1063 1064 1065 1066

			kvm_make_request(KVM_REQ_EVENT, vcpu);
			kvm_vcpu_kick(vcpu);
		}
E
Eddie Dong 已提交
1067 1068 1069
		break;

	case APIC_DM_REMRD:
1070 1071 1072 1073
		result = 1;
		vcpu->arch.pv.pv_unhalted = 1;
		kvm_make_request(KVM_REQ_EVENT, vcpu);
		kvm_vcpu_kick(vcpu);
E
Eddie Dong 已提交
1074 1075 1076
		break;

	case APIC_DM_SMI:
P
Paolo Bonzini 已提交
1077 1078 1079
		result = 1;
		kvm_make_request(KVM_REQ_SMI, vcpu);
		kvm_vcpu_kick(vcpu);
E
Eddie Dong 已提交
1080
		break;
1081

E
Eddie Dong 已提交
1082
	case APIC_DM_NMI:
1083
		result = 1;
1084
		kvm_inject_nmi(vcpu);
J
Jan Kiszka 已提交
1085
		kvm_vcpu_kick(vcpu);
E
Eddie Dong 已提交
1086 1087 1088
		break;

	case APIC_DM_INIT:
1089
		if (!trig_mode || level) {
1090
			result = 1;
1091 1092 1093 1094 1095
			/* 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();
1096
			kvm_make_request(KVM_REQ_EVENT, vcpu);
1097 1098
			kvm_vcpu_kick(vcpu);
		} else {
1099 1100
			apic_debug("Ignoring de-assert INIT to vcpu %d\n",
				   vcpu->vcpu_id);
1101
		}
E
Eddie Dong 已提交
1102 1103 1104
		break;

	case APIC_DM_STARTUP:
1105 1106
		apic_debug("SIPI to vcpu %d vector 0x%02x\n",
			   vcpu->vcpu_id, vector);
1107 1108 1109 1110 1111 1112 1113
		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 已提交
1114 1115
		break;

1116 1117 1118 1119 1120 1121 1122 1123
	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 已提交
1124 1125 1126 1127 1128 1129 1130 1131
	default:
		printk(KERN_ERR "TODO: unsupported delivery mode %x\n",
		       delivery_mode);
		break;
	}
	return result;
}

1132
int kvm_apic_compare_prio(struct kvm_vcpu *vcpu1, struct kvm_vcpu *vcpu2)
1133
{
1134
	return vcpu1->arch.apic_arb_prio - vcpu2->arch.apic_arb_prio;
1135 1136
}

1137 1138
static bool kvm_ioapic_handles_vector(struct kvm_lapic *apic, int vector)
{
1139
	return test_bit(vector, apic->vcpu->arch.ioapic_handled_vectors);
1140 1141
}

1142 1143
static void kvm_ioapic_send_eoi(struct kvm_lapic *apic, int vector)
{
1144 1145 1146 1147 1148
	int trigger_mode;

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

1150 1151 1152 1153 1154
	/* 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;
1155
	}
1156 1157 1158 1159 1160 1161 1162

	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);
1163 1164
}

1165
static int apic_set_eoi(struct kvm_lapic *apic)
E
Eddie Dong 已提交
1166 1167
{
	int vector = apic_find_highest_isr(apic);
1168 1169 1170

	trace_kvm_eoi(apic, vector);

E
Eddie Dong 已提交
1171 1172 1173 1174 1175
	/*
	 * Not every write EOI will has corresponding ISR,
	 * one example is when Kernel check timer on setup_IO_APIC
	 */
	if (vector == -1)
1176
		return vector;
E
Eddie Dong 已提交
1177

M
Michael S. Tsirkin 已提交
1178
	apic_clear_isr(vector, apic);
E
Eddie Dong 已提交
1179 1180
	apic_update_ppr(apic);

1181 1182 1183
	if (test_bit(vector, vcpu_to_synic(apic->vcpu)->vec_bitmap))
		kvm_hv_synic_send_eoi(apic->vcpu, vector);

1184
	kvm_ioapic_send_eoi(apic, vector);
1185
	kvm_make_request(KVM_REQ_EVENT, apic->vcpu);
1186
	return vector;
E
Eddie Dong 已提交
1187 1188
}

1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203
/*
 * 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 已提交
1204 1205
static void apic_send_ipi(struct kvm_lapic *apic)
{
1206 1207
	u32 icr_low = kvm_lapic_get_reg(apic, APIC_ICR);
	u32 icr_high = kvm_lapic_get_reg(apic, APIC_ICR2);
1208
	struct kvm_lapic_irq irq;
E
Eddie Dong 已提交
1209

1210 1211 1212
	irq.vector = icr_low & APIC_VECTOR_MASK;
	irq.delivery_mode = icr_low & APIC_MODE_MASK;
	irq.dest_mode = icr_low & APIC_DEST_MASK;
1213
	irq.level = (icr_low & APIC_INT_ASSERT) != 0;
1214 1215
	irq.trig_mode = icr_low & APIC_INT_LEVELTRIG;
	irq.shorthand = icr_low & APIC_SHORT_MASK;
1216
	irq.msi_redir_hint = false;
G
Gleb Natapov 已提交
1217 1218 1219 1220
	if (apic_x2apic_mode(apic))
		irq.dest_id = icr_high;
	else
		irq.dest_id = GET_APIC_DEST_FIELD(icr_high);
E
Eddie Dong 已提交
1221

1222 1223
	trace_kvm_apic_ipi(icr_low, irq.dest_id);

E
Eddie Dong 已提交
1224 1225
	apic_debug("icr_high 0x%x, icr_low 0x%x, "
		   "short_hand 0x%x, dest 0x%x, trig_mode 0x%x, level 0x%x, "
1226 1227
		   "dest_mode 0x%x, delivery_mode 0x%x, vector 0x%x, "
		   "msi_redir_hint 0x%x\n",
G
Glauber Costa 已提交
1228
		   icr_high, icr_low, irq.shorthand, irq.dest_id,
1229
		   irq.trig_mode, irq.level, irq.dest_mode, irq.delivery_mode,
1230
		   irq.vector, irq.msi_redir_hint);
1231

1232
	kvm_irq_delivery_to_apic(apic->vcpu->kvm, apic, &irq, NULL);
E
Eddie Dong 已提交
1233 1234 1235 1236
}

static u32 apic_get_tmcct(struct kvm_lapic *apic)
{
1237
	ktime_t remaining, now;
1238
	s64 ns;
1239
	u32 tmcct;
E
Eddie Dong 已提交
1240 1241 1242

	ASSERT(apic != NULL);

1243
	/* if initial count is 0, current count should also be 0 */
1244
	if (kvm_lapic_get_reg(apic, APIC_TMICT) == 0 ||
1245
		apic->lapic_timer.period == 0)
1246 1247
		return 0;

1248
	now = ktime_get();
1249
	remaining = ktime_sub(apic->lapic_timer.target_expiration, now);
1250
	if (ktime_to_ns(remaining) < 0)
T
Thomas Gleixner 已提交
1251
		remaining = 0;
1252

1253 1254 1255
	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 已提交
1256 1257 1258 1259

	return tmcct;
}

1260 1261 1262 1263 1264
static void __report_tpr_access(struct kvm_lapic *apic, bool write)
{
	struct kvm_vcpu *vcpu = apic->vcpu;
	struct kvm_run *run = vcpu->run;

1265
	kvm_make_request(KVM_REQ_REPORT_TPR_ACCESS, vcpu);
1266
	run->tpr_access.rip = kvm_rip_read(vcpu);
1267 1268 1269 1270 1271 1272 1273 1274 1275
	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 已提交
1276 1277 1278 1279 1280 1281 1282 1283 1284
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:
1285
		apic_debug("Access APIC ARBPRI register which is for P6\n");
E
Eddie Dong 已提交
1286 1287 1288
		break;

	case APIC_TMCCT:	/* Timer CCR */
1289 1290 1291
		if (apic_lvtt_tscdeadline(apic))
			return 0;

E
Eddie Dong 已提交
1292 1293
		val = apic_get_tmcct(apic);
		break;
1294 1295
	case APIC_PROCPRI:
		apic_update_ppr(apic);
1296
		val = kvm_lapic_get_reg(apic, offset);
1297
		break;
1298 1299 1300
	case APIC_TASKPRI:
		report_tpr_access(apic, false);
		/* fall thru */
E
Eddie Dong 已提交
1301
	default:
1302
		val = kvm_lapic_get_reg(apic, offset);
E
Eddie Dong 已提交
1303 1304 1305 1306 1307 1308
		break;
	}

	return val;
}

G
Gregory Haskins 已提交
1309 1310 1311 1312 1313
static inline struct kvm_lapic *to_lapic(struct kvm_io_device *dev)
{
	return container_of(dev, struct kvm_lapic, dev);
}

1314 1315 1316 1317
#define APIC_REG_MASK(reg)	(1ull << ((reg) >> 4))
#define APIC_REGS_MASK(first, count) \
	(APIC_REG_MASK(first) * ((1ull << (count)) - 1))

1318
int kvm_lapic_reg_read(struct kvm_lapic *apic, u32 offset, int len,
G
Gleb Natapov 已提交
1319
		void *data)
E
Eddie Dong 已提交
1320 1321 1322
{
	unsigned char alignment = offset & 0xf;
	u32 result;
G
Guo Chao 已提交
1323
	/* this bitmask has a bit cleared for each reserved register */
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 1350
	u64 valid_reg_mask =
		APIC_REG_MASK(APIC_ID) |
		APIC_REG_MASK(APIC_LVR) |
		APIC_REG_MASK(APIC_TASKPRI) |
		APIC_REG_MASK(APIC_PROCPRI) |
		APIC_REG_MASK(APIC_LDR) |
		APIC_REG_MASK(APIC_DFR) |
		APIC_REG_MASK(APIC_SPIV) |
		APIC_REGS_MASK(APIC_ISR, APIC_ISR_NR) |
		APIC_REGS_MASK(APIC_TMR, APIC_ISR_NR) |
		APIC_REGS_MASK(APIC_IRR, APIC_ISR_NR) |
		APIC_REG_MASK(APIC_ESR) |
		APIC_REG_MASK(APIC_ICR) |
		APIC_REG_MASK(APIC_ICR2) |
		APIC_REG_MASK(APIC_LVTT) |
		APIC_REG_MASK(APIC_LVTTHMR) |
		APIC_REG_MASK(APIC_LVTPC) |
		APIC_REG_MASK(APIC_LVT0) |
		APIC_REG_MASK(APIC_LVT1) |
		APIC_REG_MASK(APIC_LVTERR) |
		APIC_REG_MASK(APIC_TMICT) |
		APIC_REG_MASK(APIC_TMCCT) |
		APIC_REG_MASK(APIC_TDCR);

	/* ARBPRI is not valid on x2APIC */
	if (!apic_x2apic_mode(apic))
		valid_reg_mask |= APIC_REG_MASK(APIC_ARBPRI);
G
Gleb Natapov 已提交
1351

1352
	if (offset > 0x3f0 || !(valid_reg_mask & APIC_REG_MASK(offset))) {
1353 1354
		apic_debug("KVM_APIC_READ: read reserved register %x\n",
			   offset);
G
Gleb Natapov 已提交
1355 1356 1357
		return 1;
	}

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

1360 1361
	trace_kvm_apic_read(offset, result);

E
Eddie Dong 已提交
1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372
	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;
	}
1373
	return 0;
E
Eddie Dong 已提交
1374
}
1375
EXPORT_SYMBOL_GPL(kvm_lapic_reg_read);
E
Eddie Dong 已提交
1376

G
Gleb Natapov 已提交
1377 1378
static int apic_mmio_in_range(struct kvm_lapic *apic, gpa_t addr)
{
1379 1380
	return addr >= apic->base_address &&
		addr < apic->base_address + LAPIC_MMIO_LENGTH;
G
Gleb Natapov 已提交
1381 1382
}

1383
static int apic_mmio_read(struct kvm_vcpu *vcpu, struct kvm_io_device *this,
G
Gleb Natapov 已提交
1384 1385 1386 1387 1388 1389 1390 1391
			   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;

1392 1393 1394 1395 1396 1397 1398 1399 1400
	if (!kvm_apic_hw_enabled(apic) || apic_x2apic_mode(apic)) {
		if (!kvm_check_has_quirk(vcpu->kvm,
					 KVM_X86_QUIRK_LAPIC_MMIO_HOLE))
			return -EOPNOTSUPP;

		memset(data, 0xff, len);
		return 0;
	}

1401
	kvm_lapic_reg_read(apic, offset, len, data);
G
Gleb Natapov 已提交
1402 1403 1404 1405

	return 0;
}

E
Eddie Dong 已提交
1406 1407 1408 1409
static void update_divide_count(struct kvm_lapic *apic)
{
	u32 tmp1, tmp2, tdcr;

1410
	tdcr = kvm_lapic_get_reg(apic, APIC_TDCR);
E
Eddie Dong 已提交
1411 1412
	tmp1 = tdcr & 0xf;
	tmp2 = ((tmp1 & 0x3) | ((tmp1 & 0x8) >> 1)) + 1;
1413
	apic->divide_count = 0x1 << (tmp2 & 0x7);
E
Eddie Dong 已提交
1414 1415

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

1419 1420 1421 1422 1423 1424 1425
static void limit_periodic_timer_frequency(struct kvm_lapic *apic)
{
	/*
	 * Do not allow the guest to program periodic timers with small
	 * interval, since the hrtimers are not throttled by the host
	 * scheduler.
	 */
1426
	if (apic_lvtt_period(apic) && apic->lapic_timer.period) {
1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439
		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;
		}
	}
}

1440 1441
static void apic_update_lvtt(struct kvm_lapic *apic)
{
1442
	u32 timer_mode = kvm_lapic_get_reg(apic, APIC_LVTT) &
1443 1444 1445
			apic->lapic_timer.timer_mode_mask;

	if (apic->lapic_timer.timer_mode != timer_mode) {
1446
		if (apic_lvtt_tscdeadline(apic) != (timer_mode ==
1447 1448
				APIC_LVT_TIMER_TSCDEADLINE)) {
			hrtimer_cancel(&apic->lapic_timer.timer);
1449 1450 1451
			kvm_lapic_set_reg(apic, APIC_TMICT, 0);
			apic->lapic_timer.period = 0;
			apic->lapic_timer.tscdeadline = 0;
1452
		}
1453
		apic->lapic_timer.timer_mode = timer_mode;
1454
		limit_periodic_timer_frequency(apic);
1455 1456 1457
	}
}

1458 1459 1460
static void apic_timer_expired(struct kvm_lapic *apic)
{
	struct kvm_vcpu *vcpu = apic->vcpu;
1461
	struct swait_queue_head *q = &vcpu->wq;
1462
	struct kvm_timer *ktimer = &apic->lapic_timer;
1463 1464 1465 1466 1467

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

	atomic_inc(&apic->lapic_timer.pending);
1468
	kvm_set_pending_timer(vcpu);
1469

1470 1471 1472 1473
	/*
	 * For x86, the atomic_inc() is serialized, thus
	 * using swait_active() is safe.
	 */
1474
	if (swait_active(q))
1475
		swake_up_one(q);
1476

1477
	if (apic_lvtt_tscdeadline(apic) || ktimer->hv_timer_in_use)
1478 1479 1480 1481 1482 1483 1484 1485 1486 1487 1488
		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;
1489
	u32 reg = kvm_lapic_get_reg(apic, APIC_LVTT);
1490 1491 1492

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

1495
		if (vcpu->arch.apicv_active)
1496 1497 1498 1499
			bitmap = apic->regs + APIC_IRR;

		if (apic_test_vector(vec, bitmap))
			return true;
1500 1501 1502 1503
	}
	return false;
}

1504 1505 1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523
static inline void __wait_lapic_expire(struct kvm_vcpu *vcpu, u64 guest_cycles)
{
	u64 timer_advance_ns = vcpu->arch.apic->lapic_timer.timer_advance_ns;

	/*
	 * If the guest TSC is running at a different ratio than the host, then
	 * convert the delay to nanoseconds to achieve an accurate delay.  Note
	 * that __delay() uses delay_tsc whenever the hardware has TSC, thus
	 * always for VMX enabled hardware.
	 */
	if (vcpu->arch.tsc_scaling_ratio == kvm_default_tsc_scaling_ratio) {
		__delay(min(guest_cycles,
			nsec_to_cycles(vcpu, timer_advance_ns)));
	} else {
		u64 delay_ns = guest_cycles * 1000000ULL;
		do_div(delay_ns, vcpu->arch.virtual_tsc_khz);
		ndelay(min_t(u32, delay_ns, timer_advance_ns));
	}
}

1524
static inline void adjust_lapic_timer_advance(struct kvm_vcpu *vcpu,
1525
					      s64 advance_expire_delta)
1526 1527
{
	struct kvm_lapic *apic = vcpu->arch.apic;
1528
	u32 timer_advance_ns = apic->lapic_timer.timer_advance_ns;
1529 1530 1531
	u64 ns;

	/* too early */
1532 1533
	if (advance_expire_delta < 0) {
		ns = -advance_expire_delta * 1000000ULL;
1534 1535 1536 1537 1538
		do_div(ns, vcpu->arch.virtual_tsc_khz);
		timer_advance_ns -= min((u32)ns,
			timer_advance_ns / LAPIC_TIMER_ADVANCE_ADJUST_STEP);
	} else {
	/* too late */
1539
		ns = advance_expire_delta * 1000000ULL;
1540 1541 1542 1543 1544
		do_div(ns, vcpu->arch.virtual_tsc_khz);
		timer_advance_ns += min((u32)ns,
			timer_advance_ns / LAPIC_TIMER_ADVANCE_ADJUST_STEP);
	}

1545
	if (abs(advance_expire_delta) < LAPIC_TIMER_ADVANCE_ADJUST_DONE)
1546 1547
		apic->lapic_timer.timer_advance_adjust_done = true;
	if (unlikely(timer_advance_ns > 5000)) {
1548 1549
		timer_advance_ns = LAPIC_TIMER_ADVANCE_ADJUST_INIT;
		apic->lapic_timer.timer_advance_adjust_done = false;
1550 1551 1552 1553
	}
	apic->lapic_timer.timer_advance_ns = timer_advance_ns;
}

1554
void kvm_wait_lapic_expire(struct kvm_vcpu *vcpu)
1555 1556 1557
{
	struct kvm_lapic *apic = vcpu->arch.apic;
	u64 guest_tsc, tsc_deadline;
1558 1559 1560 1561 1562 1563 1564 1565 1566

	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;
1567
	guest_tsc = kvm_read_l1_tsc(vcpu, rdtsc());
1568
	apic->lapic_timer.advance_expire_delta = guest_tsc - tsc_deadline;
1569 1570

	if (guest_tsc < tsc_deadline)
1571
		__wait_lapic_expire(vcpu, tsc_deadline - guest_tsc);
1572

1573
	if (unlikely(!apic->lapic_timer.timer_advance_adjust_done))
1574
		adjust_lapic_timer_advance(vcpu, apic->lapic_timer.advance_expire_delta);
1575
}
1576
EXPORT_SYMBOL_GPL(kvm_wait_lapic_expire);
1577

1578 1579
static void start_sw_tscdeadline(struct kvm_lapic *apic)
{
1580 1581
	struct kvm_timer *ktimer = &apic->lapic_timer;
	u64 guest_tsc, tscdeadline = ktimer->tscdeadline;
1582 1583 1584 1585 1586 1587 1588 1589 1590 1591 1592 1593
	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);

1594
	now = ktime_get();
1595
	guest_tsc = kvm_read_l1_tsc(vcpu, rdtsc());
1596 1597 1598 1599 1600

	ns = (tscdeadline - guest_tsc) * 1000000ULL;
	do_div(ns, this_tsc_khz);

	if (likely(tscdeadline > guest_tsc) &&
1601
	    likely(ns > apic->lapic_timer.timer_advance_ns)) {
1602
		expire = ktime_add_ns(now, ns);
1603 1604
		expire = ktime_sub_ns(expire, ktimer->timer_advance_ns);
		hrtimer_start(&ktimer->timer, expire, HRTIMER_MODE_ABS_PINNED);
1605 1606 1607 1608 1609 1610
	} else
		apic_timer_expired(apic);

	local_irq_restore(flags);
}

1611 1612 1613 1614 1615 1616 1617 1618 1619 1620 1621 1622 1623 1624 1625 1626 1627 1628 1629 1630 1631 1632 1633 1634
static void update_target_expiration(struct kvm_lapic *apic, uint32_t old_divisor)
{
	ktime_t now, remaining;
	u64 ns_remaining_old, ns_remaining_new;

	apic->lapic_timer.period = (u64)kvm_lapic_get_reg(apic, APIC_TMICT)
		* APIC_BUS_CYCLE_NS * apic->divide_count;
	limit_periodic_timer_frequency(apic);

	now = ktime_get();
	remaining = ktime_sub(apic->lapic_timer.target_expiration, now);
	if (ktime_to_ns(remaining) < 0)
		remaining = 0;

	ns_remaining_old = ktime_to_ns(remaining);
	ns_remaining_new = mul_u64_u32_div(ns_remaining_old,
	                                   apic->divide_count, old_divisor);

	apic->lapic_timer.tscdeadline +=
		nsec_to_cycles(apic->vcpu, ns_remaining_new) -
		nsec_to_cycles(apic->vcpu, ns_remaining_old);
	apic->lapic_timer.target_expiration = ktime_add_ns(now, ns_remaining_new);
}

1635
static bool set_target_expiration(struct kvm_lapic *apic)
1636 1637
{
	ktime_t now;
1638
	u64 tscl = rdtsc();
1639

1640
	now = ktime_get();
1641
	apic->lapic_timer.period = (u64)kvm_lapic_get_reg(apic, APIC_TMICT)
1642
		* APIC_BUS_CYCLE_NS * apic->divide_count;
1643

1644 1645
	if (!apic->lapic_timer.period) {
		apic->lapic_timer.tscdeadline = 0;
1646
		return false;
1647 1648
	}

1649
	limit_periodic_timer_frequency(apic);
1650 1651 1652 1653 1654 1655 1656 1657 1658 1659

	apic_debug("%s: bus cycle is %" PRId64 "ns, now 0x%016"
		   PRIx64 ", "
		   "timer initial count 0x%x, period %lldns, "
		   "expire @ 0x%016" PRIx64 ".\n", __func__,
		   APIC_BUS_CYCLE_NS, ktime_to_ns(now),
		   kvm_lapic_get_reg(apic, APIC_TMICT),
		   apic->lapic_timer.period,
		   ktime_to_ns(ktime_add_ns(now,
				apic->lapic_timer.period)));
1660 1661 1662 1663 1664 1665 1666 1667 1668 1669

	apic->lapic_timer.tscdeadline = kvm_read_l1_tsc(apic->vcpu, tscl) +
		nsec_to_cycles(apic->vcpu, apic->lapic_timer.period);
	apic->lapic_timer.target_expiration = ktime_add_ns(now, apic->lapic_timer.period);

	return true;
}

static void advance_periodic_target_expiration(struct kvm_lapic *apic)
{
1670 1671 1672 1673 1674 1675 1676 1677 1678 1679 1680
	ktime_t now = ktime_get();
	u64 tscl = rdtsc();
	ktime_t delta;

	/*
	 * Synchronize both deadlines to the same time source or
	 * differences in the periods (caused by differences in the
	 * underlying clocks or numerical approximation errors) will
	 * cause the two to drift apart over time as the errors
	 * accumulate.
	 */
1681 1682 1683
	apic->lapic_timer.target_expiration =
		ktime_add_ns(apic->lapic_timer.target_expiration,
				apic->lapic_timer.period);
1684 1685 1686
	delta = ktime_sub(apic->lapic_timer.target_expiration, now);
	apic->lapic_timer.tscdeadline = kvm_read_l1_tsc(apic->vcpu, tscl) +
		nsec_to_cycles(apic->vcpu, delta);
1687 1688
}

1689 1690 1691 1692 1693 1694 1695 1696 1697 1698 1699 1700 1701 1702 1703 1704 1705 1706 1707 1708
static void start_sw_period(struct kvm_lapic *apic)
{
	if (!apic->lapic_timer.period)
		return;

	if (ktime_after(ktime_get(),
			apic->lapic_timer.target_expiration)) {
		apic_timer_expired(apic);

		if (apic_lvtt_oneshot(apic))
			return;

		advance_periodic_target_expiration(apic);
	}

	hrtimer_start(&apic->lapic_timer.timer,
		apic->lapic_timer.target_expiration,
		HRTIMER_MODE_ABS_PINNED);
}

1709 1710
bool kvm_lapic_hv_timer_in_use(struct kvm_vcpu *vcpu)
{
1711 1712 1713
	if (!lapic_in_kernel(vcpu))
		return false;

1714 1715 1716 1717
	return vcpu->arch.apic->lapic_timer.hv_timer_in_use;
}
EXPORT_SYMBOL_GPL(kvm_lapic_hv_timer_in_use);

1718
static void cancel_hv_timer(struct kvm_lapic *apic)
1719
{
1720
	WARN_ON(preemptible());
1721
	WARN_ON(!apic->lapic_timer.hv_timer_in_use);
1722 1723 1724 1725
	kvm_x86_ops->cancel_hv_timer(apic->vcpu);
	apic->lapic_timer.hv_timer_in_use = false;
}

1726
static bool start_hv_timer(struct kvm_lapic *apic)
1727
{
1728
	struct kvm_timer *ktimer = &apic->lapic_timer;
1729 1730
	struct kvm_vcpu *vcpu = apic->vcpu;
	bool expired;
1731

1732
	WARN_ON(preemptible());
1733 1734 1735
	if (!kvm_x86_ops->set_hv_timer)
		return false;

1736 1737 1738
	if (!ktimer->tscdeadline)
		return false;

1739
	if (kvm_x86_ops->set_hv_timer(vcpu, ktimer->tscdeadline, &expired))
1740 1741 1742 1743
		return false;

	ktimer->hv_timer_in_use = true;
	hrtimer_cancel(&ktimer->timer);
1744

1745
	/*
1746 1747 1748
	 * To simplify handling the periodic timer, leave the hv timer running
	 * even if the deadline timer has expired, i.e. rely on the resulting
	 * VM-Exit to recompute the periodic timer's target expiration.
1749
	 */
1750 1751 1752 1753 1754 1755 1756
	if (!apic_lvtt_period(apic)) {
		/*
		 * Cancel the hv timer if the sw timer fired while the hv timer
		 * was being programmed, or if the hv timer itself expired.
		 */
		if (atomic_read(&ktimer->pending)) {
			cancel_hv_timer(apic);
1757
		} else if (expired) {
1758
			apic_timer_expired(apic);
1759 1760
			cancel_hv_timer(apic);
		}
1761
	}
1762

1763
	trace_kvm_hv_timer_state(vcpu->vcpu_id, ktimer->hv_timer_in_use);
1764

1765 1766 1767
	return true;
}

1768
static void start_sw_timer(struct kvm_lapic *apic)
1769
{
1770
	struct kvm_timer *ktimer = &apic->lapic_timer;
1771 1772

	WARN_ON(preemptible());
1773 1774 1775 1776 1777 1778 1779 1780 1781 1782 1783
	if (apic->lapic_timer.hv_timer_in_use)
		cancel_hv_timer(apic);
	if (!apic_lvtt_period(apic) && atomic_read(&ktimer->pending))
		return;

	if (apic_lvtt_period(apic) || apic_lvtt_oneshot(apic))
		start_sw_period(apic);
	else if (apic_lvtt_tscdeadline(apic))
		start_sw_tscdeadline(apic);
	trace_kvm_hv_timer_state(apic->vcpu->vcpu_id, false);
}
1784

1785 1786
static void restart_apic_timer(struct kvm_lapic *apic)
{
1787
	preempt_disable();
1788 1789 1790 1791

	if (!apic_lvtt_period(apic) && atomic_read(&apic->lapic_timer.pending))
		goto out;

1792 1793
	if (!start_hv_timer(apic))
		start_sw_timer(apic);
1794
out:
1795
	preempt_enable();
1796 1797
}

1798 1799 1800 1801
void kvm_lapic_expired_hv_timer(struct kvm_vcpu *vcpu)
{
	struct kvm_lapic *apic = vcpu->arch.apic;

1802 1803 1804 1805
	preempt_disable();
	/* If the preempt notifier has already run, it also called apic_timer_expired */
	if (!apic->lapic_timer.hv_timer_in_use)
		goto out;
1806 1807 1808 1809 1810 1811
	WARN_ON(swait_active(&vcpu->wq));
	cancel_hv_timer(apic);
	apic_timer_expired(apic);

	if (apic_lvtt_period(apic) && apic->lapic_timer.period) {
		advance_periodic_target_expiration(apic);
1812
		restart_apic_timer(apic);
1813
	}
1814 1815
out:
	preempt_enable();
1816 1817 1818
}
EXPORT_SYMBOL_GPL(kvm_lapic_expired_hv_timer);

1819 1820
void kvm_lapic_switch_to_hv_timer(struct kvm_vcpu *vcpu)
{
1821
	restart_apic_timer(vcpu->arch.apic);
1822 1823 1824 1825 1826 1827 1828
}
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;

1829
	preempt_disable();
1830
	/* Possibly the TSC deadline timer is not enabled yet */
1831 1832
	if (apic->lapic_timer.hv_timer_in_use)
		start_sw_timer(apic);
1833
	preempt_enable();
1834 1835
}
EXPORT_SYMBOL_GPL(kvm_lapic_switch_to_sw_timer);
1836

1837 1838 1839
void kvm_lapic_restart_hv_timer(struct kvm_vcpu *vcpu)
{
	struct kvm_lapic *apic = vcpu->arch.apic;
1840

1841 1842
	WARN_ON(!apic->lapic_timer.hv_timer_in_use);
	restart_apic_timer(apic);
1843 1844
}

E
Eddie Dong 已提交
1845 1846
static void start_apic_timer(struct kvm_lapic *apic)
{
1847
	atomic_set(&apic->lapic_timer.pending, 0);
1848

1849 1850 1851 1852 1853
	if ((apic_lvtt_period(apic) || apic_lvtt_oneshot(apic))
	    && !set_target_expiration(apic))
		return;

	restart_apic_timer(apic);
E
Eddie Dong 已提交
1854 1855
}

1856 1857
static void apic_manage_nmi_watchdog(struct kvm_lapic *apic, u32 lvt0_val)
{
1858
	bool lvt0_in_nmi_mode = apic_lvt_nmi_mode(lvt0_val);
1859

1860 1861 1862
	if (apic->lvt0_in_nmi_mode != lvt0_in_nmi_mode) {
		apic->lvt0_in_nmi_mode = lvt0_in_nmi_mode;
		if (lvt0_in_nmi_mode) {
1863 1864
			apic_debug("Receive NMI setting on APIC_LVT0 "
				   "for cpu %d\n", apic->vcpu->vcpu_id);
1865
			atomic_inc(&apic->vcpu->kvm->arch.vapics_in_nmi_mode);
1866 1867 1868
		} else
			atomic_dec(&apic->vcpu->kvm->arch.vapics_in_nmi_mode);
	}
1869 1870
}

1871
int kvm_lapic_reg_write(struct kvm_lapic *apic, u32 reg, u32 val)
E
Eddie Dong 已提交
1872
{
G
Gleb Natapov 已提交
1873
	int ret = 0;
E
Eddie Dong 已提交
1874

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

G
Gleb Natapov 已提交
1877
	switch (reg) {
E
Eddie Dong 已提交
1878
	case APIC_ID:		/* Local APIC ID */
G
Gleb Natapov 已提交
1879
		if (!apic_x2apic_mode(apic))
1880
			kvm_apic_set_xapic_id(apic, val >> 24);
G
Gleb Natapov 已提交
1881 1882
		else
			ret = 1;
E
Eddie Dong 已提交
1883 1884 1885
		break;

	case APIC_TASKPRI:
1886
		report_tpr_access(apic, true);
E
Eddie Dong 已提交
1887 1888 1889 1890 1891 1892 1893 1894
		apic_set_tpr(apic, val & 0xff);
		break;

	case APIC_EOI:
		apic_set_eoi(apic);
		break;

	case APIC_LDR:
G
Gleb Natapov 已提交
1895
		if (!apic_x2apic_mode(apic))
1896
			kvm_apic_set_ldr(apic, val & APIC_LDR_MASK);
G
Gleb Natapov 已提交
1897 1898
		else
			ret = 1;
E
Eddie Dong 已提交
1899 1900 1901
		break;

	case APIC_DFR:
1902
		if (!apic_x2apic_mode(apic)) {
1903
			kvm_lapic_set_reg(apic, APIC_DFR, val | 0x0FFFFFFF);
1904 1905
			recalculate_apic_map(apic->vcpu->kvm);
		} else
G
Gleb Natapov 已提交
1906
			ret = 1;
E
Eddie Dong 已提交
1907 1908
		break;

1909 1910
	case APIC_SPIV: {
		u32 mask = 0x3ff;
1911
		if (kvm_lapic_get_reg(apic, APIC_LVR) & APIC_LVR_DIRECTED_EOI)
1912
			mask |= APIC_SPIV_DIRECTED_EOI;
1913
		apic_set_spiv(apic, val & mask);
E
Eddie Dong 已提交
1914 1915 1916 1917
		if (!(val & APIC_SPIV_APIC_ENABLED)) {
			int i;
			u32 lvt_val;

1918
			for (i = 0; i < KVM_APIC_LVT_NUM; i++) {
1919
				lvt_val = kvm_lapic_get_reg(apic,
E
Eddie Dong 已提交
1920
						       APIC_LVTT + 0x10 * i);
1921
				kvm_lapic_set_reg(apic, APIC_LVTT + 0x10 * i,
E
Eddie Dong 已提交
1922 1923
					     lvt_val | APIC_LVT_MASKED);
			}
1924
			apic_update_lvtt(apic);
1925
			atomic_set(&apic->lapic_timer.pending, 0);
E
Eddie Dong 已提交
1926 1927 1928

		}
		break;
1929
	}
E
Eddie Dong 已提交
1930 1931
	case APIC_ICR:
		/* No delay here, so we always clear the pending bit */
1932
		kvm_lapic_set_reg(apic, APIC_ICR, val & ~(1 << 12));
E
Eddie Dong 已提交
1933 1934 1935 1936
		apic_send_ipi(apic);
		break;

	case APIC_ICR2:
G
Gleb Natapov 已提交
1937 1938
		if (!apic_x2apic_mode(apic))
			val &= 0xff000000;
1939
		kvm_lapic_set_reg(apic, APIC_ICR2, val);
E
Eddie Dong 已提交
1940 1941
		break;

1942
	case APIC_LVT0:
1943
		apic_manage_nmi_watchdog(apic, val);
1944
		/* fall through */
E
Eddie Dong 已提交
1945 1946 1947 1948 1949
	case APIC_LVTTHMR:
	case APIC_LVTPC:
	case APIC_LVT1:
	case APIC_LVTERR:
		/* TODO: Check vector */
1950
		if (!kvm_apic_sw_enabled(apic))
E
Eddie Dong 已提交
1951 1952
			val |= APIC_LVT_MASKED;

G
Gleb Natapov 已提交
1953
		val &= apic_lvt_mask[(reg - APIC_LVTT) >> 4];
1954
		kvm_lapic_set_reg(apic, reg, val);
E
Eddie Dong 已提交
1955 1956 1957

		break;

1958
	case APIC_LVTT:
1959
		if (!kvm_apic_sw_enabled(apic))
1960 1961
			val |= APIC_LVT_MASKED;
		val &= (apic_lvt_mask[0] | apic->lapic_timer.timer_mode_mask);
1962
		kvm_lapic_set_reg(apic, APIC_LVTT, val);
1963
		apic_update_lvtt(apic);
1964 1965
		break;

E
Eddie Dong 已提交
1966
	case APIC_TMICT:
1967 1968 1969
		if (apic_lvtt_tscdeadline(apic))
			break;

1970
		hrtimer_cancel(&apic->lapic_timer.timer);
1971
		kvm_lapic_set_reg(apic, APIC_TMICT, val);
E
Eddie Dong 已提交
1972
		start_apic_timer(apic);
G
Gleb Natapov 已提交
1973
		break;
E
Eddie Dong 已提交
1974

1975 1976 1977
	case APIC_TDCR: {
		uint32_t old_divisor = apic->divide_count;

E
Eddie Dong 已提交
1978
		if (val & 4)
1979
			apic_debug("KVM_WRITE:TDCR %x\n", val);
1980
		kvm_lapic_set_reg(apic, APIC_TDCR, val);
E
Eddie Dong 已提交
1981
		update_divide_count(apic);
1982 1983 1984 1985 1986 1987
		if (apic->divide_count != old_divisor &&
				apic->lapic_timer.period) {
			hrtimer_cancel(&apic->lapic_timer.timer);
			update_target_expiration(apic, old_divisor);
			restart_apic_timer(apic);
		}
E
Eddie Dong 已提交
1988
		break;
1989
	}
G
Gleb Natapov 已提交
1990 1991
	case APIC_ESR:
		if (apic_x2apic_mode(apic) && val != 0) {
1992
			apic_debug("KVM_WRITE:ESR not zero %x\n", val);
G
Gleb Natapov 已提交
1993 1994 1995 1996 1997 1998
			ret = 1;
		}
		break;

	case APIC_SELF_IPI:
		if (apic_x2apic_mode(apic)) {
1999
			kvm_lapic_reg_write(apic, APIC_ICR, 0x40000 | (val & 0xff));
G
Gleb Natapov 已提交
2000 2001 2002
		} else
			ret = 1;
		break;
E
Eddie Dong 已提交
2003
	default:
G
Gleb Natapov 已提交
2004
		ret = 1;
E
Eddie Dong 已提交
2005 2006
		break;
	}
G
Gleb Natapov 已提交
2007 2008 2009 2010
	if (ret)
		apic_debug("Local APIC Write to read-only register %x\n", reg);
	return ret;
}
2011
EXPORT_SYMBOL_GPL(kvm_lapic_reg_write);
G
Gleb Natapov 已提交
2012

2013
static int apic_mmio_write(struct kvm_vcpu *vcpu, struct kvm_io_device *this,
G
Gleb Natapov 已提交
2014 2015 2016 2017 2018 2019 2020 2021 2022
			    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;

2023 2024 2025 2026 2027 2028 2029 2030
	if (!kvm_apic_hw_enabled(apic) || apic_x2apic_mode(apic)) {
		if (!kvm_check_has_quirk(vcpu->kvm,
					 KVM_X86_QUIRK_LAPIC_MMIO_HOLE))
			return -EOPNOTSUPP;

		return 0;
	}

G
Gleb Natapov 已提交
2031 2032 2033 2034 2035 2036 2037 2038
	/*
	 * 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);
2039
		return 0;
G
Gleb Natapov 已提交
2040 2041 2042 2043 2044 2045 2046 2047 2048
	}

	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);

2049
	kvm_lapic_reg_write(apic, offset, val);
G
Gleb Natapov 已提交
2050

2051
	return 0;
E
Eddie Dong 已提交
2052 2053
}

2054 2055
void kvm_lapic_set_eoi(struct kvm_vcpu *vcpu)
{
2056
	kvm_lapic_reg_write(vcpu->arch.apic, APIC_EOI, 0);
2057 2058 2059
}
EXPORT_SYMBOL_GPL(kvm_lapic_set_eoi);

2060 2061 2062 2063 2064 2065 2066 2067
/* 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;

2068
	kvm_lapic_reg_read(vcpu->arch.apic, offset, 4, &val);
2069 2070

	/* TODO: optimize to just emulate side effect w/o one more write */
2071
	kvm_lapic_reg_write(vcpu->arch.apic, offset, val);
2072 2073 2074
}
EXPORT_SYMBOL_GPL(kvm_apic_write_nodecode);

2075
void kvm_free_lapic(struct kvm_vcpu *vcpu)
E
Eddie Dong 已提交
2076
{
2077 2078
	struct kvm_lapic *apic = vcpu->arch.apic;

2079
	if (!vcpu->arch.apic)
E
Eddie Dong 已提交
2080 2081
		return;

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

2084 2085 2086
	if (!(vcpu->arch.apic_base & MSR_IA32_APICBASE_ENABLE))
		static_key_slow_dec_deferred(&apic_hw_disabled);

2087
	if (!apic->sw_enabled)
2088
		static_key_slow_dec_deferred(&apic_sw_disabled);
E
Eddie Dong 已提交
2089

2090 2091 2092 2093
	if (apic->regs)
		free_page((unsigned long)apic->regs);

	kfree(apic);
E
Eddie Dong 已提交
2094 2095 2096 2097 2098 2099 2100
}

/*
 *----------------------------------------------------------------------
 * LAPIC interface
 *----------------------------------------------------------------------
 */
2101 2102 2103 2104
u64 kvm_get_lapic_tscdeadline_msr(struct kvm_vcpu *vcpu)
{
	struct kvm_lapic *apic = vcpu->arch.apic;

2105 2106
	if (!lapic_in_kernel(vcpu) ||
		!apic_lvtt_tscdeadline(apic))
2107 2108 2109 2110 2111 2112 2113 2114 2115
		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;

2116
	if (!lapic_in_kernel(vcpu) || apic_lvtt_oneshot(apic) ||
2117
			apic_lvtt_period(apic))
2118 2119 2120 2121 2122 2123 2124
		return;

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

E
Eddie Dong 已提交
2125 2126
void kvm_lapic_set_tpr(struct kvm_vcpu *vcpu, unsigned long cr8)
{
2127
	struct kvm_lapic *apic = vcpu->arch.apic;
E
Eddie Dong 已提交
2128

A
Avi Kivity 已提交
2129
	apic_set_tpr(apic, ((cr8 & 0x0f) << 4)
2130
		     | (kvm_lapic_get_reg(apic, APIC_TASKPRI) & 4));
E
Eddie Dong 已提交
2131 2132 2133 2134 2135 2136
}

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

2137
	tpr = (u64) kvm_lapic_get_reg(vcpu->arch.apic, APIC_TASKPRI);
E
Eddie Dong 已提交
2138 2139 2140 2141 2142 2143

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

void kvm_lapic_set_base(struct kvm_vcpu *vcpu, u64 value)
{
2144
	u64 old_value = vcpu->arch.apic_base;
2145
	struct kvm_lapic *apic = vcpu->arch.apic;
E
Eddie Dong 已提交
2146

2147
	if (!apic)
E
Eddie Dong 已提交
2148
		value |= MSR_IA32_APICBASE_BSP;
2149

2150 2151
	vcpu->arch.apic_base = value;

2152 2153 2154 2155 2156 2157
	if ((old_value ^ value) & MSR_IA32_APICBASE_ENABLE)
		kvm_update_cpuid(vcpu);

	if (!apic)
		return;

2158
	/* update jump label if enable bit changes */
2159
	if ((old_value ^ value) & MSR_IA32_APICBASE_ENABLE) {
2160 2161
		if (value & MSR_IA32_APICBASE_ENABLE) {
			kvm_apic_set_xapic_id(apic, vcpu->vcpu_id);
2162
			static_key_slow_dec_deferred(&apic_hw_disabled);
2163
		} else {
2164
			static_key_slow_inc(&apic_hw_disabled.key);
2165 2166
			recalculate_apic_map(vcpu->kvm);
		}
2167 2168
	}

2169 2170 2171 2172 2173
	if (((old_value ^ value) & X2APIC_ENABLE) && (value & X2APIC_ENABLE))
		kvm_apic_set_x2apic_id(apic, vcpu->vcpu_id);

	if ((old_value ^ value) & (MSR_IA32_APICBASE_ENABLE | X2APIC_ENABLE))
		kvm_x86_ops->set_virtual_apic_mode(vcpu);
2174

2175
	apic->base_address = apic->vcpu->arch.apic_base &
E
Eddie Dong 已提交
2176 2177
			     MSR_IA32_APICBASE_BASE;

2178 2179 2180 2181
	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 已提交
2182 2183
	/* with FSB delivery interrupt, we can restart APIC functionality */
	apic_debug("apic base msr is 0x%016" PRIx64 ", and base address is "
2184
		   "0x%lx.\n", apic->vcpu->arch.apic_base, apic->base_address);
E
Eddie Dong 已提交
2185 2186 2187

}

2188
void kvm_lapic_reset(struct kvm_vcpu *vcpu, bool init_event)
E
Eddie Dong 已提交
2189
{
2190
	struct kvm_lapic *apic = vcpu->arch.apic;
E
Eddie Dong 已提交
2191 2192
	int i;

2193 2194
	if (!apic)
		return;
E
Eddie Dong 已提交
2195

2196
	apic_debug("%s\n", __func__);
E
Eddie Dong 已提交
2197 2198

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

2201 2202 2203
	if (!init_event) {
		kvm_lapic_set_base(vcpu, APIC_DEFAULT_PHYS_BASE |
		                         MSR_IA32_APICBASE_ENABLE);
2204
		kvm_apic_set_xapic_id(apic, vcpu->vcpu_id);
2205
	}
2206
	kvm_apic_set_version(apic->vcpu);
E
Eddie Dong 已提交
2207

2208 2209
	for (i = 0; i < KVM_APIC_LVT_NUM; i++)
		kvm_lapic_set_reg(apic, APIC_LVTT + 0x10 * i, APIC_LVT_MASKED);
2210
	apic_update_lvtt(apic);
2211 2212
	if (kvm_vcpu_is_reset_bsp(vcpu) &&
	    kvm_check_has_quirk(vcpu->kvm, KVM_X86_QUIRK_LINT0_REENABLED))
2213
		kvm_lapic_set_reg(apic, APIC_LVT0,
2214
			     SET_APIC_DELIVERY_MODE(0, APIC_MODE_EXTINT));
2215
	apic_manage_nmi_watchdog(apic, kvm_lapic_get_reg(apic, APIC_LVT0));
E
Eddie Dong 已提交
2216

2217
	kvm_lapic_set_reg(apic, APIC_DFR, 0xffffffffU);
2218
	apic_set_spiv(apic, 0xff);
2219
	kvm_lapic_set_reg(apic, APIC_TASKPRI, 0);
2220 2221
	if (!apic_x2apic_mode(apic))
		kvm_apic_set_ldr(apic, 0);
2222 2223 2224 2225 2226
	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 已提交
2227
	for (i = 0; i < 8; i++) {
2228 2229 2230
		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 已提交
2231
	}
2232 2233
	apic->irr_pending = vcpu->arch.apicv_active;
	apic->isr_count = vcpu->arch.apicv_active ? 1 : 0;
M
Michael S. Tsirkin 已提交
2234
	apic->highest_isr_cache = -1;
2235
	update_divide_count(apic);
2236
	atomic_set(&apic->lapic_timer.pending, 0);
2237
	if (kvm_vcpu_is_bsp(vcpu))
2238 2239
		kvm_lapic_set_base(vcpu,
				vcpu->arch.apic_base | MSR_IA32_APICBASE_BSP);
2240
	vcpu->arch.pv_eoi.msr_val = 0;
E
Eddie Dong 已提交
2241
	apic_update_ppr(apic);
2242 2243 2244 2245 2246
	if (vcpu->arch.apicv_active) {
		kvm_x86_ops->apicv_post_state_restore(vcpu);
		kvm_x86_ops->hwapic_irr_update(vcpu, -1);
		kvm_x86_ops->hwapic_isr_update(vcpu, -1);
	}
E
Eddie Dong 已提交
2247

2248
	vcpu->arch.apic_arb_prio = 0;
2249
	vcpu->arch.apic_attention = 0;
2250

2251
	apic_debug("%s: vcpu=%p, id=0x%x, base_msr="
2252
		   "0x%016" PRIx64 ", base_address=0x%0lx.\n", __func__,
2253
		   vcpu, kvm_lapic_get_reg(apic, APIC_ID),
2254
		   vcpu->arch.apic_base, apic->base_address);
E
Eddie Dong 已提交
2255 2256 2257 2258 2259 2260 2261
}

/*
 *----------------------------------------------------------------------
 * timer interface
 *----------------------------------------------------------------------
 */
2262

A
Avi Kivity 已提交
2263
static bool lapic_is_periodic(struct kvm_lapic *apic)
E
Eddie Dong 已提交
2264
{
2265
	return apic_lvtt_period(apic);
E
Eddie Dong 已提交
2266 2267
}

2268 2269
int apic_has_pending_timer(struct kvm_vcpu *vcpu)
{
2270
	struct kvm_lapic *apic = vcpu->arch.apic;
2271

2272
	if (apic_enabled(apic) && apic_lvt_enabled(apic, APIC_LVTT))
2273
		return atomic_read(&apic->lapic_timer.pending);
2274 2275 2276 2277

	return 0;
}

A
Avi Kivity 已提交
2278
int kvm_apic_local_deliver(struct kvm_lapic *apic, int lvt_type)
2279
{
2280
	u32 reg = kvm_lapic_get_reg(apic, lvt_type);
2281 2282
	int vector, mode, trig_mode;

2283
	if (kvm_apic_hw_enabled(apic) && !(reg & APIC_LVT_MASKED)) {
2284 2285 2286
		vector = reg & APIC_VECTOR_MASK;
		mode = reg & APIC_MODE_MASK;
		trig_mode = reg & APIC_LVT_LEVEL_TRIGGER;
2287 2288
		return __apic_accept_irq(apic, mode, vector, 1, trig_mode,
					NULL);
2289 2290 2291
	}
	return 0;
}
2292

2293
void kvm_apic_nmi_wd_deliver(struct kvm_vcpu *vcpu)
2294
{
2295 2296 2297 2298
	struct kvm_lapic *apic = vcpu->arch.apic;

	if (apic)
		kvm_apic_local_deliver(apic, APIC_LVT0);
2299 2300
}

G
Gregory Haskins 已提交
2301 2302 2303 2304 2305
static const struct kvm_io_device_ops apic_mmio_ops = {
	.read     = apic_mmio_read,
	.write    = apic_mmio_write,
};

2306 2307 2308
static enum hrtimer_restart apic_timer_fn(struct hrtimer *data)
{
	struct kvm_timer *ktimer = container_of(data, struct kvm_timer, timer);
A
Avi Kivity 已提交
2309
	struct kvm_lapic *apic = container_of(ktimer, struct kvm_lapic, lapic_timer);
2310

2311
	apic_timer_expired(apic);
2312

A
Avi Kivity 已提交
2313
	if (lapic_is_periodic(apic)) {
2314
		advance_periodic_target_expiration(apic);
2315 2316 2317 2318 2319 2320
		hrtimer_add_expires_ns(&ktimer->timer, ktimer->period);
		return HRTIMER_RESTART;
	} else
		return HRTIMER_NORESTART;
}

2321
int kvm_create_lapic(struct kvm_vcpu *vcpu, int timer_advance_ns)
E
Eddie Dong 已提交
2322 2323 2324 2325 2326 2327
{
	struct kvm_lapic *apic;

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

2328
	apic = kzalloc(sizeof(*apic), GFP_KERNEL_ACCOUNT);
E
Eddie Dong 已提交
2329 2330 2331
	if (!apic)
		goto nomem;

2332
	vcpu->arch.apic = apic;
E
Eddie Dong 已提交
2333

2334
	apic->regs = (void *)get_zeroed_page(GFP_KERNEL_ACCOUNT);
2335
	if (!apic->regs) {
E
Eddie Dong 已提交
2336 2337
		printk(KERN_ERR "malloc apic regs error for vcpu %x\n",
		       vcpu->vcpu_id);
2338
		goto nomem_free_apic;
E
Eddie Dong 已提交
2339 2340 2341
	}
	apic->vcpu = vcpu;

2342
	hrtimer_init(&apic->lapic_timer.timer, CLOCK_MONOTONIC,
2343
		     HRTIMER_MODE_ABS_PINNED);
2344
	apic->lapic_timer.timer.function = apic_timer_fn;
2345
	if (timer_advance_ns == -1) {
2346
		apic->lapic_timer.timer_advance_ns = LAPIC_TIMER_ADVANCE_ADJUST_INIT;
2347 2348 2349 2350 2351 2352
		apic->lapic_timer.timer_advance_adjust_done = false;
	} else {
		apic->lapic_timer.timer_advance_ns = timer_advance_ns;
		apic->lapic_timer.timer_advance_adjust_done = true;
	}

2353

2354 2355
	/*
	 * APIC is created enabled. This will prevent kvm_lapic_set_base from
2356
	 * thinking that APIC state has changed.
2357 2358
	 */
	vcpu->arch.apic_base = MSR_IA32_APICBASE_ENABLE;
2359
	static_key_slow_inc(&apic_sw_disabled.key); /* sw disabled at reset */
G
Gregory Haskins 已提交
2360
	kvm_iodevice_init(&apic->dev, &apic_mmio_ops);
E
Eddie Dong 已提交
2361 2362

	return 0;
2363 2364
nomem_free_apic:
	kfree(apic);
2365
	vcpu->arch.apic = NULL;
E
Eddie Dong 已提交
2366 2367 2368 2369 2370 2371
nomem:
	return -ENOMEM;
}

int kvm_apic_has_interrupt(struct kvm_vcpu *vcpu)
{
2372
	struct kvm_lapic *apic = vcpu->arch.apic;
2373
	u32 ppr;
E
Eddie Dong 已提交
2374

2375
	if (!kvm_apic_hw_enabled(apic))
E
Eddie Dong 已提交
2376 2377
		return -1;

2378 2379
	__apic_update_ppr(apic, &ppr);
	return apic_has_interrupt_for_ppr(apic, ppr);
E
Eddie Dong 已提交
2380 2381
}

Q
Qing He 已提交
2382 2383
int kvm_apic_accept_pic_intr(struct kvm_vcpu *vcpu)
{
2384
	u32 lvt0 = kvm_lapic_get_reg(vcpu->arch.apic, APIC_LVT0);
Q
Qing He 已提交
2385 2386
	int r = 0;

2387
	if (!kvm_apic_hw_enabled(vcpu->arch.apic))
2388 2389 2390 2391
		r = 1;
	if ((lvt0 & APIC_LVT_MASKED) == 0 &&
	    GET_APIC_DELIVERY_MODE(lvt0) == APIC_MODE_EXTINT)
		r = 1;
Q
Qing He 已提交
2392 2393 2394
	return r;
}

2395 2396
void kvm_inject_apic_timer_irqs(struct kvm_vcpu *vcpu)
{
2397
	struct kvm_lapic *apic = vcpu->arch.apic;
2398

2399
	if (atomic_read(&apic->lapic_timer.pending) > 0) {
2400
		kvm_apic_local_deliver(apic, APIC_LVTT);
2401 2402
		if (apic_lvtt_tscdeadline(apic))
			apic->lapic_timer.tscdeadline = 0;
2403 2404
		if (apic_lvtt_oneshot(apic)) {
			apic->lapic_timer.tscdeadline = 0;
T
Thomas Gleixner 已提交
2405
			apic->lapic_timer.target_expiration = 0;
2406
		}
2407
		atomic_set(&apic->lapic_timer.pending, 0);
2408 2409 2410
	}
}

E
Eddie Dong 已提交
2411 2412 2413
int kvm_get_apic_interrupt(struct kvm_vcpu *vcpu)
{
	int vector = kvm_apic_has_interrupt(vcpu);
2414
	struct kvm_lapic *apic = vcpu->arch.apic;
2415
	u32 ppr;
E
Eddie Dong 已提交
2416 2417 2418 2419

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

2420 2421 2422 2423 2424 2425 2426
	/*
	 * 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.
	 */

E
Eddie Dong 已提交
2427
	apic_clear_irr(vector, apic);
2428
	if (test_bit(vector, vcpu_to_synic(vcpu)->auto_eoi_bitmap)) {
2429 2430 2431 2432 2433
		/*
		 * For auto-EOI interrupts, there might be another pending
		 * interrupt above PPR, so check whether to raise another
		 * KVM_REQ_EVENT.
		 */
2434
		apic_update_ppr(apic);
2435 2436 2437 2438 2439 2440 2441 2442 2443
	} else {
		/*
		 * For normal interrupts, PPR has been raised and there cannot
		 * be a higher-priority pending interrupt---except if there was
		 * a concurrent interrupt injection, but that would have
		 * triggered KVM_REQ_EVENT already.
		 */
		apic_set_isr(vector, apic);
		__apic_update_ppr(apic, &ppr);
2444 2445
	}

E
Eddie Dong 已提交
2446 2447
	return vector;
}
2448

2449 2450 2451 2452 2453
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);
2454
		u32 *ldr = (u32 *)(s->regs + APIC_LDR);
2455

2456 2457 2458 2459 2460 2461 2462 2463 2464
		if (vcpu->kvm->arch.x2apic_format) {
			if (*id != vcpu->vcpu_id)
				return -EINVAL;
		} else {
			if (set)
				*id >>= 24;
			else
				*id <<= 24;
		}
2465 2466 2467 2468

		/* In x2APIC mode, the LDR is fixed and based on the id */
		if (set)
			*ldr = kvm_apic_calc_x2apic_ldr(*id);
2469 2470 2471 2472 2473 2474 2475 2476 2477 2478 2479 2480
	}

	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)
2481
{
2482
	struct kvm_lapic *apic = vcpu->arch.apic;
2483 2484
	int r;

2485

2486
	kvm_lapic_set_base(vcpu, vcpu->arch.apic_base);
2487 2488
	/* set SPIV separately to get count of SW disabled APICs right */
	apic_set_spiv(apic, *((u32 *)(s->regs + APIC_SPIV)));
2489 2490 2491 2492

	r = kvm_apic_state_fixup(vcpu, s, true);
	if (r)
		return r;
2493
	memcpy(vcpu->arch.apic->regs, s->regs, sizeof(*s));
2494 2495

	recalculate_apic_map(vcpu->kvm);
2496 2497
	kvm_apic_set_version(vcpu);

2498
	apic_update_ppr(apic);
2499
	hrtimer_cancel(&apic->lapic_timer.timer);
2500
	apic_update_lvtt(apic);
2501
	apic_manage_nmi_watchdog(apic, kvm_lapic_get_reg(apic, APIC_LVT0));
2502 2503
	update_divide_count(apic);
	start_apic_timer(apic);
2504
	apic->irr_pending = true;
2505
	apic->isr_count = vcpu->arch.apicv_active ?
2506
				1 : count_vectors(apic->regs + APIC_ISR);
M
Michael S. Tsirkin 已提交
2507
	apic->highest_isr_cache = -1;
2508
	if (vcpu->arch.apicv_active) {
2509
		kvm_x86_ops->apicv_post_state_restore(vcpu);
W
Wei Wang 已提交
2510 2511
		kvm_x86_ops->hwapic_irr_update(vcpu,
				apic_find_highest_irr(apic));
2512
		kvm_x86_ops->hwapic_isr_update(vcpu,
2513
				apic_find_highest_isr(apic));
2514
	}
2515
	kvm_make_request(KVM_REQ_EVENT, vcpu);
2516 2517
	if (ioapic_in_kernel(vcpu->kvm))
		kvm_rtc_eoi_tracking_restore_one(vcpu);
2518 2519

	vcpu->arch.apic_arb_prio = 0;
2520 2521

	return 0;
2522
}
2523

2524
void __kvm_migrate_apic_timer(struct kvm_vcpu *vcpu)
2525 2526 2527
{
	struct hrtimer *timer;

2528
	if (!lapic_in_kernel(vcpu))
2529 2530
		return;

2531
	timer = &vcpu->arch.apic->lapic_timer.timer;
2532
	if (hrtimer_cancel(timer))
2533
		hrtimer_start_expires(timer, HRTIMER_MODE_ABS_PINNED);
2534
}
A
Avi Kivity 已提交
2535

2536 2537 2538 2539 2540 2541 2542 2543 2544 2545 2546 2547 2548 2549 2550 2551 2552 2553 2554 2555 2556 2557 2558 2559 2560 2561 2562 2563 2564 2565 2566 2567 2568 2569 2570 2571 2572
/*
 * 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 已提交
2573 2574 2575 2576
void kvm_lapic_sync_from_vapic(struct kvm_vcpu *vcpu)
{
	u32 data;

2577 2578 2579
	if (test_bit(KVM_APIC_PV_EOI_PENDING, &vcpu->arch.apic_attention))
		apic_sync_pv_eoi_from_guest(vcpu, vcpu->arch.apic);

2580
	if (!test_bit(KVM_APIC_CHECK_VAPIC, &vcpu->arch.apic_attention))
A
Avi Kivity 已提交
2581 2582
		return;

2583 2584
	if (kvm_read_guest_cached(vcpu->kvm, &vcpu->arch.apic->vapic_cache, &data,
				  sizeof(u32)))
2585
		return;
A
Avi Kivity 已提交
2586 2587 2588 2589

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

2590 2591 2592 2593 2594 2595 2596 2597 2598 2599 2600 2601 2602 2603 2604
/*
 * 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. */
2605
	    kvm_ioapic_handles_vector(apic, apic->highest_isr_cache)) {
2606 2607 2608 2609 2610 2611 2612 2613 2614 2615
		/*
		 * 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 已提交
2616 2617 2618 2619
void kvm_lapic_sync_to_vapic(struct kvm_vcpu *vcpu)
{
	u32 data, tpr;
	int max_irr, max_isr;
2620
	struct kvm_lapic *apic = vcpu->arch.apic;
A
Avi Kivity 已提交
2621

2622 2623
	apic_sync_pv_eoi_to_guest(vcpu, apic);

2624
	if (!test_bit(KVM_APIC_CHECK_VAPIC, &vcpu->arch.apic_attention))
A
Avi Kivity 已提交
2625 2626
		return;

2627
	tpr = kvm_lapic_get_reg(apic, APIC_TASKPRI) & 0xff;
A
Avi Kivity 已提交
2628 2629 2630 2631 2632 2633 2634 2635
	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);

2636 2637
	kvm_write_guest_cached(vcpu->kvm, &vcpu->arch.apic->vapic_cache, &data,
				sizeof(u32));
A
Avi Kivity 已提交
2638 2639
}

2640
int kvm_lapic_set_vapic_addr(struct kvm_vcpu *vcpu, gpa_t vapic_addr)
A
Avi Kivity 已提交
2641
{
2642
	if (vapic_addr) {
2643
		if (kvm_gfn_to_hva_cache_init(vcpu->kvm,
2644 2645 2646
					&vcpu->arch.apic->vapic_cache,
					vapic_addr, sizeof(u32)))
			return -EINVAL;
2647
		__set_bit(KVM_APIC_CHECK_VAPIC, &vcpu->arch.apic_attention);
2648
	} else {
2649
		__clear_bit(KVM_APIC_CHECK_VAPIC, &vcpu->arch.apic_attention);
2650 2651 2652 2653
	}

	vcpu->arch.apic->vapic_addr = vapic_addr;
	return 0;
A
Avi Kivity 已提交
2654
}
G
Gleb Natapov 已提交
2655 2656 2657 2658 2659 2660

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;

2661
	if (!lapic_in_kernel(vcpu) || !apic_x2apic_mode(apic))
G
Gleb Natapov 已提交
2662 2663
		return 1;

2664 2665 2666
	if (reg == APIC_ICR2)
		return 1;

G
Gleb Natapov 已提交
2667
	/* if this is ICR write vector before command */
2668
	if (reg == APIC_ICR)
2669 2670
		kvm_lapic_reg_write(apic, APIC_ICR2, (u32)(data >> 32));
	return kvm_lapic_reg_write(apic, reg, (u32)data);
G
Gleb Natapov 已提交
2671 2672 2673 2674 2675 2676 2677
}

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;

2678
	if (!lapic_in_kernel(vcpu) || !apic_x2apic_mode(apic))
G
Gleb Natapov 已提交
2679 2680
		return 1;

2681 2682 2683 2684 2685 2686
	if (reg == APIC_DFR || reg == APIC_ICR2) {
		apic_debug("KVM_APIC_READ: read x2apic reserved register %x\n",
			   reg);
		return 1;
	}

2687
	if (kvm_lapic_reg_read(apic, reg, 4, &low))
G
Gleb Natapov 已提交
2688
		return 1;
2689
	if (reg == APIC_ICR)
2690
		kvm_lapic_reg_read(apic, APIC_ICR2, 4, &high);
G
Gleb Natapov 已提交
2691 2692 2693 2694 2695

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

	return 0;
}
G
Gleb Natapov 已提交
2696 2697 2698 2699 2700

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

2701
	if (!lapic_in_kernel(vcpu))
G
Gleb Natapov 已提交
2702 2703 2704 2705
		return 1;

	/* if this is ICR write vector before command */
	if (reg == APIC_ICR)
2706 2707
		kvm_lapic_reg_write(apic, APIC_ICR2, (u32)(data >> 32));
	return kvm_lapic_reg_write(apic, reg, (u32)data);
G
Gleb Natapov 已提交
2708 2709 2710 2711 2712 2713 2714
}

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;

2715
	if (!lapic_in_kernel(vcpu))
G
Gleb Natapov 已提交
2716 2717
		return 1;

2718
	if (kvm_lapic_reg_read(apic, reg, 4, &low))
G
Gleb Natapov 已提交
2719 2720
		return 1;
	if (reg == APIC_ICR)
2721
		kvm_lapic_reg_read(apic, APIC_ICR2, 4, &high);
G
Gleb Natapov 已提交
2722 2723 2724 2725 2726

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

	return 0;
}
2727

2728
int kvm_lapic_enable_pv_eoi(struct kvm_vcpu *vcpu, u64 data, unsigned long len)
2729 2730
{
	u64 addr = data & ~KVM_MSR_ENABLED;
2731 2732 2733
	struct gfn_to_hva_cache *ghc = &vcpu->arch.pv_eoi.data;
	unsigned long new_len;

2734 2735 2736 2737 2738 2739
	if (!IS_ALIGNED(addr, 4))
		return 1;

	vcpu->arch.pv_eoi.msr_val = data;
	if (!pv_eoi_enabled(vcpu))
		return 0;
2740 2741 2742 2743 2744 2745 2746

	if (addr == ghc->gpa && len <= ghc->len)
		new_len = ghc->len;
	else
		new_len = len;

	return kvm_gfn_to_hva_cache_init(vcpu->kvm, ghc, addr, new_len);
2747
}
2748

2749 2750 2751
void kvm_apic_accept_events(struct kvm_vcpu *vcpu)
{
	struct kvm_lapic *apic = vcpu->arch.apic;
2752
	u8 sipi_vector;
2753
	unsigned long pe;
2754

2755
	if (!lapic_in_kernel(vcpu) || !apic->pending_events)
2756 2757
		return;

2758 2759 2760 2761 2762 2763 2764 2765 2766 2767 2768
	/*
	 * 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;
	}
2769

2770
	pe = xchg(&apic->pending_events, 0);
2771
	if (test_bit(KVM_APIC_INIT, &pe)) {
2772
		kvm_vcpu_reset(vcpu, true);
2773 2774 2775 2776 2777
		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;
	}
2778
	if (test_bit(KVM_APIC_SIPI, &pe) &&
2779 2780 2781 2782
	    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 已提交
2783
		apic_debug("vcpu %d received sipi with vector # %x\n",
2784 2785 2786 2787 2788 2789
			 vcpu->vcpu_id, sipi_vector);
		kvm_vcpu_deliver_sipi_vector(vcpu, sipi_vector);
		vcpu->arch.mp_state = KVM_MP_STATE_RUNNABLE;
	}
}

2790 2791 2792 2793
void kvm_lapic_init(void)
{
	/* do not patch jump label more than once per second */
	jump_label_rate_limit(&apic_hw_disabled, HZ);
2794
	jump_label_rate_limit(&apic_sw_disabled, HZ);
2795
}
2796 2797 2798 2799 2800 2801

void kvm_lapic_exit(void)
{
	static_key_deferred_flush(&apic_hw_disabled);
	static_key_deferred_flush(&apic_sw_disabled);
}