lapic.c 73.6 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 "ioapic.h"
40
#include "trace.h"
41
#include "x86.h"
A
Avi Kivity 已提交
42
#include "cpuid.h"
43
#include "hyperv.h"
E
Eddie Dong 已提交
44

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

/* 14 is the version for Xeon and Pentium 8.4.8*/
57
#define APIC_VERSION			(0x14UL | ((KVM_APIC_LVT_NUM - 1) << 16))
E
Eddie Dong 已提交
58 59 60
#define LAPIC_MMIO_LENGTH		(1 << 12)
/* followed define is not in apicdef.h */
#define MAX_APIC_VECTOR			256
61
#define APIC_VECTORS_PER_REG		32
E
Eddie Dong 已提交
62

63
static bool lapic_timer_advance_dynamic __read_mostly;
64 65 66 67
#define LAPIC_TIMER_ADVANCE_ADJUST_MIN	100	/* clock cycles */
#define LAPIC_TIMER_ADVANCE_ADJUST_MAX	10000	/* clock cycles */
#define LAPIC_TIMER_ADVANCE_NS_INIT	1000
#define LAPIC_TIMER_ADVANCE_NS_MAX     5000
68 69 70
/* step-by-step approximation to mitigate fluctuation */
#define LAPIC_TIMER_ADVANCE_ADJUST_STEP 8

M
Michael S. Tsirkin 已提交
71 72 73 74 75
static inline int apic_test_vector(int vec, void *bitmap)
{
	return test_bit(VEC_POS(vec), (bitmap) + REG_POS(vec));
}

76 77 78 79 80 81 82 83
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 已提交
84 85 86 87 88 89 90 91 92 93
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));
}

94
struct static_key_deferred apic_hw_disabled __read_mostly;
95 96
struct static_key_deferred apic_sw_disabled __read_mostly;

E
Eddie Dong 已提交
97 98
static inline int apic_enabled(struct kvm_lapic *apic)
{
99
	return kvm_apic_sw_enabled(apic) &&	kvm_apic_hw_enabled(apic);
100 101
}

E
Eddie Dong 已提交
102 103 104 105 106 107 108
#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)

109 110 111 112 113
static inline u32 kvm_x2apic_id(struct kvm_lapic *apic)
{
	return apic->vcpu->vcpu_id;
}

114
static bool kvm_can_post_timer_interrupt(struct kvm_vcpu *vcpu)
115 116 117
{
	return pi_inject_timer && kvm_vcpu_apicv_active(vcpu);
}
118 119 120 121 122 123 124 125

bool kvm_can_use_hv_timer(struct kvm_vcpu *vcpu)
{
	return kvm_x86_ops.set_hv_timer
	       && !(kvm_mwait_in_guest(vcpu->kvm) ||
		    kvm_can_post_timer_interrupt(vcpu));
}
EXPORT_SYMBOL_GPL(kvm_can_use_hv_timer);
126 127 128 129 130 131

static bool kvm_use_posted_timer_interrupt(struct kvm_vcpu *vcpu)
{
	return kvm_can_post_timer_interrupt(vcpu) && vcpu->mode == IN_GUEST_MODE;
}

132 133 134 135 136
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ář 已提交
137
		u32 max_apic_id = map->max_apic_id;
138 139 140 141

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

P
Paolo Bonzini 已提交
142
			offset = array_index_nospec(offset, map->max_apic_id + 1);
143 144 145 146 147
			*cluster = &map->phys_map[offset];
			*mask = dest_id & (0xffff >> (16 - cluster_size));
		} else {
			*mask = 0;
		}
148

149 150 151 152 153 154 155
		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:
156
		*cluster = map->xapic_cluster_map[(dest_id >> 4) & 0xf];
157 158 159 160 161 162
		*mask = dest_id & 0xf;
		return true;
	default:
		/* Not optimized. */
		return false;
	}
163 164
}

165
static void kvm_apic_map_free(struct rcu_head *rcu)
166
{
167
	struct kvm_apic_map *map = container_of(rcu, struct kvm_apic_map, rcu);
168

169
	kvfree(map);
170 171
}

172 173 174 175 176 177 178 179 180 181 182 183
/*
 * CLEAN -> DIRTY and UPDATE_IN_PROGRESS -> DIRTY changes happen without a lock.
 *
 * DIRTY -> UPDATE_IN_PROGRESS and UPDATE_IN_PROGRESS -> CLEAN happen with
 * apic_map_lock_held.
 */
enum {
	CLEAN,
	UPDATE_IN_PROGRESS,
	DIRTY
};

184
void kvm_recalculate_apic_map(struct kvm *kvm)
185 186 187 188
{
	struct kvm_apic_map *new, *old = NULL;
	struct kvm_vcpu *vcpu;
	int i;
189
	u32 max_id = 255; /* enough space for any xAPIC ID */
190

191 192
	/* Read kvm->arch.apic_map_dirty before kvm->arch.apic_map.  */
	if (atomic_read_acquire(&kvm->arch.apic_map_dirty) == CLEAN)
193 194
		return;

195
	mutex_lock(&kvm->arch.apic_map_lock);
196 197 198 199 200 201
	/*
	 * Read kvm->arch.apic_map_dirty before kvm->arch.apic_map
	 * (if clean) or the APIC registers (if dirty).
	 */
	if (atomic_cmpxchg_acquire(&kvm->arch.apic_map_dirty,
				   DIRTY, UPDATE_IN_PROGRESS) == CLEAN) {
202 203 204 205
		/* Someone else has updated the map. */
		mutex_unlock(&kvm->arch.apic_map_lock);
		return;
	}
206

R
Radim Krčmář 已提交
207 208
	kvm_for_each_vcpu(i, vcpu, kvm)
		if (kvm_apic_present(vcpu))
209
			max_id = max(max_id, kvm_x2apic_id(vcpu->arch.apic));
R
Radim Krčmář 已提交
210

M
Michal Hocko 已提交
211
	new = kvzalloc(sizeof(struct kvm_apic_map) +
212 213
	                   sizeof(struct kvm_lapic *) * ((u64)max_id + 1),
			   GFP_KERNEL_ACCOUNT);
R
Radim Krčmář 已提交
214

215 216 217
	if (!new)
		goto out;

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

220 221
	kvm_for_each_vcpu(i, vcpu, kvm) {
		struct kvm_lapic *apic = vcpu->arch.apic;
222 223
		struct kvm_lapic **cluster;
		u16 mask;
224 225 226
		u32 ldr;
		u8 xapic_id;
		u32 x2apic_id;
227

228 229 230
		if (!kvm_apic_present(vcpu))
			continue;

231 232 233 234 235 236 237 238 239 240 241 242 243
		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;
244

245 246 247
		if (!kvm_apic_sw_enabled(apic))
			continue;

248 249
		ldr = kvm_lapic_get_reg(apic, APIC_LDR);

250 251 252 253
		if (apic_x2apic_mode(apic)) {
			new->mode |= KVM_APIC_MODE_X2APIC;
		} else if (ldr) {
			ldr = GET_APIC_LOGICAL_ID(ldr);
254
			if (kvm_lapic_get_reg(apic, APIC_DFR) == APIC_DFR_FLAT)
255 256 257 258 259
				new->mode |= KVM_APIC_MODE_XAPIC_FLAT;
			else
				new->mode |= KVM_APIC_MODE_XAPIC_CLUSTER;
		}

260
		if (!kvm_apic_map_get_logical_dest(new, ldr, &cluster, &mask))
261 262
			continue;

263 264
		if (mask)
			cluster[ffs(mask) - 1] = apic;
265 266 267 268 269
	}
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);
270
	/*
271 272
	 * Write kvm->arch.apic_map before clearing apic->apic_map_dirty.
	 * If another update has come in, leave it DIRTY.
273
	 */
274 275
	atomic_cmpxchg_release(&kvm->arch.apic_map_dirty,
			       UPDATE_IN_PROGRESS, CLEAN);
276 277 278
	mutex_unlock(&kvm->arch.apic_map_lock);

	if (old)
279
		call_rcu(&old->rcu, kvm_apic_map_free);
280

281
	kvm_make_scan_ioapic_request(kvm);
282 283
}

284 285
static inline void apic_set_spiv(struct kvm_lapic *apic, u32 val)
{
286
	bool enabled = val & APIC_SPIV_APIC_ENABLED;
287

288
	kvm_lapic_set_reg(apic, APIC_SPIV, val);
289 290 291

	if (enabled != apic->sw_enabled) {
		apic->sw_enabled = enabled;
292
		if (enabled)
293
			static_key_slow_dec_deferred(&apic_sw_disabled);
294
		else
295
			static_key_slow_inc(&apic_sw_disabled.key);
296

297
		atomic_set_release(&apic->vcpu->kvm->arch.apic_map_dirty, DIRTY);
298 299 300
	}
}

301
static inline void kvm_apic_set_xapic_id(struct kvm_lapic *apic, u8 id)
302
{
303
	kvm_lapic_set_reg(apic, APIC_ID, id << 24);
304
	atomic_set_release(&apic->vcpu->kvm->arch.apic_map_dirty, DIRTY);
305 306 307 308
}

static inline void kvm_apic_set_ldr(struct kvm_lapic *apic, u32 id)
{
309
	kvm_lapic_set_reg(apic, APIC_LDR, id);
310
	atomic_set_release(&apic->vcpu->kvm->arch.apic_map_dirty, DIRTY);
311 312
}

313 314 315 316 317 318
static inline void kvm_apic_set_dfr(struct kvm_lapic *apic, u32 val)
{
	kvm_lapic_set_reg(apic, APIC_DFR, val);
	atomic_set_release(&apic->vcpu->kvm->arch.apic_map_dirty, DIRTY);
}

319 320 321 322 323
static inline u32 kvm_apic_calc_x2apic_ldr(u32 id)
{
	return ((id >> 4) << 16) | (1 << (id & 0xf));
}

324
static inline void kvm_apic_set_x2apic_id(struct kvm_lapic *apic, u32 id)
325
{
326
	u32 ldr = kvm_apic_calc_x2apic_ldr(id);
327

328 329
	WARN_ON_ONCE(id != apic->vcpu->vcpu_id);

330
	kvm_lapic_set_reg(apic, APIC_ID, id);
331
	kvm_lapic_set_reg(apic, APIC_LDR, ldr);
332
	atomic_set_release(&apic->vcpu->kvm->arch.apic_map_dirty, DIRTY);
333 334
}

E
Eddie Dong 已提交
335 336
static inline int apic_lvt_enabled(struct kvm_lapic *apic, int lvt_type)
{
337
	return !(kvm_lapic_get_reg(apic, lvt_type) & APIC_LVT_MASKED);
E
Eddie Dong 已提交
338 339
}

340 341
static inline int apic_lvtt_oneshot(struct kvm_lapic *apic)
{
342
	return apic->lapic_timer.timer_mode == APIC_LVT_TIMER_ONESHOT;
343 344
}

E
Eddie Dong 已提交
345 346
static inline int apic_lvtt_period(struct kvm_lapic *apic)
{
347
	return apic->lapic_timer.timer_mode == APIC_LVT_TIMER_PERIODIC;
348 349 350 351
}

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

355 356 357 358 359
static inline int apic_lvt_nmi_mode(u32 lvt_val)
{
	return (lvt_val & (APIC_MODE_MASK | APIC_LVT_MASKED)) == APIC_DM_NMI;
}

360 361 362 363 364
void kvm_apic_set_version(struct kvm_vcpu *vcpu)
{
	struct kvm_lapic *apic = vcpu->arch.apic;
	u32 v = APIC_VERSION;

365
	if (!lapic_in_kernel(vcpu))
366 367
		return;

368 369 370 371 372 373 374
	/*
	 * 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.
	 */
375
	if (guest_cpuid_has(vcpu, X86_FEATURE_X2APIC) &&
376
	    !ioapic_in_kernel(vcpu->kvm))
377
		v |= APIC_LVR_DIRECTED_EOI;
378
	kvm_lapic_set_reg(apic, APIC_LVR, v);
379 380
}

