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
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
|
// 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.
#ifndef __PIC_H
#define __PIC_H
#include "ioport.h" // PORT_PIC*
// PORT_PIC1 bitdefs
#define PIC1_IRQ0 (1<<0)
#define PIC1_IRQ1 (1<<1)
#define PIC1_IRQ2 (1<<2)
#define PIC1_IRQ5 (1<<5)
#define PIC1_IRQ6 (1<<6)
// PORT_PIC2 bitdefs
#define PIC2_IRQ8 (1<<0)
#define PIC2_IRQ12 (1<<4)
#define PIC2_IRQ13 (1<<5)
#define PIC2_IRQ14 (1<<6)
static inline void
eoi_pic1()
{
// Send eoi (select OCW2 + eoi)
outb(0x20, PORT_PIC1_CMD);
}
static inline void
eoi_pic2()
{
// Send eoi (select OCW2 + eoi)
outb(0x20, PORT_PIC2_CMD);
eoi_pic1();
}
static inline void
unmask_pic1(u8 irq)
{
outb(inb(PORT_PIC1_DATA) & ~irq, PORT_PIC1_DATA);
}
static inline void
unmask_pic2(u8 irq)
{
outb(inb(PORT_PIC2_DATA) & ~irq, PORT_PIC2_DATA);
}
static inline void
mask_pic1(u8 irq)
{
outb(inb(PORT_PIC1_DATA) | irq, PORT_PIC1_DATA);
}
static inline void
mask_pic2(u8 irq)
{
outb(inb(PORT_PIC2_DATA) | irq, PORT_PIC2_DATA);
}
static inline u8
get_pic1_isr()
{
// 0x0b == select OCW1 + read ISR
outb(0x0b, PORT_PIC1_CMD);
return inb(PORT_PIC1_CMD);
}
static inline u8
get_pic2_isr()
{
// 0x0b == select OCW1 + read ISR
outb(0x0b, PORT_PIC2_CMD);
return inb(PORT_PIC2_CMD);
}
// post.c
void __set_irq(int vector, void *loc);
static inline void
__enable_hwirq(int hwirq, void (*func)(void))
{
int vector;
if (hwirq < 8) {
unmask_pic1(1 << hwirq);
vector = 0x08 + hwirq;
} else {
unmask_pic2(1 << (hwirq - 8));
vector = 0x70 + hwirq - 8;
}
__set_irq(vector, func);
}
#define enable_hwirq(irq, func) do { \
extern void func (void); \
__enable_hwirq(irq, func); \
} while (0)
void pic_setup();
#endif // pic.h
|
