hwdrv_apci1564.c

最新版comedi的源码

/**
@verbatim

Copyright (C) 2004,2005  ADDI-DATA GmbH for the source code of this module. 
        
        ADDI-DATA GmbH 
        Dieselstrasse 3 
        D-77833 Ottersweier 
        Tel: [phone] 
        Fax: [phone] 
        http://www.addi-data-com 
        [e-mail] 

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., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA

You shoud also find the complete GPL in the COPYING file accompanying this source code.

@endverbatim
*/
/*
    
  +-----------------------------------------------------------------------+
  | (C) ADDI-DATA GmbH          Dieselstraße 3       D-77833 Ottersweier  |
  +-----------------------------------------------------------------------+
  | Tel : [phone]     | email    : [e-mail]         |
  | Fax : [phone]    | Internet : http://www.addi-data.com   |
  +-------------------------------+---------------------------------------+
  | Project     : APCI-1564       | Compiler   : GCC                      |
  | Module name : hwdrv_apci1564.c| Version    : 2.96                     |
  +-------------------------------+---------------------------------------+
  | Project manager: Eric Stolz   | Date       :  02/12/2002              |
  +-------------------------------+---------------------------------------+
  | Description :   Hardware Layer Acces For APCI-1564                    |
  +-----------------------------------------------------------------------+
  |                             UPDATES                                   |
  +----------+-----------+------------------------------------------------+
  |   Date   |   Author  |          Description of updates                |
  +----------+-----------+------------------------------------------------+
  |          |           |                                                |
  |          |           |                                                |
  |          |           |                                                |
  +----------+-----------+------------------------------------------------+
*/

/*
+----------------------------------------------------------------------------+
|                               Included files                               |
+----------------------------------------------------------------------------+
*/

#include <linux/delay.h>
#include "hwdrv_apci1564.h"

//Global variables
UINT ui_InterruptStatus_1564=0 ;
UINT ui_InterruptData,ui_Type;

/*
+----------------------------------------------------------------------------+
| Function   Name   : int i_APCI1564_ConfigDigitalInput                      |
|			  (comedi_device *dev,comedi_subdevice *s,               | 
|                      comedi_insn *insn,lsampl_t *data)                     |
+----------------------------------------------------------------------------+
| Task              : Configures the digital input Subdevice                 |
+----------------------------------------------------------------------------+
| Input Parameters  : comedi_device *dev : Driver handle                     |
|                     lsampl_t *data         : Data Pointer contains         |
|                                          configuration parameters as below |
|                                                                            | 
|			  data[0]            : 1 Enable  Digital Input Interrupt | 	
|								   0 Disable Digital Input Interrupt | 
|			  data[1]            : 0 ADDIDATA Interrupt OR LOGIC	 | 
|								 : 1 ADDIDATA Interrupt AND LOGIC    | 
|			  data[2]			 : Interrupt mask for the mode 1	 | 
|			  data[3]			 : Interrupt mask for the mode 2	 |
|																	 |
+----------------------------------------------------------------------------+
| Output Parameters :	--													 |
+----------------------------------------------------------------------------+
| Return Value      : TRUE  : No error occur                                 |
|		            : FALSE : Error occur. Return the error          |
|			                                                         |
+----------------------------------------------------------------------------+
*/
INT i_APCI1564_ConfigDigitalInput(comedi_device *dev,comedi_subdevice *s,comedi_insn *insn,lsampl_t *data) 
{
   devpriv->tsk_Current=current;
   /*******************************/
   /* Set the digital input logic */
   /*******************************/
   if  ( data[0] == ADDIDATA_ENABLE)
      {
      data[2]=data[2]<<4;
      data[3]=data[3]<<4;
      outl (data[2] , devpriv->i_IobaseAmcc + APCI1564_DIGITAL_IP + APCI1564_DIGITAL_IP_INTERRUPT_MODE1);
      outl (data[3] , devpriv->i_IobaseAmcc + APCI1564_DIGITAL_IP + APCI1564_DIGITAL_IP_INTERRUPT_MODE2);
      if  (data[1] == ADDIDATA_OR)
         {
         outl(0x4 ,devpriv->i_IobaseAmcc + APCI1564_DIGITAL_IP + APCI1564_DIGITAL_IP_IRQ);
         } // if  (data[1] == ADDIDATA_OR)
      else
         { 
         outl(0x6 ,devpriv->i_IobaseAmcc + APCI1564_DIGITAL_IP + APCI1564_DIGITAL_IP_IRQ);
         } // else if  (data[1] == ADDIDATA_OR)
      } // if  (data[0] == ADDIDATA_ENABLE)
   else
      {
      outl (0x0, devpriv->i_IobaseAmcc +APCI1564_DIGITAL_IP +APCI1564_DIGITAL_IP_INTERRUPT_MODE1);
      outl (0x0, devpriv->i_IobaseAmcc +APCI1564_DIGITAL_IP +APCI1564_DIGITAL_IP_INTERRUPT_MODE2);
      outl(0x0 ,devpriv->i_IobaseAmcc + APCI1564_DIGITAL_IP +APCI1564_DIGITAL_IP_IRQ);
      } // else if  (data[0] == ADDIDATA_ENABLE)
  
   return insn->n;
}