381
static const unsigned int apic_lvt_mask[KVM_APIC_LVT_NUM] = {
382
	LVT_MASK ,      /* part LVTT mask, timer mode mask added at runtime */
E
Eddie Dong 已提交
383 384 385 386 387 388 389 390
	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)
{
391 392
	int vec;
	u32 *reg;
E
Eddie Dong 已提交
393

394 395 396 397
	for (vec = MAX_APIC_VECTOR - APIC_VECTORS_PER_REG;
	     vec >= 0; vec -= APIC_VECTORS_PER_REG) {
		reg = bitmap + REG_POS(vec);
		if (*reg)
398
			return __fls(*reg) + vec;
399
	}
E
Eddie Dong 已提交
400

401
	return -1;
E
Eddie Dong 已提交
402 403
}

M
Michael S. Tsirkin 已提交
404 405
static u8 count_vectors(void *bitmap)
{
406 407
	int vec;
	u32 *reg;
M
Michael S. Tsirkin 已提交
408
	u8 count = 0;
409 410 411 412 413 414

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

M
Michael S. Tsirkin 已提交
415 416 417
	return count;
}

418
bool __kvm_apic_update_irr(u32 *pir, void *regs, int *max_irr)
419
{
420
	u32 i, vec;
421 422 423 424 425
	u32 pir_val, irr_val, prev_irr_val;
	int max_updated_irr;

	max_updated_irr = -1;
	*max_irr = -1;
426

427
	for (i = vec = 0; i <= 7; i++, vec += 32) {
428
		pir_val = READ_ONCE(pir[i]);
429
		irr_val = *((u32 *)(regs + APIC_IRR + i * 0x10));
430
		if (pir_val) {
431
			prev_irr_val = irr_val;
432 433
			irr_val |= xchg(&pir[i], 0);
			*((u32 *)(regs + APIC_IRR + i * 0x10)) = irr_val;
434 435 436 437
			if (prev_irr_val != irr_val) {
				max_updated_irr =
					__fls(irr_val ^ prev_irr_val) + vec;
			}
438
		}
439
		if (irr_val)
440
			*max_irr = __fls(irr_val) + vec;
441
	}
442

443 444
	return ((max_updated_irr != -1) &&
		(max_updated_irr == *max_irr));
445
}
446 447
EXPORT_SYMBOL_GPL(__kvm_apic_update_irr);

448
bool kvm_apic_update_irr(struct kvm_vcpu *vcpu, u32 *pir, int *max_irr)
449 450 451
{
	struct kvm_lapic *apic = vcpu->arch.apic;

452
	return __kvm_apic_update_irr(pir, apic->regs, max_irr);
453
}
454 455
EXPORT_SYMBOL_GPL(kvm_apic_update_irr);

456
static inline int apic_search_irr(struct kvm_lapic *apic)
E
Eddie Dong 已提交
457
{
458
	return find_highest_vector(apic->regs + APIC_IRR);
E
Eddie Dong 已提交
459 460 461 462 463 464
}

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

465 466 467 468
	/*
	 * Note that irr_pending is just a hint. It will be always
	 * true with virtual interrupt delivery enabled.
	 */
469 470 471 472
	if (!apic->irr_pending)
		return -1;

	result = apic_search_irr(apic);
E
Eddie Dong 已提交
473 474 475 476 477
	ASSERT(result == -1 || result >= 16);

	return result;
}

478 479
static inline void apic_clear_irr(int vec, struct kvm_lapic *apic)
{
480 481 482 483
	struct kvm_vcpu *vcpu;

	vcpu = apic->vcpu;

484
	if (unlikely(vcpu->arch.apicv_active)) {
485
		/* need to update RVI */
486
		kvm_lapic_clear_vector(vec, apic->regs + APIC_IRR);
487
		kvm_x86_ops.hwapic_irr_update(vcpu,
488
				apic_find_highest_irr(apic));
489 490
	} else {
		apic->irr_pending = false;
491
		kvm_lapic_clear_vector(vec, apic->regs + APIC_IRR);
492 493
		if (apic_search_irr(apic) != -1)
			apic->irr_pending = true;
494
	}
495 496
}

497 498 499 500 501 502
void kvm_apic_clear_irr(struct kvm_vcpu *vcpu, int vec)
{
	apic_clear_irr(vec, vcpu->arch.apic);
}
EXPORT_SYMBOL_GPL(kvm_apic_clear_irr);

M
Michael S. Tsirkin 已提交
503 504
static inline void apic_set_isr(int vec, struct kvm_lapic *apic)
{
505 506 507 508 509 510
	struct kvm_vcpu *vcpu;

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

	vcpu = apic->vcpu;
511

M
Michael S. Tsirkin 已提交
512
	/*
513 514 515
	 * 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 已提交
516
	 */
517
	if (unlikely(vcpu->arch.apicv_active))
518
		kvm_x86_ops.hwapic_isr_update(vcpu, vec);
519 520 521 522 523 524 525 526 527 528
	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 已提交
529 530
}

531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549
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 已提交
550 551
static inline void apic_clear_isr(int vec, struct kvm_lapic *apic)
{
552 553 554 555 556 557 558 559 560 561 562 563 564
	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.
	 */
565
	if (unlikely(vcpu->arch.apicv_active))
566
		kvm_x86_ops.hwapic_isr_update(vcpu,
567 568
					       apic_find_highest_isr(apic));
	else {
M
Michael S. Tsirkin 已提交
569
		--apic->isr_count;
570 571 572
		BUG_ON(apic->isr_count < 0);
		apic->highest_isr_cache = -1;
	}
M
Michael S. Tsirkin 已提交
573 574
}

575 576
int kvm_lapic_find_highest_irr(struct kvm_vcpu *vcpu)
{
577 578 579 580 581
	/* 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.
	 */
582
	return apic_find_highest_irr(vcpu->arch.apic);
583
}
584
EXPORT_SYMBOL_GPL(kvm_lapic_find_highest_irr);
585

586
static int __apic_accept_irq(struct kvm_lapic *apic, int delivery_mode,
587
			     int vector, int level, int trig_mode,
588
			     struct dest_map *dest_map);
589

590
int kvm_apic_set_irq(struct kvm_vcpu *vcpu, struct kvm_lapic_irq *irq,
591
		     struct dest_map *dest_map)
E
Eddie Dong 已提交
592
{
593
	struct kvm_lapic *apic = vcpu->arch.apic;
594

595
	return __apic_accept_irq(apic, irq->delivery_mode, irq->vector,
596
			irq->level, irq->trig_mode, dest_map);
E
Eddie Dong 已提交
597 598
}

599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618
static int __pv_send_ipi(unsigned long *ipi_bitmap, struct kvm_apic_map *map,
			 struct kvm_lapic_irq *irq, u32 min)
{
	int i, count = 0;
	struct kvm_vcpu *vcpu;

	if (min > map->max_apic_id)
		return 0;

	for_each_set_bit(i, ipi_bitmap,
		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);
		}
	}

	return count;
}

619
int kvm_pv_send_ipi(struct kvm *kvm, unsigned long ipi_bitmap_low,
620
		    unsigned long ipi_bitmap_high, u32 min,
621 622 623 624 625
		    unsigned long icr, int op_64_bit)
{
	struct kvm_apic_map *map;
	struct kvm_lapic_irq irq = {0};
	int cluster_size = op_64_bit ? 64 : 32;
626 627 628 629
	int count;

	if (icr & (APIC_DEST_MASK | APIC_SHORT_MASK))
		return -KVM_EINVAL;
630 631 632 633 634 635 636 637 638

	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;

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

639 640 641 642 643
	count = -EOPNOTSUPP;
	if (likely(map)) {
		count = __pv_send_ipi(&ipi_bitmap_low, map, &irq, min);
		min += cluster_size;
		count += __pv_send_ipi(&ipi_bitmap_high, map, &irq, min);
644 645 646 647 648 649
	}

	rcu_read_unlock();
	return count;
}

650 651
static int pv_eoi_put_user(struct kvm_vcpu *vcpu, u8 val)
{
652 653 654

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

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

	return kvm_read_guest_cached(vcpu->kvm, &vcpu->arch.pv_eoi.data, val,
				      sizeof(*val));
662 663 664 665 666 667 668 669 670 671
}

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;
672
	if (pv_eoi_get_user(vcpu, &val) < 0) {
673
		printk(KERN_WARNING "Can't read EOI MSR value: 0x%llx\n",
674
			   (unsigned long long)vcpu->arch.pv_eoi.msr_val);
675 676
		return false;
	}
677
	return val & KVM_PV_EOI_ENABLED;
678 679 680 681 682
}

static void pv_eoi_set_pending(struct kvm_vcpu *vcpu)
{
	if (pv_eoi_put_user(vcpu, KVM_PV_EOI_ENABLED) < 0) {
683
		printk(KERN_WARNING "Can't set EOI MSR value: 0x%llx\n",
684
			   (unsigned long long)vcpu->arch.pv_eoi.msr_val);
685 686 687 688 689 690 691 692
		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) {
693
		printk(KERN_WARNING "Can't clear EOI MSR value: 0x%llx\n",
694
			   (unsigned long long)vcpu->arch.pv_eoi.msr_val);
695 696 697 698 699
		return;
	}
	__clear_bit(KVM_APIC_PV_EOI_PENDING, &vcpu->arch.apic_attention);
}

700 701
static int apic_has_interrupt_for_ppr(struct kvm_lapic *apic, u32 ppr)
{
702
	int highest_irr;
703
	if (apic->vcpu->arch.apicv_active)
704
		highest_irr = kvm_x86_ops.sync_pir_to_irr(apic->vcpu);
705 706
	else
		highest_irr = apic_find_highest_irr(apic);
707 708 709 710 711 712
	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 已提交
713
{
714
	u32 tpr, isrv, ppr, old_ppr;
E
Eddie Dong 已提交
715 716
	int isr;

717 718
	old_ppr = kvm_lapic_get_reg(apic, APIC_PROCPRI);
	tpr = kvm_lapic_get_reg(apic, APIC_TASKPRI);
E
Eddie Dong 已提交
719 720 721 722 723 724 725 726
	isr = apic_find_highest_isr(apic);
	isrv = (isr != -1) ? isr : 0;

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

727 728
	*new_ppr = ppr;
	if (old_ppr != ppr)
729
		kvm_lapic_set_reg(apic, APIC_PROCPRI, ppr);
730 731 732 733 734 735 736 737

	return ppr < old_ppr;
}

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

738 739
	if (__apic_update_ppr(apic, &ppr) &&
	    apic_has_interrupt_for_ppr(apic, ppr) != -1)
740
		kvm_make_request(KVM_REQ_EVENT, apic->vcpu);
E
Eddie Dong 已提交
741 742
}

743 744 745 746 747 748
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 已提交
749 750
static void apic_set_tpr(struct kvm_lapic *apic, u32 tpr)
{
751
	kvm_lapic_set_reg(apic, APIC_TASKPRI, tpr);
E
Eddie Dong 已提交
752 753 754
	apic_update_ppr(apic);
}

755
static bool kvm_apic_broadcast(struct kvm_lapic *apic, u32 mda)
756
{
757 758
	return mda == (apic_x2apic_mode(apic) ?
			X2APIC_BROADCAST : APIC_BROADCAST);
759 760
}

