mirror of https://github.com/E-Almqvist/eOS
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
75 lines
1.4 KiB
75 lines
1.4 KiB
#include "pic.h"
|
|
#include "io.h"
|
|
|
|
void pic_send_eoi(uint8 irq) {
|
|
if( irq >= 8 )
|
|
outb(PIC2_CMD, PIC_EOI);
|
|
outb(PIC1_CMD, PIC_EOI);
|
|
}
|
|
|
|
void pic_remap(uint offset_1, uint offset_2) {
|
|
uint8 a1, a2;
|
|
a1 = inb(PIC1_DATA);
|
|
a2 = inb(PIC2_DATA);
|
|
|
|
// Start the init sequance
|
|
outb_w(PIC1_CMD, ICW_INIT_MASK);
|
|
|
|
outb_w(PIC2_CMD, ICW_INIT_MASK);
|
|
|
|
outb_w(PIC1_DATA, offset_1); // ICW2 master offset
|
|
outb_w(PIC2_DATA, offset_2); // ICW2 slave offset
|
|
|
|
outb_w(PIC1_DATA, 0x4);
|
|
outb_w(PIC2_DATA, 0x2);
|
|
|
|
outb_w(PIC1_DATA, ICW4_8086);
|
|
outb_w(PIC2_DATA, ICW4_8086);
|
|
|
|
// restore old masks
|
|
outb(PIC1_DATA, a1);
|
|
outb(PIC2_DATA, a2);
|
|
}
|
|
|
|
// disable the PIC
|
|
// will probably never use this.
|
|
void pic_disable() {
|
|
outb(PIC1_DATA, 0xff);
|
|
outb(PIC2_DATA, 0xff);
|
|
}
|
|
|
|
|
|
void pic_init() {
|
|
pic_remap(PIC1, PIC2);
|
|
}
|
|
|
|
// (un)set a specific irq
|
|
void irq(uint8 idx, bool t) {
|
|
uint16 port;
|
|
uint8 data;
|
|
|
|
if(idx < 8) {
|
|
port = PIC1_DATA;
|
|
} else {
|
|
port = PIC2_DATA;
|
|
idx -= 8;
|
|
}
|
|
|
|
if( t == true ) { // set irq
|
|
data = inb(port) | (1 << idx);
|
|
outb(port, data);
|
|
} else { // clear irq
|
|
data = inb(port) & ~(1 << idx);
|
|
outb(port, data);
|
|
}
|
|
}
|
|
|
|
static uint16 irq_reg(int ocw3) {
|
|
outb(PIC1_CMD, ocw3);
|
|
outb(PIC2_CMD, ocw3);
|
|
return (inb(PIC2_CMD) << 8 | inb(PIC1_CMD));
|
|
}
|
|
|
|
uint16 get_irr() { return irq_reg(PIC_R_IRR); } // fetch IRR
|
|
uint16 get_isr() { return irq_reg(PIC_R_ISR); } // fetch ISR
|
|
|
|
|