/*
+----------------------------------------------------------------------------+
| Function   Name   : int i_APCI1564_Read1DigitalInput                       |
|			  (comedi_device *dev,comedi_subdevice *s,               |
|                      comedi_insn *insn,lsampl_t *data)                     |
+----------------------------------------------------------------------------+
| Task              : Return the status of the digital input                 |
+----------------------------------------------------------------------------+
| Input Parameters  : comedi_device *dev      : Driver handle                |
|		              UINT ui_Channel : Channel number to read       |
|                     lsampl_t *data          : Data Pointer to read status  |
+----------------------------------------------------------------------------+
| Output Parameters :	--													 |
+----------------------------------------------------------------------------+
| Return Value      : TRUE  : No error occur                                 |
|		            : FALSE : Error occur. Return the error          |
|			                                                         |
+----------------------------------------------------------------------------+
*/
INT i_APCI1564_Read1DigitalInput(comedi_device *dev,comedi_subdevice *s,comedi_insn *insn,lsampl_t *data)
{
   UINT ui_TmpValue=0;
   UINT ui_Channel;
   
   ui_Channel=CR_CHAN(insn->chanspec);
   if  (ui_Channel >= 0 && ui_Channel <=31)
      {
      ui_TmpValue=(UINT) inl(devpriv->i_IobaseAmcc + APCI1564_DIGITAL_IP );
      //  since only 1 channel reqd  to bring it to last bit it is rotated 
      //  8 +(chan - 1) times then ANDed with 1 for last bit. 
      *data = (ui_TmpValue >> ui_Channel)&0x1 ;
      } // if  (ui_Channel >= 0 && ui_Channel <=31)
   else 
      {
      comedi_error(dev,"Not a valid channel number !!! \n");  
      return -EINVAL;   // "sorry channel spec wrong "
      }  //else if  (ui_Channel >= 0 && ui_Channel <=31)
   return insn->n;
}

/*
+----------------------------------------------------------------------------+
| Function   Name   : int i_APCI1564_ReadMoreDigitalInput                    |
|			  (comedi_device *dev,comedi_subdevice *s,               |
|                     comedi_insn *insn,lsampl_t *data)                      |
+----------------------------------------------------------------------------+
| Task              : Return the status of the Requested digital inputs      |
+----------------------------------------------------------------------------+
| Input Parameters  : comedi_device *dev      : Driver handle                |
|                     UINT ui_NoOfChannels    : No Of Channels To be Read    |
|                      UINT *data             : Data Pointer to read status  |
+----------------------------------------------------------------------------+
| Output Parameters :	--													 |
+----------------------------------------------------------------------------+
| Return Value      : TRUE  : No error occur                                 |
|		            : FALSE : Error occur. Return the error          |
|			                                                         |
+----------------------------------------------------------------------------+
*/
INT i_APCI1564_ReadMoreDigitalInput(comedi_device *dev,comedi_subdevice *s,comedi_insn *insn,lsampl_t *data)
{
   UINT ui_PortValue=data[0];
   UINT ui_Mask=0;
   UINT ui_NoOfChannels;
   
   ui_NoOfChannels=CR_CHAN(insn->chanspec);
   if  (data[1]==0)
      {
      *data=(UINT)inl(devpriv->i_IobaseAmcc + APCI1564_DIGITAL_IP );
      switch (ui_NoOfChannels)
	 {
	 case 2: ui_Mask=3;
                 *data=(*data >>(2*ui_PortValue))&ui_Mask; 
                 break;
	 case 4: ui_Mask=15;
                 *data=(*data >>(4*ui_PortValue))&ui_Mask; 
	         break;
	 case 8: ui_Mask=255;
	         *data=(*data >>(8*ui_PortValue))&ui_Mask;  
                 break;
         case 16:ui_Mask=65535;
                 *data=(*data >>(16*ui_PortValue))&ui_Mask;
                 break;
         case 31:break;
         default:
                comedi_error(dev,"Not a valid Channel number !!!\n");  
		return -EINVAL;   // "sorry channel spec wrong "  
                break;
         } // switch  (ui_NoOfChannels)
      } // if  (data[1]==0)
   else
      {
      if  (data[1]==1)
         {
         *data=ui_InterruptStatus_1564;
         } // if  (data[1]==1)
      } // else if  (data[1]==0)   
   return insn->n;
}