761
static bool kvm_apic_match_physical_addr(struct kvm_lapic *apic, u32 mda)
E
Eddie Dong 已提交
762
{
763 764 765 766
	if (kvm_apic_broadcast(apic, mda))
		return true;

	if (apic_x2apic_mode(apic))
767
		return mda == kvm_x2apic_id(apic);
768

769 770 771 772 773 774 775 776 777
	/*
	 * 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;

778
	return mda == kvm_xapic_id(apic);
E
Eddie Dong 已提交
779 780
}

781
static bool kvm_apic_match_logical_addr(struct kvm_lapic *apic, u32 mda)
E
Eddie Dong 已提交
782
{
G
Gleb Natapov 已提交
783 784
	u32 logical_id;

785
	if (kvm_apic_broadcast(apic, mda))
786
		return true;
787

788
	logical_id = kvm_lapic_get_reg(apic, APIC_LDR);
E
Eddie Dong 已提交
789

790
	if (apic_x2apic_mode(apic))
791 792
		return ((logical_id >> 16) == (mda >> 16))
		       && (logical_id & mda & 0xffff) != 0;
E
Eddie Dong 已提交
793

794
	logical_id = GET_APIC_LOGICAL_ID(logical_id);
E
Eddie Dong 已提交
795

796
	switch (kvm_lapic_get_reg(apic, APIC_DFR)) {
E
Eddie Dong 已提交
797
	case APIC_DFR_FLAT:
798
		return (logical_id & mda) != 0;
E
Eddie Dong 已提交
799
	case APIC_DFR_CLUSTER:
800 801
		return ((logical_id >> 4) == (mda >> 4))
		       && (logical_id & mda & 0xf) != 0;
E
Eddie Dong 已提交
802
	default:
803
		return false;
E
Eddie Dong 已提交
804 805 806
	}
}

807 808
/* The KVM local APIC implementation has two quirks:
 *
809 810 811
 *  - 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.
812 813 814 815 816 817 818 819 820 821
 *
 *  - 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".
822
 */
823 824
static u32 kvm_apic_mda(struct kvm_vcpu *vcpu, unsigned int dest_id,
		struct kvm_lapic *source, struct kvm_lapic *target)
825 826 827
{
	bool ipi = source != NULL;

828
	if (!vcpu->kvm->arch.x2apic_broadcast_quirk_disabled &&
829
	    !ipi && dest_id == APIC_BROADCAST && apic_x2apic_mode(target))
830 831
		return X2APIC_BROADCAST;

832
	return dest_id;
833 834
}

835
bool kvm_apic_match_dest(struct kvm_vcpu *vcpu, struct kvm_lapic *source,
836
			   int shorthand, unsigned int dest, int dest_mode)
E
Eddie Dong 已提交
837
{
838
	struct kvm_lapic *target = vcpu->arch.apic;
839
	u32 mda = kvm_apic_mda(vcpu, dest, source, target);
E
Eddie Dong 已提交
840

Z
Zachary Amsden 已提交
841
	ASSERT(target);
842
	switch (shorthand) {
E
Eddie Dong 已提交
843
	case APIC_DEST_NOSHORT:
844
		if (dest_mode == APIC_DEST_PHYSICAL)
845
			return kvm_apic_match_physical_addr(target, mda);
846
		else
847
			return kvm_apic_match_logical_addr(target, mda);
E
Eddie Dong 已提交
848
	case APIC_DEST_SELF:
849
		return target == source;
E
Eddie Dong 已提交
850
	case APIC_DEST_ALLINC:
851
		return true;
E
Eddie Dong 已提交
852
	case APIC_DEST_ALLBUT:
853
		return target != source;
E
Eddie Dong 已提交
854
	default:
855
		return false;
E
Eddie Dong 已提交
856 857
	}
}
858
EXPORT_SYMBOL_GPL(kvm_apic_match_dest);
E
Eddie Dong 已提交
859

860 861 862 863 864 865 866 867 868 869 870 871 872 873 874 875
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;
}

876 877 878 879 880 881 882 883 884
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");
	}
}

885 886
static bool kvm_apic_is_broadcast_dest(struct kvm *kvm, struct kvm_lapic **src,
		struct kvm_lapic_irq *irq, struct kvm_apic_map *map)
887
{
888 889 890 891 892 893 894 895 896 897 898 899
	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;
	}
900

901 902
	return false;
}
903

904 905 906 907 908 909 910 911 912 913 914 915 916
/* 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;
917

918 919 920 921 922
	if (irq->shorthand == APIC_DEST_SELF && src) {
		*dst = src;
		*bitmap = 1;
		return true;
	} else if (irq->shorthand)
923 924
		return false;

925
	if (!map || kvm_apic_is_broadcast_dest(kvm, src, irq, map))
926 927
		return false;

928
	if (irq->dest_mode == APIC_DEST_PHYSICAL) {
R
Radim Krčmář 已提交
929
		if (irq->dest_id > map->max_apic_id) {
930 931
			*bitmap = 0;
		} else {
P
Paolo Bonzini 已提交
932 933
			u32 dest_id = array_index_nospec(irq->dest_id, map->max_apic_id + 1);
			*dst = &map->phys_map[dest_id];
934 935
			*bitmap = 1;
		}
936
		return true;
937
	}
938

939 940 941
	*bitmap = 0;
	if (!kvm_apic_map_get_logical_dest(map, irq->dest_id, dst,
				(u16 *)bitmap))
942
		return false;
943

944 945
	if (!kvm_lowest_prio_delivery(irq))
		return true;
946

947 948 949 950 951 952 953 954 955 956
	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;
957
		}
958 959 960
	} else {
		if (!*bitmap)
			return true;
961

962 963
		lowest = kvm_vector_to_index(irq->vector, hweight16(*bitmap),
				bitmap, 16);
964

965 966 967 968 969 970
		if (!(*dst)[lowest]) {
			kvm_apic_disabled_lapic_found(kvm);
			*bitmap = 0;
			return true;
		}
	}
971

972
	*bitmap = (lowest >= 0) ? 1 << lowest : 0;
973

974 975
	return true;
}
976

977 978 979 980 981 982 983 984
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;
985

986
	*r = -1;
987

988 989 990 991
	if (irq->shorthand == APIC_DEST_SELF) {
		*r = kvm_apic_set_irq(src->vcpu, irq, dest_map);
		return true;
	}
992

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

996
	ret = kvm_apic_map_get_dest_lapic(kvm, &src, irq, map, &dst, &bitmap);
997 998
	if (ret) {
		*r = 0;
999 1000 1001 1002
		for_each_set_bit(i, &bitmap, 16) {
			if (!dst[i])
				continue;
			*r += kvm_apic_set_irq(dst[i]->vcpu, irq, dest_map);
1003
		}
1004
	}
1005 1006 1007 1008 1009

	rcu_read_unlock();
	return ret;
}

1010
/*
M
Miaohe Lin 已提交
1011
 * This routine tries to handle interrupts in posted mode, here is how
1012 1013 1014 1015
 * 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
1016
 *   to find the destination vCPU.
1017 1018 1019 1020 1021 1022 1023
 *	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.
 */
1024 1025 1026 1027
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;
1028 1029
	unsigned long bitmap;
	struct kvm_lapic **dst = NULL;
1030 1031 1032 1033 1034 1035 1036 1037
	bool ret = false;

	if (irq->shorthand)
		return false;

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

1038 1039 1040
	if (kvm_apic_map_get_dest_lapic(kvm, NULL, irq, map, &dst, &bitmap) &&
			hweight16(bitmap) == 1) {
		unsigned long i = find_first_bit(&bitmap, 16);
1041

1042 1043 1044
		if (dst[i]) {
			*dest_vcpu = dst[i]->vcpu;
			ret = true;
1045
		}
1046 1047 1048 1049 1050 1051
	}

	rcu_read_unlock();
	return ret;
}

E
Eddie Dong 已提交
1052 1053 1054 1055 1056
/*
 * 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,
1057
			     int vector, int level, int trig_mode,
1058
			     struct dest_map *dest_map)
E
Eddie Dong 已提交
1059
{
1060
	int result = 0;
1061
	struct kvm_vcpu *vcpu = apic->vcpu;
E
Eddie Dong 已提交
1062

1063 1064
	trace_kvm_apic_accept_irq(vcpu->vcpu_id, delivery_mode,
				  trig_mode, vector);
E
Eddie Dong 已提交
1065 1066
	switch (delivery_mode) {
	case APIC_DM_LOWEST:
1067
		vcpu->arch.apic_arb_prio++;
1068
		fallthrough;
1069
	case APIC_DM_FIXED:
1070 1071 1072
		if (unlikely(trig_mode && !level))
			break;

E
Eddie Dong 已提交
1073 1074 1075 1076
		/* FIXME add logic for vcpu on reset */
		if (unlikely(!apic_enabled(apic)))
			break;

1077 1078
		result = 1;

1079
		if (dest_map) {
1080
			__set_bit(vcpu->vcpu_id, dest_map->map);
1081 1082
			dest_map->vectors[vcpu->vcpu_id] = vector;
		}
1083

1084 1085
		if (apic_test_vector(vector, apic->regs + APIC_TMR) != !!trig_mode) {
			if (trig_mode)
1086 1087
				kvm_lapic_set_vector(vector,
						     apic->regs + APIC_TMR);
1088
			else
1089 1090
				kvm_lapic_clear_vector(vector,
						       apic->regs + APIC_TMR);
1091 1092
		}

1093
		if (kvm_x86_ops.deliver_posted_interrupt(vcpu, vector)) {
1094
			kvm_lapic_set_irr(vector, apic);
1095 1096 1097
			kvm_make_request(KVM_REQ_EVENT, vcpu);
			kvm_vcpu_kick(vcpu);
		}
E
Eddie Dong 已提交
1098 1099 1100
		break;

	case APIC_DM_REMRD:
1101 1102 1103 1104
		result = 1;
		vcpu->arch.pv.pv_unhalted = 1;
		kvm_make_request(KVM_REQ_EVENT, vcpu);
		kvm_vcpu_kick(vcpu);
E
Eddie Dong 已提交
1105 1106 1107
		break;

	case APIC_DM_SMI:
P
Paolo Bonzini 已提交
1108 1109 1110
		result = 1;
		kvm_make_request(KVM_REQ_SMI, vcpu);
		kvm_vcpu_kick(vcpu);
E
Eddie Dong 已提交
1111
		break;
1112

E
Eddie Dong 已提交
1113
	case APIC_DM_NMI:
1114
		result = 1;
1115
		kvm_inject_nmi(vcpu);
J
Jan Kiszka 已提交
1116
		kvm_vcpu_kick(vcpu);
E
Eddie Dong 已提交
1117 1118 1119
		break;

	case APIC_DM_INIT:
1120
		if (!trig_mode || level) {
1121
			result = 1;
1122 1123
			/* assumes that there are only KVM_APIC_INIT/SIPI */
			apic->pending_events = (1UL << KVM_APIC_INIT);
1124
			kvm_make_request(KVM_REQ_EVENT, vcpu);
1125 1126
			kvm_vcpu_kick(vcpu);
		}
E
Eddie Dong 已提交
1127 1128 1129
		break;

	case APIC_DM_STARTUP:
1130 1131 1132 1133 1134 1135 1136
		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 已提交
1137 1138
		break;

1139 1140 1141 1142 1143 1144 1145 1146
	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 已提交
1147 1148 1149 1150 1151 1152 1153 1154
	default:
		printk(KERN_ERR "TODO: unsupported delivery mode %x\n",
		       delivery_mode);
		break;
	}
	return result;
}

1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188
/*
 * This routine identifies the destination vcpus mask meant to receive the
 * IOAPIC interrupts. It either uses kvm_apic_map_get_dest_lapic() to find
 * out the destination vcpus array and set the bitmap or it traverses to
 * each available vcpu to identify the same.
 */
void kvm_bitmap_or_dest_vcpus(struct kvm *kvm, struct kvm_lapic_irq *irq,
			      unsigned long *vcpu_bitmap)
{
	struct kvm_lapic **dest_vcpu = NULL;
	struct kvm_lapic *src = NULL;
	struct kvm_apic_map *map;
	struct kvm_vcpu *vcpu;
	unsigned long bitmap;
	int i, vcpu_idx;
	bool ret;

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

	ret = kvm_apic_map_get_dest_lapic(kvm, &src, irq, map, &dest_vcpu,
					  &bitmap);
	if (ret) {
		for_each_set_bit(i, &bitmap, 16) {
			if (!dest_vcpu[i])
				continue;
			vcpu_idx = dest_vcpu[i]->vcpu->vcpu_idx;
			__set_bit(vcpu_idx, vcpu_bitmap);
		}
	} else {
		kvm_for_each_vcpu(i, vcpu, kvm) {
			if (!kvm_apic_present(vcpu))
				continue;
			if (!kvm_apic_match_dest(vcpu, NULL,
1189
						 irq->shorthand,
1190 1191 1192 1193 1194 1195 1196 1197 1198
						 irq->dest_id,
						 irq->dest_mode))
				continue;
			__set_bit(i, vcpu_bitmap);
		}
	}
	rcu_read_unlock();
}

1199
int kvm_apic_compare_prio(struct kvm_vcpu *vcpu1, struct kvm_vcpu *vcpu2)
1200
{
1201
	return vcpu1->arch.apic_arb_prio - vcpu2->arch.apic_arb_prio;
1202 1203
}

1204 1205
static bool kvm_ioapic_handles_vector(struct kvm_lapic *apic, int vector)
{
1206
	return test_bit(vector, apic->vcpu->arch.ioapic_handled_vectors);
1207 1208
}

