rom/exec/addintserver.c

   1 /*
   2     Copyright © 1995-2011, 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_intern.h"
  18 #include "chipset.h"
  19
  20 static void krnIRQwrapper(void *data1, void *data2)
  21 {
  22     struct Interrupt *irq = (struct Interrupt *)data1;
  23
  24     AROS_INTC1(irq->is_Code, irq->is_Data);
  25 }
  26
  27 /*****************************************************************************
  28
  29     NAME */
  30
  31         AROS_LH2(void, AddIntServer,
  32
  33 /*  SYNOPSIS */
  34         AROS_LHA(ULONG,              intNumber, D0),
  35         AROS_LHA(struct Interrupt *, interrupt, A1),
  36
  37 /*  LOCATION */
  38         struct ExecBase *, SysBase, 28, Exec)
  39
  40 /*  FUNCTION
  41
  42     INPUTS
  43
  44     RESULT
  45
  46     NOTES
  47         This function also enables the corresponding chipset interrupt if
  48         run on a native Amiga.
  49
  50     EXAMPLE
  51
  52     BUGS
  53
  54     SEE ALSO
  55
  56     INTERNALS
  57
  58 ******************************************************************************/
  59 {
  60     AROS_LIBFUNC_INIT
  61
  62     if (intNumber >= INTB_KERNEL) {
  63         interrupt->is_Node.ln_Succ = KrnAddIRQHandler(intNumber - INTB_KERNEL, krnIRQwrapper, interrupt, NULL);
  64         return;
  65     }
  66
  67     Disable();
  68
  69     Enqueue((struct List *)SysBase->IntVects[intNumber].iv_Data, &interrupt->is_Node);
  70     CUSTOM_ENABLE(intNumber);
  71
  72     Enable();
  73
  74     AROS_LIBFUNC_EXIT
  75 } /* AddIntServer */