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 #define DEBUG 1
  10
  11 #include <aros/debug.h>
  12 #include <aros/libcall.h>
  13 #include <exec/execbase.h>
  14 #include <exec/interrupts.h>
  15 #include <hardware/intbits.h>
  16 #include <proto/exec.h>
  17
  18 #include "chipset.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
  55     D(bug("[AddIntServer] Vector %d, list 0x%p, SysBase 0x%p\n", intNumber, SysBase->IntVects[intNumber].iv_Data, SysBase));
  56
  57     if (SysBase->IntVects[intNumber].iv_Data == 0)
  58     {
  59         int i;
  60
  61         for (i = 0; i < 16; i++)
  62         {
  63             bug("[AddIntServer] Vector %d, code 0x%p, data 0x%p\n", i, SysBase->IntVects[i].iv_Code, SysBase->IntVects[i].iv_Data);
  64         }
  65         for(;;);
  66     }
  67
  68     Disable();
  69
  70     Enqueue((struct List *)SysBase->IntVects[intNumber].iv_Data, &interrupt->is_Node);
  71     CUSTOM_ENABLE(intNumber);
  72
  73     Enable();
  74
  75     AROS_LIBFUNC_EXIT
  76 } /* AddIntServer */