1209 1210
static void kvm_ioapic_send_eoi(struct kvm_lapic *apic, int vector)
{
1211 1212 1213 1214 1215
	int trigger_mode;

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

1217 1218 1219 1220 1221
	/* 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;
1222
	}
1223 1224 1225 1226 1227 1228 1229

	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);
1230 1231
}

1232
static int apic_set_eoi(struct kvm_lapic *apic)
E
Eddie Dong 已提交
1233 1234
{
	int vector = apic_find_highest_isr(apic);
1235 1236 1237

	trace_kvm_eoi(apic, vector);

E
Eddie Dong 已提交
1238 1239 1240 1241 1242
	/*
	 * Not every write EOI will has corresponding ISR,
	 * one example is when Kernel check timer on setup_IO_APIC
	 */
	if (vector == -1)
1243
		return vector;
E
Eddie Dong 已提交
1244

M
Michael S. Tsirkin 已提交
1245
	apic_clear_isr(vector, apic);
E
Eddie Dong 已提交
1246 1247
	apic_update_ppr(apic);

1248 1249 1250
	if (test_bit(vector, vcpu_to_synic(apic->vcpu)->vec_bitmap))
		kvm_hv_synic_send_eoi(apic->vcpu, vector);

1251
	kvm_ioapic_send_eoi(apic, vector);
1252
	kvm_make_request(KVM_REQ_EVENT, apic->vcpu);
1253
	return vector;
E
Eddie Dong 已提交
1254 1255
}

1256 1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269 1270
/*
 * 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);

1271
void kvm_apic_send_ipi(struct kvm_lapic *apic, u32 icr_low, u32 icr_high)
E
Eddie Dong 已提交
1272
{
1273
	struct kvm_lapic_irq irq;
E
Eddie Dong 已提交
1274

1275 1276 1277
	irq.vector = icr_low & APIC_VECTOR_MASK;
	irq.delivery_mode = icr_low & APIC_MODE_MASK;
	irq.dest_mode = icr_low & APIC_DEST_MASK;
1278
	irq.level = (icr_low & APIC_INT_ASSERT) != 0;
1279 1280
	irq.trig_mode = icr_low & APIC_INT_LEVELTRIG;
	irq.shorthand = icr_low & APIC_SHORT_MASK;
1281
	irq.msi_redir_hint = false;
G
Gleb Natapov 已提交
1282 1283 1284 1285
	if (apic_x2apic_mode(apic))
		irq.dest_id = icr_high;
	else
		irq.dest_id = GET_APIC_DEST_FIELD(icr_high);
E
Eddie Dong 已提交
1286

1287 1288
	trace_kvm_apic_ipi(icr_low, irq.dest_id);

1289
	kvm_irq_delivery_to_apic(apic->vcpu->kvm, apic, &irq, NULL);
E
Eddie Dong 已提交
1290 1291 1292 1293
}

static u32 apic_get_tmcct(struct kvm_lapic *apic)
{
1294
	ktime_t remaining, now;
1295
	s64 ns;
1296
	u32 tmcct;
E
Eddie Dong 已提交
1297 1298 1299

	ASSERT(apic != NULL);

1300
	/* if initial count is 0, current count should also be 0 */
1301
	if (kvm_lapic_get_reg(apic, APIC_TMICT) == 0 ||
1302
		apic->lapic_timer.period == 0)
1303 1304
		return 0;

1305
	now = ktime_get();
1306
	remaining = ktime_sub(apic->lapic_timer.target_expiration, now);
1307
	if (ktime_to_ns(remaining) < 0)
T
Thomas Gleixner 已提交
1308
		remaining = 0;
1309

1310 1311 1312
	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 已提交
1313 1314 1315 1316

	return tmcct;
}

1317 1318 1319 1320 1321
static void __report_tpr_access(struct kvm_lapic *apic, bool write)
{
	struct kvm_vcpu *vcpu = apic->vcpu;
	struct kvm_run *run = vcpu->run;

1322
	kvm_make_request(KVM_REQ_REPORT_TPR_ACCESS, vcpu);
1323
	run->tpr_access.rip = kvm_rip_read(vcpu);
1324 1325 1326 1327 1328 1329 1330 1331 1332
	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 已提交
1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344
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:
		break;

	case APIC_TMCCT:	/* Timer CCR */
1345 1346 1347
		if (apic_lvtt_tscdeadline(apic))
			return 0;

E
Eddie Dong 已提交
1348 1349
		val = apic_get_tmcct(apic);
		break;
1350 1351
	case APIC_PROCPRI:
		apic_update_ppr(apic);
1352
		val = kvm_lapic_get_reg(apic, offset);
1353
		break;
1354 1355
	case APIC_TASKPRI:
		report_tpr_access(apic, false);
1356
		fallthrough;
E
Eddie Dong 已提交
1357
	default:
1358
		val = kvm_lapic_get_reg(apic, offset);
E
Eddie Dong 已提交
1359 1360 1361 1362 1363 1364
		break;
	}

	return val;
}

G
Gregory Haskins 已提交
1365 1366 1367 1368 1369
static inline struct kvm_lapic *to_lapic(struct kvm_io_device *dev)
{
	return container_of(dev, struct kvm_lapic, dev);
}

1370 1371 1372 1373
#define APIC_REG_MASK(reg)	(1ull << ((reg) >> 4))
#define APIC_REGS_MASK(first, count) \
	(APIC_REG_MASK(first) * ((1ull << (count)) - 1))

1374
int kvm_lapic_reg_read(struct kvm_lapic *apic, u32 offset, int len,
G
Gleb Natapov 已提交
1375
		void *data)
E
Eddie Dong 已提交
1376 1377 1378
{
	unsigned char alignment = offset & 0xf;
	u32 result;
G
Guo Chao 已提交
1379
	/* this bitmask has a bit cleared for each reserved register */
1380 1381 1382 1383 1384 1385 1386 1387 1388 1389 1390 1391 1392 1393 1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406
	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 已提交
1407

1408
	if (offset > 0x3f0 || !(valid_reg_mask & APIC_REG_MASK(offset)))
G
Gleb Natapov 已提交
1409 1410
		return 1;

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

1413 1414
	trace_kvm_apic_read(offset, result);

E
Eddie Dong 已提交
1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425
	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;
	}
1426
	return 0;
E
Eddie Dong 已提交
1427
}
1428
EXPORT_SYMBOL_GPL(kvm_lapic_reg_read);
E
Eddie Dong 已提交
1429

G
Gleb Natapov 已提交
1430 1431
static int apic_mmio_in_range(struct kvm_lapic *apic, gpa_t addr)
{
1432 1433
	return addr >= apic->base_address &&
		addr < apic->base_address + LAPIC_MMIO_LENGTH;
G
Gleb Natapov 已提交
1434 1435
}

1436
static int apic_mmio_read(struct kvm_vcpu *vcpu, struct kvm_io_device *this,
G
Gleb Natapov 已提交
1437 1438 1439 1440 1441 1442 1443 1444
			   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;

1445 1446 1447 1448 1449 1450 1451 1452 1453
	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;
	}

1454
	kvm_lapic_reg_read(apic, offset, len, data);
G
Gleb Natapov 已提交
1455 1456 1457 1458

	return 0;
}

E
Eddie Dong 已提交
1459 1460 1461 1462
static void update_divide_count(struct kvm_lapic *apic)
{
	u32 tmp1, tmp2, tdcr;

1463
	tdcr = kvm_lapic_get_reg(apic, APIC_TDCR);
E
Eddie Dong 已提交
1464 1465
	tmp1 = tdcr & 0xf;
	tmp2 = ((tmp1 & 0x3) | ((tmp1 & 0x8) >> 1)) + 1;
1466
	apic->divide_count = 0x1 << (tmp2 & 0x7);
E
Eddie Dong 已提交
1467 1468
}

1469 1470 1471 1472 1473 1474 1475
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.
	 */
1476
	if (apic_lvtt_period(apic) && apic->lapic_timer.period) {
1477 1478 1479 1480 1481 1482 1483 1484 1485 1486 1487 1488 1489
		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;
		}
	}
}

1490 1491
static void cancel_hv_timer(struct kvm_lapic *apic);

1492 1493
static void apic_update_lvtt(struct kvm_lapic *apic)
{
1494
	u32 timer_mode = kvm_lapic_get_reg(apic, APIC_LVTT) &
1495 1496 1497
			apic->lapic_timer.timer_mode_mask;

	if (apic->lapic_timer.timer_mode != timer_mode) {
1498
		if (apic_lvtt_tscdeadline(apic) != (timer_mode ==
1499 1500
				APIC_LVT_TIMER_TSCDEADLINE)) {
			hrtimer_cancel(&apic->lapic_timer.timer);
1501 1502 1503 1504
			preempt_disable();
			if (apic->lapic_timer.hv_timer_in_use)
				cancel_hv_timer(apic);
			preempt_enable();
1505 1506 1507
			kvm_lapic_set_reg(apic, APIC_TMICT, 0);
			apic->lapic_timer.period = 0;
			apic->lapic_timer.tscdeadline = 0;
1508
		}
1509
		apic->lapic_timer.timer_mode = timer_mode;
1510
		limit_periodic_timer_frequency(apic);
1511 1512 1513
	}
}

1514 1515 1516 1517 1518 1519 1520 1521
/*
 * 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;
1522
	u32 reg = kvm_lapic_get_reg(apic, APIC_LVTT);
1523 1524 1525

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

1528
		if (vcpu->arch.apicv_active)
1529 1530 1531 1532
			bitmap = apic->regs + APIC_IRR;

		if (apic_test_vector(vec, bitmap))
			return true;
1533 1534 1535 1536
	}
	return false;
}

1537 1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556
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));
	}
}

1557
static inline void adjust_lapic_timer_advance(struct kvm_vcpu *vcpu,
1558
					      s64 advance_expire_delta)
1559 1560
{
	struct kvm_lapic *apic = vcpu->arch.apic;
1561
	u32 timer_advance_ns = apic->lapic_timer.timer_advance_ns;
1562 1563
	u64 ns;

1564 1565 1566 1567 1568
	/* Do not adjust for tiny fluctuations or large random spikes. */
	if (abs(advance_expire_delta) > LAPIC_TIMER_ADVANCE_ADJUST_MAX ||
	    abs(advance_expire_delta) < LAPIC_TIMER_ADVANCE_ADJUST_MIN)
		return;

1569
	/* too early */
1570 1571
	if (advance_expire_delta < 0) {
		ns = -advance_expire_delta * 1000000ULL;
1572
		do_div(ns, vcpu->arch.virtual_tsc_khz);
1573
		timer_advance_ns -= ns/LAPIC_TIMER_ADVANCE_ADJUST_STEP;
1574 1575
	} else {
	/* too late */
1576
		ns = advance_expire_delta * 1000000ULL;
1577
		do_div(ns, vcpu->arch.virtual_tsc_khz);
1578
		timer_advance_ns += ns/LAPIC_TIMER_ADVANCE_ADJUST_STEP;
1579 1580
	}

1581 1582
	if (unlikely(timer_advance_ns > LAPIC_TIMER_ADVANCE_NS_MAX))
		timer_advance_ns = LAPIC_TIMER_ADVANCE_NS_INIT;
1583 1584 1585
	apic->lapic_timer.timer_advance_ns = timer_advance_ns;
}

1586
static void __kvm_wait_lapic_expire(struct kvm_vcpu *vcpu)
1587 1588 1589
{
	struct kvm_lapic *apic = vcpu->arch.apic;
	u64 guest_tsc, tsc_deadline;
1590 1591 1592

	tsc_deadline = apic->lapic_timer.expired_tscdeadline;
	apic->lapic_timer.expired_tscdeadline = 0;
1593
	guest_tsc = kvm_read_l1_tsc(vcpu, rdtsc());
1594
	apic->lapic_timer.advance_expire_delta = guest_tsc - tsc_deadline;
1595 1596

	if (guest_tsc < tsc_deadline)
1597
		__wait_lapic_expire(vcpu, tsc_deadline - guest_tsc);
1598

1599
	if (lapic_timer_advance_dynamic)
1600
		adjust_lapic_timer_advance(vcpu, apic->lapic_timer.advance_expire_delta);
1601
}
1602 1603 1604

