104 lines
2.0 KiB
C
104 lines
2.0 KiB
C
// 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
|