apci1710_dig_io.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     : API APCI1710    | Compiler : gcc                        |
  | Module name : DIG_IO.C        | Version  : 2.96                       |
  +-------------------------------+---------------------------------------+
  | Project manager: Eric Stolz   | Date     :  02/12/2002                |
  +-----------------------------------------------------------------------+
  | Description :   APCI-1710 digital I/O module                          |
  |                                                                       |
  |                                                                       |
  +-----------------------------------------------------------------------+
  |                             UPDATES                                   |
  +-----------------------------------------------------------------------+
  |   Date   |   Author  |          Description of updates                |
  +----------+-----------+------------------------------------------------+
  | 16/06/98 | S. Weber  | Digital input / output implementation          |
  |----------|-----------|------------------------------------------------|
  | 08/05/00 | Guinot C  | - 0400/0228 All Function in RING 0             |
  |          |           |   available                                    |
  +-----------------------------------------------------------------------+
  |          |           |                                                |
  |          |           |                                                |
  +-----------------------------------------------------------------------+
*/

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


/*
+----------------------------------------------------------------------------+
| Function Name     : INT i_APCI1710_InsnConfigDigitalIO(comedi_device *dev, |
|						comedi_subdevice *s,comedi_insn *insn,lsampl_t *data)|
+----------------------------------------------------------------------------+
| Task              : Configure the digital I/O operating mode from selected |
|                     module  (b_ModulNbr). You must calling this function be|
|                     for you call any other function witch access of digital|
|                     I/O.                                                   |
+----------------------------------------------------------------------------+
| Input Parameters  :													     |
|                  BYTE_ b_ModulNbr      data[0]: Module number to               |
|                                             configure (0 to 3)             |
|                     BYTE_ b_ChannelAMode data[1]  : Channel A mode selection       |
|                                             0 : Channel used for digital   |
|                                                 input                      |
|                                             1 : Channel used for digital   |
|                                                 output                     |
|                     BYTE_ b_ChannelBMode data[2] : Channel B mode selection       |
|                                             0 : Channel used for digital   |
|                                                 input                      |
|                                             1 : Channel used for digital   |
|                                                 output					 |                                          
						data[0]	  memory on/off
Activates and deactivates the digital output memory. 
						After having      |
|                 called up this function with memory on,the output you have previously|
|                     activated with the function are not reset
+----------------------------------------------------------------------------+
| Output Parameters : -                                                      |
+----------------------------------------------------------------------------+
| Return Value      : 0: No error                                            |
|                    -1: The handle parameter of the board is wrong          |
|                    -2: The module parameter is wrong                       |
|                    -3: The module is not a digital I/O module              |
|                    -4: Bi-directional channel A configuration error        |
|                    -5: Bi-directional channel B configuration error        |
+----------------------------------------------------------------------------+
*/

INT i_APCI1710_InsnConfigDigitalIO(comedi_device *dev,comedi_subdevice *s,
	comedi_insn *insn,lsampl_t *data)
    {
	BYTE   b_ModulNbr,b_ChannelAMode,b_ChannelBMode ;
        BYTE   b_MemoryOnOff,b_ConfigType;
	INT    i_ReturnValue = 0;
	DWORD  dw_WriteConfig = 0;
	
	b_ModulNbr		=	(BYTE) CR_AREF(insn->chanspec);
        b_ConfigType
   =   (BYTE) data[0];// Memory or  Init
	b_ChannelAMode	=	(BYTE) data[1];
	b_ChannelBMode	=	(BYTE) data[2];
        b_MemoryOnOff   =	(BYTE) data[1]; // if memory operation 
 	i_ReturnValue   =   insn->n;

  
		/**************************/
		/* Test the module number */
		/**************************/

		if (b_ModulNbr >= 4)
		{
			DPRINTK("Module Number invalid\n");
			i_ReturnValue = -2;
                    return i_ReturnValue;   
		}	
            switch(b_ConfigType)
	       {
               case APCI1710_DIGIO_MEMORYONOFF:	

        	if(b_MemoryOnOff) // If Memory ON
		{
		 /****************************/
		 /* Set the output memory on */
		 /****************************/

		 devpriv->s_ModuleInfo [b_ModulNbr].
		 s_DigitalIOInfo.
		 b_OutputMemoryEnabled = 1;

		 /***************************/
		 /* Clear the output memory */
		 /***************************/
		 devpriv->s_ModuleInfo [b_ModulNbr].
		 s_DigitalIOInfo.
		 dw_OutputMemory = 0;
		}
		else   // If memory off
		{
		 /*****************************/
		 /* Set the output memory off */
		 /*****************************/

		 devpriv->s_ModuleInfo [b_ModulNbr].
		 s_DigitalIOInfo.
		 b_OutputMemoryEnabled = 0;	
        	}
	        break;

        case APCI1710_DIGIO_INIT:
            
	/*******************************/
	/* Test if digital I/O counter */
	/*******************************/

        if((devpriv->s_BoardInfos.dw_MolduleConfiguration [b_ModulNbr] & 0xFFFF0000UL) == APCI1710_DIGITAL_IO)
	{

	/***************************************************/
	/* Test the bi-directional channel A configuration */
	/***************************************************/
          
			if ((b_ChannelAMode == 0) || (b_ChannelAMode == 1))
			{
	/***************************************************/
	/* Test the bi-directional channel B configuration */
	/***************************************************/

				if ((b_ChannelBMode == 0) || (b_ChannelBMode == 1))
				{
					 devpriv->s_ModuleInfo [b_ModulNbr].
						s_DigitalIOInfo.
						b_DigitalInit = 1;

	/********************************/
	/* Save channel A configuration */
	/********************************/

					devpriv->s_ModuleInfo [b_ModulNbr].
						s_DigitalIOInfo.
						b_ChannelAMode = b_ChannelAMode;

	/********************************/
	/* Save channel B configuration */
	/********************************/

					devpriv->s_ModuleInfo [b_ModulNbr].
						s_DigitalIOInfo.
						b_ChannelBMode = b_ChannelBMode;

	/*****************************************/
	/* Set the channel A and B configuration */
	/*****************************************/


		    dw_WriteConfig = (DWORD) (b_ChannelAMode | (b_ChannelBMode * 2));

	/***************************/
	/* Write the configuration */
	/***************************/

			 outl(dw_WriteConfig,devpriv->s_BoardInfos.ui_Address + 4 + (64 * b_ModulNbr));

			}
            else
			{
	/************************************************/
	/* Bi-directional channel B configuration error */
	/************************************************/	
			 DPRINTK("Bi-directional channel B configuration error\n");	
			 i_ReturnValue = -5;  
			}		

		}
        else
		 {
	/************************************************/
	/* Bi-directional channel A configuration error */
	/************************************************/
			DPRINTK("Bi-directional channel A configuration error\n");	
			i_ReturnValue = -4; 
		 
		 } 

	}
	else
	 {
	/******************************************/
	/* The module is not a digital I/O module */
	/******************************************/
			DPRINTK("The module is not a digital I/O module\n");	
			i_ReturnValue = -3;
     }
    } // end of Switch 
     printk("Return Value %d\n",i_ReturnValue);  
     return i_ReturnValue;
}