void kvm_wait_lapic_expire(struct kvm_vcpu *vcpu)
{
1605 1606 1607 1608
	if (lapic_in_kernel(vcpu) &&
	    vcpu->arch.apic->lapic_timer.expired_tscdeadline &&
	    vcpu->arch.apic->lapic_timer.timer_advance_ns &&
	    lapic_timer_int_injected(vcpu))
1609 1610
		__kvm_wait_lapic_expire(vcpu);
}
1611
EXPORT_SYMBOL_GPL(kvm_wait_lapic_expire);
1612

1613 1614 1615 1616 1617
static void kvm_apic_inject_pending_timer_irqs(struct kvm_lapic *apic)
{
	struct kvm_timer *ktimer = &apic->lapic_timer;

	kvm_apic_local_deliver(apic, APIC_LVTT);
H
Haiwei Li 已提交
1618
	if (apic_lvtt_tscdeadline(apic)) {
1619
		ktimer->tscdeadline = 0;
H
Haiwei Li 已提交
1620
	} else if (apic_lvtt_oneshot(apic)) {
1621 1622 1623 1624 1625
		ktimer->tscdeadline = 0;
		ktimer->target_expiration = 0;
	}
}

1626
static void apic_timer_expired(struct kvm_lapic *apic, bool from_timer_fn)
1627 1628 1629 1630 1631 1632 1633 1634 1635 1636
{
	struct kvm_vcpu *vcpu = apic->vcpu;
	struct kvm_timer *ktimer = &apic->lapic_timer;

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

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

1637 1638 1639 1640 1641 1642
	if (!from_timer_fn && vcpu->arch.apicv_active) {
		WARN_ON(kvm_get_running_vcpu() != vcpu);
		kvm_apic_inject_pending_timer_irqs(apic);
		return;
	}

1643
	if (kvm_use_posted_timer_interrupt(apic->vcpu)) {
1644
		kvm_wait_lapic_expire(vcpu);
1645 1646 1647 1648 1649
		kvm_apic_inject_pending_timer_irqs(apic);
		return;
	}

	atomic_inc(&apic->lapic_timer.pending);
1650 1651 1652
	kvm_make_request(KVM_REQ_PENDING_TIMER, vcpu);
	if (from_timer_fn)
		kvm_vcpu_kick(vcpu);
1653 1654
}

1655 1656
static void start_sw_tscdeadline(struct kvm_lapic *apic)
{
1657 1658
	struct kvm_timer *ktimer = &apic->lapic_timer;
	u64 guest_tsc, tscdeadline = ktimer->tscdeadline;
1659 1660 1661 1662 1663 1664 1665 1666 1667 1668 1669 1670
	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);

1671
	now = ktime_get();
1672
	guest_tsc = kvm_read_l1_tsc(vcpu, rdtsc());
1673 1674 1675 1676 1677

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

	if (likely(tscdeadline > guest_tsc) &&
1678
	    likely(ns > apic->lapic_timer.timer_advance_ns)) {
1679
		expire = ktime_add_ns(now, ns);
1680
		expire = ktime_sub_ns(expire, ktimer->timer_advance_ns);
1681
		hrtimer_start(&ktimer->timer, expire, HRTIMER_MODE_ABS_HARD);
1682
	} else
1683
		apic_timer_expired(apic, false);
1684 1685 1686 1687

	local_irq_restore(flags);
}

1688 1689 1690 1691 1692
static inline u64 tmict_to_ns(struct kvm_lapic *apic, u32 tmict)
{
	return (u64)tmict * APIC_BUS_CYCLE_NS * (u64)apic->divide_count;
}

1693 1694 1695 1696 1697
static void update_target_expiration(struct kvm_lapic *apic, uint32_t old_divisor)
{
	ktime_t now, remaining;
	u64 ns_remaining_old, ns_remaining_new;

1698 1699
	apic->lapic_timer.period =
			tmict_to_ns(apic, kvm_lapic_get_reg(apic, APIC_TMICT));
1700 1701 1702 1703 1704 1705 1706 1707 1708 1709 1710 1711 1712 1713 1714 1715 1716
	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);
}

1717
static bool set_target_expiration(struct kvm_lapic *apic, u32 count_reg)
1718 1719
{
	ktime_t now;
1720
	u64 tscl = rdtsc();
1721
	s64 deadline;
1722

1723
	now = ktime_get();
1724 1725
	apic->lapic_timer.period =
			tmict_to_ns(apic, kvm_lapic_get_reg(apic, APIC_TMICT));
1726

1727 1728
	if (!apic->lapic_timer.period) {
		apic->lapic_timer.tscdeadline = 0;
1729
		return false;
1730 1731
	}

1732
	limit_periodic_timer_frequency(apic);
1733 1734 1735 1736 1737 1738 1739 1740 1741 1742 1743 1744 1745 1746 1747 1748 1749 1750 1751 1752 1753 1754
	deadline = apic->lapic_timer.period;

	if (apic_lvtt_period(apic) || apic_lvtt_oneshot(apic)) {
		if (unlikely(count_reg != APIC_TMICT)) {
			deadline = tmict_to_ns(apic,
				     kvm_lapic_get_reg(apic, count_reg));
			if (unlikely(deadline <= 0))
				deadline = apic->lapic_timer.period;
			else if (unlikely(deadline > apic->lapic_timer.period)) {
				pr_info_ratelimited(
				    "kvm: vcpu %i: requested lapic timer restore with "
				    "starting count register %#x=%u (%lld ns) > initial count (%lld ns). "
				    "Using initial count to start timer.\n",
				    apic->vcpu->vcpu_id,
				    count_reg,
				    kvm_lapic_get_reg(apic, count_reg),
				    deadline, apic->lapic_timer.period);
				kvm_lapic_set_reg(apic, count_reg, 0);
				deadline = apic->lapic_timer.period;
			}
		}
	}
1755

1756
	apic->lapic_timer.tscdeadline = kvm_read_l1_tsc(apic->vcpu, tscl) +
1757 1758
		nsec_to_cycles(apic->vcpu, deadline);
	apic->lapic_timer.target_expiration = ktime_add_ns(now, deadline);
1759 1760 1761 1762 1763 1764

	return true;
}

static void advance_periodic_target_expiration(struct kvm_lapic *apic)
{
1765 1766 1767 1768 1769 1770 1771 1772 1773 1774 1775
	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.
	 */
1776 1777 1778
	apic->lapic_timer.target_expiration =
		ktime_add_ns(apic->lapic_timer.target_expiration,
				apic->lapic_timer.period);
1779 1780 1781
	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);
1782 1783
}

1784 1785 1786 1787 1788 1789 1790
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)) {
1791
		apic_timer_expired(apic, false);
1792 1793 1794 1795 1796 1797 1798 1799 1800

		if (apic_lvtt_oneshot(apic))
			return;

		advance_periodic_target_expiration(apic);
	}

	hrtimer_start(&apic->lapic_timer.timer,
		apic->lapic_timer.target_expiration,
1801
		HRTIMER_MODE_ABS_HARD);
1802 1803
}

1804 1805
bool kvm_lapic_hv_timer_in_use(struct kvm_vcpu *vcpu)
{
1806 1807 1808
	if (!lapic_in_kernel(vcpu))
		return false;

1809 1810 1811 1812
	return vcpu->arch.apic->lapic_timer.hv_timer_in_use;
}
EXPORT_SYMBOL_GPL(kvm_lapic_hv_timer_in_use);

1813
static void cancel_hv_timer(struct kvm_lapic *apic)
1814
{
1815
	WARN_ON(preemptible());
1816
	WARN_ON(!apic->lapic_timer.hv_timer_in_use);
1817
	kvm_x86_ops.cancel_hv_timer(apic->vcpu);
1818 1819 1820
	apic->lapic_timer.hv_timer_in_use = false;
}

1821
static bool start_hv_timer(struct kvm_lapic *apic)
1822
{
1823
	struct kvm_timer *ktimer = &apic->lapic_timer;
1824 1825
	struct kvm_vcpu *vcpu = apic->vcpu;
	bool expired;
1826

1827
	WARN_ON(preemptible());
1828
	if (!kvm_can_use_hv_timer(vcpu))
1829 1830
		return false;

1831 1832 1833
	if (!ktimer->tscdeadline)
		return false;

1834
	if (kvm_x86_ops.set_hv_timer(vcpu, ktimer->tscdeadline, &expired))
1835 1836 1837 1838
		return false;

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

1840
	/*
1841 1842 1843
	 * 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.
1844
	 */
1845 1846 1847 1848 1849 1850 1851
	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);
1852
		} else if (expired) {
1853
			apic_timer_expired(apic, false);
1854 1855
			cancel_hv_timer(apic);
		}
1856
	}
1857

1858
	trace_kvm_hv_timer_state(vcpu->vcpu_id, ktimer->hv_timer_in_use);
1859

1860 1861 1862
	return true;
}

1863
static void start_sw_timer(struct kvm_lapic *apic)
1864
{
1865
	struct kvm_timer *ktimer = &apic->lapic_timer;
1866 1867

	WARN_ON(preemptible());
1868 1869 1870 1871 1872 1873 1874 1875 1876 1877 1878
	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);
}
1879

1880 1881
static void restart_apic_timer(struct kvm_lapic *apic)
{
1882
	preempt_disable();
1883 1884 1885 1886

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

1887 1888
	if (!start_hv_timer(apic))
		start_sw_timer(apic);
1889
out:
1890
	preempt_enable();
1891 1892
}

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

1897 1898 1899 1900
	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;
1901
	WARN_ON(rcuwait_active(&vcpu->wait));
1902
	cancel_hv_timer(apic);
1903
	apic_timer_expired(apic, false);
1904 1905 1906

	if (apic_lvtt_period(apic) && apic->lapic_timer.period) {
		advance_periodic_target_expiration(apic);
1907
		restart_apic_timer(apic);
1908
	}
1909 1910
out:
	preempt_enable();
1911 1912 1913
}
EXPORT_SYMBOL_GPL(kvm_lapic_expired_hv_timer);

1914 1915
void kvm_lapic_switch_to_hv_timer(struct kvm_vcpu *vcpu)
{
1916
	restart_apic_timer(vcpu->arch.apic);
1917 1918 1919 1920 1921 1922 1923
}
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;

1924
	preempt_disable();
1925
	/* Possibly the TSC deadline timer is not enabled yet */
1926 1927
	if (apic->lapic_timer.hv_timer_in_use)
		start_sw_timer(apic);
1928
	preempt_enable();
1929 1930
}
EXPORT_SYMBOL_GPL(kvm_lapic_switch_to_sw_timer);
1931

1932 1933 1934
void kvm_lapic_restart_hv_timer(struct kvm_vcpu *vcpu)
{
	struct kvm_lapic *apic = vcpu->arch.apic;
1935

1936 1937
	WARN_ON(!apic->lapic_timer.hv_timer_in_use);
	restart_apic_timer(apic);
1938 1939
}

1940
static void __start_apic_timer(struct kvm_lapic *apic, u32 count_reg)
E
Eddie Dong 已提交
1941
{
1942
	atomic_set(&apic->lapic_timer.pending, 0);
1943

1944
	if ((apic_lvtt_period(apic) || apic_lvtt_oneshot(apic))
1945
	    && !set_target_expiration(apic, count_reg))
1946 1947 1948
		return;

	restart_apic_timer(apic);
E
Eddie Dong 已提交
1949 1950
}

1951 1952 1953 1954 1955
static void start_apic_timer(struct kvm_lapic *apic)
{
	__start_apic_timer(apic, APIC_TMICT);
}

1956 1957
static void apic_manage_nmi_watchdog(struct kvm_lapic *apic, u32 lvt0_val)
{
1958
	bool lvt0_in_nmi_mode = apic_lvt_nmi_mode(lvt0_val);
1959

1960 1961 1962
	if (apic->lvt0_in_nmi_mode != lvt0_in_nmi_mode) {
		apic->lvt0_in_nmi_mode = lvt0_in_nmi_mode;
		if (lvt0_in_nmi_mode) {
1963
			atomic_inc(&apic->vcpu->kvm->arch.vapics_in_nmi_mode);
1964 1965 1966
		} else
			atomic_dec(&apic->vcpu->kvm->arch.vapics_in_nmi_mode);
	}
1967 1968
}

