75 lines
1.2 KiB
C
75 lines
1.2 KiB
C
//Functions.c
|
|
//05/07/03 Josh Holtrop
|
|
//for HOS
|
|
|
|
|
|
inline void outportb(unsigned int port, unsigned char value) // Output a byte to a port
|
|
{
|
|
asm volatile ("outb %%al,%%dx"::"d" (port), "a" (value));
|
|
};
|
|
|
|
inline void outportw(unsigned int port, unsigned int value) // Output a word to a port
|
|
{
|
|
asm volatile ("outw %%ax,%%dx"::"d" (port), "a" (value));
|
|
};
|
|
|
|
inline byte inportb(unsigned short port)
|
|
{
|
|
unsigned char ret_val;
|
|
|
|
asm volatile("inb %w1,%b0"
|
|
: "=a"(ret_val)
|
|
: "d"(port));
|
|
return ret_val;
|
|
};
|
|
|
|
void enable_ints()
|
|
{
|
|
asm("sti");
|
|
};
|
|
|
|
void disable_ints()
|
|
{
|
|
asm("cli");
|
|
};
|
|
|
|
void remap_pics(int pic1, int pic2)
|
|
{
|
|
byte a1, a2;
|
|
|
|
a1 = inportb(PIC1_DATA);
|
|
a2 = inportb(PIC2_DATA);
|
|
|
|
outportb(PIC1_COMMAND, ICW1_INIT+ICW1_ICW4);
|
|
outportb(PIC2_COMMAND, ICW1_INIT+ICW1_ICW4);
|
|
outportb(PIC1_DATA, pic1);
|
|
outportb(PIC2_DATA, pic2);
|
|
outportb(PIC1_DATA, 4);
|
|
outportb(PIC2_DATA, 2);
|
|
outportb(PIC1_DATA, ICW4_8086);
|
|
outportb(PIC2_DATA, ICW4_8086);
|
|
|
|
outportb(PIC1_DATA, a1);
|
|
outportb(PIC2_DATA, a2);
|
|
};
|
|
|
|
inline void restart()
|
|
{
|
|
outportb (0x64, 0xfe);
|
|
for (;;)
|
|
{
|
|
}
|
|
}
|
|
|
|
inline void eoi()
|
|
{
|
|
outportb(0x20, 0x20); //EOI
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|