rom/kernel/addirqhandler.c

   1 /*
   2     Copyright © 1995-2013, The AROS Development Team. All rights reserved.
   3     $Id$
   4
   5     Desc:
   6 */
   7
   8 #include <aros/kernel.h>
   9 #include <aros/libcall.h>
  10 #include <proto/exec.h>
  11
  12 #include <kernel_base.h>
  13 #include <kernel_cpu.h>
  14 #include <kernel_debug.h>
  15 #include <kernel_interrupts.h>
  16 #include <kernel_objects.h>
  17
  18 /* We use own implementation of bug(), so we don't need aros/debug.h */
  19 #define D(x)
  20
  21 /*****************************************************************************
  22
  23     NAME */
  24 #include <proto/kernel.h>
  25
  26         AROS_LH4(void *, KrnAddIRQHandler,
  27
  28 /*  SYNOPSIS */
  29         AROS_LHA(uint8_t, irq, D0),
  30         AROS_LHA(irqhandler_t *, handler, A0),
  31         AROS_LHA(void *, handlerData, A1),
  32         AROS_LHA(void *, handlerData2, A2),
  33
  34 /*  LOCATION */
  35         struct KernelBase *, KernelBase, 7, Kernel)
  36
  37 /*  FUNCTION
  38         Add a raw hardware IRQ handler to the chain of handlers.
  39
  40     INPUTS
  41         num          - hardware-specific IRQ number
  42         handler      - Pointer to a handler function
  43         handlerData,
  44         handlerData2 - User-defined data which is passed to the
  45                        handler.
  46
  47           Handler function uses a C calling convention and must be
  48           declared as follows:
  49
  50           void IRQHandler(void *handlerData, void *handlerData2)
  51
  52           handlerData and handlerData2 will be values passed to the
  53           KrnAddExceptionHandler() function.
  54
  55           There is no return code for the IRQ handler.
  56
  57     RESULT
  58         An opaque handle that can be used for handler removal or NULL in case
  59         of failure (like unsupported exception number).
  60
  61     NOTES
  62
  63     EXAMPLE
  64
  65     BUGS
  66
  67     SEE ALSO
  68         KrnRemIRQHandler()
  69
  70     INTERNALS
  71
  72 ******************************************************************************/
  73 {
  74     AROS_LIBFUNC_INIT
  75
  76     struct IntrNode *handle = NULL;
  77
  78     D(bug("[KRN] KrnAddIRQHandler(%02x, %012p, %012p, %012p):\n", irq, handler, handlerData, handlerData2));
  79
  80     if (irq < IRQ_COUNT)
  81     {
  82         /* Go to supervisor mode */
  83         (void)goSuper();
  84
  85         handle = krnAllocIntrNode();
  86         D(bug("[KRN] handle=%012p\n", handle));
  87
  88         if (handle)
  89         {
  90             handle->in_Handler = handler;
  91             handle->in_HandlerData = handlerData;
  92             handle->in_HandlerData2 = handlerData2;
  93             handle->in_type = it_interrupt;
  94             handle->in_nr = irq;
  95
  96             Disable();
  97
  98             ADDHEAD(&KernelBase->kb_Interrupts[irq], &handle->in_Node);
  99
 100             ictl_enable_irq(irq, KernelBase);
 101
 102             Enable();
 103         }
 104
 105         goUser();
 106     }
 107
 108     return handle;
 109
 110     AROS_LIBFUNC_EXIT
 111 }
 112
 113 /* Run IRQ handlers */
 114 void krnRunIRQHandlers(struct KernelBase *KernelBase, uint8_t irq)
 115 {
 116     struct IntrNode *in, *in2;
 117
 118     ForeachNodeSafe(&KernelBase->kb_Interrupts[irq], in, in2)
 119     {
 120         irqhandler_t h = in->in_Handler;
 121
 122         h(in->in_HandlerData, in->in_HandlerData2);
 123     }
 124 }