1969
int kvm_lapic_reg_write(struct kvm_lapic *apic, u32 reg, u32 val)
E
Eddie Dong 已提交
1970
{
G
Gleb Natapov 已提交
1971
	int ret = 0;
E
Eddie Dong 已提交
1972

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

G
Gleb Natapov 已提交
1975
	switch (reg) {
E
Eddie Dong 已提交
1976
	case APIC_ID:		/* Local APIC ID */
G
Gleb Natapov 已提交
1977
		if (!apic_x2apic_mode(apic))
1978
			kvm_apic_set_xapic_id(apic, val >> 24);
G
Gleb Natapov 已提交
1979 1980
		else
			ret = 1;
E
Eddie Dong 已提交
1981 1982 1983
		break;

	case APIC_TASKPRI:
1984
		report_tpr_access(apic, true);
E
Eddie Dong 已提交
1985 1986 1987 1988 1989 1990 1991 1992
		apic_set_tpr(apic, val & 0xff);
		break;

	case APIC_EOI:
		apic_set_eoi(apic);
		break;

	case APIC_LDR:
G
Gleb Natapov 已提交
1993
		if (!apic_x2apic_mode(apic))
1994
			kvm_apic_set_ldr(apic, val & APIC_LDR_MASK);
G
Gleb Natapov 已提交
1995 1996
		else
			ret = 1;
E
Eddie Dong 已提交
1997 1998 1999
		break;

	case APIC_DFR:
2000 2001 2002
		if (!apic_x2apic_mode(apic))
			kvm_apic_set_dfr(apic, val | 0x0FFFFFFF);
		else
G
Gleb Natapov 已提交
2003
			ret = 1;
E
Eddie Dong 已提交
2004 2005
		break;

2006 2007
	case APIC_SPIV: {
		u32 mask = 0x3ff;
2008
		if (kvm_lapic_get_reg(apic, APIC_LVR) & APIC_LVR_DIRECTED_EOI)
2009
			mask |= APIC_SPIV_DIRECTED_EOI;
2010
		apic_set_spiv(apic, val & mask);
E
Eddie Dong 已提交
2011 2012 2013 2014
		if (!(val & APIC_SPIV_APIC_ENABLED)) {
			int i;
			u32 lvt_val;

2015
			for (i = 0; i < KVM_APIC_LVT_NUM; i++) {
2016
				lvt_val = kvm_lapic_get_reg(apic,
E
Eddie Dong 已提交
2017
						       APIC_LVTT + 0x10 * i);
2018
				kvm_lapic_set_reg(apic, APIC_LVTT + 0x10 * i,
E
Eddie Dong 已提交
2019 2020
					     lvt_val | APIC_LVT_MASKED);
			}
2021
			apic_update_lvtt(apic);
2022
			atomic_set(&apic->lapic_timer.pending, 0);
E
Eddie Dong 已提交
2023 2024 2025

		}
		break;
2026
	}
E
Eddie Dong 已提交
2027 2028
	case APIC_ICR:
		/* No delay here, so we always clear the pending bit */
2029
		val &= ~(1 << 12);
2030
		kvm_apic_send_ipi(apic, val, kvm_lapic_get_reg(apic, APIC_ICR2));
2031
		kvm_lapic_set_reg(apic, APIC_ICR, val);
E
Eddie Dong 已提交
2032 2033 2034
		break;

	case APIC_ICR2:
G
Gleb Natapov 已提交
2035 2036
		if (!apic_x2apic_mode(apic))
			val &= 0xff000000;
2037
		kvm_lapic_set_reg(apic, APIC_ICR2, val);
E
Eddie Dong 已提交
2038 2039
		break;

2040
	case APIC_LVT0:
2041
		apic_manage_nmi_watchdog(apic, val);
2042
		fallthrough;
E
Eddie Dong 已提交
2043 2044 2045
	case APIC_LVTTHMR:
	case APIC_LVTPC:
	case APIC_LVT1:
2046
	case APIC_LVTERR: {
E
Eddie Dong 已提交
2047
		/* TODO: Check vector */
2048 2049 2050
		size_t size;
		u32 index;

2051
		if (!kvm_apic_sw_enabled(apic))
E
Eddie Dong 已提交
2052
			val |= APIC_LVT_MASKED;
2053 2054 2055 2056
		size = ARRAY_SIZE(apic_lvt_mask);
		index = array_index_nospec(
				(reg - APIC_LVTT) >> 4, size);
		val &= apic_lvt_mask[index];
2057
		kvm_lapic_set_reg(apic, reg, val);
E
Eddie Dong 已提交
2058
		break;
2059
	}
E
Eddie Dong 已提交
2060

2061
	case APIC_LVTT:
2062
		if (!kvm_apic_sw_enabled(apic))
2063 2064
			val |= APIC_LVT_MASKED;
		val &= (apic_lvt_mask[0] | apic->lapic_timer.timer_mode_mask);
2065
		kvm_lapic_set_reg(apic, APIC_LVTT, val);
2066
		apic_update_lvtt(apic);
2067 2068
		break;

E
Eddie Dong 已提交
2069
	case APIC_TMICT:
2070 2071 2072
		if (apic_lvtt_tscdeadline(apic))
			break;

2073
		hrtimer_cancel(&apic->lapic_timer.timer);
2074
		kvm_lapic_set_reg(apic, APIC_TMICT, val);
E
Eddie Dong 已提交
2075
		start_apic_timer(apic);
G
Gleb Natapov 已提交
2076
		break;
E
Eddie Dong 已提交
2077

2078 2079 2080
	case APIC_TDCR: {
		uint32_t old_divisor = apic->divide_count;

2081
		kvm_lapic_set_reg(apic, APIC_TDCR, val & 0xb);
E
Eddie Dong 已提交
2082
		update_divide_count(apic);
2083 2084 2085 2086 2087 2088
		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 已提交
2089
		break;
2090
	}
G
Gleb Natapov 已提交
2091
	case APIC_ESR:
2092
		if (apic_x2apic_mode(apic) && val != 0)
G
Gleb Natapov 已提交
2093 2094 2095 2096 2097
			ret = 1;
		break;

	case APIC_SELF_IPI:
		if (apic_x2apic_mode(apic)) {
2098 2099
			kvm_lapic_reg_write(apic, APIC_ICR,
					    APIC_DEST_SELF | (val & APIC_VECTOR_MASK));
G
Gleb Natapov 已提交
2100 2101 2102
		} else
			ret = 1;
		break;
E
Eddie Dong 已提交
2103
	default:
G
Gleb Natapov 已提交
2104
		ret = 1;
E
Eddie Dong 已提交
2105 2106
		break;
	}
2107

2108 2109
	kvm_recalculate_apic_map(apic->vcpu->kvm);

G
Gleb Natapov 已提交
2110 2111
	return ret;
}
2112
EXPORT_SYMBOL_GPL(kvm_lapic_reg_write);
G
Gleb Natapov 已提交
2113

2114
static int apic_mmio_write(struct kvm_vcpu *vcpu, struct kvm_io_device *this,
G
Gleb Natapov 已提交
2115 2116 2117 2118 2119 2120 2121 2122 2123
			    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;

2124 2125 2126 2127 2128 2129 2130 2131
	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 已提交
2132 2133 2134 2135 2136
	/*
	 * 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
	 */
2137
	if (len != 4 || (offset & 0xf))
2138
		return 0;
G
Gleb Natapov 已提交
2139 2140 2141

	val = *(u32*)data;

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

2144
	return 0;
E
Eddie Dong 已提交
2145 2146
}

2147 2148
void kvm_lapic_set_eoi(struct kvm_vcpu *vcpu)
{
2149
	kvm_lapic_reg_write(vcpu->arch.apic, APIC_EOI, 0);
2150 2151 2152
}
EXPORT_SYMBOL_GPL(kvm_lapic_set_eoi);

2153 2154 2155 2156 2157 2158 2159 2160
/* 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;

2161
	kvm_lapic_reg_read(vcpu->arch.apic, offset, 4, &val);
2162 2163

	/* TODO: optimize to just emulate side effect w/o one more write */
2164
	kvm_lapic_reg_write(vcpu->arch.apic, offset, val);
2165 2166 2167
}
EXPORT_SYMBOL_GPL(kvm_apic_write_nodecode);

2168
void kvm_free_lapic(struct kvm_vcpu *vcpu)
E
Eddie Dong 已提交
2169
{
2170 2171
	struct kvm_lapic *apic = vcpu->arch.apic;

2172
	if (!vcpu->arch.apic)
E
Eddie Dong 已提交
2173 2174
		return;

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

2177 2178 2179
	if (!(vcpu->arch.apic_base & MSR_IA32_APICBASE_ENABLE))
		static_key_slow_dec_deferred(&apic_hw_disabled);

2180
	if (!apic->sw_enabled)
2181
		static_key_slow_dec_deferred(&apic_sw_disabled);
E
Eddie Dong 已提交
2182

2183 2184 2185 2186
	if (apic->regs)
		free_page((unsigned long)apic->regs);

	kfree(apic);
E
Eddie Dong 已提交
2187 2188 2189 2190 2191 2192 2193
}

/*
 *----------------------------------------------------------------------
 * LAPIC interface
 *----------------------------------------------------------------------
 */
2194 2195 2196 2197
u64 kvm_get_lapic_tscdeadline_msr(struct kvm_vcpu *vcpu)
{
	struct kvm_lapic *apic = vcpu->arch.apic;

2198
	if (!kvm_apic_present(vcpu) || !apic_lvtt_tscdeadline(apic))
2199 2200 2201 2202 2203 2204 2205 2206 2207
		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;

2208
	if (!kvm_apic_present(vcpu) || !apic_lvtt_tscdeadline(apic))
2209 2210 2211 2212 2213 2214 2215
		return;

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

E
Eddie Dong 已提交
2216 2217
void kvm_lapic_set_tpr(struct kvm_vcpu *vcpu, unsigned long cr8)
{
2218
	struct kvm_lapic *apic = vcpu->arch.apic;
E
Eddie Dong 已提交
2219

A
Avi Kivity 已提交
2220
	apic_set_tpr(apic, ((cr8 & 0x0f) << 4)
2221
		     | (kvm_lapic_get_reg(apic, APIC_TASKPRI) & 4));
E
Eddie Dong 已提交
2222 2223 2224 2225 2226 2227
}

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

2228
	tpr = (u64) kvm_lapic_get_reg(vcpu->arch.apic, APIC_TASKPRI);
E
Eddie Dong 已提交
2229 2230 2231 2232 2233 2234

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

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

2238
	if (!apic)
E
Eddie Dong 已提交
2239
		value |= MSR_IA32_APICBASE_BSP;
2240

2241 2242
	vcpu->arch.apic_base = value;

2243
	if ((old_value ^ value) & MSR_IA32_APICBASE_ENABLE)
2244
		kvm_update_cpuid_runtime(vcpu);
2245 2246 2247 2248

	if (!apic)
		return;

2249
	/* update jump label if enable bit changes */
2250
	if ((old_value ^ value) & MSR_IA32_APICBASE_ENABLE) {
2251 2252
		if (value & MSR_IA32_APICBASE_ENABLE) {
			kvm_apic_set_xapic_id(apic, vcpu->vcpu_id);
2253
			static_key_slow_dec_deferred(&apic_hw_disabled);
2254
		} else {
2255
			static_key_slow_inc(&apic_hw_disabled.key);
2256
			atomic_set_release(&apic->vcpu->kvm->arch.apic_map_dirty, DIRTY);
2257
		}
2258 2259
	}

2260 2261 2262 2263
	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))
2264
		kvm_x86_ops.set_virtual_apic_mode(vcpu);
2265

2266
	apic->base_address = apic->vcpu->arch.apic_base &
E
Eddie Dong 已提交
2267 2268
			     MSR_IA32_APICBASE_BASE;

2269 2270 2271
	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 已提交
2272 2273
}

2274 2275 2276 2277 2278 2279 2280 2281 2282 2283 2284 2285 2286 2287 2288
void kvm_apic_update_apicv(struct kvm_vcpu *vcpu)
{
	struct kvm_lapic *apic = vcpu->arch.apic;

	if (vcpu->arch.apicv_active) {
		/* irr_pending is always true when apicv is activated. */
		apic->irr_pending = true;
		apic->isr_count = 1;
	} else {
		apic->irr_pending = (apic_search_irr(apic) != -1);
		apic->isr_count = count_vectors(apic->regs + APIC_ISR);
	}
}
EXPORT_SYMBOL_GPL(kvm_apic_update_apicv);

