arch/m68k-amiga/cia/seticr.c

   1 /*
   2     Copyright © 2010, The AROS Development Team. All rights reserved.
   3     $Id$
   4
   5     Desc: SetICR() 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, SetICR,
  19          AROS_LHA(WORD, mask, D0),
  20          struct Library *, resource, 4, Cia)
  21 {
  22     AROS_LIBFUNC_INIT
  23
  24     struct CIABase *CiaBase = (struct CIABase *)resource;
  25     volatile struct Custom *custom = (struct Custom*)0xdff000;
  26     WORD old;
  27
  28     Disable();
  29
  30     // I think this needs to return interrupt=active status
  31     // if called inside CIA interrupt handler
  32     CiaBase->active_mask |= CiaBase->hw->ciaicr & 0x1f;
  33     old = CiaBase->active_mask | CiaBase->executing_mask;
  34     if (mask & 0x80)
  35         CiaBase->active_mask |= mask & 0x1f;
  36     else
  37         CiaBase->active_mask &= ~mask;
  38
  39     // do we need to trigger the interrupt now?
  40     if (CiaBase->enable_mask & CiaBase->active_mask)
  41         custom->intreq = INTF_SETCLR | CiaBase->inten_mask;
  42
  43     Enable();
  44
  45     return old;
  46
  47     AROS_LIBFUNC_EXIT
  48 }