530 lines
18 KiB
C
530 lines
18 KiB
C
#include <utsm/idt.h>
|
|
#include <utsm/log.h>
|
|
#include <utsm/types.h>
|
|
#include <utsm/instr.h>
|
|
|
|
/* IDT gate descriptor (64-bit) */
|
|
typedef struct __attribute__((packed)) {
|
|
u16 offset_low;
|
|
u16 selector;
|
|
u8 ist;
|
|
u8 type_attr;
|
|
u16 offset_mid;
|
|
u32 offset_high;
|
|
u32 reserved;
|
|
} idt_entry;
|
|
|
|
/* IDT register */
|
|
typedef struct __attribute__((packed)) {
|
|
u16 limit;
|
|
u64 base;
|
|
} idt_ptr;
|
|
|
|
#define IDT_ENTRIES 256
|
|
static idt_entry g_idt[IDT_ENTRIES] __attribute__((aligned(16)));
|
|
|
|
#define PIC1_CMD 0x20
|
|
#define PIC1_DATA 0x21
|
|
#define PIC2_CMD 0xA0
|
|
#define PIC2_DATA 0xA1
|
|
#define ICW1_ICW4 0x01
|
|
#define ICW1_INIT 0x10
|
|
|
|
/* assembly stub declarations — vectors 0-255 全覆盖 */
|
|
extern void isr_stub_0(void);
|
|
extern void isr_stub_1(void);
|
|
extern void isr_stub_2(void);
|
|
extern void isr_stub_3(void);
|
|
extern void isr_stub_4(void);
|
|
extern void isr_stub_5(void);
|
|
extern void isr_stub_6(void);
|
|
extern void isr_stub_7(void);
|
|
extern void isr_stub_8(void);
|
|
extern void isr_stub_9(void);
|
|
extern void isr_stub_10(void);
|
|
extern void isr_stub_11(void);
|
|
extern void isr_stub_12(void);
|
|
extern void isr_stub_13(void);
|
|
extern void isr_stub_14(void);
|
|
extern void isr_stub_15(void);
|
|
extern void isr_stub_16(void);
|
|
extern void isr_stub_17(void);
|
|
extern void isr_stub_18(void);
|
|
extern void isr_stub_19(void);
|
|
extern void isr_stub_20(void);
|
|
extern void isr_stub_21(void);
|
|
extern void isr_stub_22(void);
|
|
extern void isr_stub_23(void);
|
|
extern void isr_stub_24(void);
|
|
extern void isr_stub_25(void);
|
|
extern void isr_stub_26(void);
|
|
extern void isr_stub_27(void);
|
|
extern void isr_stub_28(void);
|
|
extern void isr_stub_29(void);
|
|
extern void isr_stub_30(void);
|
|
extern void isr_stub_31(void);
|
|
extern void isr_stub_32(void);
|
|
extern void isr_stub_33(void);
|
|
extern void isr_stub_34(void);
|
|
extern void isr_stub_35(void);
|
|
extern void isr_stub_36(void);
|
|
extern void isr_stub_37(void);
|
|
extern void isr_stub_38(void);
|
|
extern void isr_stub_39(void);
|
|
extern void isr_stub_40(void);
|
|
extern void isr_stub_41(void);
|
|
extern void isr_stub_42(void);
|
|
extern void isr_stub_43(void);
|
|
extern void isr_stub_44(void);
|
|
extern void isr_stub_45(void);
|
|
extern void isr_stub_46(void);
|
|
extern void isr_stub_47(void);
|
|
extern void isr_stub_48(void);
|
|
extern void isr_stub_49(void);
|
|
extern void isr_stub_50(void);
|
|
extern void isr_stub_51(void);
|
|
extern void isr_stub_52(void);
|
|
extern void isr_stub_53(void);
|
|
extern void isr_stub_54(void);
|
|
extern void isr_stub_55(void);
|
|
extern void isr_stub_56(void);
|
|
extern void isr_stub_57(void);
|
|
extern void isr_stub_58(void);
|
|
extern void isr_stub_59(void);
|
|
extern void isr_stub_60(void);
|
|
extern void isr_stub_61(void);
|
|
extern void isr_stub_62(void);
|
|
extern void isr_stub_63(void);
|
|
extern void isr_stub_64(void);
|
|
extern void isr_stub_65(void);
|
|
extern void isr_stub_66(void);
|
|
extern void isr_stub_67(void);
|
|
extern void isr_stub_68(void);
|
|
extern void isr_stub_69(void);
|
|
extern void isr_stub_70(void);
|
|
extern void isr_stub_71(void);
|
|
extern void isr_stub_72(void);
|
|
extern void isr_stub_73(void);
|
|
extern void isr_stub_74(void);
|
|
extern void isr_stub_75(void);
|
|
extern void isr_stub_76(void);
|
|
extern void isr_stub_77(void);
|
|
extern void isr_stub_78(void);
|
|
extern void isr_stub_79(void);
|
|
extern void isr_stub_80(void);
|
|
extern void isr_stub_81(void);
|
|
extern void isr_stub_82(void);
|
|
extern void isr_stub_83(void);
|
|
extern void isr_stub_84(void);
|
|
extern void isr_stub_85(void);
|
|
extern void isr_stub_86(void);
|
|
extern void isr_stub_87(void);
|
|
extern void isr_stub_88(void);
|
|
extern void isr_stub_89(void);
|
|
extern void isr_stub_90(void);
|
|
extern void isr_stub_91(void);
|
|
extern void isr_stub_92(void);
|
|
extern void isr_stub_93(void);
|
|
extern void isr_stub_94(void);
|
|
extern void isr_stub_95(void);
|
|
extern void isr_stub_96(void);
|
|
extern void isr_stub_97(void);
|
|
extern void isr_stub_98(void);
|
|
extern void isr_stub_99(void);
|
|
extern void isr_stub_100(void);
|
|
extern void isr_stub_101(void);
|
|
extern void isr_stub_102(void);
|
|
extern void isr_stub_103(void);
|
|
extern void isr_stub_104(void);
|
|
extern void isr_stub_105(void);
|
|
extern void isr_stub_106(void);
|
|
extern void isr_stub_107(void);
|
|
extern void isr_stub_108(void);
|
|
extern void isr_stub_109(void);
|
|
extern void isr_stub_110(void);
|
|
extern void isr_stub_111(void);
|
|
extern void isr_stub_112(void);
|
|
extern void isr_stub_113(void);
|
|
extern void isr_stub_114(void);
|
|
extern void isr_stub_115(void);
|
|
extern void isr_stub_116(void);
|
|
extern void isr_stub_117(void);
|
|
extern void isr_stub_118(void);
|
|
extern void isr_stub_119(void);
|
|
extern void isr_stub_120(void);
|
|
extern void isr_stub_121(void);
|
|
extern void isr_stub_122(void);
|
|
extern void isr_stub_123(void);
|
|
extern void isr_stub_124(void);
|
|
extern void isr_stub_125(void);
|
|
extern void isr_stub_126(void);
|
|
extern void isr_stub_127(void);
|
|
extern void isr_stub_128(void);
|
|
extern void isr_stub_129(void);
|
|
extern void isr_stub_130(void);
|
|
extern void isr_stub_131(void);
|
|
extern void isr_stub_132(void);
|
|
extern void isr_stub_133(void);
|
|
extern void isr_stub_134(void);
|
|
extern void isr_stub_135(void);
|
|
extern void isr_stub_136(void);
|
|
extern void isr_stub_137(void);
|
|
extern void isr_stub_138(void);
|
|
extern void isr_stub_139(void);
|
|
extern void isr_stub_140(void);
|
|
extern void isr_stub_141(void);
|
|
extern void isr_stub_142(void);
|
|
extern void isr_stub_143(void);
|
|
extern void isr_stub_144(void);
|
|
extern void isr_stub_145(void);
|
|
extern void isr_stub_146(void);
|
|
extern void isr_stub_147(void);
|
|
extern void isr_stub_148(void);
|
|
extern void isr_stub_149(void);
|
|
extern void isr_stub_150(void);
|
|
extern void isr_stub_151(void);
|
|
extern void isr_stub_152(void);
|
|
extern void isr_stub_153(void);
|
|
extern void isr_stub_154(void);
|
|
extern void isr_stub_155(void);
|
|
extern void isr_stub_156(void);
|
|
extern void isr_stub_157(void);
|
|
extern void isr_stub_158(void);
|
|
extern void isr_stub_159(void);
|
|
extern void isr_stub_160(void);
|
|
extern void isr_stub_161(void);
|
|
extern void isr_stub_162(void);
|
|
extern void isr_stub_163(void);
|
|
extern void isr_stub_164(void);
|
|
extern void isr_stub_165(void);
|
|
extern void isr_stub_166(void);
|
|
extern void isr_stub_167(void);
|
|
extern void isr_stub_168(void);
|
|
extern void isr_stub_169(void);
|
|
extern void isr_stub_170(void);
|
|
extern void isr_stub_171(void);
|
|
extern void isr_stub_172(void);
|
|
extern void isr_stub_173(void);
|
|
extern void isr_stub_174(void);
|
|
extern void isr_stub_175(void);
|
|
extern void isr_stub_176(void);
|
|
extern void isr_stub_177(void);
|
|
extern void isr_stub_178(void);
|
|
extern void isr_stub_179(void);
|
|
extern void isr_stub_180(void);
|
|
extern void isr_stub_181(void);
|
|
extern void isr_stub_182(void);
|
|
extern void isr_stub_183(void);
|
|
extern void isr_stub_184(void);
|
|
extern void isr_stub_185(void);
|
|
extern void isr_stub_186(void);
|
|
extern void isr_stub_187(void);
|
|
extern void isr_stub_188(void);
|
|
extern void isr_stub_189(void);
|
|
extern void isr_stub_190(void);
|
|
extern void isr_stub_191(void);
|
|
extern void isr_stub_192(void);
|
|
extern void isr_stub_193(void);
|
|
extern void isr_stub_194(void);
|
|
extern void isr_stub_195(void);
|
|
extern void isr_stub_196(void);
|
|
extern void isr_stub_197(void);
|
|
extern void isr_stub_198(void);
|
|
extern void isr_stub_199(void);
|
|
extern void isr_stub_200(void);
|
|
extern void isr_stub_201(void);
|
|
extern void isr_stub_202(void);
|
|
extern void isr_stub_203(void);
|
|
extern void isr_stub_204(void);
|
|
extern void isr_stub_205(void);
|
|
extern void isr_stub_206(void);
|
|
extern void isr_stub_207(void);
|
|
extern void isr_stub_208(void);
|
|
extern void isr_stub_209(void);
|
|
extern void isr_stub_210(void);
|
|
extern void isr_stub_211(void);
|
|
extern void isr_stub_212(void);
|
|
extern void isr_stub_213(void);
|
|
extern void isr_stub_214(void);
|
|
extern void isr_stub_215(void);
|
|
extern void isr_stub_216(void);
|
|
extern void isr_stub_217(void);
|
|
extern void isr_stub_218(void);
|
|
extern void isr_stub_219(void);
|
|
extern void isr_stub_220(void);
|
|
extern void isr_stub_221(void);
|
|
extern void isr_stub_222(void);
|
|
extern void isr_stub_223(void);
|
|
extern void isr_stub_224(void);
|
|
extern void isr_stub_225(void);
|
|
extern void isr_stub_226(void);
|
|
extern void isr_stub_227(void);
|
|
extern void isr_stub_228(void);
|
|
extern void isr_stub_229(void);
|
|
extern void isr_stub_230(void);
|
|
extern void isr_stub_231(void);
|
|
extern void isr_stub_232(void);
|
|
extern void isr_stub_233(void);
|
|
extern void isr_stub_234(void);
|
|
extern void isr_stub_235(void);
|
|
extern void isr_stub_236(void);
|
|
extern void isr_stub_237(void);
|
|
extern void isr_stub_238(void);
|
|
extern void isr_stub_239(void);
|
|
extern void isr_stub_240(void);
|
|
extern void isr_stub_241(void);
|
|
extern void isr_stub_242(void);
|
|
extern void isr_stub_243(void);
|
|
extern void isr_stub_244(void);
|
|
extern void isr_stub_245(void);
|
|
extern void isr_stub_246(void);
|
|
extern void isr_stub_247(void);
|
|
extern void isr_stub_248(void);
|
|
extern void isr_stub_249(void);
|
|
extern void isr_stub_250(void);
|
|
extern void isr_stub_251(void);
|
|
extern void isr_stub_252(void);
|
|
extern void isr_stub_253(void);
|
|
extern void isr_stub_254(void);
|
|
extern void isr_stub_255(void);
|
|
|
|
static void *g_isr_table[256] = {
|
|
isr_stub_0, isr_stub_1, isr_stub_2, isr_stub_3,
|
|
isr_stub_4, isr_stub_5, isr_stub_6, isr_stub_7,
|
|
isr_stub_8, isr_stub_9, isr_stub_10, isr_stub_11,
|
|
isr_stub_12, isr_stub_13, isr_stub_14, isr_stub_15,
|
|
isr_stub_16, isr_stub_17, isr_stub_18, isr_stub_19,
|
|
isr_stub_20, isr_stub_21, isr_stub_22, isr_stub_23,
|
|
isr_stub_24, isr_stub_25, isr_stub_26, isr_stub_27,
|
|
isr_stub_28, isr_stub_29, isr_stub_30, isr_stub_31,
|
|
isr_stub_32, isr_stub_33, isr_stub_34, isr_stub_35,
|
|
isr_stub_36, isr_stub_37, isr_stub_38, isr_stub_39,
|
|
isr_stub_40, isr_stub_41, isr_stub_42, isr_stub_43,
|
|
isr_stub_44, isr_stub_45, isr_stub_46, isr_stub_47,
|
|
isr_stub_48, isr_stub_49, isr_stub_50, isr_stub_51,
|
|
isr_stub_52, isr_stub_53, isr_stub_54, isr_stub_55,
|
|
isr_stub_56, isr_stub_57, isr_stub_58, isr_stub_59,
|
|
isr_stub_60, isr_stub_61, isr_stub_62, isr_stub_63,
|
|
isr_stub_64, isr_stub_65, isr_stub_66, isr_stub_67,
|
|
isr_stub_68, isr_stub_69, isr_stub_70, isr_stub_71,
|
|
isr_stub_72, isr_stub_73, isr_stub_74, isr_stub_75,
|
|
isr_stub_76, isr_stub_77, isr_stub_78, isr_stub_79,
|
|
isr_stub_80, isr_stub_81, isr_stub_82, isr_stub_83,
|
|
isr_stub_84, isr_stub_85, isr_stub_86, isr_stub_87,
|
|
isr_stub_88, isr_stub_89, isr_stub_90, isr_stub_91,
|
|
isr_stub_92, isr_stub_93, isr_stub_94, isr_stub_95,
|
|
isr_stub_96, isr_stub_97, isr_stub_98, isr_stub_99,
|
|
isr_stub_100, isr_stub_101, isr_stub_102, isr_stub_103,
|
|
isr_stub_104, isr_stub_105, isr_stub_106, isr_stub_107,
|
|
isr_stub_108, isr_stub_109, isr_stub_110, isr_stub_111,
|
|
isr_stub_112, isr_stub_113, isr_stub_114, isr_stub_115,
|
|
isr_stub_116, isr_stub_117, isr_stub_118, isr_stub_119,
|
|
isr_stub_120, isr_stub_121, isr_stub_122, isr_stub_123,
|
|
isr_stub_124, isr_stub_125, isr_stub_126, isr_stub_127,
|
|
isr_stub_128, isr_stub_129, isr_stub_130, isr_stub_131,
|
|
isr_stub_132, isr_stub_133, isr_stub_134, isr_stub_135,
|
|
isr_stub_136, isr_stub_137, isr_stub_138, isr_stub_139,
|
|
isr_stub_140, isr_stub_141, isr_stub_142, isr_stub_143,
|
|
isr_stub_144, isr_stub_145, isr_stub_146, isr_stub_147,
|
|
isr_stub_148, isr_stub_149, isr_stub_150, isr_stub_151,
|
|
isr_stub_152, isr_stub_153, isr_stub_154, isr_stub_155,
|
|
isr_stub_156, isr_stub_157, isr_stub_158, isr_stub_159,
|
|
isr_stub_160, isr_stub_161, isr_stub_162, isr_stub_163,
|
|
isr_stub_164, isr_stub_165, isr_stub_166, isr_stub_167,
|
|
isr_stub_168, isr_stub_169, isr_stub_170, isr_stub_171,
|
|
isr_stub_172, isr_stub_173, isr_stub_174, isr_stub_175,
|
|
isr_stub_176, isr_stub_177, isr_stub_178, isr_stub_179,
|
|
isr_stub_180, isr_stub_181, isr_stub_182, isr_stub_183,
|
|
isr_stub_184, isr_stub_185, isr_stub_186, isr_stub_187,
|
|
isr_stub_188, isr_stub_189, isr_stub_190, isr_stub_191,
|
|
isr_stub_192, isr_stub_193, isr_stub_194, isr_stub_195,
|
|
isr_stub_196, isr_stub_197, isr_stub_198, isr_stub_199,
|
|
isr_stub_200, isr_stub_201, isr_stub_202, isr_stub_203,
|
|
isr_stub_204, isr_stub_205, isr_stub_206, isr_stub_207,
|
|
isr_stub_208, isr_stub_209, isr_stub_210, isr_stub_211,
|
|
isr_stub_212, isr_stub_213, isr_stub_214, isr_stub_215,
|
|
isr_stub_216, isr_stub_217, isr_stub_218, isr_stub_219,
|
|
isr_stub_220, isr_stub_221, isr_stub_222, isr_stub_223,
|
|
isr_stub_224, isr_stub_225, isr_stub_226, isr_stub_227,
|
|
isr_stub_228, isr_stub_229, isr_stub_230, isr_stub_231,
|
|
isr_stub_232, isr_stub_233, isr_stub_234, isr_stub_235,
|
|
isr_stub_236, isr_stub_237, isr_stub_238, isr_stub_239,
|
|
isr_stub_240, isr_stub_241, isr_stub_242, isr_stub_243,
|
|
isr_stub_244, isr_stub_245, isr_stub_246, isr_stub_247,
|
|
isr_stub_248, isr_stub_249, isr_stub_250, isr_stub_251,
|
|
isr_stub_252, isr_stub_253, isr_stub_254, isr_stub_255,
|
|
};
|
|
|
|
static void outb(u16 port, u8 value) {
|
|
__asm__ volatile ("outb %0, %1" :: "a"(value), "Nd"(port));
|
|
}
|
|
|
|
static u8 inb(u16 port) {
|
|
u8 value;
|
|
__asm__ volatile ("inb %1, %0" : "=a"(value) : "Nd"(port));
|
|
return value;
|
|
}
|
|
|
|
static void io_wait(void) {
|
|
outb(0x80, 0);
|
|
}
|
|
|
|
static void pic_remap(void) {
|
|
/* save masks (kept for reference; fixed masks are applied below) */
|
|
u8 m1 = inb(PIC1_DATA);
|
|
u8 m2 = inb(PIC2_DATA);
|
|
(void)m1;
|
|
(void)m2;
|
|
|
|
/* ICW1: start init + ICW4 */
|
|
outb(PIC1_CMD, ICW1_INIT | ICW1_ICW4);
|
|
io_wait();
|
|
outb(PIC2_CMD, ICW1_INIT | ICW1_ICW4);
|
|
io_wait();
|
|
|
|
/* ICW2: vector offsets */
|
|
outb(PIC1_DATA, 0x20); /* master: vectors 0x20-0x27 */
|
|
io_wait();
|
|
outb(PIC2_DATA, 0x28); /* slave: vectors 0x28-0x2F */
|
|
io_wait();
|
|
|
|
/* ICW3: master/slave wiring */
|
|
outb(PIC1_DATA, 0x04); /* master: IRQ2 → slave */
|
|
io_wait();
|
|
outb(PIC2_DATA, 0x02); /* slave: cascade identity */
|
|
io_wait();
|
|
|
|
/* ICW4: 8086 mode */
|
|
outb(PIC1_DATA, 0x01);
|
|
io_wait();
|
|
outb(PIC2_DATA, 0x01);
|
|
io_wait();
|
|
|
|
/* restore masks: mask all except IRQ1 (keyboard) */
|
|
outb(PIC1_DATA, 0xFD); /* 1111_1101: enable IRQ0 (timer) and IRQ1 (kb) */
|
|
outb(PIC2_DATA, 0xFF); /* mask all slave */
|
|
}
|
|
|
|
static void idt_set_entry(u8 vector, void *handler, u8 ist, u8 type) {
|
|
u64 addr = (u64)handler;
|
|
g_idt[vector].offset_low = (u16)(addr & 0xffff);
|
|
g_idt[vector].selector = 0x08; /* kernel code segment (from GDT) */
|
|
g_idt[vector].ist = ist;
|
|
g_idt[vector].type_attr = type;
|
|
g_idt[vector].offset_mid = (u16)((addr >> 16) & 0xffff);
|
|
g_idt[vector].offset_high = (u32)(addr >> 32);
|
|
g_idt[vector].reserved = 0;
|
|
}
|
|
|
|
void idt_init(void) {
|
|
log_info("[IDT] init begin");
|
|
|
|
for (u16 i = 0; i < IDT_ENTRIES; i++) {
|
|
idt_set_entry((u8)i, g_isr_table[i], 0, 0x8E); /* present, ring0, 64-bit interrupt gate */
|
|
}
|
|
|
|
idt_ptr idtr;
|
|
idtr.limit = (u16)(sizeof(g_idt) - 1);
|
|
idtr.base = (u64)&g_idt;
|
|
|
|
__asm__ volatile ("lidt %0" :: "m"(idtr));
|
|
|
|
pic_remap();
|
|
log_info("[IDT] PIC remapped (master=0x20 slave=0x28)");
|
|
|
|
__asm__ volatile ("sti");
|
|
log_info("[IDT] interrupts enabled");
|
|
log_info("[IDT] init ok");
|
|
}
|
|
|
|
/* 安全 halt stub: cli; hlt 循环。用于 idt_halt_all()。
|
|
* 任何异常/IRQ 触发此 stub 将安全停机，不会三重故障。 */
|
|
static void isr_halt_stub(void) {
|
|
for (;;) { __asm__ volatile("cli; hlt"); }
|
|
}
|
|
|
|
void idt_halt_all(void) {
|
|
/* 将 IDT 所有 256 个条目替换为安全 halt stub。
|
|
* 调用前应已 cli + mask PIC，此函数是额外防御层:
|
|
* - 实机 spurious IRQ7/15 即使 PIC 已 mask 也可能触发
|
|
* - NMI / SMI 可能导致异常
|
|
* - DSK 运行期间 CPU 异常 (PF/GP) 应安全停机而非执行过期 handler */
|
|
for (u16 i = 0; i < IDT_ENTRIES; i++) {
|
|
idt_set_entry((u8)i, (void *)isr_halt_stub, 0, 0x8E);
|
|
}
|
|
/* 重新加载 IDTR 以确保更改生效 */
|
|
idt_ptr idtr;
|
|
idtr.limit = (u16)(sizeof(g_idt) - 1);
|
|
idtr.base = (u64)&g_idt;
|
|
__asm__ volatile("lidt %0" :: "m"(idtr));
|
|
}
|
|
|
|
/* IRQ handler table — 扩展到 256 个 vector (真机 APIC/IOAPIC/MSI 需要) */
|
|
static irq_handler_t g_irq_handlers[256];
|
|
|
|
/* ---- 插桩: IRQ 统计计数器 ---- */
|
|
INSTR_STAT_DECL(pic_irq_total);
|
|
INSTR_STAT_DECL(apic_irq_total);
|
|
|
|
int irq_register(u8 vector, irq_handler_t handler) {
|
|
if ((unsigned)vector >= 256) return -1;
|
|
g_irq_handlers[vector] = handler;
|
|
INSTR_LOG(INSTR_LOG_DEBUG, INSTR_F_UTSM_TRACE, "[IDT] IRQ handler registered");
|
|
return 0;
|
|
}
|
|
|
|
/* Stack frame pushed by isr_common in idt.S */
|
|
typedef struct {
|
|
u64 r11, r10, r9, r8, rax, rcx, rdx, rsi, rdi;
|
|
u64 vector;
|
|
u64 error_code;
|
|
u64 rip, cs, rflags;
|
|
} isr_frame;
|
|
|
|
void idt_handler(isr_frame *frame) {
|
|
if (frame->vector < 32) {
|
|
INSTR_PROBE(EXCP, frame->vector, frame->error_code, frame->rip, 0);
|
|
log_error("[IDT] exception");
|
|
log_hex64("[IDT] vector=", frame->vector);
|
|
log_hex64("[IDT] err=", frame->error_code);
|
|
log_hex64("[IDT] rip=", frame->rip);
|
|
for (;;) { __asm__ volatile ("cli; hlt"); }
|
|
}
|
|
|
|
/* PIC IRQ: vectors 0x20-0x2F (32-47) */
|
|
if (frame->vector >= 32 && frame->vector <= 47) {
|
|
INSTR_STAT_INC(pic_irq_total);
|
|
u8 irq = (u8)(frame->vector - 0x20);
|
|
|
|
/* call registered handler */
|
|
if (g_irq_handlers[frame->vector]) {
|
|
int suppress_eoi = g_irq_handlers[frame->vector](irq);
|
|
if (suppress_eoi) return;
|
|
}
|
|
|
|
/* send PIC EOI */
|
|
if (frame->vector >= 0x28) {
|
|
outb(PIC2_CMD, 0x20);
|
|
}
|
|
outb(PIC1_CMD, 0x20);
|
|
return;
|
|
}
|
|
|
|
/* APIC/IOAPIC/MSI IRQ: vectors 0x30-0xFF (48-255)
|
|
* **QEMU 无法测试但真机必需的代码路径**:
|
|
* - APIC EOI 写入 LAPIC EOI 寄存器 (0xFEE000B0)
|
|
* - 当前 PIC 仍激活, 不需要 APIC EOI
|
|
* - 迁移到 IOAPIC 后需要此处补 APIC EOI */
|
|
if (frame->vector >= 48 && frame->vector <= 255) {
|
|
INSTR_STAT_INC(apic_irq_total);
|
|
if (g_irq_handlers[frame->vector]) {
|
|
g_irq_handlers[frame->vector]((u8)frame->vector);
|
|
}
|
|
/* TODO: LAPIC EOI — 写 0 到 LAPIC EOI 寄存器 (mmio offset 0xB0)
|
|
* 当从 PIC 迁移到 APIC 中断路由时, 必须在此处添加:
|
|
* *(volatile u32 *)(hhdm_offset + lapic_phys + 0xB0) = 0;
|
|
*/
|
|
return;
|
|
}
|
|
}
|