/* $NetBSD: i82093reg.h,v 1.10 2021/04/17 20:12:55 rillig Exp $ */

/* $NetBSD: i82093reg.h,v 1.10 2021/04/17 20:12:55 rillig Exp $ */

#include <x86/i82093reg.h>

#ifdef _KERNEL

#if defined(_KERNEL_OPT)
#include "opt_multiprocessor.h"
#endif

#define ioapic_asm_ack(num) \
movq _C_LABEL(local_apic_va),%rax ; \
movl $0,LAPIC_EOI(%rax)

#define x2apic_asm_ack(num) \
movl $(MSR_X2APIC_BASE + MSR_X2APIC_EOI),%ecx ; \
xorl %eax,%eax ; \
xorl %edx,%edx ; \
wrmsr

#ifdef MULTIPROCESSOR

#define ioapic_asm_lock(num) \
movb $1,%bl ; \
76: \
xchgb %bl,PIC_LOCK(%rdi) ; \
testb %bl,%bl ; \
jz 78f ; \
77: \
pause ; \
nop ; \
nop ; \
cmpb $0,PIC_LOCK(%rdi) ; \
jne 77b ; \
jmp 76b ; \
78:

#define ioapic_asm_unlock(num) \
movb $0,PIC_LOCK(%rdi)

#else

#define ioapic_asm_lock(num)
#define ioapic_asm_unlock(num)

#endif /* MULTIPROCESSOR */

#define ioapic_mask(num) \
movq IS_PIC(%r14),%rdi ;\
ioapic_asm_lock(num) ;\
movl IS_PIN(%r14),%esi ;\
leaq 0x10(%rsi,%rsi,1),%rsi ;\
movq PIC_IOAPIC(%rdi),%rdi ;\
movq IOAPIC_SC_REG(%rdi),%r15 ;\
movl %esi, (%r15) ;\
movq IOAPIC_SC_DATA(%rdi),%r15 ;\
movl (%r15),%esi ;\
orl $IOAPIC_REDLO_MASK,%esi ;\
andl $~IOAPIC_REDLO_RIRR,%esi ;\
movl %esi,(%r15) ;\
movq IS_PIC(%r14),%rdi ;\
ioapic_asm_unlock(num)

#define ioapic_unmask(num) \
cmpq $IREENT_MAGIC,(TF_ERR+8)(%rsp) ;\
jne 79f ;\
movq IS_PIC(%r14),%rdi ;\
ioapic_asm_lock(num) ;\
movl IS_PIN(%r14),%esi ;\
leaq 0x10(%rsi,%rsi,1),%rsi ;\
movq PIC_IOAPIC(%rdi),%rdi ;\
movq IOAPIC_SC_REG(%rdi),%r15 ;\
movq IOAPIC_SC_DATA(%rdi),%r13 ;\
movl %esi, (%r15) ;\
movl (%r13),%r12d ;\
andl $~(IOAPIC_REDLO_MASK|IOAPIC_REDLO_RIRR),%r12d ;\
movl %esi,(%r15) ;\
movl %r12d,(%r13) ;\
movq IS_PIC(%r14),%rdi ;\
ioapic_asm_unlock(num) ;\
79:

#endif