/*
+----------------------------------------------------------------------------+
|                            INPUT FUNCTIONS                                 |
+----------------------------------------------------------------------------+
*/

/*
+----------------------------------------------------------------------------+

|INT i_APCI1710_InsnReadDigitalIOChlValue(comedi_device *dev,comedi_subdevice 
*s,	comedi_insn *insn,lsampl_t *data)

+----------------------------------------------------------------------------+
| Task              : Read the status from selected digital I/O digital input|
|                     (b_InputChannel)                                       |
+----------------------------------------------------------------------------|

  
|
|  BYTE_ b_ModulNbr  CR_AREF(chanspec)          : Selected module number   |
|                                                   (0 to 3)                 |
|  BYTE_ b_InputChannel CR_CHAN(chanspec)        : Selection from digital   |
|                                                   input ( 0 to 6)          |
|                                                      0 : Channel C         |
|                                                      1 : Channel D         |
|                                                      2 : Channel E         |
|                                                      3 : Channel F         |
|                                                      4 : Channel G         |
|                                                      5 : Channel A         |
|                                                      6 : Channel B   

  
	|
+----------------------------------------------------------------------------+
| Output Parameters :					 data[0]   : Digital input channel    |
|                                                   status                   |
|                                                   0 : Channle is not active|
|                                                   1 : Channle is active    |
+----------------------------------------------------------------------------+
| Return Value      : 0: No error                                            |
|                    -1: The handle parameter of the board is wrong          |
|                    -2: The module parameter is wrong                       |
|                    -3: The module is not a digital I/O module              |
|                    -4: The selected digital I/O digital input is wrong     |
|                    -5: Digital I/O not initialised                         |
|                    -6: The digital channel A is used for output            |
|                    -7: The digital channel B is used for output            |
+----------------------------------------------------------------------------+
*/

//_INT_   i_APCI1710_ReadDigitalIOChlValue      (BYTE_    b_BoardHandle,
//					       BYTE_    b_ModulNbr,
//					       BYTE_    b_InputChannel,
//
//					       PBYTE_  pb_ChannelStatus)
INT i_APCI1710_InsnReadDigitalIOChlValue(comedi_device *dev,comedi_subdevice *s,
	comedi_insn *insn,lsampl_t *data)
{
	INT    i_ReturnValue = 0;
	DWORD dw_StatusReg;
	BYTE    b_ModulNbr,b_InputChannel;
        PBYTE  pb_ChannelStatus;
	b_ModulNbr		= (BYTE) CR_AREF(insn->chanspec);
        b_InputChannel	= (BYTE) CR_CHAN(insn->chanspec);
        data[0]=0;
        pb_ChannelStatus= (PBYTE) &data[0];
        i_ReturnValue = insn->n;


	/**************************/
	/* Test the module number */
	/**************************/

	if (b_ModulNbr < 4)
	   {
	   /*******************************/
	   /* Test if digital I/O counter */
	   /*******************************/

	   if ((devpriv->s_BoardInfos.dw_MolduleConfiguration [b_ModulNbr] & 0xFFFF0000UL) == APCI1710_DIGITAL_IO)
	      {
	      /******************************************/
	      /* Test the digital imnput channel number */
	      /******************************************/

	      if (b_InputChannel <= 6)
		 {
		 /**********************************************/