4 * Copyright (c) 2004-2005 Fabrice Bellard
6 * This library is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU Lesser General Public
8 * License as published by the Free Software Foundation; either
9 * version 2 of the License, or (at your option) any later version.
11 * This library is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
14 * Lesser General Public License for more details.
16 * You should have received a copy of the GNU Lesser General Public
17 * License along with this library; if not, see <http://www.gnu.org/licenses/>
19 #include "qemu/thread.h"
20 #include "hw/i386/apic_internal.h"
21 #include "hw/i386/apic.h"
22 #include "hw/i386/ioapic.h"
23 #include "hw/pci/msi.h"
24 #include "qemu/host-utils.h"
26 #include "hw/i386/pc.h"
27 #include "hw/i386/apic-msidef.h"
29 #define MAX_APIC_WORDS 8
31 #define SYNC_FROM_VAPIC 0x1
32 #define SYNC_TO_VAPIC 0x2
33 #define SYNC_ISR_IRR_TO_VAPIC 0x4
35 static APICCommonState
*local_apics
[MAX_APICS
+ 1];
37 static void apic_set_irq(APICCommonState
*s
, int vector_num
, int trigger_mode
);
38 static void apic_update_irq(APICCommonState
*s
);
39 static void apic_get_delivery_bitmask(uint32_t *deliver_bitmask
,
40 uint8_t dest
, uint8_t dest_mode
);
42 /* Find first bit starting from msb */
43 static int fls_bit(uint32_t value
)
45 return 31 - clz32(value
);
48 /* Find first bit starting from lsb */
49 static int ffs_bit(uint32_t value
)
54 static inline void set_bit(uint32_t *tab
, int index
)
58 mask
= 1 << (index
& 0x1f);
62 static inline void reset_bit(uint32_t *tab
, int index
)
66 mask
= 1 << (index
& 0x1f);
70 static inline int get_bit(uint32_t *tab
, int index
)
74 mask
= 1 << (index
& 0x1f);
75 return !!(tab
[i
] & mask
);
78 /* return -1 if no bit is set */
79 static int get_highest_priority_int(uint32_t *tab
)
82 for (i
= 7; i
>= 0; i
--) {
84 return i
* 32 + fls_bit(tab
[i
]);
90 static void apic_sync_vapic(APICCommonState
*s
, int sync_type
)
92 VAPICState vapic_state
;
97 if (!s
->vapic_paddr
) {
100 if (sync_type
& SYNC_FROM_VAPIC
) {
101 cpu_physical_memory_rw(s
->vapic_paddr
, (void *)&vapic_state
,
102 sizeof(vapic_state
), 0);
103 s
->tpr
= vapic_state
.tpr
;
105 if (sync_type
& (SYNC_TO_VAPIC
| SYNC_ISR_IRR_TO_VAPIC
)) {
106 start
= offsetof(VAPICState
, isr
);
107 length
= offsetof(VAPICState
, enabled
) - offsetof(VAPICState
, isr
);
109 if (sync_type
& SYNC_TO_VAPIC
) {
110 assert(qemu_cpu_is_self(CPU(s
->cpu
)));
112 vapic_state
.tpr
= s
->tpr
;
113 vapic_state
.enabled
= 1;
115 length
= sizeof(VAPICState
);
118 vector
= get_highest_priority_int(s
->isr
);
122 vapic_state
.isr
= vector
& 0xf0;
124 vapic_state
.zero
= 0;
126 vector
= get_highest_priority_int(s
->irr
);
130 vapic_state
.irr
= vector
& 0xff;
132 cpu_physical_memory_write_rom(s
->vapic_paddr
+ start
,
133 ((void *)&vapic_state
) + start
, length
);
137 static void apic_vapic_base_update(APICCommonState
*s
)
139 apic_sync_vapic(s
, SYNC_TO_VAPIC
);
142 static void apic_local_deliver(APICCommonState
*s
, int vector
)
144 uint32_t lvt
= s
->lvt
[vector
];
147 trace_apic_local_deliver(vector
, (lvt
>> 8) & 7);
149 if (lvt
& APIC_LVT_MASKED
)
152 switch ((lvt
>> 8) & 7) {
154 cpu_interrupt(CPU(s
->cpu
), CPU_INTERRUPT_SMI
);
158 cpu_interrupt(CPU(s
->cpu
), CPU_INTERRUPT_NMI
);
162 cpu_interrupt(CPU(s
->cpu
), CPU_INTERRUPT_HARD
);
166 trigger_mode
= APIC_TRIGGER_EDGE
;
167 if ((vector
== APIC_LVT_LINT0
|| vector
== APIC_LVT_LINT1
) &&
168 (lvt
& APIC_LVT_LEVEL_TRIGGER
))
169 trigger_mode
= APIC_TRIGGER_LEVEL
;
170 apic_set_irq(s
, lvt
& 0xff, trigger_mode
);
174 void apic_deliver_pic_intr(DeviceState
*d
, int level
)
176 APICCommonState
*s
= DO_UPCAST(APICCommonState
, busdev
.qdev
, d
);
179 apic_local_deliver(s
, APIC_LVT_LINT0
);
181 uint32_t lvt
= s
->lvt
[APIC_LVT_LINT0
];
183 switch ((lvt
>> 8) & 7) {
185 if (!(lvt
& APIC_LVT_LEVEL_TRIGGER
))
187 reset_bit(s
->irr
, lvt
& 0xff);
190 cpu_reset_interrupt(CPU(s
->cpu
), CPU_INTERRUPT_HARD
);
196 static void apic_external_nmi(APICCommonState
*s
)
198 apic_local_deliver(s
, APIC_LVT_LINT1
);
201 #define foreach_apic(apic, deliver_bitmask, code) \
203 int __i, __j, __mask;\
204 for(__i = 0; __i < MAX_APIC_WORDS; __i++) {\
205 __mask = deliver_bitmask[__i];\
207 for(__j = 0; __j < 32; __j++) {\
208 if (__mask & (1 << __j)) {\
209 apic = local_apics[__i * 32 + __j];\
219 static void apic_bus_deliver(const uint32_t *deliver_bitmask
,
220 uint8_t delivery_mode
, uint8_t vector_num
,
221 uint8_t trigger_mode
)
223 APICCommonState
*apic_iter
;
225 switch (delivery_mode
) {
227 /* XXX: search for focus processor, arbitration */
231 for(i
= 0; i
< MAX_APIC_WORDS
; i
++) {
232 if (deliver_bitmask
[i
]) {
233 d
= i
* 32 + ffs_bit(deliver_bitmask
[i
]);
238 apic_iter
= local_apics
[d
];
240 apic_set_irq(apic_iter
, vector_num
, trigger_mode
);
250 foreach_apic(apic_iter
, deliver_bitmask
,
251 cpu_interrupt(CPU(apic_iter
->cpu
), CPU_INTERRUPT_SMI
)
256 foreach_apic(apic_iter
, deliver_bitmask
,
257 cpu_interrupt(CPU(apic_iter
->cpu
), CPU_INTERRUPT_NMI
)
262 /* normal INIT IPI sent to processors */
263 foreach_apic(apic_iter
, deliver_bitmask
,
264 cpu_interrupt(CPU(apic_iter
->cpu
),
270 /* handled in I/O APIC code */
277 foreach_apic(apic_iter
, deliver_bitmask
,
278 apic_set_irq(apic_iter
, vector_num
, trigger_mode
) );
281 void apic_deliver_irq(uint8_t dest
, uint8_t dest_mode
, uint8_t delivery_mode
,
282 uint8_t vector_num
, uint8_t trigger_mode
)
284 uint32_t deliver_bitmask
[MAX_APIC_WORDS
];
286 trace_apic_deliver_irq(dest
, dest_mode
, delivery_mode
, vector_num
,
289 apic_get_delivery_bitmask(deliver_bitmask
, dest
, dest_mode
);
290 apic_bus_deliver(deliver_bitmask
, delivery_mode
, vector_num
, trigger_mode
);
293 static void apic_set_base(APICCommonState
*s
, uint64_t val
)
295 s
->apicbase
= (val
& 0xfffff000) |
296 (s
->apicbase
& (MSR_IA32_APICBASE_BSP
| MSR_IA32_APICBASE_ENABLE
));
297 /* if disabled, cannot be enabled again */
298 if (!(val
& MSR_IA32_APICBASE_ENABLE
)) {
299 s
->apicbase
&= ~MSR_IA32_APICBASE_ENABLE
;
300 cpu_clear_apic_feature(&s
->cpu
->env
);
301 s
->spurious_vec
&= ~APIC_SV_ENABLE
;
305 static void apic_set_tpr(APICCommonState
*s
, uint8_t val
)
307 /* Updates from cr8 are ignored while the VAPIC is active */
308 if (!s
->vapic_paddr
) {
314 static uint8_t apic_get_tpr(APICCommonState
*s
)
316 apic_sync_vapic(s
, SYNC_FROM_VAPIC
);
320 static int apic_get_ppr(APICCommonState
*s
)
325 isrv
= get_highest_priority_int(s
->isr
);
336 static int apic_get_arb_pri(APICCommonState
*s
)
338 /* XXX: arbitration */
344 * <0 - low prio interrupt,
346 * >0 - interrupt number
348 static int apic_irq_pending(APICCommonState
*s
)
351 irrv
= get_highest_priority_int(s
->irr
);
355 ppr
= apic_get_ppr(s
);
356 if (ppr
&& (irrv
& 0xf0) <= (ppr
& 0xf0)) {
363 /* signal the CPU if an irq is pending */
364 static void apic_update_irq(APICCommonState
*s
)
368 if (!(s
->spurious_vec
& APIC_SV_ENABLE
)) {
372 if (!qemu_cpu_is_self(cpu
)) {
373 cpu_interrupt(cpu
, CPU_INTERRUPT_POLL
);
374 } else if (apic_irq_pending(s
) > 0) {
375 cpu_interrupt(cpu
, CPU_INTERRUPT_HARD
);
379 void apic_poll_irq(DeviceState
*d
)
381 APICCommonState
*s
= APIC_COMMON(d
);
383 apic_sync_vapic(s
, SYNC_FROM_VAPIC
);
387 static void apic_set_irq(APICCommonState
*s
, int vector_num
, int trigger_mode
)
389 apic_report_irq_delivered(!get_bit(s
->irr
, vector_num
));
391 set_bit(s
->irr
, vector_num
);
393 set_bit(s
->tmr
, vector_num
);
395 reset_bit(s
->tmr
, vector_num
);
396 if (s
->vapic_paddr
) {
397 apic_sync_vapic(s
, SYNC_ISR_IRR_TO_VAPIC
);
399 * The vcpu thread needs to see the new IRR before we pull its current
400 * TPR value. That way, if we miss a lowering of the TRP, the guest
401 * has the chance to notice the new IRR and poll for IRQs on its own.
404 apic_sync_vapic(s
, SYNC_FROM_VAPIC
);
409 static void apic_eoi(APICCommonState
*s
)
412 isrv
= get_highest_priority_int(s
->isr
);
415 reset_bit(s
->isr
, isrv
);
416 if (!(s
->spurious_vec
& APIC_SV_DIRECTED_IO
) && get_bit(s
->tmr
, isrv
)) {
417 ioapic_eoi_broadcast(isrv
);
419 apic_sync_vapic(s
, SYNC_FROM_VAPIC
| SYNC_TO_VAPIC
);
423 static int apic_find_dest(uint8_t dest
)
425 APICCommonState
*apic
= local_apics
[dest
];
428 if (apic
&& apic
->id
== dest
)
429 return dest
; /* shortcut in case apic->id == apic->idx */
431 for (i
= 0; i
< MAX_APICS
; i
++) {
432 apic
= local_apics
[i
];
433 if (apic
&& apic
->id
== dest
)
442 static void apic_get_delivery_bitmask(uint32_t *deliver_bitmask
,
443 uint8_t dest
, uint8_t dest_mode
)
445 APICCommonState
*apic_iter
;
448 if (dest_mode
== 0) {
450 memset(deliver_bitmask
, 0xff, MAX_APIC_WORDS
* sizeof(uint32_t));
452 int idx
= apic_find_dest(dest
);
453 memset(deliver_bitmask
, 0x00, MAX_APIC_WORDS
* sizeof(uint32_t));
455 set_bit(deliver_bitmask
, idx
);
458 /* XXX: cluster mode */
459 memset(deliver_bitmask
, 0x00, MAX_APIC_WORDS
* sizeof(uint32_t));
460 for(i
= 0; i
< MAX_APICS
; i
++) {
461 apic_iter
= local_apics
[i
];
463 if (apic_iter
->dest_mode
== 0xf) {
464 if (dest
& apic_iter
->log_dest
)
465 set_bit(deliver_bitmask
, i
);
466 } else if (apic_iter
->dest_mode
== 0x0) {
467 if ((dest
& 0xf0) == (apic_iter
->log_dest
& 0xf0) &&
468 (dest
& apic_iter
->log_dest
& 0x0f)) {
469 set_bit(deliver_bitmask
, i
);
479 static void apic_startup(APICCommonState
*s
, int vector_num
)
481 s
->sipi_vector
= vector_num
;
482 cpu_interrupt(CPU(s
->cpu
), CPU_INTERRUPT_SIPI
);
485 void apic_sipi(DeviceState
*d
)
487 APICCommonState
*s
= DO_UPCAST(APICCommonState
, busdev
.qdev
, d
);
489 cpu_reset_interrupt(CPU(s
->cpu
), CPU_INTERRUPT_SIPI
);
491 if (!s
->wait_for_sipi
)
493 cpu_x86_load_seg_cache_sipi(s
->cpu
, s
->sipi_vector
);
494 s
->wait_for_sipi
= 0;
497 static void apic_deliver(DeviceState
*d
, uint8_t dest
, uint8_t dest_mode
,
498 uint8_t delivery_mode
, uint8_t vector_num
,
499 uint8_t trigger_mode
)
501 APICCommonState
*s
= DO_UPCAST(APICCommonState
, busdev
.qdev
, d
);
502 uint32_t deliver_bitmask
[MAX_APIC_WORDS
];
503 int dest_shorthand
= (s
->icr
[0] >> 18) & 3;
504 APICCommonState
*apic_iter
;
506 switch (dest_shorthand
) {
508 apic_get_delivery_bitmask(deliver_bitmask
, dest
, dest_mode
);
511 memset(deliver_bitmask
, 0x00, sizeof(deliver_bitmask
));
512 set_bit(deliver_bitmask
, s
->idx
);
515 memset(deliver_bitmask
, 0xff, sizeof(deliver_bitmask
));
518 memset(deliver_bitmask
, 0xff, sizeof(deliver_bitmask
));
519 reset_bit(deliver_bitmask
, s
->idx
);
523 switch (delivery_mode
) {
526 int trig_mode
= (s
->icr
[0] >> 15) & 1;
527 int level
= (s
->icr
[0] >> 14) & 1;
528 if (level
== 0 && trig_mode
== 1) {
529 foreach_apic(apic_iter
, deliver_bitmask
,
530 apic_iter
->arb_id
= apic_iter
->id
);
537 foreach_apic(apic_iter
, deliver_bitmask
,
538 apic_startup(apic_iter
, vector_num
) );
542 apic_bus_deliver(deliver_bitmask
, delivery_mode
, vector_num
, trigger_mode
);
545 static bool apic_check_pic(APICCommonState
*s
)
547 if (!apic_accept_pic_intr(&s
->busdev
.qdev
) || !pic_get_output(isa_pic
)) {
550 apic_deliver_pic_intr(&s
->busdev
.qdev
, 1);
554 int apic_get_interrupt(DeviceState
*d
)
556 APICCommonState
*s
= DO_UPCAST(APICCommonState
, busdev
.qdev
, d
);
559 /* if the APIC is installed or enabled, we let the 8259 handle the
563 if (!(s
->spurious_vec
& APIC_SV_ENABLE
))
566 apic_sync_vapic(s
, SYNC_FROM_VAPIC
);
567 intno
= apic_irq_pending(s
);
570 apic_sync_vapic(s
, SYNC_TO_VAPIC
);
572 } else if (intno
< 0) {
573 apic_sync_vapic(s
, SYNC_TO_VAPIC
);
574 return s
->spurious_vec
& 0xff;
576 reset_bit(s
->irr
, intno
);
577 set_bit(s
->isr
, intno
);
578 apic_sync_vapic(s
, SYNC_TO_VAPIC
);
580 /* re-inject if there is still a pending PIC interrupt */
588 int apic_accept_pic_intr(DeviceState
*d
)
590 APICCommonState
*s
= DO_UPCAST(APICCommonState
, busdev
.qdev
, d
);
596 lvt0
= s
->lvt
[APIC_LVT_LINT0
];
598 if ((s
->apicbase
& MSR_IA32_APICBASE_ENABLE
) == 0 ||
599 (lvt0
& APIC_LVT_MASKED
) == 0)
605 static uint32_t apic_get_current_count(APICCommonState
*s
)
609 d
= (qemu_get_clock_ns(vm_clock
) - s
->initial_count_load_time
) >>
611 if (s
->lvt
[APIC_LVT_TIMER
] & APIC_LVT_TIMER_PERIODIC
) {
613 val
= s
->initial_count
- (d
% ((uint64_t)s
->initial_count
+ 1));
615 if (d
>= s
->initial_count
)
618 val
= s
->initial_count
- d
;
623 static void apic_timer_update(APICCommonState
*s
, int64_t current_time
)
625 if (apic_next_timer(s
, current_time
)) {
626 qemu_mod_timer(s
->timer
, s
->next_time
);
628 qemu_del_timer(s
->timer
);
632 static void apic_timer(void *opaque
)
634 APICCommonState
*s
= opaque
;
636 apic_local_deliver(s
, APIC_LVT_TIMER
);
637 apic_timer_update(s
, s
->next_time
);
640 static uint32_t apic_mem_readb(void *opaque
, hwaddr addr
)
645 static uint32_t apic_mem_readw(void *opaque
, hwaddr addr
)
650 static void apic_mem_writeb(void *opaque
, hwaddr addr
, uint32_t val
)
654 static void apic_mem_writew(void *opaque
, hwaddr addr
, uint32_t val
)
658 static uint32_t apic_mem_readl(void *opaque
, hwaddr addr
)
665 d
= cpu_get_current_apic();
669 s
= DO_UPCAST(APICCommonState
, busdev
.qdev
, d
);
671 index
= (addr
>> 4) & 0xff;
676 case 0x03: /* version */
677 val
= 0x11 | ((APIC_LVT_NB
- 1) << 16); /* version 0x11 */
680 apic_sync_vapic(s
, SYNC_FROM_VAPIC
);
681 if (apic_report_tpr_access
) {
682 cpu_report_tpr_access(&s
->cpu
->env
, TPR_ACCESS_READ
);
687 val
= apic_get_arb_pri(s
);
691 val
= apic_get_ppr(s
);
697 val
= s
->log_dest
<< 24;
700 val
= s
->dest_mode
<< 28;
703 val
= s
->spurious_vec
;
706 val
= s
->isr
[index
& 7];
709 val
= s
->tmr
[index
& 7];
712 val
= s
->irr
[index
& 7];
719 val
= s
->icr
[index
& 1];
722 val
= s
->lvt
[index
- 0x32];
725 val
= s
->initial_count
;
728 val
= apic_get_current_count(s
);
731 val
= s
->divide_conf
;
734 s
->esr
|= ESR_ILLEGAL_ADDRESS
;
738 trace_apic_mem_readl(addr
, val
);
742 static void apic_send_msi(hwaddr addr
, uint32_t data
)
744 uint8_t dest
= (addr
& MSI_ADDR_DEST_ID_MASK
) >> MSI_ADDR_DEST_ID_SHIFT
;
745 uint8_t vector
= (data
& MSI_DATA_VECTOR_MASK
) >> MSI_DATA_VECTOR_SHIFT
;
746 uint8_t dest_mode
= (addr
>> MSI_ADDR_DEST_MODE_SHIFT
) & 0x1;
747 uint8_t trigger_mode
= (data
>> MSI_DATA_TRIGGER_SHIFT
) & 0x1;
748 uint8_t delivery
= (data
>> MSI_DATA_DELIVERY_MODE_SHIFT
) & 0x7;
749 /* XXX: Ignore redirection hint. */
750 apic_deliver_irq(dest
, dest_mode
, delivery
, vector
, trigger_mode
);
753 static void apic_mem_writel(void *opaque
, hwaddr addr
, uint32_t val
)
757 int index
= (addr
>> 4) & 0xff;
758 if (addr
> 0xfff || !index
) {
759 /* MSI and MMIO APIC are at the same memory location,
760 * but actually not on the global bus: MSI is on PCI bus
761 * APIC is connected directly to the CPU.
762 * Mapping them on the global bus happens to work because
763 * MSI registers are reserved in APIC MMIO and vice versa. */
764 apic_send_msi(addr
, val
);
768 d
= cpu_get_current_apic();
772 s
= DO_UPCAST(APICCommonState
, busdev
.qdev
, d
);
774 trace_apic_mem_writel(addr
, val
);
783 if (apic_report_tpr_access
) {
784 cpu_report_tpr_access(&s
->cpu
->env
, TPR_ACCESS_WRITE
);
787 apic_sync_vapic(s
, SYNC_TO_VAPIC
);
797 s
->log_dest
= val
>> 24;
800 s
->dest_mode
= val
>> 28;
803 s
->spurious_vec
= val
& 0x1ff;
813 apic_deliver(d
, (s
->icr
[1] >> 24) & 0xff, (s
->icr
[0] >> 11) & 1,
814 (s
->icr
[0] >> 8) & 7, (s
->icr
[0] & 0xff),
815 (s
->icr
[0] >> 15) & 1);
822 int n
= index
- 0x32;
824 if (n
== APIC_LVT_TIMER
) {
825 apic_timer_update(s
, qemu_get_clock_ns(vm_clock
));
826 } else if (n
== APIC_LVT_LINT0
&& apic_check_pic(s
)) {
832 s
->initial_count
= val
;
833 s
->initial_count_load_time
= qemu_get_clock_ns(vm_clock
);
834 apic_timer_update(s
, s
->initial_count_load_time
);
841 s
->divide_conf
= val
& 0xb;
842 v
= (s
->divide_conf
& 3) | ((s
->divide_conf
>> 1) & 4);
843 s
->count_shift
= (v
+ 1) & 7;
847 s
->esr
|= ESR_ILLEGAL_ADDRESS
;
852 static void apic_pre_save(APICCommonState
*s
)
854 apic_sync_vapic(s
, SYNC_FROM_VAPIC
);
857 static void apic_post_load(APICCommonState
*s
)
859 if (s
->timer_expiry
!= -1) {
860 qemu_mod_timer(s
->timer
, s
->timer_expiry
);
862 qemu_del_timer(s
->timer
);
866 static const MemoryRegionOps apic_io_ops
= {
868 .read
= { apic_mem_readb
, apic_mem_readw
, apic_mem_readl
, },
869 .write
= { apic_mem_writeb
, apic_mem_writew
, apic_mem_writel
, },
871 .endianness
= DEVICE_NATIVE_ENDIAN
,
874 static void apic_init(APICCommonState
*s
)
876 memory_region_init_io(&s
->io_memory
, &apic_io_ops
, s
, "apic-msi",
879 s
->timer
= qemu_new_timer_ns(vm_clock
, apic_timer
, s
);
880 local_apics
[s
->idx
] = s
;
882 msi_supported
= true;
885 static void apic_class_init(ObjectClass
*klass
, void *data
)
887 APICCommonClass
*k
= APIC_COMMON_CLASS(klass
);
890 k
->set_base
= apic_set_base
;
891 k
->set_tpr
= apic_set_tpr
;
892 k
->get_tpr
= apic_get_tpr
;
893 k
->vapic_base_update
= apic_vapic_base_update
;
894 k
->external_nmi
= apic_external_nmi
;
895 k
->pre_save
= apic_pre_save
;
896 k
->post_load
= apic_post_load
;
899 static const TypeInfo apic_info
= {
901 .instance_size
= sizeof(APICCommonState
),
902 .parent
= TYPE_APIC_COMMON
,
903 .class_init
= apic_class_init
,
906 static void apic_register_types(void)
908 type_register_static(&apic_info
);
911 type_init(apic_register_types
)