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

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

/*
+----------------------------------------------------------------------------+
| Function   Name   : int i_APCI2016_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[0]            : 1 Digital Memory On               | 	
|				     			   0 Digital Memory Off              | 
+----------------------------------------------------------------------------+
| Output Parameters :	--													 |
+----------------------------------------------------------------------------+
| Return Value      : TRUE  : No error occur                                 |
|		            : FALSE : Error occur. Return the error          |
|			                                                         |
+----------------------------------------------------------------------------+
*/
int i_APCI2016_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_APCI2016_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_APCI2016_WriteDigitalOutput(comedi_device *dev,comedi_subdevice *s,comedi_insn *insn,lsampl_t *data)  
{
   UINT  ui_NoOfChannel;
   UINT ui_Temp,ui_Temp1;
   ui_NoOfChannel=CR_CHAN(insn->chanspec);
   if  ((ui_NoOfChannel<0) || (ui_NoOfChannel>15)) 
      {   
      comedi_error(dev,"Invalid Channel Numbers !!!, Channel Numbers must be between 0 and 15\n");  
      return -EINVAL;
      } // if  ((ui_NoOfChannel<0) || (ui_NoOfChannel>15))
   if  (devpriv->b_OutputMemoryStatus )
      {
      ui_Temp=inw(devpriv->iobase+APCI2016_DIGITAL_OP);
      } // if  (devpriv->b_OutputMemoryStatus )
   else
      { 
      ui_Temp=0;
      } // else if  (devpriv->b_OutputMemoryStatus )
   if  ((data[1]!=0) && (data[1]!=1)) 
      {   
      comedi_error(dev,"Invalid Data[1] value !!!, Data[1] should be 0 or 1\n");  
      return -EINVAL;
      } // if  ((data[1]!=0) && (data[1]!=1))
  
   if  (data[3]==0)
      { 
      if  (data[1]==0)
         {
         data[0]=(data[0] << ui_NoOfChannel)|ui_Temp;
         outw(data[0],devpriv->iobase+APCI2016_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 15: data[0]=data[0]|ui_Temp; 
                        break;
               default: comedi_error(dev," chan spec wrong");
                        return -EINVAL;   // "sorry channel spec wrong "  
               }//switch(ui_NoOfChannels)
            outw(data[0],devpriv->iobase+APCI2016_DIGITAL_OP);
            }// if  (data[1]==1)
         else
            {
            printk("\nSpecified channel not supported\n");
            } // else if  (data[1]==1)
         } // else if (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)^0xffff;
            data[0]=data[0]& ui_Temp; 
            outw(data[0],devpriv->iobase+APCI2016_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]))^0xffff)& 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]))^0xffff)&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]))^0xffff)&ui_Temp;
                          break;
                 case 15: break;
                 default: comedi_error(dev," chan spec wrong");
        		      return -EINVAL;   // "sorry channel spec wrong "  
                 }//switch(ui_NoOfChannels)
              outw(data[0],devpriv->iobase+APCI2016_DIGITAL_OP);
              }// if(data[1]==1)
           else
              {
              printk("\nSpecified channel not supported\n");