rom/kernel/remirqhandler.c

   1 #include <aros/kernel.h>
   2 #include <aros/libcall.h>
   3 #include <proto/exec.h>
   4
   5 #include <kernel_base.h>
   6 #include <kernel_debug.h>
   7 #include <kernel_cpu.h>
   8 #include <kernel_interrupts.h>
   9 #include <kernel_memory.h>
  10
  11 /* We use own implementation of bug(), so we don't need aros/debug.h */
  12 #define D(x)
  13
  14 /*****************************************************************************
  15
  16     NAME */
  17 #include <proto/kernel.h>
  18
  19 AROS_LH1(void, KrnRemIRQHandler,
  20
  21 /*  SYNOPSIS */
  22          AROS_LHA(void *, handle, A0),
  23
  24 /*  LOCATION */
  25          struct KernelBase *, KernelBase, 8, Kernel)
  26
  27 /*  FUNCTION
  28         Remove previously installed hardware IRQ handler
  29
  30     INPUTS
  31         handle - an opaque handler returned by KrnAddIRQHandler()
  32                  function
  33
  34     RESULT
  35         None
  36
  37     NOTES
  38
  39     EXAMPLE
  40
  41     BUGS
  42
  43     SEE ALSO
  44
  45     INTERNALS
  46
  47 ******************************************************************************/
  48 {
  49     AROS_LIBFUNC_INIT
  50
  51     struct IntrNode *h = handle;
  52     uint8_t irq = h->in_nr;
  53
  54     if (h && (h->in_type == it_interrupt))
  55     {
  56         (void)goSuper();
  57
  58         Disable();
  59         REMOVE(h);
  60         if (IsListEmpty(&KernelBase->kb_Interrupts[irq]))
  61         {
  62                 ictl_disable_irq(irq, KernelBase);
  63         }
  64         Enable();
  65
  66         krnFreeMem(h, sizeof(struct IntrNode));
  67
  68         goUser();
  69     }
  70
  71     AROS_LIBFUNC_EXIT
  72 }