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

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

#include "hwdrv_apci2032.h"
UINT ui_InterruptData,ui_Type;
/*
+----------------------------------------------------------------------------+
| Function   Name   : int i_APCI2032_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_APCI2032_ConfigDigitalOutput(comedi_device *dev,comedi_subdevice *s,comedi_insn *insn,lsampl_t *data)
{
  ULONG  ul_Command = 0; 
 devpriv->tsk_Current=current; 

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;
     }//elseif  (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;
     }//elseif  (data[2] == ADDIDATA_ENABLE)
  outl( ul_Command , devpriv->iobase+APCI2032_DIGITAL_OP_INTERRUPT);
 ui_InterruptData=inl( devpriv->iobase+APCI2032_DIGITAL_OP_INTERRUPT); 
return insn->n;
}

/*
+----------------------------------------------------------------------------+
| Function   Name   : int i_APCI2032_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_APCI2032_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+APCI2032_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+APCI2032_DIGITAL_OP);  
    }//if(data[1]==0) 
  else
    {
    if(data[1]==1)
       { 
       switch( ui_NoOfChannel)
	 {

	 case 2: data[0]=(data[0] << (2*data[2]))|ui_Temp; 
	       break;


	 case 4:data[0]=(data[0] << (4*data[2]))|ui_Temp;
	       break;

	 case 8: 
	          data[0]=(data[0] <<(8*data[2]))|ui_Temp;  
                  break;
 
         case 16: 
                 data[0]=(data[0] <<(16*data[2]))|ui_Temp;
                 break;
         case 31:data[0]=data[0]|ui_Temp; 
                 break;
         
         default:
 	          comedi_error(dev," chan spec wrong");
		  return -EINVAL;   // "sorry channel spec wrong "  
                

         }//switch(ui_NoOfChannels)
   
     outl(data[0],devpriv->iobase+APCI2032_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+APCI2032_DIGITAL_OP);  
          }//if(data[1]==0) 
        else
          {
          if(data[1]==1)
             { 
             switch( ui_NoOfChannel)
	       {

	       case 2: 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; 
	               break;


	       case 4:data[0]=~data[0]&0xf;
                      ui_Temp1=15;
                      ui_Temp1=ui_Temp1<<4*data[2];
                      ui_Temp=ui_Temp|ui_Temp1;    
                      data[0]=((data[0] << (4*data[2]))^0xffffffff)&ui_Temp;
	              break;

	        case 8:data[0]=~data[0]&0xff;
                       ui_Temp1=255;
                       ui_Temp1=ui_Temp1<<8*data[2];
                       ui_Temp=ui_Temp|ui_Temp1;    
                       data[0]=((data[0] << (8*data[2]))^0xffffffff)&ui_Temp;  
	               break;
 
                case 16:data[0]=~data[0]&0xffff;
                       ui_Temp1=65535;
                       ui_Temp1=ui_Temp1<<16*data[2];
                       ui_Temp=ui_Temp|ui_Temp1;    
                       data[0]=((data[0] << (16*data[2]))^0xffffffff)&ui_Temp;  
	               break;
                        
               case 31: break;
               default:
 	              comedi_error(dev," chan spec wrong");
		      return -EINVAL;   // "sorry channel spec wrong "  
                

              }//switch(ui_NoOfChannels)
   
            outl(data[0],devpriv->iobase+APCI2032_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);;
}


/*
+----------------------------------------------------------------------------+
| Function   Name   : int i_APCI2032_ReadDigitalOutput                       |
|			  (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                                 |