2289
void kvm_lapic_reset(struct kvm_vcpu *vcpu, bool init_event)
E
Eddie Dong 已提交
2290
{
2291
	struct kvm_lapic *apic = vcpu->arch.apic;
E
Eddie Dong 已提交
2292 2293
	int i;

2294 2295
	if (!apic)
		return;
E
Eddie Dong 已提交
2296 2297

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

2300 2301 2302
	if (!init_event) {
		kvm_lapic_set_base(vcpu, APIC_DEFAULT_PHYS_BASE |
		                         MSR_IA32_APICBASE_ENABLE);
2303
		kvm_apic_set_xapic_id(apic, vcpu->vcpu_id);
2304
	}
2305
	kvm_apic_set_version(apic->vcpu);
E
Eddie Dong 已提交
2306

2307 2308
	for (i = 0; i < KVM_APIC_LVT_NUM; i++)
		kvm_lapic_set_reg(apic, APIC_LVTT + 0x10 * i, APIC_LVT_MASKED);
2309
	apic_update_lvtt(apic);
2310 2311
	if (kvm_vcpu_is_reset_bsp(vcpu) &&
	    kvm_check_has_quirk(vcpu->kvm, KVM_X86_QUIRK_LINT0_REENABLED))
2312
		kvm_lapic_set_reg(apic, APIC_LVT0,
2313
			     SET_APIC_DELIVERY_MODE(0, APIC_MODE_EXTINT));
2314
	apic_manage_nmi_watchdog(apic, kvm_lapic_get_reg(apic, APIC_LVT0));
E
Eddie Dong 已提交
2315

2316
	kvm_apic_set_dfr(apic, 0xffffffffU);
2317
	apic_set_spiv(apic, 0xff);
2318
	kvm_lapic_set_reg(apic, APIC_TASKPRI, 0);
2319 2320
	if (!apic_x2apic_mode(apic))
		kvm_apic_set_ldr(apic, 0);
2321 2322 2323 2324 2325
	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 已提交
2326
	for (i = 0; i < 8; i++) {
2327 2328 2329
		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 已提交
2330
	}
2331
	kvm_apic_update_apicv(vcpu);
M
Michael S. Tsirkin 已提交
2332
	apic->highest_isr_cache = -1;
2333
	update_divide_count(apic);
2334
	atomic_set(&apic->lapic_timer.pending, 0);
2335
	if (kvm_vcpu_is_bsp(vcpu))
2336 2337
		kvm_lapic_set_base(vcpu,
				vcpu->arch.apic_base | MSR_IA32_APICBASE_BSP);
2338
	vcpu->arch.pv_eoi.msr_val = 0;
E
Eddie Dong 已提交
2339
	apic_update_ppr(apic);
2340
	if (vcpu->arch.apicv_active) {
2341 2342 2343
		kvm_x86_ops.apicv_post_state_restore(vcpu);
		kvm_x86_ops.hwapic_irr_update(vcpu, -1);
		kvm_x86_ops.hwapic_isr_update(vcpu, -1);
2344
	}
E
Eddie Dong 已提交
2345

2346
	vcpu->arch.apic_arb_prio = 0;
2347
	vcpu->arch.apic_attention = 0;
2348 2349

	kvm_recalculate_apic_map(vcpu->kvm);
E
Eddie Dong 已提交
2350 2351 2352 2353 2354 2355 2356
}

/*
 *----------------------------------------------------------------------
 * timer interface
 *----------------------------------------------------------------------
 */
2357

A
Avi Kivity 已提交
2358
static bool lapic_is_periodic(struct kvm_lapic *apic)
E
Eddie Dong 已提交
2359
{
2360
	return apic_lvtt_period(apic);
E
Eddie Dong 已提交
2361 2362
}

2363 2364
int apic_has_pending_timer(struct kvm_vcpu *vcpu)
{
2365
	struct kvm_lapic *apic = vcpu->arch.apic;
2366

2367
	if (apic_enabled(apic) && apic_lvt_enabled(apic, APIC_LVTT))
2368
		return atomic_read(&apic->lapic_timer.pending);
2369 2370 2371 2372

	return 0;
}

A
Avi Kivity 已提交
2373
int kvm_apic_local_deliver(struct kvm_lapic *apic, int lvt_type)
2374
{
2375
	u32 reg = kvm_lapic_get_reg(apic, lvt_type);
2376 2377
	int vector, mode, trig_mode;

2378
	if (kvm_apic_hw_enabled(apic) && !(reg & APIC_LVT_MASKED)) {
2379 2380 2381
		vector = reg & APIC_VECTOR_MASK;
		mode = reg & APIC_MODE_MASK;
		trig_mode = reg & APIC_LVT_LEVEL_TRIGGER;
2382 2383
		return __apic_accept_irq(apic, mode, vector, 1, trig_mode,
					NULL);
2384 2385 2386
	}
	return 0;
}
2387

2388
void kvm_apic_nmi_wd_deliver(struct kvm_vcpu *vcpu)
2389
{
2390 2391 2392 2393
	struct kvm_lapic *apic = vcpu->arch.apic;

	if (apic)
		kvm_apic_local_deliver(apic, APIC_LVT0);
2394 2395
}

G
Gregory Haskins 已提交
2396 2397 2398 2399 2400
static const struct kvm_io_device_ops apic_mmio_ops = {
	.read     = apic_mmio_read,
	.write    = apic_mmio_write,
};

2401 2402 2403
static enum hrtimer_restart apic_timer_fn(struct hrtimer *data)
{
	struct kvm_timer *ktimer = container_of(data, struct kvm_timer, timer);
A
Avi Kivity 已提交
2404
	struct kvm_lapic *apic = container_of(ktimer, struct kvm_lapic, lapic_timer);
2405

2406
	apic_timer_expired(apic, true);
2407

A
Avi Kivity 已提交
2408
	if (lapic_is_periodic(apic)) {
2409
		advance_periodic_target_expiration(apic);
2410 2411 2412 2413 2414 2415
		hrtimer_add_expires_ns(&ktimer->timer, ktimer->period);
		return HRTIMER_RESTART;
	} else
		return HRTIMER_NORESTART;
}

2416
int kvm_create_lapic(struct kvm_vcpu *vcpu, int timer_advance_ns)
E
Eddie Dong 已提交
2417 2418 2419 2420 2421
{
	struct kvm_lapic *apic;

	ASSERT(vcpu != NULL);

2422
	apic = kzalloc(sizeof(*apic), GFP_KERNEL_ACCOUNT);
E
Eddie Dong 已提交
2423 2424 2425
	if (!apic)
		goto nomem;

2426
	vcpu->arch.apic = apic;
E
Eddie Dong 已提交
2427

2428
	apic->regs = (void *)get_zeroed_page(GFP_KERNEL_ACCOUNT);
2429
	if (!apic->regs) {
E
Eddie Dong 已提交
2430 2431
		printk(KERN_ERR "malloc apic regs error for vcpu %x\n",
		       vcpu->vcpu_id);
2432
		goto nomem_free_apic;
E
Eddie Dong 已提交
2433 2434 2435
	}
	apic->vcpu = vcpu;

2436
	hrtimer_init(&apic->lapic_timer.timer, CLOCK_MONOTONIC,
2437
		     HRTIMER_MODE_ABS_HARD);
2438
	apic->lapic_timer.timer.function = apic_timer_fn;
2439
	if (timer_advance_ns == -1) {
2440
		apic->lapic_timer.timer_advance_ns = LAPIC_TIMER_ADVANCE_NS_INIT;
2441
		lapic_timer_advance_dynamic = true;
2442 2443
	} else {
		apic->lapic_timer.timer_advance_ns = timer_advance_ns;
2444
		lapic_timer_advance_dynamic = false;
2445 2446
	}

2447 2448
	/*
	 * APIC is created enabled. This will prevent kvm_lapic_set_base from
2449
	 * thinking that APIC state has changed.
2450 2451
	 */
	vcpu->arch.apic_base = MSR_IA32_APICBASE_ENABLE;
2452
	static_key_slow_inc(&apic_sw_disabled.key); /* sw disabled at reset */
G
Gregory Haskins 已提交
2453
	kvm_iodevice_init(&apic->dev, &apic_mmio_ops);
E
Eddie Dong 已提交
2454 2455

	return 0;
2456 2457
nomem_free_apic:
	kfree(apic);
2458
	vcpu->arch.apic = NULL;
E
Eddie Dong 已提交
2459 2460 2461 2462 2463 2464
nomem:
	return -ENOMEM;
}

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

2468
	if (!kvm_apic_present(vcpu))
E
Eddie Dong 已提交
2469 2470
		return -1;

2471 2472
	__apic_update_ppr(apic, &ppr);
	return apic_has_interrupt_for_ppr(apic, ppr);
E
Eddie Dong 已提交
2473
}
2474
EXPORT_SYMBOL_GPL(kvm_apic_has_interrupt);
E
Eddie Dong 已提交
2475

Q
Qing He 已提交
2476 2477
int kvm_apic_accept_pic_intr(struct kvm_vcpu *vcpu)
{
2478
	u32 lvt0 = kvm_lapic_get_reg(vcpu->arch.apic, APIC_LVT0);
Q
Qing He 已提交
2479

2480
	if (!kvm_apic_hw_enabled(vcpu->arch.apic))
2481
		return 1;
2482 2483
	if ((lvt0 & APIC_LVT_MASKED) == 0 &&
	    GET_APIC_DELIVERY_MODE(lvt0) == APIC_MODE_EXTINT)
2484 2485
		return 1;
	return 0;
Q
Qing He 已提交
2486 2487
}

2488 2489
void kvm_inject_apic_timer_irqs(struct kvm_vcpu *vcpu)
{
2490
	struct kvm_lapic *apic = vcpu->arch.apic;
2491

2492
	if (atomic_read(&apic->lapic_timer.pending) > 0) {
2493
		kvm_apic_inject_pending_timer_irqs(apic);
2494
		atomic_set(&apic->lapic_timer.pending, 0);
2495 2496 2497
	}
}

E
Eddie Dong 已提交
2498 2499 2500
int kvm_get_apic_interrupt(struct kvm_vcpu *vcpu)
{
	int vector = kvm_apic_has_interrupt(vcpu);
2501
	struct kvm_lapic *apic = vcpu->arch.apic;
2502
	u32 ppr;
E
Eddie Dong 已提交
2503 2504 2505 2506

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

2507 2508 2509 2510 2511 2512 2513
	/*
	 * 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 已提交
2514
	apic_clear_irr(vector, apic);
2515
	if (test_bit(vector, vcpu_to_synic(vcpu)->auto_eoi_bitmap)) {
2516 2517 2518 2519 2520
		/*
		 * For auto-EOI interrupts, there might be another pending
		 * interrupt above PPR, so check whether to raise another
		 * KVM_REQ_EVENT.
		 */
2521
		apic_update_ppr(apic);
2522 2523 2524 2525 2526 2527 2528 2529 2530
	} 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);
2531 2532
	}

E
Eddie Dong 已提交
2533 2534
	return vector;
}
2535

2536 2537 2538 2539 2540
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);
2541
		u32 *ldr = (u32 *)(s->regs + APIC_LDR);
2542

2543 2544 2545 2546 2547 2548 2549 2550 2551
		if (vcpu->kvm->arch.x2apic_format) {
			if (*id != vcpu->vcpu_id)
				return -EINVAL;
		} else {
			if (set)
				*id >>= 24;
			else
				*id <<= 24;
		}
2552 2553 2554 2555

		/* In x2APIC mode, the LDR is fixed and based on the id */
		if (set)
			*ldr = kvm_apic_calc_x2apic_ldr(*id);
2556 2557 2558 2559 2560 2561 2562 2563
	}

	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));
2564 2565 2566 2567 2568 2569 2570 2571

	/*
	 * Get calculated timer current count for remaining timer period (if
	 * any) and store it in the returned register set.
	 */
	__kvm_lapic_set_reg(s->regs, APIC_TMCCT,
			    __apic_read(vcpu->arch.apic, APIC_TMCCT));

