]> git.proxmox.com Git - mirror_ubuntu-bionic-kernel.git/blob - arch/x86/kvm/lapic.c
Merge branch 'irq-urgent-for-linus' of git://git.kernel.org/pub/scm/linux/kernel...
[mirror_ubuntu-bionic-kernel.git] / arch / x86 / kvm / lapic.c
1
2 /*
3 * Local APIC virtualization
4 *
5 * Copyright (C) 2006 Qumranet, Inc.
6 * Copyright (C) 2007 Novell
7 * Copyright (C) 2007 Intel
8 * Copyright 2009 Red Hat, Inc. and/or its affiliates.
9 *
10 * Authors:
11 * Dor Laor <dor.laor@qumranet.com>
12 * Gregory Haskins <ghaskins@novell.com>
13 * Yaozu (Eddie) Dong <eddie.dong@intel.com>
14 *
15 * Based on Xen 3.1 code, Copyright (c) 2004, Intel Corporation.
16 *
17 * This work is licensed under the terms of the GNU GPL, version 2. See
18 * the COPYING file in the top-level directory.
19 */
20
21 #include <linux/kvm_host.h>
22 #include <linux/kvm.h>
23 #include <linux/mm.h>
24 #include <linux/highmem.h>
25 #include <linux/smp.h>
26 #include <linux/hrtimer.h>
27 #include <linux/io.h>
28 #include <linux/export.h>
29 #include <linux/math64.h>
30 #include <linux/slab.h>
31 #include <asm/processor.h>
32 #include <asm/msr.h>
33 #include <asm/page.h>
34 #include <asm/current.h>
35 #include <asm/apicdef.h>
36 #include <asm/delay.h>
37 #include <linux/atomic.h>
38 #include <linux/jump_label.h>
39 #include "kvm_cache_regs.h"
40 #include "irq.h"
41 #include "trace.h"
42 #include "x86.h"
43 #include "cpuid.h"
44 #include "hyperv.h"
45
46 #ifndef CONFIG_X86_64
47 #define mod_64(x, y) ((x) - (y) * div64_u64(x, y))
48 #else
49 #define mod_64(x, y) ((x) % (y))
50 #endif
51
52 #define PRId64 "d"
53 #define PRIx64 "llx"
54 #define PRIu64 "u"
55 #define PRIo64 "o"
56
57 /* #define apic_debug(fmt,arg...) printk(KERN_WARNING fmt,##arg) */
58 #define apic_debug(fmt, arg...)
59
60 /* 14 is the version for Xeon and Pentium 8.4.8*/
61 #define APIC_VERSION (0x14UL | ((KVM_APIC_LVT_NUM - 1) << 16))
62 #define LAPIC_MMIO_LENGTH (1 << 12)
63 /* followed define is not in apicdef.h */
64 #define APIC_SHORT_MASK 0xc0000
65 #define APIC_DEST_NOSHORT 0x0
66 #define APIC_DEST_MASK 0x800
67 #define MAX_APIC_VECTOR 256
68 #define APIC_VECTORS_PER_REG 32
69
70 #define APIC_BROADCAST 0xFF
71 #define X2APIC_BROADCAST 0xFFFFFFFFul
72
73 static inline int apic_test_vector(int vec, void *bitmap)
74 {
75 return test_bit(VEC_POS(vec), (bitmap) + REG_POS(vec));
76 }
77
78 bool kvm_apic_pending_eoi(struct kvm_vcpu *vcpu, int vector)
79 {
80 struct kvm_lapic *apic = vcpu->arch.apic;
81
82 return apic_test_vector(vector, apic->regs + APIC_ISR) ||
83 apic_test_vector(vector, apic->regs + APIC_IRR);
84 }
85
86 static inline void apic_clear_vector(int vec, void *bitmap)
87 {
88 clear_bit(VEC_POS(vec), (bitmap) + REG_POS(vec));
89 }
90
91 static inline int __apic_test_and_set_vector(int vec, void *bitmap)
92 {
93 return __test_and_set_bit(VEC_POS(vec), (bitmap) + REG_POS(vec));
94 }
95
96 static inline int __apic_test_and_clear_vector(int vec, void *bitmap)
97 {
98 return __test_and_clear_bit(VEC_POS(vec), (bitmap) + REG_POS(vec));
99 }
100
101 struct static_key_deferred apic_hw_disabled __read_mostly;
102 struct static_key_deferred apic_sw_disabled __read_mostly;
103
104 static inline int apic_enabled(struct kvm_lapic *apic)
105 {
106 return kvm_apic_sw_enabled(apic) && kvm_apic_hw_enabled(apic);
107 }
108
109 #define LVT_MASK \
110 (APIC_LVT_MASKED | APIC_SEND_PENDING | APIC_VECTOR_MASK)
111
112 #define LINT_MASK \
113 (LVT_MASK | APIC_MODE_MASK | APIC_INPUT_POLARITY | \
114 APIC_LVT_REMOTE_IRR | APIC_LVT_LEVEL_TRIGGER)
115
116 static inline u8 kvm_xapic_id(struct kvm_lapic *apic)
117 {
118 return kvm_lapic_get_reg(apic, APIC_ID) >> 24;
119 }
120
121 static inline u32 kvm_x2apic_id(struct kvm_lapic *apic)
122 {
123 return apic->vcpu->vcpu_id;
124 }
125
126 static inline bool kvm_apic_map_get_logical_dest(struct kvm_apic_map *map,
127 u32 dest_id, struct kvm_lapic ***cluster, u16 *mask) {
128 switch (map->mode) {
129 case KVM_APIC_MODE_X2APIC: {
130 u32 offset = (dest_id >> 16) * 16;
131 u32 max_apic_id = map->max_apic_id;
132
133 if (offset <= max_apic_id) {
134 u8 cluster_size = min(max_apic_id - offset + 1, 16U);
135
136 *cluster = &map->phys_map[offset];
137 *mask = dest_id & (0xffff >> (16 - cluster_size));
138 } else {
139 *mask = 0;
140 }
141
142 return true;
143 }
144 case KVM_APIC_MODE_XAPIC_FLAT:
145 *cluster = map->xapic_flat_map;
146 *mask = dest_id & 0xff;
147 return true;
148 case KVM_APIC_MODE_XAPIC_CLUSTER:
149 *cluster = map->xapic_cluster_map[(dest_id >> 4) & 0xf];
150 *mask = dest_id & 0xf;
151 return true;
152 default:
153 /* Not optimized. */
154 return false;
155 }
156 }
157
158 static void kvm_apic_map_free(struct rcu_head *rcu)
159 {
160 struct kvm_apic_map *map = container_of(rcu, struct kvm_apic_map, rcu);
161
162 kvfree(map);
163 }
164
165 static void recalculate_apic_map(struct kvm *kvm)
166 {
167 struct kvm_apic_map *new, *old = NULL;
168 struct kvm_vcpu *vcpu;
169 int i;
170 u32 max_id = 255; /* enough space for any xAPIC ID */
171
172 mutex_lock(&kvm->arch.apic_map_lock);
173
174 kvm_for_each_vcpu(i, vcpu, kvm)
175 if (kvm_apic_present(vcpu))
176 max_id = max(max_id, kvm_x2apic_id(vcpu->arch.apic));
177
178 new = kvzalloc(sizeof(struct kvm_apic_map) +
179 sizeof(struct kvm_lapic *) * ((u64)max_id + 1), GFP_KERNEL);
180
181 if (!new)
182 goto out;
183
184 new->max_apic_id = max_id;
185
186 kvm_for_each_vcpu(i, vcpu, kvm) {
187 struct kvm_lapic *apic = vcpu->arch.apic;
188 struct kvm_lapic **cluster;
189 u16 mask;
190 u32 ldr;
191 u8 xapic_id;
192 u32 x2apic_id;
193
194 if (!kvm_apic_present(vcpu))
195 continue;
196
197 xapic_id = kvm_xapic_id(apic);
198 x2apic_id = kvm_x2apic_id(apic);
199
200 /* Hotplug hack: see kvm_apic_match_physical_addr(), ... */
201 if ((apic_x2apic_mode(apic) || x2apic_id > 0xff) &&
202 x2apic_id <= new->max_apic_id)
203 new->phys_map[x2apic_id] = apic;
204 /*
205 * ... xAPIC ID of VCPUs with APIC ID > 0xff will wrap-around,
206 * prevent them from masking VCPUs with APIC ID <= 0xff.
207 */
208 if (!apic_x2apic_mode(apic) && !new->phys_map[xapic_id])
209 new->phys_map[xapic_id] = apic;
210
211 ldr = kvm_lapic_get_reg(apic, APIC_LDR);
212
213 if (apic_x2apic_mode(apic)) {
214 new->mode |= KVM_APIC_MODE_X2APIC;
215 } else if (ldr) {
216 ldr = GET_APIC_LOGICAL_ID(ldr);
217 if (kvm_lapic_get_reg(apic, APIC_DFR) == APIC_DFR_FLAT)
218 new->mode |= KVM_APIC_MODE_XAPIC_FLAT;
219 else
220 new->mode |= KVM_APIC_MODE_XAPIC_CLUSTER;
221 }
222
223 if (!kvm_apic_map_get_logical_dest(new, ldr, &cluster, &mask))
224 continue;
225
226 if (mask)
227 cluster[ffs(mask) - 1] = apic;
228 }
229 out:
230 old = rcu_dereference_protected(kvm->arch.apic_map,
231 lockdep_is_held(&kvm->arch.apic_map_lock));
232 rcu_assign_pointer(kvm->arch.apic_map, new);
233 mutex_unlock(&kvm->arch.apic_map_lock);
234
235 if (old)
236 call_rcu(&old->rcu, kvm_apic_map_free);
237
238 kvm_make_scan_ioapic_request(kvm);
239 }
240
241 static inline void apic_set_spiv(struct kvm_lapic *apic, u32 val)
242 {
243 bool enabled = val & APIC_SPIV_APIC_ENABLED;
244
245 kvm_lapic_set_reg(apic, APIC_SPIV, val);
246
247 if (enabled != apic->sw_enabled) {
248 apic->sw_enabled = enabled;
249 if (enabled) {
250 static_key_slow_dec_deferred(&apic_sw_disabled);
251 recalculate_apic_map(apic->vcpu->kvm);
252 } else
253 static_key_slow_inc(&apic_sw_disabled.key);
254 }
255 }
256
257 static inline void kvm_apic_set_xapic_id(struct kvm_lapic *apic, u8 id)
258 {
259 kvm_lapic_set_reg(apic, APIC_ID, id << 24);
260 recalculate_apic_map(apic->vcpu->kvm);
261 }
262
263 static inline void kvm_apic_set_ldr(struct kvm_lapic *apic, u32 id)
264 {
265 kvm_lapic_set_reg(apic, APIC_LDR, id);
266 recalculate_apic_map(apic->vcpu->kvm);
267 }
268
269 static inline void kvm_apic_set_x2apic_id(struct kvm_lapic *apic, u32 id)
270 {
271 u32 ldr = ((id >> 4) << 16) | (1 << (id & 0xf));
272
273 WARN_ON_ONCE(id != apic->vcpu->vcpu_id);
274
275 kvm_lapic_set_reg(apic, APIC_ID, id);
276 kvm_lapic_set_reg(apic, APIC_LDR, ldr);
277 recalculate_apic_map(apic->vcpu->kvm);
278 }
279
280 static inline int apic_lvt_enabled(struct kvm_lapic *apic, int lvt_type)
281 {
282 return !(kvm_lapic_get_reg(apic, lvt_type) & APIC_LVT_MASKED);
283 }
284
285 static inline int apic_lvt_vector(struct kvm_lapic *apic, int lvt_type)
286 {
287 return kvm_lapic_get_reg(apic, lvt_type) & APIC_VECTOR_MASK;
288 }
289
290 static inline int apic_lvtt_oneshot(struct kvm_lapic *apic)
291 {
292 return apic->lapic_timer.timer_mode == APIC_LVT_TIMER_ONESHOT;
293 }
294
295 static inline int apic_lvtt_period(struct kvm_lapic *apic)
296 {
297 return apic->lapic_timer.timer_mode == APIC_LVT_TIMER_PERIODIC;
298 }
299
300 static inline int apic_lvtt_tscdeadline(struct kvm_lapic *apic)
301 {
302 return apic->lapic_timer.timer_mode == APIC_LVT_TIMER_TSCDEADLINE;
303 }
304
305 static inline int apic_lvt_nmi_mode(u32 lvt_val)
306 {
307 return (lvt_val & (APIC_MODE_MASK | APIC_LVT_MASKED)) == APIC_DM_NMI;
308 }
309
310 void kvm_apic_set_version(struct kvm_vcpu *vcpu)
311 {
312 struct kvm_lapic *apic = vcpu->arch.apic;
313 struct kvm_cpuid_entry2 *feat;
314 u32 v = APIC_VERSION;
315
316 if (!lapic_in_kernel(vcpu))
317 return;
318
319 feat = kvm_find_cpuid_entry(apic->vcpu, 0x1, 0);
320 if (feat && (feat->ecx & (1 << (X86_FEATURE_X2APIC & 31))))
321 v |= APIC_LVR_DIRECTED_EOI;
322 kvm_lapic_set_reg(apic, APIC_LVR, v);
323 }
324
325 static const unsigned int apic_lvt_mask[KVM_APIC_LVT_NUM] = {
326 LVT_MASK , /* part LVTT mask, timer mode mask added at runtime */
327 LVT_MASK | APIC_MODE_MASK, /* LVTTHMR */
328 LVT_MASK | APIC_MODE_MASK, /* LVTPC */
329 LINT_MASK, LINT_MASK, /* LVT0-1 */
330 LVT_MASK /* LVTERR */
331 };
332
333 static int find_highest_vector(void *bitmap)
334 {
335 int vec;
336 u32 *reg;
337
338 for (vec = MAX_APIC_VECTOR - APIC_VECTORS_PER_REG;
339 vec >= 0; vec -= APIC_VECTORS_PER_REG) {
340 reg = bitmap + REG_POS(vec);
341 if (*reg)
342 return __fls(*reg) + vec;
343 }
344
345 return -1;
346 }
347
348 static u8 count_vectors(void *bitmap)
349 {
350 int vec;
351 u32 *reg;
352 u8 count = 0;
353
354 for (vec = 0; vec < MAX_APIC_VECTOR; vec += APIC_VECTORS_PER_REG) {
355 reg = bitmap + REG_POS(vec);
356 count += hweight32(*reg);
357 }
358
359 return count;
360 }
361
362 int __kvm_apic_update_irr(u32 *pir, void *regs)
363 {
364 u32 i, vec;
365 u32 pir_val, irr_val;
366 int max_irr = -1;
367
368 for (i = vec = 0; i <= 7; i++, vec += 32) {
369 pir_val = READ_ONCE(pir[i]);
370 irr_val = *((u32 *)(regs + APIC_IRR + i * 0x10));
371 if (pir_val) {
372 irr_val |= xchg(&pir[i], 0);
373 *((u32 *)(regs + APIC_IRR + i * 0x10)) = irr_val;
374 }
375 if (irr_val)
376 max_irr = __fls(irr_val) + vec;
377 }
378
379 return max_irr;
380 }
381 EXPORT_SYMBOL_GPL(__kvm_apic_update_irr);
382
383 int kvm_apic_update_irr(struct kvm_vcpu *vcpu, u32 *pir)
384 {
385 struct kvm_lapic *apic = vcpu->arch.apic;
386
387 return __kvm_apic_update_irr(pir, apic->regs);
388 }
389 EXPORT_SYMBOL_GPL(kvm_apic_update_irr);
390
391 static inline int apic_search_irr(struct kvm_lapic *apic)
392 {
393 return find_highest_vector(apic->regs + APIC_IRR);
394 }
395
396 static inline int apic_find_highest_irr(struct kvm_lapic *apic)
397 {
398 int result;
399
400 /*
401 * Note that irr_pending is just a hint. It will be always
402 * true with virtual interrupt delivery enabled.
403 */
404 if (!apic->irr_pending)
405 return -1;
406
407 result = apic_search_irr(apic);
408 ASSERT(result == -1 || result >= 16);
409
410 return result;
411 }
412
413 static inline void apic_clear_irr(int vec, struct kvm_lapic *apic)
414 {
415 struct kvm_vcpu *vcpu;
416
417 vcpu = apic->vcpu;
418
419 if (unlikely(vcpu->arch.apicv_active)) {
420 /* need to update RVI */
421 apic_clear_vector(vec, apic->regs + APIC_IRR);
422 kvm_x86_ops->hwapic_irr_update(vcpu,
423 apic_find_highest_irr(apic));
424 } else {
425 apic->irr_pending = false;
426 apic_clear_vector(vec, apic->regs + APIC_IRR);
427 if (apic_search_irr(apic) != -1)
428 apic->irr_pending = true;
429 }
430 }
431
432 static inline void apic_set_isr(int vec, struct kvm_lapic *apic)
433 {
434 struct kvm_vcpu *vcpu;
435
436 if (__apic_test_and_set_vector(vec, apic->regs + APIC_ISR))
437 return;
438
439 vcpu = apic->vcpu;
440
441 /*
442 * With APIC virtualization enabled, all caching is disabled
443 * because the processor can modify ISR under the hood. Instead
444 * just set SVI.
445 */
446 if (unlikely(vcpu->arch.apicv_active))
447 kvm_x86_ops->hwapic_isr_update(vcpu, vec);
448 else {
449 ++apic->isr_count;
450 BUG_ON(apic->isr_count > MAX_APIC_VECTOR);
451 /*
452 * ISR (in service register) bit is set when injecting an interrupt.
453 * The highest vector is injected. Thus the latest bit set matches
454 * the highest bit in ISR.
455 */
456 apic->highest_isr_cache = vec;
457 }
458 }
459
460 static inline int apic_find_highest_isr(struct kvm_lapic *apic)
461 {
462 int result;
463
464 /*
465 * Note that isr_count is always 1, and highest_isr_cache
466 * is always -1, with APIC virtualization enabled.
467 */
468 if (!apic->isr_count)
469 return -1;
470 if (likely(apic->highest_isr_cache != -1))
471 return apic->highest_isr_cache;
472
473 result = find_highest_vector(apic->regs + APIC_ISR);
474 ASSERT(result == -1 || result >= 16);
475
476 return result;
477 }
478
479 static inline void apic_clear_isr(int vec, struct kvm_lapic *apic)
480 {
481 struct kvm_vcpu *vcpu;
482 if (!__apic_test_and_clear_vector(vec, apic->regs + APIC_ISR))
483 return;
484
485 vcpu = apic->vcpu;
486
487 /*
488 * We do get here for APIC virtualization enabled if the guest
489 * uses the Hyper-V APIC enlightenment. In this case we may need
490 * to trigger a new interrupt delivery by writing the SVI field;
491 * on the other hand isr_count and highest_isr_cache are unused
492 * and must be left alone.
493 */
494 if (unlikely(vcpu->arch.apicv_active))
495 kvm_x86_ops->hwapic_isr_update(vcpu,
496 apic_find_highest_isr(apic));
497 else {
498 --apic->isr_count;
499 BUG_ON(apic->isr_count < 0);
500 apic->highest_isr_cache = -1;
501 }
502 }
503
504 int kvm_lapic_find_highest_irr(struct kvm_vcpu *vcpu)
505 {
506 /* This may race with setting of irr in __apic_accept_irq() and
507 * value returned may be wrong, but kvm_vcpu_kick() in __apic_accept_irq
508 * will cause vmexit immediately and the value will be recalculated
509 * on the next vmentry.
510 */
511 return apic_find_highest_irr(vcpu->arch.apic);
512 }
513 EXPORT_SYMBOL_GPL(kvm_lapic_find_highest_irr);
514
515 static int __apic_accept_irq(struct kvm_lapic *apic, int delivery_mode,
516 int vector, int level, int trig_mode,
517 struct dest_map *dest_map);
518
519 int kvm_apic_set_irq(struct kvm_vcpu *vcpu, struct kvm_lapic_irq *irq,
520 struct dest_map *dest_map)
521 {
522 struct kvm_lapic *apic = vcpu->arch.apic;
523
524 return __apic_accept_irq(apic, irq->delivery_mode, irq->vector,
525 irq->level, irq->trig_mode, dest_map);
526 }
527
528 static int pv_eoi_put_user(struct kvm_vcpu *vcpu, u8 val)
529 {
530
531 return kvm_write_guest_cached(vcpu->kvm, &vcpu->arch.pv_eoi.data, &val,
532 sizeof(val));
533 }
534
535 static int pv_eoi_get_user(struct kvm_vcpu *vcpu, u8 *val)
536 {
537
538 return kvm_read_guest_cached(vcpu->kvm, &vcpu->arch.pv_eoi.data, val,
539 sizeof(*val));
540 }
541
542 static inline bool pv_eoi_enabled(struct kvm_vcpu *vcpu)
543 {
544 return vcpu->arch.pv_eoi.msr_val & KVM_MSR_ENABLED;
545 }
546
547 static bool pv_eoi_get_pending(struct kvm_vcpu *vcpu)
548 {
549 u8 val;
550 if (pv_eoi_get_user(vcpu, &val) < 0)
551 apic_debug("Can't read EOI MSR value: 0x%llx\n",
552 (unsigned long long)vcpu->arch.pv_eoi.msr_val);
553 return val & 0x1;
554 }
555
556 static void pv_eoi_set_pending(struct kvm_vcpu *vcpu)
557 {
558 if (pv_eoi_put_user(vcpu, KVM_PV_EOI_ENABLED) < 0) {
559 apic_debug("Can't set EOI MSR value: 0x%llx\n",
560 (unsigned long long)vcpu->arch.pv_eoi.msr_val);
561 return;
562 }
563 __set_bit(KVM_APIC_PV_EOI_PENDING, &vcpu->arch.apic_attention);
564 }
565
566 static void pv_eoi_clr_pending(struct kvm_vcpu *vcpu)
567 {
568 if (pv_eoi_put_user(vcpu, KVM_PV_EOI_DISABLED) < 0) {
569 apic_debug("Can't clear EOI MSR value: 0x%llx\n",
570 (unsigned long long)vcpu->arch.pv_eoi.msr_val);
571 return;
572 }
573 __clear_bit(KVM_APIC_PV_EOI_PENDING, &vcpu->arch.apic_attention);
574 }
575
576 static int apic_has_interrupt_for_ppr(struct kvm_lapic *apic, u32 ppr)
577 {
578 int highest_irr;
579 if (kvm_x86_ops->sync_pir_to_irr && apic->vcpu->arch.apicv_active)
580 highest_irr = kvm_x86_ops->sync_pir_to_irr(apic->vcpu);
581 else
582 highest_irr = apic_find_highest_irr(apic);
583 if (highest_irr == -1 || (highest_irr & 0xF0) <= ppr)
584 return -1;
585 return highest_irr;
586 }
587
588 static bool __apic_update_ppr(struct kvm_lapic *apic, u32 *new_ppr)
589 {
590 u32 tpr, isrv, ppr, old_ppr;
591 int isr;
592
593 old_ppr = kvm_lapic_get_reg(apic, APIC_PROCPRI);
594 tpr = kvm_lapic_get_reg(apic, APIC_TASKPRI);
595 isr = apic_find_highest_isr(apic);
596 isrv = (isr != -1) ? isr : 0;
597
598 if ((tpr & 0xf0) >= (isrv & 0xf0))
599 ppr = tpr & 0xff;
600 else
601 ppr = isrv & 0xf0;
602
603 apic_debug("vlapic %p, ppr 0x%x, isr 0x%x, isrv 0x%x",
604 apic, ppr, isr, isrv);
605
606 *new_ppr = ppr;
607 if (old_ppr != ppr)
608 kvm_lapic_set_reg(apic, APIC_PROCPRI, ppr);
609
610 return ppr < old_ppr;
611 }
612
613 static void apic_update_ppr(struct kvm_lapic *apic)
614 {
615 u32 ppr;
616
617 if (__apic_update_ppr(apic, &ppr) &&
618 apic_has_interrupt_for_ppr(apic, ppr) != -1)
619 kvm_make_request(KVM_REQ_EVENT, apic->vcpu);
620 }
621
622 void kvm_apic_update_ppr(struct kvm_vcpu *vcpu)
623 {
624 apic_update_ppr(vcpu->arch.apic);
625 }
626 EXPORT_SYMBOL_GPL(kvm_apic_update_ppr);
627
628 static void apic_set_tpr(struct kvm_lapic *apic, u32 tpr)
629 {
630 kvm_lapic_set_reg(apic, APIC_TASKPRI, tpr);
631 apic_update_ppr(apic);
632 }
633
634 static bool kvm_apic_broadcast(struct kvm_lapic *apic, u32 mda)
635 {
636 return mda == (apic_x2apic_mode(apic) ?
637 X2APIC_BROADCAST : APIC_BROADCAST);
638 }
639
640 static bool kvm_apic_match_physical_addr(struct kvm_lapic *apic, u32 mda)
641 {
642 if (kvm_apic_broadcast(apic, mda))
643 return true;
644
645 if (apic_x2apic_mode(apic))
646 return mda == kvm_x2apic_id(apic);
647
648 /*
649 * Hotplug hack: Make LAPIC in xAPIC mode also accept interrupts as if
650 * it were in x2APIC mode. Hotplugged VCPUs start in xAPIC mode and
651 * this allows unique addressing of VCPUs with APIC ID over 0xff.
652 * The 0xff condition is needed because writeable xAPIC ID.
653 */
654 if (kvm_x2apic_id(apic) > 0xff && mda == kvm_x2apic_id(apic))
655 return true;
656
657 return mda == kvm_xapic_id(apic);
658 }
659
660 static bool kvm_apic_match_logical_addr(struct kvm_lapic *apic, u32 mda)
661 {
662 u32 logical_id;
663
664 if (kvm_apic_broadcast(apic, mda))
665 return true;
666
667 logical_id = kvm_lapic_get_reg(apic, APIC_LDR);
668
669 if (apic_x2apic_mode(apic))
670 return ((logical_id >> 16) == (mda >> 16))
671 && (logical_id & mda & 0xffff) != 0;
672
673 logical_id = GET_APIC_LOGICAL_ID(logical_id);
674
675 switch (kvm_lapic_get_reg(apic, APIC_DFR)) {
676 case APIC_DFR_FLAT:
677 return (logical_id & mda) != 0;
678 case APIC_DFR_CLUSTER:
679 return ((logical_id >> 4) == (mda >> 4))
680 && (logical_id & mda & 0xf) != 0;
681 default:
682 apic_debug("Bad DFR vcpu %d: %08x\n",
683 apic->vcpu->vcpu_id, kvm_lapic_get_reg(apic, APIC_DFR));
684 return false;
685 }
686 }
687
688 /* The KVM local APIC implementation has two quirks:
689 *
690 * - Real hardware delivers interrupts destined to x2APIC ID > 0xff to LAPICs
691 * in xAPIC mode if the "destination & 0xff" matches its xAPIC ID.
692 * KVM doesn't do that aliasing.
693 *
694 * - in-kernel IOAPIC messages have to be delivered directly to
695 * x2APIC, because the kernel does not support interrupt remapping.
696 * In order to support broadcast without interrupt remapping, x2APIC
697 * rewrites the destination of non-IPI messages from APIC_BROADCAST
698 * to X2APIC_BROADCAST.
699 *
700 * The broadcast quirk can be disabled with KVM_CAP_X2APIC_API. This is
701 * important when userspace wants to use x2APIC-format MSIs, because
702 * APIC_BROADCAST (0xff) is a legal route for "cluster 0, CPUs 0-7".
703 */
704 static u32 kvm_apic_mda(struct kvm_vcpu *vcpu, unsigned int dest_id,
705 struct kvm_lapic *source, struct kvm_lapic *target)
706 {
707 bool ipi = source != NULL;
708
709 if (!vcpu->kvm->arch.x2apic_broadcast_quirk_disabled &&
710 !ipi && dest_id == APIC_BROADCAST && apic_x2apic_mode(target))
711 return X2APIC_BROADCAST;
712
713 return dest_id;
714 }
715
716 bool kvm_apic_match_dest(struct kvm_vcpu *vcpu, struct kvm_lapic *source,
717 int short_hand, unsigned int dest, int dest_mode)
718 {
719 struct kvm_lapic *target = vcpu->arch.apic;
720 u32 mda = kvm_apic_mda(vcpu, dest, source, target);
721
722 apic_debug("target %p, source %p, dest 0x%x, "
723 "dest_mode 0x%x, short_hand 0x%x\n",
724 target, source, dest, dest_mode, short_hand);
725
726 ASSERT(target);
727 switch (short_hand) {
728 case APIC_DEST_NOSHORT:
729 if (dest_mode == APIC_DEST_PHYSICAL)
730 return kvm_apic_match_physical_addr(target, mda);
731 else
732 return kvm_apic_match_logical_addr(target, mda);
733 case APIC_DEST_SELF:
734 return target == source;
735 case APIC_DEST_ALLINC:
736 return true;
737 case APIC_DEST_ALLBUT:
738 return target != source;
739 default:
740 apic_debug("kvm: apic: Bad dest shorthand value %x\n",
741 short_hand);
742 return false;
743 }
744 }
745 EXPORT_SYMBOL_GPL(kvm_apic_match_dest);
746
747 int kvm_vector_to_index(u32 vector, u32 dest_vcpus,
748 const unsigned long *bitmap, u32 bitmap_size)
749 {
750 u32 mod;
751 int i, idx = -1;
752
753 mod = vector % dest_vcpus;
754
755 for (i = 0; i <= mod; i++) {
756 idx = find_next_bit(bitmap, bitmap_size, idx + 1);
757 BUG_ON(idx == bitmap_size);
758 }
759
760 return idx;
761 }
762
763 static void kvm_apic_disabled_lapic_found(struct kvm *kvm)
764 {
765 if (!kvm->arch.disabled_lapic_found) {
766 kvm->arch.disabled_lapic_found = true;
767 printk(KERN_INFO
768 "Disabled LAPIC found during irq injection\n");
769 }
770 }
771
772 static bool kvm_apic_is_broadcast_dest(struct kvm *kvm, struct kvm_lapic **src,
773 struct kvm_lapic_irq *irq, struct kvm_apic_map *map)
774 {
775 if (kvm->arch.x2apic_broadcast_quirk_disabled) {
776 if ((irq->dest_id == APIC_BROADCAST &&
777 map->mode != KVM_APIC_MODE_X2APIC))
778 return true;
779 if (irq->dest_id == X2APIC_BROADCAST)
780 return true;
781 } else {
782 bool x2apic_ipi = src && *src && apic_x2apic_mode(*src);
783 if (irq->dest_id == (x2apic_ipi ?
784 X2APIC_BROADCAST : APIC_BROADCAST))
785 return true;
786 }
787
788 return false;
789 }
790
791 /* Return true if the interrupt can be handled by using *bitmap as index mask
792 * for valid destinations in *dst array.
793 * Return false if kvm_apic_map_get_dest_lapic did nothing useful.
794 * Note: we may have zero kvm_lapic destinations when we return true, which
795 * means that the interrupt should be dropped. In this case, *bitmap would be
796 * zero and *dst undefined.
797 */
798 static inline bool kvm_apic_map_get_dest_lapic(struct kvm *kvm,
799 struct kvm_lapic **src, struct kvm_lapic_irq *irq,
800 struct kvm_apic_map *map, struct kvm_lapic ***dst,
801 unsigned long *bitmap)
802 {
803 int i, lowest;
804
805 if (irq->shorthand == APIC_DEST_SELF && src) {
806 *dst = src;
807 *bitmap = 1;
808 return true;
809 } else if (irq->shorthand)
810 return false;
811
812 if (!map || kvm_apic_is_broadcast_dest(kvm, src, irq, map))
813 return false;
814
815 if (irq->dest_mode == APIC_DEST_PHYSICAL) {
816 if (irq->dest_id > map->max_apic_id) {
817 *bitmap = 0;
818 } else {
819 *dst = &map->phys_map[irq->dest_id];
820 *bitmap = 1;
821 }
822 return true;
823 }
824
825 *bitmap = 0;
826 if (!kvm_apic_map_get_logical_dest(map, irq->dest_id, dst,
827 (u16 *)bitmap))
828 return false;
829
830 if (!kvm_lowest_prio_delivery(irq))
831 return true;
832
833 if (!kvm_vector_hashing_enabled()) {
834 lowest = -1;
835 for_each_set_bit(i, bitmap, 16) {
836 if (!(*dst)[i])
837 continue;
838 if (lowest < 0)
839 lowest = i;
840 else if (kvm_apic_compare_prio((*dst)[i]->vcpu,
841 (*dst)[lowest]->vcpu) < 0)
842 lowest = i;
843 }
844 } else {
845 if (!*bitmap)
846 return true;
847
848 lowest = kvm_vector_to_index(irq->vector, hweight16(*bitmap),
849 bitmap, 16);
850
851 if (!(*dst)[lowest]) {
852 kvm_apic_disabled_lapic_found(kvm);
853 *bitmap = 0;
854 return true;
855 }
856 }
857
858 *bitmap = (lowest >= 0) ? 1 << lowest : 0;
859
860 return true;
861 }
862
863 bool kvm_irq_delivery_to_apic_fast(struct kvm *kvm, struct kvm_lapic *src,
864 struct kvm_lapic_irq *irq, int *r, struct dest_map *dest_map)
865 {
866 struct kvm_apic_map *map;
867 unsigned long bitmap;
868 struct kvm_lapic **dst = NULL;
869 int i;
870 bool ret;
871
872 *r = -1;
873
874 if (irq->shorthand == APIC_DEST_SELF) {
875 *r = kvm_apic_set_irq(src->vcpu, irq, dest_map);
876 return true;
877 }
878
879 rcu_read_lock();
880 map = rcu_dereference(kvm->arch.apic_map);
881
882 ret = kvm_apic_map_get_dest_lapic(kvm, &src, irq, map, &dst, &bitmap);
883 if (ret)
884 for_each_set_bit(i, &bitmap, 16) {
885 if (!dst[i])
886 continue;
887 if (*r < 0)
888 *r = 0;
889 *r += kvm_apic_set_irq(dst[i]->vcpu, irq, dest_map);
890 }
891
892 rcu_read_unlock();
893 return ret;
894 }
895
896 /*
897 * This routine tries to handler interrupts in posted mode, here is how
898 * it deals with different cases:
899 * - For single-destination interrupts, handle it in posted mode
900 * - Else if vector hashing is enabled and it is a lowest-priority
901 * interrupt, handle it in posted mode and use the following mechanism
902 * to find the destinaiton vCPU.
903 * 1. For lowest-priority interrupts, store all the possible
904 * destination vCPUs in an array.
905 * 2. Use "guest vector % max number of destination vCPUs" to find
906 * the right destination vCPU in the array for the lowest-priority
907 * interrupt.
908 * - Otherwise, use remapped mode to inject the interrupt.
909 */
910 bool kvm_intr_is_single_vcpu_fast(struct kvm *kvm, struct kvm_lapic_irq *irq,
911 struct kvm_vcpu **dest_vcpu)
912 {
913 struct kvm_apic_map *map;
914 unsigned long bitmap;
915 struct kvm_lapic **dst = NULL;
916 bool ret = false;
917
918 if (irq->shorthand)
919 return false;
920
921 rcu_read_lock();
922 map = rcu_dereference(kvm->arch.apic_map);
923
924 if (kvm_apic_map_get_dest_lapic(kvm, NULL, irq, map, &dst, &bitmap) &&
925 hweight16(bitmap) == 1) {
926 unsigned long i = find_first_bit(&bitmap, 16);
927
928 if (dst[i]) {
929 *dest_vcpu = dst[i]->vcpu;
930 ret = true;
931 }
932 }
933
934 rcu_read_unlock();
935 return ret;
936 }
937
938 /*
939 * Add a pending IRQ into lapic.
940 * Return 1 if successfully added and 0 if discarded.
941 */
942 static int __apic_accept_irq(struct kvm_lapic *apic, int delivery_mode,
943 int vector, int level, int trig_mode,
944 struct dest_map *dest_map)
945 {
946 int result = 0;
947 struct kvm_vcpu *vcpu = apic->vcpu;
948
949 trace_kvm_apic_accept_irq(vcpu->vcpu_id, delivery_mode,
950 trig_mode, vector);
951 switch (delivery_mode) {
952 case APIC_DM_LOWEST:
953 vcpu->arch.apic_arb_prio++;
954 case APIC_DM_FIXED:
955 if (unlikely(trig_mode && !level))
956 break;
957
958 /* FIXME add logic for vcpu on reset */
959 if (unlikely(!apic_enabled(apic)))
960 break;
961
962 result = 1;
963
964 if (dest_map) {
965 __set_bit(vcpu->vcpu_id, dest_map->map);
966 dest_map->vectors[vcpu->vcpu_id] = vector;
967 }
968
969 if (apic_test_vector(vector, apic->regs + APIC_TMR) != !!trig_mode) {
970 if (trig_mode)
971 kvm_lapic_set_vector(vector, apic->regs + APIC_TMR);
972 else
973 apic_clear_vector(vector, apic->regs + APIC_TMR);
974 }
975
976 if (vcpu->arch.apicv_active)
977 kvm_x86_ops->deliver_posted_interrupt(vcpu, vector);
978 else {
979 kvm_lapic_set_irr(vector, apic);
980
981 kvm_make_request(KVM_REQ_EVENT, vcpu);
982 kvm_vcpu_kick(vcpu);
983 }
984 break;
985
986 case APIC_DM_REMRD:
987 result = 1;
988 vcpu->arch.pv.pv_unhalted = 1;
989 kvm_make_request(KVM_REQ_EVENT, vcpu);
990 kvm_vcpu_kick(vcpu);
991 break;
992
993 case APIC_DM_SMI:
994 result = 1;
995 kvm_make_request(KVM_REQ_SMI, vcpu);
996 kvm_vcpu_kick(vcpu);
997 break;
998
999 case APIC_DM_NMI:
1000 result = 1;
1001 kvm_inject_nmi(vcpu);
1002 kvm_vcpu_kick(vcpu);
1003 break;
1004
1005 case APIC_DM_INIT:
1006 if (!trig_mode || level) {
1007 result = 1;
1008 /* assumes that there are only KVM_APIC_INIT/SIPI */
1009 apic->pending_events = (1UL << KVM_APIC_INIT);
1010 /* make sure pending_events is visible before sending
1011 * the request */
1012 smp_wmb();
1013 kvm_make_request(KVM_REQ_EVENT, vcpu);
1014 kvm_vcpu_kick(vcpu);
1015 } else {
1016 apic_debug("Ignoring de-assert INIT to vcpu %d\n",
1017 vcpu->vcpu_id);
1018 }
1019 break;
1020
1021 case APIC_DM_STARTUP:
1022 apic_debug("SIPI to vcpu %d vector 0x%02x\n",
1023 vcpu->vcpu_id, vector);
1024 result = 1;
1025 apic->sipi_vector = vector;
1026 /* make sure sipi_vector is visible for the receiver */
1027 smp_wmb();
1028 set_bit(KVM_APIC_SIPI, &apic->pending_events);
1029 kvm_make_request(KVM_REQ_EVENT, vcpu);
1030 kvm_vcpu_kick(vcpu);
1031 break;
1032
1033 case APIC_DM_EXTINT:
1034 /*
1035 * Should only be called by kvm_apic_local_deliver() with LVT0,
1036 * before NMI watchdog was enabled. Already handled by
1037 * kvm_apic_accept_pic_intr().
1038 */
1039 break;
1040
1041 default:
1042 printk(KERN_ERR "TODO: unsupported delivery mode %x\n",
1043 delivery_mode);
1044 break;
1045 }
1046 return result;
1047 }
1048
1049 int kvm_apic_compare_prio(struct kvm_vcpu *vcpu1, struct kvm_vcpu *vcpu2)
1050 {
1051 return vcpu1->arch.apic_arb_prio - vcpu2->arch.apic_arb_prio;
1052 }
1053
1054 static bool kvm_ioapic_handles_vector(struct kvm_lapic *apic, int vector)
1055 {
1056 return test_bit(vector, apic->vcpu->arch.ioapic_handled_vectors);
1057 }
1058
1059 static void kvm_ioapic_send_eoi(struct kvm_lapic *apic, int vector)
1060 {
1061 int trigger_mode;
1062
1063 /* Eoi the ioapic only if the ioapic doesn't own the vector. */
1064 if (!kvm_ioapic_handles_vector(apic, vector))
1065 return;
1066
1067 /* Request a KVM exit to inform the userspace IOAPIC. */
1068 if (irqchip_split(apic->vcpu->kvm)) {
1069 apic->vcpu->arch.pending_ioapic_eoi = vector;
1070 kvm_make_request(KVM_REQ_IOAPIC_EOI_EXIT, apic->vcpu);
1071 return;
1072 }
1073
1074 if (apic_test_vector(vector, apic->regs + APIC_TMR))
1075 trigger_mode = IOAPIC_LEVEL_TRIG;
1076 else
1077 trigger_mode = IOAPIC_EDGE_TRIG;
1078
1079 kvm_ioapic_update_eoi(apic->vcpu, vector, trigger_mode);
1080 }
1081
1082 static int apic_set_eoi(struct kvm_lapic *apic)
1083 {
1084 int vector = apic_find_highest_isr(apic);
1085
1086 trace_kvm_eoi(apic, vector);
1087
1088 /*
1089 * Not every write EOI will has corresponding ISR,
1090 * one example is when Kernel check timer on setup_IO_APIC
1091 */
1092 if (vector == -1)
1093 return vector;
1094
1095 apic_clear_isr(vector, apic);
1096 apic_update_ppr(apic);
1097
1098 if (test_bit(vector, vcpu_to_synic(apic->vcpu)->vec_bitmap))
1099 kvm_hv_synic_send_eoi(apic->vcpu, vector);
1100
1101 kvm_ioapic_send_eoi(apic, vector);
1102 kvm_make_request(KVM_REQ_EVENT, apic->vcpu);
1103 return vector;
1104 }
1105
1106 /*
1107 * this interface assumes a trap-like exit, which has already finished
1108 * desired side effect including vISR and vPPR update.
1109 */
1110 void kvm_apic_set_eoi_accelerated(struct kvm_vcpu *vcpu, int vector)
1111 {
1112 struct kvm_lapic *apic = vcpu->arch.apic;
1113
1114 trace_kvm_eoi(apic, vector);
1115
1116 kvm_ioapic_send_eoi(apic, vector);
1117 kvm_make_request(KVM_REQ_EVENT, apic->vcpu);
1118 }
1119 EXPORT_SYMBOL_GPL(kvm_apic_set_eoi_accelerated);
1120
1121 static void apic_send_ipi(struct kvm_lapic *apic)
1122 {
1123 u32 icr_low = kvm_lapic_get_reg(apic, APIC_ICR);
1124 u32 icr_high = kvm_lapic_get_reg(apic, APIC_ICR2);
1125 struct kvm_lapic_irq irq;
1126
1127 irq.vector = icr_low & APIC_VECTOR_MASK;
1128 irq.delivery_mode = icr_low & APIC_MODE_MASK;
1129 irq.dest_mode = icr_low & APIC_DEST_MASK;
1130 irq.level = (icr_low & APIC_INT_ASSERT) != 0;
1131 irq.trig_mode = icr_low & APIC_INT_LEVELTRIG;
1132 irq.shorthand = icr_low & APIC_SHORT_MASK;
1133 irq.msi_redir_hint = false;
1134 if (apic_x2apic_mode(apic))
1135 irq.dest_id = icr_high;
1136 else
1137 irq.dest_id = GET_APIC_DEST_FIELD(icr_high);
1138
1139 trace_kvm_apic_ipi(icr_low, irq.dest_id);
1140
1141 apic_debug("icr_high 0x%x, icr_low 0x%x, "
1142 "short_hand 0x%x, dest 0x%x, trig_mode 0x%x, level 0x%x, "
1143 "dest_mode 0x%x, delivery_mode 0x%x, vector 0x%x, "
1144 "msi_redir_hint 0x%x\n",
1145 icr_high, icr_low, irq.shorthand, irq.dest_id,
1146 irq.trig_mode, irq.level, irq.dest_mode, irq.delivery_mode,
1147 irq.vector, irq.msi_redir_hint);
1148
1149 kvm_irq_delivery_to_apic(apic->vcpu->kvm, apic, &irq, NULL);
1150 }
1151
1152 static u32 apic_get_tmcct(struct kvm_lapic *apic)
1153 {
1154 ktime_t remaining, now;
1155 s64 ns;
1156 u32 tmcct;
1157
1158 ASSERT(apic != NULL);
1159
1160 /* if initial count is 0, current count should also be 0 */
1161 if (kvm_lapic_get_reg(apic, APIC_TMICT) == 0 ||
1162 apic->lapic_timer.period == 0)
1163 return 0;
1164
1165 now = ktime_get();
1166 remaining = ktime_sub(apic->lapic_timer.target_expiration, now);
1167 if (ktime_to_ns(remaining) < 0)
1168 remaining = 0;
1169
1170 ns = mod_64(ktime_to_ns(remaining), apic->lapic_timer.period);
1171 tmcct = div64_u64(ns,
1172 (APIC_BUS_CYCLE_NS * apic->divide_count));
1173
1174 return tmcct;
1175 }
1176
1177 static void __report_tpr_access(struct kvm_lapic *apic, bool write)
1178 {
1179 struct kvm_vcpu *vcpu = apic->vcpu;
1180 struct kvm_run *run = vcpu->run;
1181
1182 kvm_make_request(KVM_REQ_REPORT_TPR_ACCESS, vcpu);
1183 run->tpr_access.rip = kvm_rip_read(vcpu);
1184 run->tpr_access.is_write = write;
1185 }
1186
1187 static inline void report_tpr_access(struct kvm_lapic *apic, bool write)
1188 {
1189 if (apic->vcpu->arch.tpr_access_reporting)
1190 __report_tpr_access(apic, write);
1191 }
1192
1193 static u32 __apic_read(struct kvm_lapic *apic, unsigned int offset)
1194 {
1195 u32 val = 0;
1196
1197 if (offset >= LAPIC_MMIO_LENGTH)
1198 return 0;
1199
1200 switch (offset) {
1201 case APIC_ARBPRI:
1202 apic_debug("Access APIC ARBPRI register which is for P6\n");
1203 break;
1204
1205 case APIC_TMCCT: /* Timer CCR */
1206 if (apic_lvtt_tscdeadline(apic))
1207 return 0;
1208
1209 val = apic_get_tmcct(apic);
1210 break;
1211 case APIC_PROCPRI:
1212 apic_update_ppr(apic);
1213 val = kvm_lapic_get_reg(apic, offset);
1214 break;
1215 case APIC_TASKPRI:
1216 report_tpr_access(apic, false);
1217 /* fall thru */
1218 default:
1219 val = kvm_lapic_get_reg(apic, offset);
1220 break;
1221 }
1222
1223 return val;
1224 }
1225
1226 static inline struct kvm_lapic *to_lapic(struct kvm_io_device *dev)
1227 {
1228 return container_of(dev, struct kvm_lapic, dev);
1229 }
1230
1231 int kvm_lapic_reg_read(struct kvm_lapic *apic, u32 offset, int len,
1232 void *data)
1233 {
1234 unsigned char alignment = offset & 0xf;
1235 u32 result;
1236 /* this bitmask has a bit cleared for each reserved register */
1237 static const u64 rmask = 0x43ff01ffffffe70cULL;
1238
1239 if ((alignment + len) > 4) {
1240 apic_debug("KVM_APIC_READ: alignment error %x %d\n",
1241 offset, len);
1242 return 1;
1243 }
1244
1245 if (offset > 0x3f0 || !(rmask & (1ULL << (offset >> 4)))) {
1246 apic_debug("KVM_APIC_READ: read reserved register %x\n",
1247 offset);
1248 return 1;
1249 }
1250
1251 result = __apic_read(apic, offset & ~0xf);
1252
1253 trace_kvm_apic_read(offset, result);
1254
1255 switch (len) {
1256 case 1:
1257 case 2:
1258 case 4:
1259 memcpy(data, (char *)&result + alignment, len);
1260 break;
1261 default:
1262 printk(KERN_ERR "Local APIC read with len = %x, "
1263 "should be 1,2, or 4 instead\n", len);
1264 break;
1265 }
1266 return 0;
1267 }
1268 EXPORT_SYMBOL_GPL(kvm_lapic_reg_read);
1269
1270 static int apic_mmio_in_range(struct kvm_lapic *apic, gpa_t addr)
1271 {
1272 return kvm_apic_hw_enabled(apic) &&
1273 addr >= apic->base_address &&
1274 addr < apic->base_address + LAPIC_MMIO_LENGTH;
1275 }
1276
1277 static int apic_mmio_read(struct kvm_vcpu *vcpu, struct kvm_io_device *this,
1278 gpa_t address, int len, void *data)
1279 {
1280 struct kvm_lapic *apic = to_lapic(this);
1281 u32 offset = address - apic->base_address;
1282
1283 if (!apic_mmio_in_range(apic, address))
1284 return -EOPNOTSUPP;
1285
1286 kvm_lapic_reg_read(apic, offset, len, data);
1287
1288 return 0;
1289 }
1290
1291 static void update_divide_count(struct kvm_lapic *apic)
1292 {
1293 u32 tmp1, tmp2, tdcr;
1294
1295 tdcr = kvm_lapic_get_reg(apic, APIC_TDCR);
1296 tmp1 = tdcr & 0xf;
1297 tmp2 = ((tmp1 & 0x3) | ((tmp1 & 0x8) >> 1)) + 1;
1298 apic->divide_count = 0x1 << (tmp2 & 0x7);
1299
1300 apic_debug("timer divide count is 0x%x\n",
1301 apic->divide_count);
1302 }
1303
1304 static void apic_update_lvtt(struct kvm_lapic *apic)
1305 {
1306 u32 timer_mode = kvm_lapic_get_reg(apic, APIC_LVTT) &
1307 apic->lapic_timer.timer_mode_mask;
1308
1309 if (apic->lapic_timer.timer_mode != timer_mode) {
1310 apic->lapic_timer.timer_mode = timer_mode;
1311 hrtimer_cancel(&apic->lapic_timer.timer);
1312 }
1313 }
1314
1315 static void apic_timer_expired(struct kvm_lapic *apic)
1316 {
1317 struct kvm_vcpu *vcpu = apic->vcpu;
1318 struct swait_queue_head *q = &vcpu->wq;
1319 struct kvm_timer *ktimer = &apic->lapic_timer;
1320
1321 if (atomic_read(&apic->lapic_timer.pending))
1322 return;
1323
1324 atomic_inc(&apic->lapic_timer.pending);
1325 kvm_set_pending_timer(vcpu);
1326
1327 if (swait_active(q))
1328 swake_up(q);
1329
1330 if (apic_lvtt_tscdeadline(apic))
1331 ktimer->expired_tscdeadline = ktimer->tscdeadline;
1332 }
1333
1334 /*
1335 * On APICv, this test will cause a busy wait
1336 * during a higher-priority task.
1337 */
1338
1339 static bool lapic_timer_int_injected(struct kvm_vcpu *vcpu)
1340 {
1341 struct kvm_lapic *apic = vcpu->arch.apic;
1342 u32 reg = kvm_lapic_get_reg(apic, APIC_LVTT);
1343
1344 if (kvm_apic_hw_enabled(apic)) {
1345 int vec = reg & APIC_VECTOR_MASK;
1346 void *bitmap = apic->regs + APIC_ISR;
1347
1348 if (vcpu->arch.apicv_active)
1349 bitmap = apic->regs + APIC_IRR;
1350
1351 if (apic_test_vector(vec, bitmap))
1352 return true;
1353 }
1354 return false;
1355 }
1356
1357 void wait_lapic_expire(struct kvm_vcpu *vcpu)
1358 {
1359 struct kvm_lapic *apic = vcpu->arch.apic;
1360 u64 guest_tsc, tsc_deadline;
1361
1362 if (!lapic_in_kernel(vcpu))
1363 return;
1364
1365 if (apic->lapic_timer.expired_tscdeadline == 0)
1366 return;
1367
1368 if (!lapic_timer_int_injected(vcpu))
1369 return;
1370
1371 tsc_deadline = apic->lapic_timer.expired_tscdeadline;
1372 apic->lapic_timer.expired_tscdeadline = 0;
1373 guest_tsc = kvm_read_l1_tsc(vcpu, rdtsc());
1374 trace_kvm_wait_lapic_expire(vcpu->vcpu_id, guest_tsc - tsc_deadline);
1375
1376 /* __delay is delay_tsc whenever the hardware has TSC, thus always. */
1377 if (guest_tsc < tsc_deadline)
1378 __delay(min(tsc_deadline - guest_tsc,
1379 nsec_to_cycles(vcpu, lapic_timer_advance_ns)));
1380 }
1381
1382 static void start_sw_tscdeadline(struct kvm_lapic *apic)
1383 {
1384 u64 guest_tsc, tscdeadline = apic->lapic_timer.tscdeadline;
1385 u64 ns = 0;
1386 ktime_t expire;
1387 struct kvm_vcpu *vcpu = apic->vcpu;
1388 unsigned long this_tsc_khz = vcpu->arch.virtual_tsc_khz;
1389 unsigned long flags;
1390 ktime_t now;
1391
1392 if (unlikely(!tscdeadline || !this_tsc_khz))
1393 return;
1394
1395 local_irq_save(flags);
1396
1397 now = ktime_get();
1398 guest_tsc = kvm_read_l1_tsc(vcpu, rdtsc());
1399 if (likely(tscdeadline > guest_tsc)) {
1400 ns = (tscdeadline - guest_tsc) * 1000000ULL;
1401 do_div(ns, this_tsc_khz);
1402 expire = ktime_add_ns(now, ns);
1403 expire = ktime_sub_ns(expire, lapic_timer_advance_ns);
1404 hrtimer_start(&apic->lapic_timer.timer,
1405 expire, HRTIMER_MODE_ABS_PINNED);
1406 } else
1407 apic_timer_expired(apic);
1408
1409 local_irq_restore(flags);
1410 }
1411
1412 static void start_sw_period(struct kvm_lapic *apic)
1413 {
1414 if (!apic->lapic_timer.period)
1415 return;
1416
1417 if (apic_lvtt_oneshot(apic) &&
1418 ktime_after(ktime_get(),
1419 apic->lapic_timer.target_expiration)) {
1420 apic_timer_expired(apic);
1421 return;
1422 }
1423
1424 hrtimer_start(&apic->lapic_timer.timer,
1425 apic->lapic_timer.target_expiration,
1426 HRTIMER_MODE_ABS_PINNED);
1427 }
1428
1429 static bool set_target_expiration(struct kvm_lapic *apic)
1430 {
1431 ktime_t now;
1432 u64 tscl = rdtsc();
1433
1434 now = ktime_get();
1435 apic->lapic_timer.period = (u64)kvm_lapic_get_reg(apic, APIC_TMICT)
1436 * APIC_BUS_CYCLE_NS * apic->divide_count;
1437
1438 if (!apic->lapic_timer.period)
1439 return false;
1440
1441 /*
1442 * Do not allow the guest to program periodic timers with small
1443 * interval, since the hrtimers are not throttled by the host
1444 * scheduler.
1445 */
1446 if (apic_lvtt_period(apic)) {
1447 s64 min_period = min_timer_period_us * 1000LL;
1448
1449 if (apic->lapic_timer.period < min_period) {
1450 pr_info_ratelimited(
1451 "kvm: vcpu %i: requested %lld ns "
1452 "lapic timer period limited to %lld ns\n",
1453 apic->vcpu->vcpu_id,
1454 apic->lapic_timer.period, min_period);
1455 apic->lapic_timer.period = min_period;
1456 }
1457 }
1458
1459 apic_debug("%s: bus cycle is %" PRId64 "ns, now 0x%016"
1460 PRIx64 ", "
1461 "timer initial count 0x%x, period %lldns, "
1462 "expire @ 0x%016" PRIx64 ".\n", __func__,
1463 APIC_BUS_CYCLE_NS, ktime_to_ns(now),
1464 kvm_lapic_get_reg(apic, APIC_TMICT),
1465 apic->lapic_timer.period,
1466 ktime_to_ns(ktime_add_ns(now,
1467 apic->lapic_timer.period)));
1468
1469 apic->lapic_timer.tscdeadline = kvm_read_l1_tsc(apic->vcpu, tscl) +
1470 nsec_to_cycles(apic->vcpu, apic->lapic_timer.period);
1471 apic->lapic_timer.target_expiration = ktime_add_ns(now, apic->lapic_timer.period);
1472
1473 return true;
1474 }
1475
1476 static void advance_periodic_target_expiration(struct kvm_lapic *apic)
1477 {
1478 apic->lapic_timer.tscdeadline +=
1479 nsec_to_cycles(apic->vcpu, apic->lapic_timer.period);
1480 apic->lapic_timer.target_expiration =
1481 ktime_add_ns(apic->lapic_timer.target_expiration,
1482 apic->lapic_timer.period);
1483 }
1484
1485 bool kvm_lapic_hv_timer_in_use(struct kvm_vcpu *vcpu)
1486 {
1487 if (!lapic_in_kernel(vcpu))
1488 return false;
1489
1490 return vcpu->arch.apic->lapic_timer.hv_timer_in_use;
1491 }
1492 EXPORT_SYMBOL_GPL(kvm_lapic_hv_timer_in_use);
1493
1494 static void cancel_hv_timer(struct kvm_lapic *apic)
1495 {
1496 WARN_ON(preemptible());
1497 WARN_ON(!apic->lapic_timer.hv_timer_in_use);
1498 kvm_x86_ops->cancel_hv_timer(apic->vcpu);
1499 apic->lapic_timer.hv_timer_in_use = false;
1500 }
1501
1502 static bool start_hv_timer(struct kvm_lapic *apic)
1503 {
1504 struct kvm_timer *ktimer = &apic->lapic_timer;
1505 int r;
1506
1507 WARN_ON(preemptible());
1508 if (!kvm_x86_ops->set_hv_timer)
1509 return false;
1510
1511 if (!apic_lvtt_period(apic) && atomic_read(&ktimer->pending))
1512 return false;
1513
1514 r = kvm_x86_ops->set_hv_timer(apic->vcpu, ktimer->tscdeadline);
1515 if (r < 0)
1516 return false;
1517
1518 ktimer->hv_timer_in_use = true;
1519 hrtimer_cancel(&ktimer->timer);
1520
1521 /*
1522 * Also recheck ktimer->pending, in case the sw timer triggered in
1523 * the window. For periodic timer, leave the hv timer running for
1524 * simplicity, and the deadline will be recomputed on the next vmexit.
1525 */
1526 if (!apic_lvtt_period(apic) && (r || atomic_read(&ktimer->pending))) {
1527 if (r)
1528 apic_timer_expired(apic);
1529 return false;
1530 }
1531
1532 trace_kvm_hv_timer_state(apic->vcpu->vcpu_id, true);
1533 return true;
1534 }
1535
1536 static void start_sw_timer(struct kvm_lapic *apic)
1537 {
1538 struct kvm_timer *ktimer = &apic->lapic_timer;
1539
1540 WARN_ON(preemptible());
1541 if (apic->lapic_timer.hv_timer_in_use)
1542 cancel_hv_timer(apic);
1543 if (!apic_lvtt_period(apic) && atomic_read(&ktimer->pending))
1544 return;
1545
1546 if (apic_lvtt_period(apic) || apic_lvtt_oneshot(apic))
1547 start_sw_period(apic);
1548 else if (apic_lvtt_tscdeadline(apic))
1549 start_sw_tscdeadline(apic);
1550 trace_kvm_hv_timer_state(apic->vcpu->vcpu_id, false);
1551 }
1552
1553 static void restart_apic_timer(struct kvm_lapic *apic)
1554 {
1555 preempt_disable();
1556 if (!start_hv_timer(apic))
1557 start_sw_timer(apic);
1558 preempt_enable();
1559 }
1560
1561 void kvm_lapic_expired_hv_timer(struct kvm_vcpu *vcpu)
1562 {
1563 struct kvm_lapic *apic = vcpu->arch.apic;
1564
1565 preempt_disable();
1566 /* If the preempt notifier has already run, it also called apic_timer_expired */
1567 if (!apic->lapic_timer.hv_timer_in_use)
1568 goto out;
1569 WARN_ON(swait_active(&vcpu->wq));
1570 cancel_hv_timer(apic);
1571 apic_timer_expired(apic);
1572
1573 if (apic_lvtt_period(apic) && apic->lapic_timer.period) {
1574 advance_periodic_target_expiration(apic);
1575 restart_apic_timer(apic);
1576 }
1577 out:
1578 preempt_enable();
1579 }
1580 EXPORT_SYMBOL_GPL(kvm_lapic_expired_hv_timer);
1581
1582 void kvm_lapic_switch_to_hv_timer(struct kvm_vcpu *vcpu)
1583 {
1584 restart_apic_timer(vcpu->arch.apic);
1585 }
1586 EXPORT_SYMBOL_GPL(kvm_lapic_switch_to_hv_timer);
1587
1588 void kvm_lapic_switch_to_sw_timer(struct kvm_vcpu *vcpu)
1589 {
1590 struct kvm_lapic *apic = vcpu->arch.apic;
1591
1592 preempt_disable();
1593 /* Possibly the TSC deadline timer is not enabled yet */
1594 if (apic->lapic_timer.hv_timer_in_use)
1595 start_sw_timer(apic);
1596 preempt_enable();
1597 }
1598 EXPORT_SYMBOL_GPL(kvm_lapic_switch_to_sw_timer);
1599
1600 void kvm_lapic_restart_hv_timer(struct kvm_vcpu *vcpu)
1601 {
1602 struct kvm_lapic *apic = vcpu->arch.apic;
1603
1604 WARN_ON(!apic->lapic_timer.hv_timer_in_use);
1605 restart_apic_timer(apic);
1606 }
1607
1608 static void start_apic_timer(struct kvm_lapic *apic)
1609 {
1610 atomic_set(&apic->lapic_timer.pending, 0);
1611
1612 if ((apic_lvtt_period(apic) || apic_lvtt_oneshot(apic))
1613 && !set_target_expiration(apic))
1614 return;
1615
1616 restart_apic_timer(apic);
1617 }
1618
1619 static void apic_manage_nmi_watchdog(struct kvm_lapic *apic, u32 lvt0_val)
1620 {
1621 bool lvt0_in_nmi_mode = apic_lvt_nmi_mode(lvt0_val);
1622
1623 if (apic->lvt0_in_nmi_mode != lvt0_in_nmi_mode) {
1624 apic->lvt0_in_nmi_mode = lvt0_in_nmi_mode;
1625 if (lvt0_in_nmi_mode) {
1626 apic_debug("Receive NMI setting on APIC_LVT0 "
1627 "for cpu %d\n", apic->vcpu->vcpu_id);
1628 atomic_inc(&apic->vcpu->kvm->arch.vapics_in_nmi_mode);
1629 } else
1630 atomic_dec(&apic->vcpu->kvm->arch.vapics_in_nmi_mode);
1631 }
1632 }
1633
1634 int kvm_lapic_reg_write(struct kvm_lapic *apic, u32 reg, u32 val)
1635 {
1636 int ret = 0;
1637
1638 trace_kvm_apic_write(reg, val);
1639
1640 switch (reg) {
1641 case APIC_ID: /* Local APIC ID */
1642 if (!apic_x2apic_mode(apic))
1643 kvm_apic_set_xapic_id(apic, val >> 24);
1644 else
1645 ret = 1;
1646 break;
1647
1648 case APIC_TASKPRI:
1649 report_tpr_access(apic, true);
1650 apic_set_tpr(apic, val & 0xff);
1651 break;
1652
1653 case APIC_EOI:
1654 apic_set_eoi(apic);
1655 break;
1656
1657 case APIC_LDR:
1658 if (!apic_x2apic_mode(apic))
1659 kvm_apic_set_ldr(apic, val & APIC_LDR_MASK);
1660 else
1661 ret = 1;
1662 break;
1663
1664 case APIC_DFR:
1665 if (!apic_x2apic_mode(apic)) {
1666 kvm_lapic_set_reg(apic, APIC_DFR, val | 0x0FFFFFFF);
1667 recalculate_apic_map(apic->vcpu->kvm);
1668 } else
1669 ret = 1;
1670 break;
1671
1672 case APIC_SPIV: {
1673 u32 mask = 0x3ff;
1674 if (kvm_lapic_get_reg(apic, APIC_LVR) & APIC_LVR_DIRECTED_EOI)
1675 mask |= APIC_SPIV_DIRECTED_EOI;
1676 apic_set_spiv(apic, val & mask);
1677 if (!(val & APIC_SPIV_APIC_ENABLED)) {
1678 int i;
1679 u32 lvt_val;
1680
1681 for (i = 0; i < KVM_APIC_LVT_NUM; i++) {
1682 lvt_val = kvm_lapic_get_reg(apic,
1683 APIC_LVTT + 0x10 * i);
1684 kvm_lapic_set_reg(apic, APIC_LVTT + 0x10 * i,
1685 lvt_val | APIC_LVT_MASKED);
1686 }
1687 apic_update_lvtt(apic);
1688 atomic_set(&apic->lapic_timer.pending, 0);
1689
1690 }
1691 break;
1692 }
1693 case APIC_ICR:
1694 /* No delay here, so we always clear the pending bit */
1695 kvm_lapic_set_reg(apic, APIC_ICR, val & ~(1 << 12));
1696 apic_send_ipi(apic);
1697 break;
1698
1699 case APIC_ICR2:
1700 if (!apic_x2apic_mode(apic))
1701 val &= 0xff000000;
1702 kvm_lapic_set_reg(apic, APIC_ICR2, val);
1703 break;
1704
1705 case APIC_LVT0:
1706 apic_manage_nmi_watchdog(apic, val);
1707 case APIC_LVTTHMR:
1708 case APIC_LVTPC:
1709 case APIC_LVT1:
1710 case APIC_LVTERR:
1711 /* TODO: Check vector */
1712 if (!kvm_apic_sw_enabled(apic))
1713 val |= APIC_LVT_MASKED;
1714
1715 val &= apic_lvt_mask[(reg - APIC_LVTT) >> 4];
1716 kvm_lapic_set_reg(apic, reg, val);
1717
1718 break;
1719
1720 case APIC_LVTT:
1721 if (!kvm_apic_sw_enabled(apic))
1722 val |= APIC_LVT_MASKED;
1723 val &= (apic_lvt_mask[0] | apic->lapic_timer.timer_mode_mask);
1724 kvm_lapic_set_reg(apic, APIC_LVTT, val);
1725 apic_update_lvtt(apic);
1726 break;
1727
1728 case APIC_TMICT:
1729 if (apic_lvtt_tscdeadline(apic))
1730 break;
1731
1732 hrtimer_cancel(&apic->lapic_timer.timer);
1733 kvm_lapic_set_reg(apic, APIC_TMICT, val);
1734 start_apic_timer(apic);
1735 break;
1736
1737 case APIC_TDCR:
1738 if (val & 4)
1739 apic_debug("KVM_WRITE:TDCR %x\n", val);
1740 kvm_lapic_set_reg(apic, APIC_TDCR, val);
1741 update_divide_count(apic);
1742 break;
1743
1744 case APIC_ESR:
1745 if (apic_x2apic_mode(apic) && val != 0) {
1746 apic_debug("KVM_WRITE:ESR not zero %x\n", val);
1747 ret = 1;
1748 }
1749 break;
1750
1751 case APIC_SELF_IPI:
1752 if (apic_x2apic_mode(apic)) {
1753 kvm_lapic_reg_write(apic, APIC_ICR, 0x40000 | (val & 0xff));
1754 } else
1755 ret = 1;
1756 break;
1757 default:
1758 ret = 1;
1759 break;
1760 }
1761 if (ret)
1762 apic_debug("Local APIC Write to read-only register %x\n", reg);
1763 return ret;
1764 }
1765 EXPORT_SYMBOL_GPL(kvm_lapic_reg_write);
1766
1767 static int apic_mmio_write(struct kvm_vcpu *vcpu, struct kvm_io_device *this,
1768 gpa_t address, int len, const void *data)
1769 {
1770 struct kvm_lapic *apic = to_lapic(this);
1771 unsigned int offset = address - apic->base_address;
1772 u32 val;
1773
1774 if (!apic_mmio_in_range(apic, address))
1775 return -EOPNOTSUPP;
1776
1777 /*
1778 * APIC register must be aligned on 128-bits boundary.
1779 * 32/64/128 bits registers must be accessed thru 32 bits.
1780 * Refer SDM 8.4.1
1781 */
1782 if (len != 4 || (offset & 0xf)) {
1783 /* Don't shout loud, $infamous_os would cause only noise. */
1784 apic_debug("apic write: bad size=%d %lx\n", len, (long)address);
1785 return 0;
1786 }
1787
1788 val = *(u32*)data;
1789
1790 /* too common printing */
1791 if (offset != APIC_EOI)
1792 apic_debug("%s: offset 0x%x with length 0x%x, and value is "
1793 "0x%x\n", __func__, offset, len, val);
1794
1795 kvm_lapic_reg_write(apic, offset & 0xff0, val);
1796
1797 return 0;
1798 }
1799
1800 void kvm_lapic_set_eoi(struct kvm_vcpu *vcpu)
1801 {
1802 kvm_lapic_reg_write(vcpu->arch.apic, APIC_EOI, 0);
1803 }
1804 EXPORT_SYMBOL_GPL(kvm_lapic_set_eoi);
1805
1806 /* emulate APIC access in a trap manner */
1807 void kvm_apic_write_nodecode(struct kvm_vcpu *vcpu, u32 offset)
1808 {
1809 u32 val = 0;
1810
1811 /* hw has done the conditional check and inst decode */
1812 offset &= 0xff0;
1813
1814 kvm_lapic_reg_read(vcpu->arch.apic, offset, 4, &val);
1815
1816 /* TODO: optimize to just emulate side effect w/o one more write */
1817 kvm_lapic_reg_write(vcpu->arch.apic, offset, val);
1818 }
1819 EXPORT_SYMBOL_GPL(kvm_apic_write_nodecode);
1820
1821 void kvm_free_lapic(struct kvm_vcpu *vcpu)
1822 {
1823 struct kvm_lapic *apic = vcpu->arch.apic;
1824
1825 if (!vcpu->arch.apic)
1826 return;
1827
1828 hrtimer_cancel(&apic->lapic_timer.timer);
1829
1830 if (!(vcpu->arch.apic_base & MSR_IA32_APICBASE_ENABLE))
1831 static_key_slow_dec_deferred(&apic_hw_disabled);
1832
1833 if (!apic->sw_enabled)
1834 static_key_slow_dec_deferred(&apic_sw_disabled);
1835
1836 if (apic->regs)
1837 free_page((unsigned long)apic->regs);
1838
1839 kfree(apic);
1840 }
1841
1842 /*
1843 *----------------------------------------------------------------------
1844 * LAPIC interface
1845 *----------------------------------------------------------------------
1846 */
1847 u64 kvm_get_lapic_tscdeadline_msr(struct kvm_vcpu *vcpu)
1848 {
1849 struct kvm_lapic *apic = vcpu->arch.apic;
1850
1851 if (!lapic_in_kernel(vcpu) ||
1852 !apic_lvtt_tscdeadline(apic))
1853 return 0;
1854
1855 return apic->lapic_timer.tscdeadline;
1856 }
1857
1858 void kvm_set_lapic_tscdeadline_msr(struct kvm_vcpu *vcpu, u64 data)
1859 {
1860 struct kvm_lapic *apic = vcpu->arch.apic;
1861
1862 if (!lapic_in_kernel(vcpu) || apic_lvtt_oneshot(apic) ||
1863 apic_lvtt_period(apic))
1864 return;
1865
1866 hrtimer_cancel(&apic->lapic_timer.timer);
1867 apic->lapic_timer.tscdeadline = data;
1868 start_apic_timer(apic);
1869 }
1870
1871 void kvm_lapic_set_tpr(struct kvm_vcpu *vcpu, unsigned long cr8)
1872 {
1873 struct kvm_lapic *apic = vcpu->arch.apic;
1874
1875 apic_set_tpr(apic, ((cr8 & 0x0f) << 4)
1876 | (kvm_lapic_get_reg(apic, APIC_TASKPRI) & 4));
1877 }
1878
1879 u64 kvm_lapic_get_cr8(struct kvm_vcpu *vcpu)
1880 {
1881 u64 tpr;
1882
1883 tpr = (u64) kvm_lapic_get_reg(vcpu->arch.apic, APIC_TASKPRI);
1884
1885 return (tpr & 0xf0) >> 4;
1886 }
1887
1888 void kvm_lapic_set_base(struct kvm_vcpu *vcpu, u64 value)
1889 {
1890 u64 old_value = vcpu->arch.apic_base;
1891 struct kvm_lapic *apic = vcpu->arch.apic;
1892
1893 if (!apic)
1894 value |= MSR_IA32_APICBASE_BSP;
1895
1896 vcpu->arch.apic_base = value;
1897
1898 if ((old_value ^ value) & MSR_IA32_APICBASE_ENABLE)
1899 kvm_update_cpuid(vcpu);
1900
1901 if (!apic)
1902 return;
1903
1904 /* update jump label if enable bit changes */
1905 if ((old_value ^ value) & MSR_IA32_APICBASE_ENABLE) {
1906 if (value & MSR_IA32_APICBASE_ENABLE) {
1907 kvm_apic_set_xapic_id(apic, vcpu->vcpu_id);
1908 static_key_slow_dec_deferred(&apic_hw_disabled);
1909 } else {
1910 static_key_slow_inc(&apic_hw_disabled.key);
1911 recalculate_apic_map(vcpu->kvm);
1912 }
1913 }
1914
1915 if ((old_value ^ value) & X2APIC_ENABLE) {
1916 if (value & X2APIC_ENABLE) {
1917 kvm_apic_set_x2apic_id(apic, vcpu->vcpu_id);
1918 kvm_x86_ops->set_virtual_x2apic_mode(vcpu, true);
1919 } else
1920 kvm_x86_ops->set_virtual_x2apic_mode(vcpu, false);
1921 }
1922
1923 apic->base_address = apic->vcpu->arch.apic_base &
1924 MSR_IA32_APICBASE_BASE;
1925
1926 if ((value & MSR_IA32_APICBASE_ENABLE) &&
1927 apic->base_address != APIC_DEFAULT_PHYS_BASE)
1928 pr_warn_once("APIC base relocation is unsupported by KVM");
1929
1930 /* with FSB delivery interrupt, we can restart APIC functionality */
1931 apic_debug("apic base msr is 0x%016" PRIx64 ", and base address is "
1932 "0x%lx.\n", apic->vcpu->arch.apic_base, apic->base_address);
1933
1934 }
1935
1936 void kvm_lapic_reset(struct kvm_vcpu *vcpu, bool init_event)
1937 {
1938 struct kvm_lapic *apic;
1939 int i;
1940
1941 apic_debug("%s\n", __func__);
1942
1943 ASSERT(vcpu);
1944 apic = vcpu->arch.apic;
1945 ASSERT(apic != NULL);
1946
1947 /* Stop the timer in case it's a reset to an active apic */
1948 hrtimer_cancel(&apic->lapic_timer.timer);
1949
1950 if (!init_event) {
1951 kvm_lapic_set_base(vcpu, APIC_DEFAULT_PHYS_BASE |
1952 MSR_IA32_APICBASE_ENABLE);
1953 kvm_apic_set_xapic_id(apic, vcpu->vcpu_id);
1954 }
1955 kvm_apic_set_version(apic->vcpu);
1956
1957 for (i = 0; i < KVM_APIC_LVT_NUM; i++)
1958 kvm_lapic_set_reg(apic, APIC_LVTT + 0x10 * i, APIC_LVT_MASKED);
1959 apic_update_lvtt(apic);
1960 if (kvm_vcpu_is_reset_bsp(vcpu) &&
1961 kvm_check_has_quirk(vcpu->kvm, KVM_X86_QUIRK_LINT0_REENABLED))
1962 kvm_lapic_set_reg(apic, APIC_LVT0,
1963 SET_APIC_DELIVERY_MODE(0, APIC_MODE_EXTINT));
1964 apic_manage_nmi_watchdog(apic, kvm_lapic_get_reg(apic, APIC_LVT0));
1965
1966 kvm_lapic_set_reg(apic, APIC_DFR, 0xffffffffU);
1967 apic_set_spiv(apic, 0xff);
1968 kvm_lapic_set_reg(apic, APIC_TASKPRI, 0);
1969 if (!apic_x2apic_mode(apic))
1970 kvm_apic_set_ldr(apic, 0);
1971 kvm_lapic_set_reg(apic, APIC_ESR, 0);
1972 kvm_lapic_set_reg(apic, APIC_ICR, 0);
1973 kvm_lapic_set_reg(apic, APIC_ICR2, 0);
1974 kvm_lapic_set_reg(apic, APIC_TDCR, 0);
1975 kvm_lapic_set_reg(apic, APIC_TMICT, 0);
1976 for (i = 0; i < 8; i++) {
1977 kvm_lapic_set_reg(apic, APIC_IRR + 0x10 * i, 0);
1978 kvm_lapic_set_reg(apic, APIC_ISR + 0x10 * i, 0);
1979 kvm_lapic_set_reg(apic, APIC_TMR + 0x10 * i, 0);
1980 }
1981 apic->irr_pending = vcpu->arch.apicv_active;
1982 apic->isr_count = vcpu->arch.apicv_active ? 1 : 0;
1983 apic->highest_isr_cache = -1;
1984 update_divide_count(apic);
1985 atomic_set(&apic->lapic_timer.pending, 0);
1986 if (kvm_vcpu_is_bsp(vcpu))
1987 kvm_lapic_set_base(vcpu,
1988 vcpu->arch.apic_base | MSR_IA32_APICBASE_BSP);
1989 vcpu->arch.pv_eoi.msr_val = 0;
1990 apic_update_ppr(apic);
1991
1992 vcpu->arch.apic_arb_prio = 0;
1993 vcpu->arch.apic_attention = 0;
1994
1995 apic_debug("%s: vcpu=%p, id=0x%x, base_msr="
1996 "0x%016" PRIx64 ", base_address=0x%0lx.\n", __func__,
1997 vcpu, kvm_lapic_get_reg(apic, APIC_ID),
1998 vcpu->arch.apic_base, apic->base_address);
1999 }
2000
2001 /*
2002 *----------------------------------------------------------------------
2003 * timer interface
2004 *----------------------------------------------------------------------
2005 */
2006
2007 static bool lapic_is_periodic(struct kvm_lapic *apic)
2008 {
2009 return apic_lvtt_period(apic);
2010 }
2011
2012 int apic_has_pending_timer(struct kvm_vcpu *vcpu)
2013 {
2014 struct kvm_lapic *apic = vcpu->arch.apic;
2015
2016 if (apic_enabled(apic) && apic_lvt_enabled(apic, APIC_LVTT))
2017 return atomic_read(&apic->lapic_timer.pending);
2018
2019 return 0;
2020 }
2021
2022 int kvm_apic_local_deliver(struct kvm_lapic *apic, int lvt_type)
2023 {
2024 u32 reg = kvm_lapic_get_reg(apic, lvt_type);
2025 int vector, mode, trig_mode;
2026
2027 if (kvm_apic_hw_enabled(apic) && !(reg & APIC_LVT_MASKED)) {
2028 vector = reg & APIC_VECTOR_MASK;
2029 mode = reg & APIC_MODE_MASK;
2030 trig_mode = reg & APIC_LVT_LEVEL_TRIGGER;
2031 return __apic_accept_irq(apic, mode, vector, 1, trig_mode,
2032 NULL);
2033 }
2034 return 0;
2035 }
2036
2037 void kvm_apic_nmi_wd_deliver(struct kvm_vcpu *vcpu)
2038 {
2039 struct kvm_lapic *apic = vcpu->arch.apic;
2040
2041 if (apic)
2042 kvm_apic_local_deliver(apic, APIC_LVT0);
2043 }
2044
2045 static const struct kvm_io_device_ops apic_mmio_ops = {
2046 .read = apic_mmio_read,
2047 .write = apic_mmio_write,
2048 };
2049
2050 static enum hrtimer_restart apic_timer_fn(struct hrtimer *data)
2051 {
2052 struct kvm_timer *ktimer = container_of(data, struct kvm_timer, timer);
2053 struct kvm_lapic *apic = container_of(ktimer, struct kvm_lapic, lapic_timer);
2054
2055 apic_timer_expired(apic);
2056
2057 if (lapic_is_periodic(apic)) {
2058 advance_periodic_target_expiration(apic);
2059 hrtimer_add_expires_ns(&ktimer->timer, ktimer->period);
2060 return HRTIMER_RESTART;
2061 } else
2062 return HRTIMER_NORESTART;
2063 }
2064
2065 int kvm_create_lapic(struct kvm_vcpu *vcpu)
2066 {
2067 struct kvm_lapic *apic;
2068
2069 ASSERT(vcpu != NULL);
2070 apic_debug("apic_init %d\n", vcpu->vcpu_id);
2071
2072 apic = kzalloc(sizeof(*apic), GFP_KERNEL);
2073 if (!apic)
2074 goto nomem;
2075
2076 vcpu->arch.apic = apic;
2077
2078 apic->regs = (void *)get_zeroed_page(GFP_KERNEL);
2079 if (!apic->regs) {
2080 printk(KERN_ERR "malloc apic regs error for vcpu %x\n",
2081 vcpu->vcpu_id);
2082 goto nomem_free_apic;
2083 }
2084 apic->vcpu = vcpu;
2085
2086 hrtimer_init(&apic->lapic_timer.timer, CLOCK_MONOTONIC,
2087 HRTIMER_MODE_ABS_PINNED);
2088 apic->lapic_timer.timer.function = apic_timer_fn;
2089
2090 /*
2091 * APIC is created enabled. This will prevent kvm_lapic_set_base from
2092 * thinking that APIC satet has changed.
2093 */
2094 vcpu->arch.apic_base = MSR_IA32_APICBASE_ENABLE;
2095 static_key_slow_inc(&apic_sw_disabled.key); /* sw disabled at reset */
2096 kvm_lapic_reset(vcpu, false);
2097 kvm_iodevice_init(&apic->dev, &apic_mmio_ops);
2098
2099 return 0;
2100 nomem_free_apic:
2101 kfree(apic);
2102 nomem:
2103 return -ENOMEM;
2104 }
2105
2106 int kvm_apic_has_interrupt(struct kvm_vcpu *vcpu)
2107 {
2108 struct kvm_lapic *apic = vcpu->arch.apic;
2109 u32 ppr;
2110
2111 if (!apic_enabled(apic))
2112 return -1;
2113
2114 __apic_update_ppr(apic, &ppr);
2115 return apic_has_interrupt_for_ppr(apic, ppr);
2116 }
2117
2118 int kvm_apic_accept_pic_intr(struct kvm_vcpu *vcpu)
2119 {
2120 u32 lvt0 = kvm_lapic_get_reg(vcpu->arch.apic, APIC_LVT0);
2121 int r = 0;
2122
2123 if (!kvm_apic_hw_enabled(vcpu->arch.apic))
2124 r = 1;
2125 if ((lvt0 & APIC_LVT_MASKED) == 0 &&
2126 GET_APIC_DELIVERY_MODE(lvt0) == APIC_MODE_EXTINT)
2127 r = 1;
2128 return r;
2129 }
2130
2131 void kvm_inject_apic_timer_irqs(struct kvm_vcpu *vcpu)
2132 {
2133 struct kvm_lapic *apic = vcpu->arch.apic;
2134
2135 if (atomic_read(&apic->lapic_timer.pending) > 0) {
2136 kvm_apic_local_deliver(apic, APIC_LVTT);
2137 if (apic_lvtt_tscdeadline(apic))
2138 apic->lapic_timer.tscdeadline = 0;
2139 if (apic_lvtt_oneshot(apic)) {
2140 apic->lapic_timer.tscdeadline = 0;
2141 apic->lapic_timer.target_expiration = 0;
2142 }
2143 atomic_set(&apic->lapic_timer.pending, 0);
2144 }
2145 }
2146
2147 int kvm_get_apic_interrupt(struct kvm_vcpu *vcpu)
2148 {
2149 int vector = kvm_apic_has_interrupt(vcpu);
2150 struct kvm_lapic *apic = vcpu->arch.apic;
2151 u32 ppr;
2152
2153 if (vector == -1)
2154 return -1;
2155
2156 /*
2157 * We get here even with APIC virtualization enabled, if doing
2158 * nested virtualization and L1 runs with the "acknowledge interrupt
2159 * on exit" mode. Then we cannot inject the interrupt via RVI,
2160 * because the process would deliver it through the IDT.
2161 */
2162
2163 apic_clear_irr(vector, apic);
2164 if (test_bit(vector, vcpu_to_synic(vcpu)->auto_eoi_bitmap)) {
2165 /*
2166 * For auto-EOI interrupts, there might be another pending
2167 * interrupt above PPR, so check whether to raise another
2168 * KVM_REQ_EVENT.
2169 */
2170 apic_update_ppr(apic);
2171 } else {
2172 /*
2173 * For normal interrupts, PPR has been raised and there cannot
2174 * be a higher-priority pending interrupt---except if there was
2175 * a concurrent interrupt injection, but that would have
2176 * triggered KVM_REQ_EVENT already.
2177 */
2178 apic_set_isr(vector, apic);
2179 __apic_update_ppr(apic, &ppr);
2180 }
2181
2182 return vector;
2183 }
2184
2185 static int kvm_apic_state_fixup(struct kvm_vcpu *vcpu,
2186 struct kvm_lapic_state *s, bool set)
2187 {
2188 if (apic_x2apic_mode(vcpu->arch.apic)) {
2189 u32 *id = (u32 *)(s->regs + APIC_ID);
2190
2191 if (vcpu->kvm->arch.x2apic_format) {
2192 if (*id != vcpu->vcpu_id)
2193 return -EINVAL;
2194 } else {
2195 if (set)
2196 *id >>= 24;
2197 else
2198 *id <<= 24;
2199 }
2200 }
2201
2202 return 0;
2203 }
2204
2205 int kvm_apic_get_state(struct kvm_vcpu *vcpu, struct kvm_lapic_state *s)
2206 {
2207 memcpy(s->regs, vcpu->arch.apic->regs, sizeof(*s));
2208 return kvm_apic_state_fixup(vcpu, s, false);
2209 }
2210
2211 int kvm_apic_set_state(struct kvm_vcpu *vcpu, struct kvm_lapic_state *s)
2212 {
2213 struct kvm_lapic *apic = vcpu->arch.apic;
2214 int r;
2215
2216
2217 kvm_lapic_set_base(vcpu, vcpu->arch.apic_base);
2218 /* set SPIV separately to get count of SW disabled APICs right */
2219 apic_set_spiv(apic, *((u32 *)(s->regs + APIC_SPIV)));
2220
2221 r = kvm_apic_state_fixup(vcpu, s, true);
2222 if (r)
2223 return r;
2224 memcpy(vcpu->arch.apic->regs, s->regs, sizeof *s);
2225
2226 recalculate_apic_map(vcpu->kvm);
2227 kvm_apic_set_version(vcpu);
2228
2229 apic_update_ppr(apic);
2230 hrtimer_cancel(&apic->lapic_timer.timer);
2231 apic_update_lvtt(apic);
2232 apic_manage_nmi_watchdog(apic, kvm_lapic_get_reg(apic, APIC_LVT0));
2233 update_divide_count(apic);
2234 start_apic_timer(apic);
2235 apic->irr_pending = true;
2236 apic->isr_count = vcpu->arch.apicv_active ?
2237 1 : count_vectors(apic->regs + APIC_ISR);
2238 apic->highest_isr_cache = -1;
2239 if (vcpu->arch.apicv_active) {
2240 kvm_x86_ops->apicv_post_state_restore(vcpu);
2241 kvm_x86_ops->hwapic_irr_update(vcpu,
2242 apic_find_highest_irr(apic));
2243 kvm_x86_ops->hwapic_isr_update(vcpu,
2244 apic_find_highest_isr(apic));
2245 }
2246 kvm_make_request(KVM_REQ_EVENT, vcpu);
2247 if (ioapic_in_kernel(vcpu->kvm))
2248 kvm_rtc_eoi_tracking_restore_one(vcpu);
2249
2250 vcpu->arch.apic_arb_prio = 0;
2251
2252 return 0;
2253 }
2254
2255 void __kvm_migrate_apic_timer(struct kvm_vcpu *vcpu)
2256 {
2257 struct hrtimer *timer;
2258
2259 if (!lapic_in_kernel(vcpu))
2260 return;
2261
2262 timer = &vcpu->arch.apic->lapic_timer.timer;
2263 if (hrtimer_cancel(timer))
2264 hrtimer_start_expires(timer, HRTIMER_MODE_ABS_PINNED);
2265 }
2266
2267 /*
2268 * apic_sync_pv_eoi_from_guest - called on vmexit or cancel interrupt
2269 *
2270 * Detect whether guest triggered PV EOI since the
2271 * last entry. If yes, set EOI on guests's behalf.
2272 * Clear PV EOI in guest memory in any case.
2273 */
2274 static void apic_sync_pv_eoi_from_guest(struct kvm_vcpu *vcpu,
2275 struct kvm_lapic *apic)
2276 {
2277 bool pending;
2278 int vector;
2279 /*
2280 * PV EOI state is derived from KVM_APIC_PV_EOI_PENDING in host
2281 * and KVM_PV_EOI_ENABLED in guest memory as follows:
2282 *
2283 * KVM_APIC_PV_EOI_PENDING is unset:
2284 * -> host disabled PV EOI.
2285 * KVM_APIC_PV_EOI_PENDING is set, KVM_PV_EOI_ENABLED is set:
2286 * -> host enabled PV EOI, guest did not execute EOI yet.
2287 * KVM_APIC_PV_EOI_PENDING is set, KVM_PV_EOI_ENABLED is unset:
2288 * -> host enabled PV EOI, guest executed EOI.
2289 */
2290 BUG_ON(!pv_eoi_enabled(vcpu));
2291 pending = pv_eoi_get_pending(vcpu);
2292 /*
2293 * Clear pending bit in any case: it will be set again on vmentry.
2294 * While this might not be ideal from performance point of view,
2295 * this makes sure pv eoi is only enabled when we know it's safe.
2296 */
2297 pv_eoi_clr_pending(vcpu);
2298 if (pending)
2299 return;
2300 vector = apic_set_eoi(apic);
2301 trace_kvm_pv_eoi(apic, vector);
2302 }
2303
2304 void kvm_lapic_sync_from_vapic(struct kvm_vcpu *vcpu)
2305 {
2306 u32 data;
2307
2308 if (test_bit(KVM_APIC_PV_EOI_PENDING, &vcpu->arch.apic_attention))
2309 apic_sync_pv_eoi_from_guest(vcpu, vcpu->arch.apic);
2310
2311 if (!test_bit(KVM_APIC_CHECK_VAPIC, &vcpu->arch.apic_attention))
2312 return;
2313
2314 if (kvm_read_guest_cached(vcpu->kvm, &vcpu->arch.apic->vapic_cache, &data,
2315 sizeof(u32)))
2316 return;
2317
2318 apic_set_tpr(vcpu->arch.apic, data & 0xff);
2319 }
2320
2321 /*
2322 * apic_sync_pv_eoi_to_guest - called before vmentry
2323 *
2324 * Detect whether it's safe to enable PV EOI and
2325 * if yes do so.
2326 */
2327 static void apic_sync_pv_eoi_to_guest(struct kvm_vcpu *vcpu,
2328 struct kvm_lapic *apic)
2329 {
2330 if (!pv_eoi_enabled(vcpu) ||
2331 /* IRR set or many bits in ISR: could be nested. */
2332 apic->irr_pending ||
2333 /* Cache not set: could be safe but we don't bother. */
2334 apic->highest_isr_cache == -1 ||
2335 /* Need EOI to update ioapic. */
2336 kvm_ioapic_handles_vector(apic, apic->highest_isr_cache)) {
2337 /*
2338 * PV EOI was disabled by apic_sync_pv_eoi_from_guest
2339 * so we need not do anything here.
2340 */
2341 return;
2342 }
2343
2344 pv_eoi_set_pending(apic->vcpu);
2345 }
2346
2347 void kvm_lapic_sync_to_vapic(struct kvm_vcpu *vcpu)
2348 {
2349 u32 data, tpr;
2350 int max_irr, max_isr;
2351 struct kvm_lapic *apic = vcpu->arch.apic;
2352
2353 apic_sync_pv_eoi_to_guest(vcpu, apic);
2354
2355 if (!test_bit(KVM_APIC_CHECK_VAPIC, &vcpu->arch.apic_attention))
2356 return;
2357
2358 tpr = kvm_lapic_get_reg(apic, APIC_TASKPRI) & 0xff;
2359 max_irr = apic_find_highest_irr(apic);
2360 if (max_irr < 0)
2361 max_irr = 0;
2362 max_isr = apic_find_highest_isr(apic);
2363 if (max_isr < 0)
2364 max_isr = 0;
2365 data = (tpr & 0xff) | ((max_isr & 0xf0) << 8) | (max_irr << 24);
2366
2367 kvm_write_guest_cached(vcpu->kvm, &vcpu->arch.apic->vapic_cache, &data,
2368 sizeof(u32));
2369 }
2370
2371 int kvm_lapic_set_vapic_addr(struct kvm_vcpu *vcpu, gpa_t vapic_addr)
2372 {
2373 if (vapic_addr) {
2374 if (kvm_gfn_to_hva_cache_init(vcpu->kvm,
2375 &vcpu->arch.apic->vapic_cache,
2376 vapic_addr, sizeof(u32)))
2377 return -EINVAL;
2378 __set_bit(KVM_APIC_CHECK_VAPIC, &vcpu->arch.apic_attention);
2379 } else {
2380 __clear_bit(KVM_APIC_CHECK_VAPIC, &vcpu->arch.apic_attention);
2381 }
2382
2383 vcpu->arch.apic->vapic_addr = vapic_addr;
2384 return 0;
2385 }
2386
2387 int kvm_x2apic_msr_write(struct kvm_vcpu *vcpu, u32 msr, u64 data)
2388 {
2389 struct kvm_lapic *apic = vcpu->arch.apic;
2390 u32 reg = (msr - APIC_BASE_MSR) << 4;
2391
2392 if (!lapic_in_kernel(vcpu) || !apic_x2apic_mode(apic))
2393 return 1;
2394
2395 if (reg == APIC_ICR2)
2396 return 1;
2397
2398 /* if this is ICR write vector before command */
2399 if (reg == APIC_ICR)
2400 kvm_lapic_reg_write(apic, APIC_ICR2, (u32)(data >> 32));
2401 return kvm_lapic_reg_write(apic, reg, (u32)data);
2402 }
2403
2404 int kvm_x2apic_msr_read(struct kvm_vcpu *vcpu, u32 msr, u64 *data)
2405 {
2406 struct kvm_lapic *apic = vcpu->arch.apic;
2407 u32 reg = (msr - APIC_BASE_MSR) << 4, low, high = 0;
2408
2409 if (!lapic_in_kernel(vcpu) || !apic_x2apic_mode(apic))
2410 return 1;
2411
2412 if (reg == APIC_DFR || reg == APIC_ICR2) {
2413 apic_debug("KVM_APIC_READ: read x2apic reserved register %x\n",
2414 reg);
2415 return 1;
2416 }
2417
2418 if (kvm_lapic_reg_read(apic, reg, 4, &low))
2419 return 1;
2420 if (reg == APIC_ICR)
2421 kvm_lapic_reg_read(apic, APIC_ICR2, 4, &high);
2422
2423 *data = (((u64)high) << 32) | low;
2424
2425 return 0;
2426 }
2427
2428 int kvm_hv_vapic_msr_write(struct kvm_vcpu *vcpu, u32 reg, u64 data)
2429 {
2430 struct kvm_lapic *apic = vcpu->arch.apic;
2431
2432 if (!lapic_in_kernel(vcpu))
2433 return 1;
2434
2435 /* if this is ICR write vector before command */
2436 if (reg == APIC_ICR)
2437 kvm_lapic_reg_write(apic, APIC_ICR2, (u32)(data >> 32));
2438 return kvm_lapic_reg_write(apic, reg, (u32)data);
2439 }
2440
2441 int kvm_hv_vapic_msr_read(struct kvm_vcpu *vcpu, u32 reg, u64 *data)
2442 {
2443 struct kvm_lapic *apic = vcpu->arch.apic;
2444 u32 low, high = 0;
2445
2446 if (!lapic_in_kernel(vcpu))
2447 return 1;
2448
2449 if (kvm_lapic_reg_read(apic, reg, 4, &low))
2450 return 1;
2451 if (reg == APIC_ICR)
2452 kvm_lapic_reg_read(apic, APIC_ICR2, 4, &high);
2453
2454 *data = (((u64)high) << 32) | low;
2455
2456 return 0;
2457 }
2458
2459 int kvm_lapic_enable_pv_eoi(struct kvm_vcpu *vcpu, u64 data)
2460 {
2461 u64 addr = data & ~KVM_MSR_ENABLED;
2462 if (!IS_ALIGNED(addr, 4))
2463 return 1;
2464
2465 vcpu->arch.pv_eoi.msr_val = data;
2466 if (!pv_eoi_enabled(vcpu))
2467 return 0;
2468 return kvm_gfn_to_hva_cache_init(vcpu->kvm, &vcpu->arch.pv_eoi.data,
2469 addr, sizeof(u8));
2470 }
2471
2472 void kvm_apic_accept_events(struct kvm_vcpu *vcpu)
2473 {
2474 struct kvm_lapic *apic = vcpu->arch.apic;
2475 u8 sipi_vector;
2476 unsigned long pe;
2477
2478 if (!lapic_in_kernel(vcpu) || !apic->pending_events)
2479 return;
2480
2481 /*
2482 * INITs are latched while in SMM. Because an SMM CPU cannot
2483 * be in KVM_MP_STATE_INIT_RECEIVED state, just eat SIPIs
2484 * and delay processing of INIT until the next RSM.
2485 */
2486 if (is_smm(vcpu)) {
2487 WARN_ON_ONCE(vcpu->arch.mp_state == KVM_MP_STATE_INIT_RECEIVED);
2488 if (test_bit(KVM_APIC_SIPI, &apic->pending_events))
2489 clear_bit(KVM_APIC_SIPI, &apic->pending_events);
2490 return;
2491 }
2492
2493 pe = xchg(&apic->pending_events, 0);
2494 if (test_bit(KVM_APIC_INIT, &pe)) {
2495 kvm_lapic_reset(vcpu, true);
2496 kvm_vcpu_reset(vcpu, true);
2497 if (kvm_vcpu_is_bsp(apic->vcpu))
2498 vcpu->arch.mp_state = KVM_MP_STATE_RUNNABLE;
2499 else
2500 vcpu->arch.mp_state = KVM_MP_STATE_INIT_RECEIVED;
2501 }
2502 if (test_bit(KVM_APIC_SIPI, &pe) &&
2503 vcpu->arch.mp_state == KVM_MP_STATE_INIT_RECEIVED) {
2504 /* evaluate pending_events before reading the vector */
2505 smp_rmb();
2506 sipi_vector = apic->sipi_vector;
2507 apic_debug("vcpu %d received sipi with vector # %x\n",
2508 vcpu->vcpu_id, sipi_vector);
2509 kvm_vcpu_deliver_sipi_vector(vcpu, sipi_vector);
2510 vcpu->arch.mp_state = KVM_MP_STATE_RUNNABLE;
2511 }
2512 }
2513
2514 void kvm_lapic_init(void)
2515 {
2516 /* do not patch jump label more than once per second */
2517 jump_label_rate_limit(&apic_hw_disabled, HZ);
2518 jump_label_rate_limit(&apic_sw_disabled, HZ);
2519 }
2520
2521 void kvm_lapic_exit(void)
2522 {
2523 static_key_deferred_flush(&apic_hw_disabled);
2524 static_key_deferred_flush(&apic_sw_disabled);
2525 }