*/
void IRQ_Handler(tRegs *Regs)
{
- int i, irq = Regs->int_num - 0xF0;
+ int irq = Regs->int_num - 0xF0;
int bHandled = 0;
//Log("IRQ_Handler: (Regs={int_num:%i})", Regs->int_num);
- for( i = 0; i < MAX_CALLBACKS_PER_IRQ; i++ )
+ for( int i = 0; i < MAX_CALLBACKS_PER_IRQ; i++ )
{
if( gIRQ_Handlers[irq][i] ) {
gIRQ_Handlers[irq][i](irq, gaIRQ_DataPointers[irq][i]);
*/
int IRQ_AddHandler( int Num, void (*Callback)(int, void*), void *Ptr )
{
- int i;
- for( i = 0; i < MAX_CALLBACKS_PER_IRQ; i++ )
+ for( int i = 0; i < MAX_CALLBACKS_PER_IRQ; i++ )
{
if( gIRQ_Handlers[Num][i] == NULL )
{
- Log_Log("IRQ", "Added IRQ%i Cb#%i %p", Num, i, Callback);
+ //Log_Log("IRQ", "Added IRQ%i Cb#%i %p", Num, i, Callback);
gIRQ_Handlers[Num][i] = Callback;
gaIRQ_DataPointers[Num][i] = Ptr;
- return 1;
+ return Num * MAX_CALLBACKS_PER_IRQ + i;
}
}
Log_Warning("IRQ", "No free callbacks on IRQ%i", Num);
- return 0;
+ return -1;
+}
+
+void IRQ_RemHandler(int Handle)
+{
+ int Num = Handle / MAX_CALLBACKS_PER_IRQ;
+ int id = Handle % MAX_CALLBACKS_PER_IRQ;
+ gIRQ_Handlers[Num][id] = NULL;
}