hwdrv_apci3501.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-3501       | Compiler   : GCC                      |
  | Module name : hwdrv_apci3501.c| Version    : 2.96                     |
  +-------------------------------+---------------------------------------+
  | Project manager: Eric Stolz   | Date       :  02/12/2002              |
  +-------------------------------+---------------------------------------+
  | Description :   Hardware Layer Acces For APCI-3501                    |
  +-----------------------------------------------------------------------+
  |                             UPDATES                                   |
  +----------+-----------+------------------------------------------------+
  |   Date   |   Author  |          Description of updates                |
  +----------+-----------+------------------------------------------------+
  |          |           |                                                |
  |          |           |                                                |
  |          |           |                                                |
  +----------+-----------+------------------------------------------------+
*/

/*
+----------------------------------------------------------------------------+
|                               Included files                               |
+----------------------------------------------------------------------------+
*/
#include "hwdrv_apci3501.h"





/*
+----------------------------------------------------------------------------+
| Function   Name   : int i_APCI3501_ReadDigitalInput                    |
|			  (comedi_device *dev,comedi_subdevice *s,               | 
|                      comedi_insn *insn,lsampl_t *data)                     |
+----------------------------------------------------------------------------+
| Task              : Read  value  of the selected channel or port           |
+----------------------------------------------------------------------------+
| Input Parameters  : comedi_device *dev      : Driver handle                |
|                     UINT ui_NoOfChannels    : No Of Channels To read       |
|                     UINT *data              : Data Pointer to read status  |
+----------------------------------------------------------------------------+
| Output Parameters :	--													 |
+----------------------------------------------------------------------------+
| Return Value      : TRUE  : No error occur                                 |
|		            : FALSE : Error occur. Return the error          |
|			                                                         |
+----------------------------------------------------------------------------+
*/

INT i_APCI3501_ReadDigitalInput(comedi_device *dev,comedi_subdevice *s,comedi_insn *insn,lsampl_t *data) 
{ 
   UINT ui_Temp;
   UINT ui_NoOfChannel;
   ui_NoOfChannel=CR_CHAN(insn->chanspec);
   ui_Temp=data[0];
   *data=inl(devpriv->iobase+APCI3501_DIGITAL_IP);
   if  (ui_Temp==0)
      {
      *data=(*data >> ui_NoOfChannel)&0x1; 
      } //if  (ui_Temp==0)
   else
      {
      if  (ui_Temp==1)
         {
              
         *data=*data & 0x3; 
         }//if  (ui_Temp==1)
      else
         {
         printk("\nSpecified channel not supported \n");
         }//elseif  (ui_Temp==1)
       }//elseif  (ui_Temp==0) 
return insn->n;
}

/*
+----------------------------------------------------------------------------+
| Function   Name   : int i_APCI3501_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_APCI3501_ConfigDigitalOutput(comedi_device *dev,comedi_subdevice *s,comedi_insn *insn,lsampl_t *data)
{

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])
return insn->n;
}



/*
+----------------------------------------------------------------------------+
| Function   Name   : int i_APCI3501_WriteDigitalOutput                      |
|			  (comedi_device *dev,comedi_subdevice *s,               | 
|                      comedi_insn *insn,lsampl_t *data)                     |
+----------------------------------------------------------------------------+
| Task              : writes To the digital Output Subdevice                 |
+----------------------------------------------------------------------------+
| Input Parameters  : comedi_device *dev      : Driver handle                |
|                     comedi_subdevice *s     : Subdevice Pointer            |  
|                     comedi_insn *insn       : Insn Structure Pointer       |  
|                     lsampl_t *data          : Data Pointer contains        |
|                                          configuration parameters as below |
|                                                                            | 	
+----------------------------------------------------------------------------+
| Output Parameters :	--													 |
+----------------------------------------------------------------------------+
| Return Value      : TRUE  : No error occur                                 |
|		            : FALSE : Error occur. Return the error          |
|			                                                         |
+----------------------------------------------------------------------------+
*/
INT i_APCI3501_WriteDigitalOutput(comedi_device *dev,comedi_subdevice *s,comedi_insn *insn,lsampl_t *data) 
{
  UINT ui_Temp,ui_Temp1;
UINT ui_NoOfChannel = CR_CHAN(insn->chanspec); // get the channel
 if(devpriv->b_OutputMemoryStatus )
   {
    ui_Temp=inl(devpriv->iobase+APCI3501_DIGITAL_OP);
   }//if(devpriv->b_OutputMemoryStatus )
 else
   {
   ui_Temp=0;
    }//if(devpriv->b_OutputMemoryStatus )
if(data[3]==0)
  { 
  if(data[1]==0)
    {
     data[0]=(data[0] << ui_NoOfChannel)|ui_Temp;
     outl(data[0],devpriv->iobase+APCI3501_DIGITAL_OP);  
    }//if(data[1]==0) 
  else
    {
    if(data[1]==1)
       { 
       data[0]=(data[0] << (2*data[2]))|ui_Temp; 
      outl(data[0],devpriv->iobase+APCI3501_DIGITAL_OP);
     }// if(data[1]==1)
   else
     {
     printk("\nSpecified channel not supported\n");
     }//else if(data[1]==1)
   }//elseif(data[1]==0)
 }//if(data[3]==0)
else
   {
    if(data[3]==1)
       {
        if(data[1]==0)
          {
          data[0]=~data[0]&0x1;
          ui_Temp1=1;
          ui_Temp1=ui_Temp1<<ui_NoOfChannel;
          ui_Temp=ui_Temp|ui_Temp1;  
          data[0]=(data[0] << ui_NoOfChannel)^0xffffffff;
          data[0]=data[0]& ui_Temp; 
          outl(data[0],devpriv->iobase+APCI3501_DIGITAL_OP);  
          }//if(data[1]==0) 
        else
          {
          if(data[1]==1)
             {
             data[0]=~data[0]&0x3; 
             ui_Temp1=3;
             ui_Temp1=ui_Temp1<<2*data[2];
             ui_Temp=ui_Temp|ui_Temp1;   
             data[0]=((data[0] << (2*data[2]))^0xffffffff)& ui_Temp;
	     outl(data[0],devpriv->iobase+APCI3501_DIGITAL_OP);
            }// if(data[1]==1)
         else
           {
            printk("\nSpecified channel not supported\n");
           }//else if(data[1]==1)
         }//elseif(data[1]==0)
      }//if(data[3]==1);
   else
      {
       printk("\nSpecified functionality does not exist\n");
       return -EINVAL;
      }//if else data[3]==1)
   }//if else data[3]==0)
return insn->n;
}