rom/exec/setintvector.c

   1 /*
   2     Copyright © 1995-2017, The AROS Development Team. All rights reserved.
   3     $Id$
   4
   5     Desc: Install an interrupt handler.
   6     Lang: english
   7 */
   8 #include <exec/execbase.h>
   9 #include <exec/interrupts.h>
  10 #include <proto/exec.h>
  11 #include <aros/libcall.h>
  12
  13 #include "exec_intern.h"
  14 #include "exec_debug.h"
  15
  16 /*****************************************************************************
  17
  18     NAME */
  19
  20         AROS_LH2(struct Interrupt *, SetIntVector,
  21
  22 /*  SYNOPSIS */
  23         AROS_LHA(ULONG,              intNumber, D0),
  24         AROS_LHA(struct Interrupt *, interrupt, A1),
  25
  26 /*  LOCATION */
  27         struct ExecBase *, SysBase, 27, Exec)
  28
  29 /*  FUNCTION
  30
  31     INPUTS
  32
  33     RESULT
  34
  35     NOTES
  36
  37     EXAMPLE
  38
  39     BUGS
  40
  41     SEE ALSO
  42
  43     INTERNALS
  44
  45 ******************************************************************************/
  46 {
  47     AROS_LIBFUNC_INIT
  48     struct Interrupt *oldint;
  49     BOOL ishandler = intNumber <= 2 || (intNumber >= 6 && intNumber <= 12);
  50
  51     ExecLog(SysBase, EXECDEBUGF_EXCEPTHANDLER, "SetIntVector: Int %d, Interrupt %p\n", intNumber, interrupt);
  52
  53     Disable ();
  54 #if defined(__AROSEXEC_SMP__)
  55     EXEC_SPINLOCK_LOCK(&PrivExecBase(SysBase)->IntrListSpinLock, SPINLOCK_MODE_WRITE);
  56 #endif
  57     oldint = (struct Interrupt *)SysBase->IntVects[intNumber].iv_Node;
  58     SysBase->IntVects[intNumber].iv_Node = ishandler ? (struct Node *)interrupt : NULL;
  59
  60     if (interrupt)
  61     {
  62         SysBase->IntVects[intNumber].iv_Data = interrupt->is_Data;
  63         SysBase->IntVects[intNumber].iv_Code = interrupt->is_Code;
  64     }
  65     else
  66     {
  67         SysBase->IntVects[intNumber].iv_Data = (APTR)~0;
  68         SysBase->IntVects[intNumber].iv_Code = (void *)~0;
  69     }
  70 #if defined(__AROSEXEC_SMP__)
  71     EXEC_SPINLOCK_UNLOCK(&PrivExecBase(SysBase)->IntrListSpinLock);
  72 #endif
  73     Enable ();
  74
  75     return oldint;
  76
  77     AROS_LIBFUNC_EXIT
  78 } /* SetIntVector */