/*
+----------------------------------------------------------------------------+
| Function   Name   : int i_APCI1564_ConfigDigitalOutput                     |
|			  (comedi_device *dev,comedi_subdevice *s,               | 
|                      comedi_insn *insn,lsampl_t *data)                     |
+----------------------------------------------------------------------------+
| Task              : Configures The Digital Output Subdevice.               |
+----------------------------------------------------------------------------+
| Input Parameters  : comedi_device *dev : Driver handle                     |
|                     UINT *data         : Data Pointer contains             |
|                                          configuration parameters as below |
|                                                                            | 
|					  data[1]            : 1 Enable  VCC  Interrupt  | 	
|										   0 Disable VCC  Interrupt  | 
|					  data[2]            : 1 Enable  CC  Interrupt   | 	
|										   0 Disable CC  Interrupt   | 
|																	 |
+----------------------------------------------------------------------------+
| Output Parameters :	--													 |
+----------------------------------------------------------------------------+
| Return Value      : TRUE  : No error occur                                 |
|		            : FALSE : Error occur. Return the error          |
|			                                                         |
+----------------------------------------------------------------------------+
*/
INT i_APCI1564_ConfigDigitalOutput(comedi_device *dev,comedi_subdevice *s,comedi_insn *insn,lsampl_t *data)
{
   ULONG  ul_Command = 0; 
  
   if  ((data[0]!=0) && (data[0]!=1)) 
      {   
      comedi_error(dev,"Not a valid Data !!! ,Data should be 1 or 0\n");  
      return -EINVAL;
      } // if  ((data[0]!=0) && (data[0]!=1)) 
   if  (data[0])
      {
      devpriv->b_OutputMemoryStatus = ADDIDATA_ENABLE ; 
      } // if  (data[0])
   else
      {
      devpriv->b_OutputMemoryStatus = ADDIDATA_DISABLE;
      } // else if  (data[0])
   if  (data[1] == ADDIDATA_ENABLE)
      {
      ul_Command = ul_Command | 0x1;
      } // if  (data[1] == ADDIDATA_ENABLE)
   else
      {
      ul_Command = ul_Command & 0xFFFFFFFE;
      } // else if  (data[1] == ADDIDATA_ENABLE)
   if  (data[2] == ADDIDATA_ENABLE)
      {
      ul_Command = ul_Command | 0x2;
      } // if  (data[2] == ADDIDATA_ENABLE)
   else
      {
      ul_Command = ul_Command & 0xFFFFFFFD;
      } // else if  (data[2] == ADDIDATA_ENABLE)
   outl( ul_Command , devpriv->i_IobaseAmcc+APCI1564_DIGITAL_OP+APCI1564_DIGITAL_OP_INTERRUPT);
   ui_InterruptData=inl( devpriv->i_IobaseAmcc+APCI1564_DIGITAL_OP+APCI1564_DIGITAL_OP_INTERRUPT); 
   devpriv->tsk_Current=current;  
   return insn->n;
}

/*
+----------------------------------------------------------------------------+
| Function   Name   : int i_APCI1564_WriteDigitalOutput                      |
|			  (comedi_device *dev,comedi_subdevice *s,               | 
|                      comedi_insn *insn,lsampl_t *data)                     |
+----------------------------------------------------------------------------+
| Task              : Writes port value  To the selected port                |
+----------------------------------------------------------------------------+
| Input Parameters  : comedi_device *dev      : Driver handle                |
|                     UINT ui_NoOfChannels    : No Of Channels To Write      |
|                     UINT *data              : Data Pointer to read status  |
+----------------------------------------------------------------------------+
| Output Parameters :	--													 |
+----------------------------------------------------------------------------+
| Return Value      : TRUE  : No error occur                                 |
|		            : FALSE : Error occur. Return the error          |
|			                                                         |
+----------------------------------------------------------------------------+
*/
INT i_APCI1564_WriteDigitalOutput(comedi_device *dev,comedi_subdevice *s,comedi_insn *insn,lsampl_t *data) {
   UINT ui_Temp,ui_Temp1;
   UINT ui_NoOfChannel;
   
   ui_NoOfChannel=CR_CHAN(insn->chanspec);
   if  (devpriv->b_OutputMemoryStatus )
      {
      ui_Temp=inl(devpriv->i_IobaseAmcc + APCI1564_DIGITAL_OP + APCI1564_DIGITAL_OP_RW);
      } // if  (devpriv->b_OutputMemoryStatus )
   else
      {
      ui_Temp=0;
      } // else if  (devpriv->b_OutputMemoryStatus )
   if  (data[3]==0)
      { 
      if  (data[1]==0)
         {