rom/exec/addintserver.c

   1 /*
   2     Copyright © 1995-2001, 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 #include <aros/config.h>
   9 #include <exec/execbase.h>
  10 #include <exec/interrupts.h>
  11
  12 #if (AROS_FLAVOUR & AROS_FLAVOUR_BINCOMPAT) && defined(mc68000)
  13 #include <hardware/custom.h>
  14 #include <hardware/intbits.h>
  15 #endif
  16
  17 #include <proto/exec.h>
  18 #include <aros/libcall.h>
  19
  20 /*****************************************************************************
  21
  22     NAME */
  23
  24         AROS_LH2(void, AddIntServer,
  25
  26 /*  SYNOPSIS */
  27         AROS_LHA(ULONG,              intNumber, D0),
  28         AROS_LHA(struct Interrupt *, interrupt, A1),
  29
  30 /*  LOCATION */
  31         struct ExecBase *, SysBase, 28, Exec)
  32
  33 /*  FUNCTION
  34
  35     INPUTS
  36
  37     RESULT
  38
  39     NOTES
  40         This function also enables the corresponding chipset interrupt if
  41         run on a native Amiga.
  42
  43     EXAMPLE
  44
  45     BUGS
  46
  47     SEE ALSO
  48
  49     INTERNALS
  50
  51 ******************************************************************************/
  52 {
  53     AROS_LIBFUNC_INIT
  54 #if (AROS_FLAVOUR & AROS_FLAVOUR_BINCOMPAT) && defined(mc68000)
  55     struct Custom *custom = (struct Custom *)(void **)0xdff000;
  56 #endif
  57
  58     Disable();
  59
  60     Enqueue((struct List *)SysBase->IntVects[intNumber].iv_Data, (struct Node *)interrupt);
  61
  62 #if (AROS_FLAVOUR & AROS_FLAVOUR_BINCOMPAT) && defined(mc68000)
  63     /*
  64         Enable the chipset interrupt if run on a native Amiga.
  65     */
  66     custom->intena = (UWORD)(INTF_SETCLR|(1L<<intNumber));
  67 #endif
  68
  69     Enable();
  70
  71     AROS_LIBFUNC_EXIT
  72 } /* AddIntServer */