HelenOS sources
This source file includes following definitions.
- pic_init
- pic_enable_interrupt
- pic_disable_interrupt
- pic_ack_interrupt
- pic_get_pending
#include <arch/drivers/pic.h>
#include <mm/km.h>
#include <byteorder.h>
#include <bitops.h>
#include <typedefs.h>
static ioport32_t *pic = NULL;
void pic_init(uintptr_t base, size_t size, cir_t *cir, void **cir_arg)
{
pic = (uint32_t *) km_map(base, size, KM_NATURAL_ALIGNMENT,
PAGE_WRITE | PAGE_NOT_CACHEABLE);
*cir = pic_ack_interrupt;
*cir_arg = NULL;
}
void pic_enable_interrupt(inr_t intnum)
{
if (!pic)
return;
if (intnum < 32) {
pio_write_32(&pic[PIC_MASK_LOW],
pio_read_32(&pic[PIC_MASK_LOW]) | (1 << intnum));
} else {
pio_write_32(&pic[PIC_MASK_HIGH],
pio_read_32(&pic[PIC_MASK_HIGH]) | (1 << (intnum - 32)));
}
}
void pic_disable_interrupt(inr_t intnum)
{
if (!pic)
return;
if (intnum < 32) {
pio_write_32(&pic[PIC_MASK_LOW],
pio_read_32(&pic[PIC_MASK_LOW]) & (~(1 << intnum)));
} else {
pio_write_32(&pic[PIC_MASK_HIGH],
pio_read_32(&pic[PIC_MASK_HIGH]) & (~(1 << (intnum - 32))));
}
}
void pic_ack_interrupt(void *arg, inr_t intnum)
{
if (!pic)
return;
if (intnum < 32) {
pio_write_32(&pic[PIC_ACK_LOW], 1 << intnum);
} else {
pio_write_32(&pic[PIC_ACK_HIGH], 1 << (intnum - 32));
}
}
uint8_t pic_get_pending(void)
{
if (pic) {
uint32_t pending;
pending = pio_read_32(&pic[PIC_PENDING_LOW]);
if (pending != 0)
return fnzb32(pending);
pending = pio_read_32(&pic[PIC_PENDING_HIGH]);
if (pending != 0)
return fnzb32(pending) + 32;
}
return 255;
}
HelenOS homepage, sources at GitHub