arch/m68k-amiga/cia/ableicr.c

   1 /*
   2     Copyright © 2010, The AROS Development Team. All rights reserved.
   3     $Id:$
   4
   5     Desc: AbleICR() function.
   6     Lang: english
   7 */
   8
   9 #include <exec/libraries.h>
  10 #include <proto/cia.h>
  11 #include <proto/exec.h>
  12 #include <hardware/cia.h>
  13 #include <hardware/custom.h>
  14 #include <hardware/intbits.h>
  15
  16 #include "cia_intern.h"
  17
  18 AROS_LH1(WORD, AbleICR,
  19          AROS_LHA(WORD, mask, D0),
  20          struct Library *, resource, 3, Cia)
  21 {
  22     AROS_LIBFUNC_INIT
  23
  24     struct CIABase *CiaBase = (struct CIABase *)resource;
  25     volatile struct Custom *custom = (struct Custom *)0xdff000;
  26     UBYTE old;
  27
  28     Disable();
  29
  30     old = CiaBase->enable_mask;
  31
  32     if (mask & 0x80)
  33         CiaBase->enable_mask |= mask & 0x1f;
  34     else
  35         CiaBase->enable_mask &= ~mask;
  36
  37     CiaBase->hw->ciaicr = mask;
  38     // do we need to trigger the interrupt now?
  39     if (CiaBase->enable_mask & CiaBase->active_mask)
  40         custom->intreq = INTF_SETCLR | CiaBase->inten_mask;
  41
  42     Enable();
  43
  44     return old;
  45
  46     AROS_LIBFUNC_EXIT
  47 }