1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
|
// Helpers for working with i8259 interrupt controller.
//
// Copyright (C) 2008 Kevin O'Connor <kevin@koconnor.net>
// Copyright (C) 2002 MandrakeSoft S.A.
//
// This file may be distributed under the terms of the GNU LGPLv3 license.
#include "pic.h" // get_pic1_isr
#include "util.h" // dprintf
#include "config.h" // CONFIG_*
void
set_pics(u8 irq0, u8 irq8)
{
// Send ICW1 (select OCW1 + will send ICW4)
outb(0x11, PORT_PIC1_CMD);
outb(0x11, PORT_PIC2_CMD);
// Send ICW2 (base irqs: 0x08-0x0f for irq0-7, 0x70-0x77 for irq8-15)
outb(irq0, PORT_PIC1_DATA);
outb(irq8, PORT_PIC2_DATA);
// Send ICW3 (cascaded pic ids)
outb(0x04, PORT_PIC1_DATA);
outb(0x02, PORT_PIC2_DATA);
// Send ICW4 (enable 8086 mode)
outb(0x01, PORT_PIC1_DATA);
outb(0x01, PORT_PIC2_DATA);
// Mask all irqs (except cascaded PIC2 irq)
outb(~PIC1_IRQ2, PORT_PIC1_DATA);
outb(~0, PORT_PIC2_DATA);
}
void
pic_setup(void)
{
dprintf(3, "init pic\n");
set_pics(BIOS_HWIRQ0_VECTOR, BIOS_HWIRQ8_VECTOR);
}
// Handler for otherwise unused hardware irqs.
void VISIBLE16
handle_hwpic1(struct bregs *regs)
{
dprintf(DEBUG_ISR_hwpic1, "handle_hwpic1 irq=%x\n", get_pic1_isr());
eoi_pic1();
}
void VISIBLE16
handle_hwpic2(struct bregs *regs)
{
dprintf(DEBUG_ISR_hwpic2, "handle_hwpic2 irq=%x\n", get_pic2_isr());
eoi_pic2();
}
u8 saved_pic_mask[2] = { ~PIC1_IRQ2, ~0 };
void
pic_save_mask(void)
{
saved_pic_mask[0] = inb(PORT_PIC1_DATA);
saved_pic_mask[1] = inb(PORT_PIC2_DATA);
}
void
pic_restore_mask(void)
{
outb(saved_pic_mask[0], PORT_PIC1_DATA);
outb(saved_pic_mask[1], PORT_PIC2_DATA);
}
|
