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