arch/x86_64-pc/exec/cause.c

   1 /*
   2     Copyright © 1995-2001, The AROS Development Team. All rights reserved.
   3     $Id: cause.c 22006 2004-08-05 19:06:53Z stegerg $
   4
   5     Desc: i386native version of Cause().
   6     Lang: english
   7 */
   8
   9 #include <exec/execbase.h>
  10 #include <aros/asmcall.h>
  11 #include <aros/kernel.h>
  12 #include <exec/interrupts.h>
  13 #include <hardware/custom.h>
  14 #include <hardware/intbits.h>
  15 #include <proto/exec.h>
  16 #include <proto/kernel.h>
  17
  18 #include <exec_intern.h>
  19
  20 AROS_LH1(void, Cause,
  21          AROS_LHA(struct Interrupt *, softint, A1),
  22          struct ExecBase *, SysBase, 30, Exec)
  23 {
  24     AROS_LIBFUNC_INIT
  25
  26     UBYTE pri;
  27     Disable();
  28     /* Check to ensure that this node is not already in a list. */
  29     if( softint->is_Node.ln_Type != NT_SOFTINT )
  30     {
  31         /* Scale the priority down to a number between 0 and 4 inclusive
  32         We can use that to index into exec's software interrupt lists. */
  33         pri = (softint->is_Node.ln_Pri + 0x20)>>4;
  34
  35         /* We are accessing an Exec list, protect ourselves. */
  36         ADDTAIL(&SysBase->SoftInts[pri].sh_List, &softint->is_Node);
  37         softint->is_Node.ln_Type = NT_SOFTINT;
  38         SysBase->SysFlags |= SFF_SoftInt;
  39
  40         /* If we are in usermode the software interrupt will end up
  41            being triggered in Enable(). See Enable() code */
  42     }
  43     Enable();
  44
  45     AROS_LIBFUNC_EXIT
  46 } /* Cause() */
  47
  48
  49 AROS_UFH5(void, SoftIntDispatch,
  50           AROS_UFHA(ULONG, intReady, D1),
  51           AROS_UFHA(struct Custom *, custom, A0),
  52           AROS_UFHA(IPTR, intData, A1),
  53           AROS_UFHA(IPTR, intCode, A5),
  54           AROS_UFHA(struct ExecBase *, SysBase, A6))
  55 {
  56     AROS_USERFUNC_INIT
  57
  58     void *KernelBase = TLS_GET(KernelBase);
  59
  60     struct Interrupt *intr = 0;
  61     BYTE i;
  62
  63     if( SysBase->SysFlags & SFF_SoftInt )
  64     {
  65         /* Clear the Software interrupt pending flag. */
  66         SysBase->SysFlags &= ~(SFF_SoftInt);
  67
  68         for(;;)
  69         {
  70             for(i=4; i>=0; i--)
  71             {
  72                 KrnCli();
  73                 intr = (struct Interrupt *)RemHead(&SysBase->SoftInts[i].sh_List);
  74
  75                 if (intr)
  76                 {
  77                     intr->is_Node.ln_Type = NT_INTERRUPT;
  78
  79                     KrnSti();
  80
  81                     /* Call the software interrupt. */
  82                     AROS_UFC3(void, intr->is_Code,
  83                               AROS_UFCA(APTR, intr->is_Data, A1),
  84                               AROS_UFCA(APTR, intr->is_Code, A5),
  85                               AROS_UFCA(struct ExecBase *, SysBase, A6));
  86
  87                     /* Get out and start loop *all* over again *from scratch*! */
  88                     break;
  89                 }
  90             }
  91
  92             if (!intr) break;
  93         }
  94     }
  95     AROS_USERFUNC_EXIT
  96 }
  97