2572 2573 2574 2575
	return kvm_apic_state_fixup(vcpu, s, false);
}

int kvm_apic_set_state(struct kvm_vcpu *vcpu, struct kvm_lapic_state *s)
2576
{
2577
	struct kvm_lapic *apic = vcpu->arch.apic;
2578 2579
	int r;

2580
	kvm_lapic_set_base(vcpu, vcpu->arch.apic_base);
2581 2582
	/* set SPIV separately to get count of SW disabled APICs right */
	apic_set_spiv(apic, *((u32 *)(s->regs + APIC_SPIV)));
2583 2584

	r = kvm_apic_state_fixup(vcpu, s, true);
2585 2586
	if (r) {
		kvm_recalculate_apic_map(vcpu->kvm);
2587
		return r;
2588
	}
2589
	memcpy(vcpu->arch.apic->regs, s->regs, sizeof(*s));
2590

2591
	atomic_set_release(&apic->vcpu->kvm->arch.apic_map_dirty, DIRTY);
2592
	kvm_recalculate_apic_map(vcpu->kvm);
2593 2594
	kvm_apic_set_version(vcpu);

2595
	apic_update_ppr(apic);
2596
	hrtimer_cancel(&apic->lapic_timer.timer);
2597
	apic_update_lvtt(apic);
2598
	apic_manage_nmi_watchdog(apic, kvm_lapic_get_reg(apic, APIC_LVT0));
2599
	update_divide_count(apic);
2600
	__start_apic_timer(apic, APIC_TMCCT);
2601
	kvm_apic_update_apicv(vcpu);
M
Michael S. Tsirkin 已提交
2602
	apic->highest_isr_cache = -1;
2603
	if (vcpu->arch.apicv_active) {
2604 2605
		kvm_x86_ops.apicv_post_state_restore(vcpu);
		kvm_x86_ops.hwapic_irr_update(vcpu,
W
Wei Wang 已提交
2606
				apic_find_highest_irr(apic));
2607
		kvm_x86_ops.hwapic_isr_update(vcpu,
2608
				apic_find_highest_isr(apic));
2609
	}
2610
	kvm_make_request(KVM_REQ_EVENT, vcpu);
2611 2612
	if (ioapic_in_kernel(vcpu->kvm))
		kvm_rtc_eoi_tracking_restore_one(vcpu);
2613 2614

	vcpu->arch.apic_arb_prio = 0;
2615 2616

	return 0;
2617
}
2618

2619
void __kvm_migrate_apic_timer(struct kvm_vcpu *vcpu)
2620 2621 2622
{
	struct hrtimer *timer;

2623 2624
	if (!lapic_in_kernel(vcpu) ||
		kvm_can_post_timer_interrupt(vcpu))
2625 2626
		return;

2627
	timer = &vcpu->arch.apic->lapic_timer.timer;
2628
	if (hrtimer_cancel(timer))
2629
		hrtimer_start_expires(timer, HRTIMER_MODE_ABS_HARD);
2630
}
A
Avi Kivity 已提交
2631

2632 2633 2634 2635 2636 2637 2638 2639 2640 2641 2642 2643 2644 2645 2646 2647 2648 2649 2650 2651 2652 2653 2654 2655 2656 2657 2658 2659 2660 2661 2662 2663 2664 2665 2666 2667 2668
/*
 * 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 已提交
2669 2670 2671 2672
void kvm_lapic_sync_from_vapic(struct kvm_vcpu *vcpu)
{
	u32 data;

2673 2674 2675
	if (test_bit(KVM_APIC_PV_EOI_PENDING, &vcpu->arch.apic_attention))
		apic_sync_pv_eoi_from_guest(vcpu, vcpu->arch.apic);

2676
	if (!test_bit(KVM_APIC_CHECK_VAPIC, &vcpu->arch.apic_attention))
A
Avi Kivity 已提交
2677 2678
		return;

2679 2680
	if (kvm_read_guest_cached(vcpu->kvm, &vcpu->arch.apic->vapic_cache, &data,
				  sizeof(u32)))
2681
		return;
A
Avi Kivity 已提交
2682 2683 2684 2685

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

2686 2687 2688 2689 2690 2691 2692 2693 2694 2695 2696 2697 2698 2699 2700
/*
 * 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. */
2701
	    kvm_ioapic_handles_vector(apic, apic->highest_isr_cache)) {
2702 2703 2704 2705 2706 2707 2708 2709 2710 2711
		/*
		 * 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 已提交
2712 2713 2714 2715
void kvm_lapic_sync_to_vapic(struct kvm_vcpu *vcpu)
{
	u32 data, tpr;
	int max_irr, max_isr;
2716
	struct kvm_lapic *apic = vcpu->arch.apic;
A
Avi Kivity 已提交
2717

2718 2719
	apic_sync_pv_eoi_to_guest(vcpu, apic);

2720
	if (!test_bit(KVM_APIC_CHECK_VAPIC, &vcpu->arch.apic_attention))
A
Avi Kivity 已提交
2721 2722
		return;

2723
	tpr = kvm_lapic_get_reg(apic, APIC_TASKPRI) & 0xff;
A
Avi Kivity 已提交
2724 2725 2726 2727 2728 2729 2730 2731
	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);

2732 2733
	kvm_write_guest_cached(vcpu->kvm, &vcpu->arch.apic->vapic_cache, &data,
				sizeof(u32));
A
Avi Kivity 已提交
2734 2735
}

2736
int kvm_lapic_set_vapic_addr(struct kvm_vcpu *vcpu, gpa_t vapic_addr)
A
Avi Kivity 已提交
2737
{
2738
	if (vapic_addr) {
2739
		if (kvm_gfn_to_hva_cache_init(vcpu->kvm,
2740 2741 2742
					&vcpu->arch.apic->vapic_cache,
					vapic_addr, sizeof(u32)))
			return -EINVAL;
2743
		__set_bit(KVM_APIC_CHECK_VAPIC, &vcpu->arch.apic_attention);
2744
	} else {
2745
		__clear_bit(KVM_APIC_CHECK_VAPIC, &vcpu->arch.apic_attention);
2746 2747 2748 2749
	}

	vcpu->arch.apic->vapic_addr = vapic_addr;
	return 0;
A
Avi Kivity 已提交
2750
}
G
Gleb Natapov 已提交
2751 2752 2753 2754 2755 2756

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;

2757
	if (!lapic_in_kernel(vcpu) || !apic_x2apic_mode(apic))
G
Gleb Natapov 已提交
2758 2759
		return 1;

2760 2761 2762
	if (reg == APIC_ICR2)
		return 1;

G
Gleb Natapov 已提交
2763
	/* if this is ICR write vector before command */
2764
	if (reg == APIC_ICR)
2765 2766
		kvm_lapic_reg_write(apic, APIC_ICR2, (u32)(data >> 32));
	return kvm_lapic_reg_write(apic, reg, (u32)data);
G
Gleb Natapov 已提交
2767 2768 2769 2770 2771 2772 2773
}

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;

2774
	if (!lapic_in_kernel(vcpu) || !apic_x2apic_mode(apic))
G
Gleb Natapov 已提交
2775 2776
		return 1;

2777
	if (reg == APIC_DFR || reg == APIC_ICR2)
2778 2779
		return 1;

2780
	if (kvm_lapic_reg_read(apic, reg, 4, &low))
G
Gleb Natapov 已提交
2781
		return 1;
2782
	if (reg == APIC_ICR)
2783
		kvm_lapic_reg_read(apic, APIC_ICR2, 4, &high);
G
Gleb Natapov 已提交
2784 2785 2786 2787 2788

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

	return 0;
}
G
Gleb Natapov 已提交
2789 2790 2791 2792 2793

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

2794
	if (!lapic_in_kernel(vcpu))
G
Gleb Natapov 已提交
2795 2796 2797 2798
		return 1;

	/* if this is ICR write vector before command */
	if (reg == APIC_ICR)
2799 2800
		kvm_lapic_reg_write(apic, APIC_ICR2, (u32)(data >> 32));
	return kvm_lapic_reg_write(apic, reg, (u32)data);
G
Gleb Natapov 已提交
2801 2802 2803 2804 2805 2806 2807
}

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;

2808
	if (!lapic_in_kernel(vcpu))
G
Gleb Natapov 已提交
2809 2810
		return 1;

2811
	if (kvm_lapic_reg_read(apic, reg, 4, &low))
G
Gleb Natapov 已提交
2812 2813
		return 1;
	if (reg == APIC_ICR)
2814
		kvm_lapic_reg_read(apic, APIC_ICR2, 4, &high);
G
Gleb Natapov 已提交
2815 2816 2817 2818 2819

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

	return 0;
}
2820

2821
int kvm_lapic_enable_pv_eoi(struct kvm_vcpu *vcpu, u64 data, unsigned long len)
2822 2823
{
	u64 addr = data & ~KVM_MSR_ENABLED;
2824 2825 2826
	struct gfn_to_hva_cache *ghc = &vcpu->arch.pv_eoi.data;
	unsigned long new_len;

2827 2828 2829 2830 2831 2832
	if (!IS_ALIGNED(addr, 4))
		return 1;

	vcpu->arch.pv_eoi.msr_val = data;
	if (!pv_eoi_enabled(vcpu))
		return 0;
2833 2834 2835 2836 2837 2838 2839

	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);
2840
}
2841

2842 2843 2844
void kvm_apic_accept_events(struct kvm_vcpu *vcpu)
{
	struct kvm_lapic *apic = vcpu->arch.apic;
2845
	u8 sipi_vector;
2846
	int r;
2847
	unsigned long pe;
2848

2849 2850 2851 2852 2853 2854 2855 2856 2857
	if (!lapic_in_kernel(vcpu))
		return;

	/*
	 * Read pending events before calling the check_events
	 * callback.
	 */
	pe = smp_load_acquire(&apic->pending_events);
	if (!pe)
2858 2859
		return;

2860 2861 2862 2863 2864 2865 2866 2867 2868 2869 2870 2871
	if (is_guest_mode(vcpu)) {
		r = kvm_x86_ops.nested_ops->check_events(vcpu);
		if (r < 0)
			return;
		/*
		 * If an event has happened and caused a vmexit,
		 * we know INITs are latched and therefore
		 * we will not incorrectly deliver an APIC
		 * event instead of a vmexit.
		 */
	}

2872
	/*
2873
	 * INITs are latched while CPU is in specific states
2874
	 * (SMM, VMX root mode, SVM with GIF=0).
2875 2876 2877 2878
	 * Because a CPU cannot be in these states immediately
	 * after it has processed an INIT signal (and thus in
	 * KVM_MP_STATE_INIT_RECEIVED state), just eat SIPIs
	 * and leave the INIT pending.
2879
	 */
2880
	if (kvm_vcpu_latch_init(vcpu)) {
2881
		WARN_ON_ONCE(vcpu->arch.mp_state == KVM_MP_STATE_INIT_RECEIVED);
2882
		if (test_bit(KVM_APIC_SIPI, &pe))
2883 2884 2885
			clear_bit(KVM_APIC_SIPI, &apic->pending_events);
		return;
	}
2886 2887

	if (test_bit(KVM_APIC_INIT, &pe)) {
2888
		clear_bit(KVM_APIC_INIT, &apic->pending_events);
2889
		kvm_vcpu_reset(vcpu, true);
2890 2891 2892 2893 2894
		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;
	}
2895
	if (test_bit(KVM_APIC_SIPI, &pe)) {
2896
		clear_bit(KVM_APIC_SIPI, &apic->pending_events);
2897 2898 2899 2900 2901 2902 2903
		if (vcpu->arch.mp_state == KVM_MP_STATE_INIT_RECEIVED) {
			/* evaluate pending_events before reading the vector */
			smp_rmb();
			sipi_vector = apic->sipi_vector;
			kvm_vcpu_deliver_sipi_vector(vcpu, sipi_vector);
			vcpu->arch.mp_state = KVM_MP_STATE_RUNNABLE;
		}
2904 2905 2906
	}
}

2907 2908 2909 2910
void kvm_lapic_init(void)
{
	/* do not patch jump label more than once per second */
	jump_label_rate_limit(&apic_hw_disabled, HZ);
2911
	jump_label_rate_limit(&apic_sw_disabled, HZ);
2912
}
2913 2914 2915 2916 2917 2918

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