source: cmedia/trunk/Lib32/irq.c@ 559

/* $Id: irq.c,v 1.1 2000/04/23 14:55:37 ktk Exp $ */

//******************************************************************************
// OS/2 implementation of Linux irq kernel services
//
// Copyright 2000 Sander van Leeuwen (sandervl@xs4all.nl)
//
//     This program is free software; you can redistribute it and/or
//     modify it under the terms of the GNU General Public License as
//     published by the Free Software Foundation; either version 2 of
//     the License, or (at your option) any later version.
//
//     This program is distributed in the hope that it will be useful,
//     but WITHOUT ANY WARRANTY; without even the implied warranty of
//     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
//     GNU General Public License for more details.
//
//     You should have received a copy of the GNU General Public
//     License along with this program; if not, write to the Free
//     Software Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139,
//     USA.
//
//******************************************************************************
#define INCL_NOPMAPI
#define INCL_DOSERRORS           // for ERROR_INVALID_FUNCTION
#include <os2.h>
#include <ossidc.h>
#include "irqos2.h"

unsigned long volatile jiffies = 0;

static IRQ_SLOT         arSlots[MAX_SLOTS] = { 0 };


//******************************************************************************
//******************************************************************************

static IRQ_SLOT *FindSlot(unsigned irq)
{
  IRQ_SLOT      *pSlot;

  for( pSlot = arSlots; pSlot != &arSlots[MAX_SLOTS]; pSlot++ )
  {
    if( pSlot->irqNo == irq )   return pSlot;
  }

  return NULL;
}


//******************************************************************************
//******************************************************************************

int request_irq(unsigned int irq,
                void (*handler)(int, void *, void *),
                unsigned long x0, const char *x1, void *x2)
{
  unsigned      u;
  IRQ_SLOT      *pSlot = FindSlot(irq);

  if( !pSlot )          pSlot = FindSlot(0);

  if( pSlot )
  {
    for( u = 0; u < MAX_SHAREDIRQS; u++ )
    {
      if( pSlot->irqHandlers[u].handler == NULL )
      {
        pSlot->irqNo = irq;

        pSlot->irqHandlers[u].handler = handler;
        pSlot->irqHandlers[u].x0 = x0;
        pSlot->irqHandlers[u].x1 = (char *)x1;
        pSlot->irqHandlers[u].x2 = x2;

        if( pSlot->flHandlers != 0 || OSS32_SetIrq(irq, (ULONG)pSlot) )
        {
          pSlot->flHandlers |= 1 << u;
          return 0;
        }

        break;
      }
    }
  }

  dprintf(("request_irq: Unable to register irq handler for irq %d\n", irq));
  return 1;
}


//******************************************************************************
//******************************************************************************
void free_irq(unsigned int irq, void *userdata)
{
  unsigned      u;
  IRQ_SLOT      *pSlot = FindSlot(irq);

  if( pSlot )
  {
    for( u = 0; u < MAX_SHAREDIRQS; u++ )
    {
      if( pSlot->irqHandlers[u].x2 == userdata )
      {
        pSlot->flHandlers &= ~(1 << u);
        if( pSlot->flHandlers == 0 )
        {
          OSS32_FreeIrq(pSlot->irqNo);
          pSlot->irqNo = 0;
          pSlot->fEOI = 0;
        }

        pSlot->irqHandlers[u].handler = NULL;
        pSlot->irqHandlers[u].x0 = 0;
        pSlot->irqHandlers[u].x1 = NULL;
        pSlot->irqHandlers[u].x2 = NULL;

        return;
      }
    }
  }
}


//******************************************************************************
//******************************************************************************
void eoi_irq(unsigned int irq)
{
  IRQ_SLOT      *pSlot = FindSlot(irq);

  if( pSlot )   pSlot->fEOI = 1;
}


//******************************************************************************
//******************************************************************************
BOOL _cdecl oss_process_interrupt(int irq, unsigned long param)
{
  unsigned      u;
  IRQ_SLOT      *pSlot = (IRQ_SLOT *)param;

  (void)irq;

  for( u = 0; u < MAX_SHAREDIRQS; u++ )
  {
    if( pSlot->irqHandlers[u].handler )
    {
      pSlot->irqHandlers[u].handler(pSlot->irqNo, pSlot->irqHandlers[u].x2, 0);
      if( pSlot->fEOI ) { pSlot->fEOI = 0; return TRUE; }
    }
  }

  return FALSE;
}