rom/exec/addintserver.c

   1 /*
   2     Copyright © 1995-2013, The AROS Development Team. All rights reserved.
   3     $Id$
   4
   5     Desc: Add interrupt client to chain of interrupt servers
   6     Lang: english
   7 */
   8
   9 #include <aros/debug.h>
  10 #include <aros/libcall.h>
  11 #include <exec/execbase.h>
  12 #include <exec/interrupts.h>
  13 #include <hardware/intbits.h>
  14 #include <proto/exec.h>
  15 #include <proto/kernel.h>
  16
  17 #include "exec_debug.h"
  18 #include "exec_intern.h"
  19 #include "chipset.h"
  20
  21 static void krnIRQwrapper(void *data1, void *data2)
  22 {
  23     struct Interrupt *irq = (struct Interrupt *)data1;
  24     struct ExecBase *SysBase = (struct ExecBase *)data2;
  25
  26     AROS_INTC1(irq->is_Code, irq->is_Data);
  27 }
  28
  29 /*****************************************************************************
  30
  31     NAME */
  32
  33         AROS_LH2(void, AddIntServer,
  34
  35 /*  SYNOPSIS */
  36         AROS_LHA(ULONG,              intNumber, D0),
  37         AROS_LHA(struct Interrupt *, interrupt, A1),
  38
  39 /*  LOCATION */
  40         struct ExecBase *, SysBase, 28, Exec)
  41
  42 /*  FUNCTION
  43
  44     INPUTS
  45
  46     RESULT
  47
  48     NOTES
  49         This function also enables the corresponding chipset interrupt if
  50         run on a native Amiga.
  51
  52     EXAMPLE
  53
  54     BUGS
  55
  56     SEE ALSO
  57
  58     INTERNALS
  59
  60 ******************************************************************************/
  61 {
  62     AROS_LIBFUNC_INIT
  63
  64     ExecLog(SysBase, EXECDEBUGF_EXCEPTHANDLER, "AddIntServer: Int %d, Interrupt %p\n", intNumber, interrupt);
  65
  66     if (intNumber >= INTB_KERNEL) {
  67         /* N.B. ln_Succ is being re-purposed/abused here */
  68         interrupt->is_Node.ln_Succ = KrnAddIRQHandler(intNumber - INTB_KERNEL, krnIRQwrapper, interrupt, SysBase);
  69         return;
  70     }
  71
  72     Disable();
  73
  74     Enqueue((struct List *)SysBase->IntVects[intNumber].iv_Data, &interrupt->is_Node);
  75     CUSTOM_ENABLE(intNumber);
  76
  77     Enable();
  78
  79     AROS_LIBFUNC_EXIT
  80 } /* AddIntServer */