vxSIS3610InterruptService.cc

Go to the documentation of this file.

/*----------------------------------------------------------------------------*
*  Copyright (c) 2005        Southeastern Universities Research Association, *
*                            Thomas Jefferson National Accelerator Facility  *
*                                                                            *
*    This software was developed under a United States Government license    *
*    described in the NOTICE file included as part of this distribution.     *
*                                                                            *
*    E.Wolin, 31-Oct-2006, Jefferson Lab                                     *
*                                                                            *
*    Authors: Elliott Wolin                                                  *
*             wolin@jlab.org                    Jefferson Lab, MS-6B         *
*             Phone: (757) 269-7365             12000 Jefferson Ave.         *
*             Fax:   (757) 269-5519             Newport News, VA 23606       *
*                                                                            *
*----------------------------------------------------------------------------*/


#include <vxSIS3610InterruptService.hxx>


using namespace std;
using namespace codaObject;


//-----------------------------------------------------------------------------
//-----------------------------------------------------------------------------


namespace codaObject {
  static int dispatcher(int ptr) {
    return ((vxSIS3610InterruptService*)ptr)->dispatchInterrupt();
  }
}


//-----------------------------------------------------------------------------
//-----------------------------------------------------------------------------


vxSIS3610InterruptService::vxSIS3610InterruptService(uint32_t base_addr, uint32_t intMask, int dispatchPriority,
                                                     uint16_t interruptLevel, uint16_t interruptVector) 
  : mySemId(NULL), myBaseAddr(base_addr), myDispatchPriority(dispatchPriority), myIntMask(intMask),
    myInterruptLevel(interruptLevel), myInterruptVector(interruptVector) {
}


//-----------------------------------------------------------------------------


void vxSIS3610InterruptService::ISR(int sem) {
  semGive((SEM_ID)sem);
}
  

//-----------------------------------------------------------------------------


int vxSIS3610InterruptService::dispatchInterrupt(void) {
  
  // loop forever
  while(true) {
    
      // sleep on semaphore
    semTake((SEM_ID)mySemId,WAIT_FOREVER);
    
    // call user interrupt routine if specified
    if(myIntObj!=NULL)myIntObj->interrupt(myIntMask);

    // reenable interrupt
    s3610IntAck(myIntMask);
  }
}


//-----------------------------------------------------------------------------


bool vxSIS3610InterruptService::setupInterrupt(void) {

  int status;
  

  // init 3610 library
  status = s3610Init(myBaseAddr, 0, 0);
  if(status!=0) {
    cerr << "?vxSIS3610InterruptService::setupInterrupt...error return from s3610Init: " << status << endl;
    return(false);
  }

  
  // create new semaphore
  mySemId = semBCreate(SEM_Q_FIFO,SEM_EMPTY);

  
  // supply interrupt routine to library
  //status = s3610IntConnect(0, (VOIDFUNCPTR)ISR, (int)mySemId, myInterruptLevel, myInterruptVector);
  status = s3610IntConnect(0, NULL, (int)mySemId, myInterruptLevel, myInterruptVector);
  if(status!=0) {
    cerr << "?vxSIS3610InterruptService::setupInterrupt...error return from s3610IntConnect: " << status << endl;
    return(false);
  }

  
  // spawn task waiting on semaphore
  myInterruptTaskId = taskSpawn("interruptHandler",myDispatchPriority,0,20000,(int(*)(...))&dispatcher,
                                (int)this,0,0,0,0, 0,0,0,0,0);
  
  return(true);
}


//-----------------------------------------------------------------------------


bool vxSIS3610InterruptService::enableInterrupt(void) {

  s3610IntEnable(myIntMask);
  return(true);
}


//-----------------------------------------------------------------------------


bool vxSIS3610InterruptService::deleteInterrupt(void) {

  // disable triggers and interrupts
  s3610IntDisable(myIntMask);

  // delete interrupt task
  taskDelete(myInterruptTaskId);
  
  // delete old semaphore
  if(mySemId!=NULL)semDelete(mySemId);

  return(true);
}
  

//-----------------------------------------------------------------------------

---