[net-next-2.6.git] / drivers / staging / comedi / drivers / addi-data / hwdrv_apci1516.c

/**
@verbatim

Copyright (C) 2004,2005  ADDI-DATA GmbH for the source code of this module.

        ADDI-DATA GmbH
        Dieselstrasse 3
        D-77833 Ottersweier
        Tel: +19(0)7223/9493-0
        Fax: +49(0)7223/9493-92
        http://www.addi-data-com
        info@addi-data.com

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 : +49 (0) 7223/9493-0     | email    : info@addi-data.com         |
  | Fax : +49 (0) 7223/9493-92    | Internet : http://www.addi-data.com   |
  +-------------------------------+---------------------------------------+
  | Project     : APCI-1516       | Compiler   : GCC                      |
  | Module name : hwdrv_apci1516.c| Version    : 2.96                     |
  +-------------------------------+---------------------------------------+
  | Project manager: Eric Stolz   | Date       :  02/12/2002              |
  +-------------------------------+---------------------------------------+
  | Description :   Hardware Layer Acces For APCI-1516                    |
  +-----------------------------------------------------------------------+
  |                             UPDATES                                   |
  +----------+-----------+------------------------------------------------+
  |   Date   |   Author  |          Description of updates                |
  +----------+-----------+------------------------------------------------+
  |          |           |                                                |
  |          |           |                                                |
  |          |           |                                                |
  +----------+-----------+------------------------------------------------+
*/

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

/*
+----------------------------------------------------------------------------+
| Function   Name   : int i_APCI1516_Read1DigitalInput                       |
|			  (struct comedi_device *dev,comedi_subdevice *s,               |
|                      comedi_insn *insn,unsigned int *data)                     |
+----------------------------------------------------------------------------+
| Task              : Return the status of the digital input                 |
+----------------------------------------------------------------------------+
| Input Parameters  : struct comedi_device *dev      : Driver handle                |
|		       comedi_subdevice *s,   :pointer to subdevice structure
                       comedi_insn *insn      :pointer to insn structure     |
|                     unsigned int *data          : Data Pointer to read status  |
+----------------------------------------------------------------------------+
| Output Parameters :	--													 |
+----------------------------------------------------------------------------+
| Return Value      : TRUE  : No error occur                                 |
|		            : FALSE : Error occur. Return the error          |
|			                                                         |
+----------------------------------------------------------------------------+
*/
INT i_APCI1516_Read1DigitalInput(struct comedi_device * dev, comedi_subdevice * s,
	comedi_insn * insn, unsigned int * data)
{
	UINT ui_TmpValue = 0;
	UINT ui_Channel;
	ui_Channel = CR_CHAN(insn->chanspec);
	if (ui_Channel >= 0 && ui_Channel <= 7) {
		ui_TmpValue = (UINT) inw(devpriv->iobase + APCI1516_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 <=7)
	else {
		//comedi_error(dev," \n chan spec wrong\n");
		return -EINVAL;	// "sorry channel spec wrong "
	}			//else if(ui_Channel >= 0 && ui_Channel <=7)

	return insn->n;
}

/*
+----------------------------------------------------------------------------+
| Function   Name   : int i_APCI1516_ReadMoreDigitalInput                    |
|			  (struct comedi_device *dev,comedi_subdevice *s,               |
|                     comedi_insn *insn,unsigned int *data)                      |
+----------------------------------------------------------------------------+
| Task              : Return the status of the Requested digital inputs      |
+----------------------------------------------------------------------------+
| Input Parameters  : struct comedi_device *dev      : Driver handle                |
|                      comedi_subdevice *s,   :pointer to subdevice structure
                       comedi_insn *insn      :pointer to insn structure     |
|                      unsigned int *data         : Data Pointer to read status  |
+----------------------------------------------------------------------------+
| Output Parameters :	--													 |
+----------------------------------------------------------------------------+
| Return Value      : TRUE  : No error occur                                 |
|		            : FALSE : Error occur. Return the error          |
|			                                                         |
+----------------------------------------------------------------------------+
*/

INT i_APCI1516_ReadMoreDigitalInput(struct comedi_device * dev, comedi_subdevice * s,
	comedi_insn * insn, unsigned int * data)
{

	UINT ui_PortValue = data[0];
	UINT ui_Mask = 0;
	UINT ui_NoOfChannels;

	ui_NoOfChannels = CR_CHAN(insn->chanspec);

	*data = (UINT) inw(devpriv->iobase + APCI1516_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 7:
		break;

	default:
		printk("\nWrong parameters\n");
		return -EINVAL;	// "sorry channel spec wrong "
		break;
	}			//switch(ui_NoOfChannels)

	return insn->n;
}

/*
+----------------------------------------------------------------------------+
| Function   Name   : int i_APCI1516_ConfigDigitalOutput (struct comedi_device *dev,
                    comedi_subdevice *s comedi_insn *insn,unsigned int *data)    |
|				                                                     |
+----------------------------------------------------------------------------+
| Task              : Configures The Digital Output Subdevice.               |
+----------------------------------------------------------------------------+
| Input Parameters  : struct comedi_device *dev : Driver handle                     |
|                     unsigned int *data         : Data Pointer contains         |
|                                          configuration parameters as below |
|                      comedi_subdevice *s,   :pointer to subdevice structure
                       comedi_insn *insn      :pointer to insn structure                                                           |
|					  data[0]  :1:Memory on                          |
|					            0:Memory off                         |
|										                             |
|																	 |
+----------------------------------------------------------------------------+
| Output Parameters :	--													 |
+----------------------------------------------------------------------------+
| Return Value      : TRUE  : No error occur                                 |
|		            : FALSE : Error occur. Return the error          |
|			                                                         |
+----------------------------------------------------------------------------+
*/
int i_APCI1516_ConfigDigitalOutput(struct comedi_device * dev, comedi_subdevice * s,
	comedi_insn * insn, unsigned int * data)
{
	devpriv->b_OutputMemoryStatus = data[0];
	return insn->n;
}

/*
+----------------------------------------------------------------------------+
| Function   Name   : int i_APCI1516_WriteDigitalOutput                      |
|			(struct comedi_device *dev,comedi_subdevice *s,comedi_insn *insn,
                     unsigned int *data)                                         |
+----------------------------------------------------------------------------+
| Task              : Writes port value  To the selected port                |
+----------------------------------------------------------------------------+
| Input Parameters  : struct comedi_device *dev      : Driver handle                |
|                     comedi_subdevice *s,   :pointer to subdevice structure
                      comedi_insn *insn      :pointer to insn structure      |
|                    unsigned int *data           : Data Pointer to read status  |
+----------------------------------------------------------------------------+
| Output Parameters :	--													 |
+----------------------------------------------------------------------------+
| Return Value      : TRUE  : No error occur                                 |
|		            : FALSE : Error occur. Return the error          |
|			                                                         |
+----------------------------------------------------------------------------+
*/

INT i_APCI1516_WriteDigitalOutput(struct comedi_device * dev, comedi_subdevice * s,
	comedi_insn * insn, unsigned int * data)
{
	UINT ui_Temp, ui_Temp1;
	UINT ui_NoOfChannel = CR_CHAN(insn->chanspec);	// get the channel

	printk("EL311003 : @=%x\n", devpriv->iobase + APCI1516_DIGITAL_OP);

	if (devpriv->b_OutputMemoryStatus) {
		ui_Temp = inw(devpriv->iobase + APCI1516_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;
			outw(data[0], devpriv->iobase + APCI1516_DIGITAL_OP);

			printk("EL311003 : d=%d @=%x\n", data[0],
				devpriv->iobase + APCI1516_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 7:
					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 + APCI1516_DIGITAL_OP);

				printk("EL311003 : d=%d @=%x\n", data[0],
					devpriv->iobase + APCI1516_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) ^ 0xff;
				data[0] = data[0] & ui_Temp;
				outw(data[0],
					devpriv->iobase + APCI1516_DIGITAL_OP);

				printk("EL311003 : d=%d @=%x\n", data[0],
					devpriv->iobase + APCI1516_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])) ^
							0xff) & 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])) ^
							0xff) & ui_Temp;
						break;

					case 7:
						break;

					default:
						comedi_error(dev,
							" chan spec wrong");
						return -EINVAL;	// "sorry channel spec wrong "

					}	//switch(ui_NoOfChannels)

					outw(data[0],
						devpriv->iobase +
						APCI1516_DIGITAL_OP);

					printk("EL311003 : d=%d @=%x\n",
						data[0],
						devpriv->iobase +
						APCI1516_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_APCI1516_ReadDigitalOutput                       |
|			(struct comedi_device *dev,comedi_subdevice *s,comedi_insn *insn,
                    unsigned int *data) 	                                     |
+----------------------------------------------------------------------------+
| Task              : Read  value  of the selected channel or port           |
+----------------------------------------------------------------------------+
| Input Parameters  : struct comedi_device *dev      : Driver handle                |
|                     comedi_subdevice *s,   :pointer to subdevice structure
                      comedi_insn *insn      :pointer to insn structure      |
|                     unsigned int *data          : Data Pointer to read status  |
+----------------------------------------------------------------------------+
| Output Parameters :	--													 |
+----------------------------------------------------------------------------+
| Return Value      : TRUE  : No error occur                                 |
|		            : FALSE : Error occur. Return the error          |
|			                                                         |
+----------------------------------------------------------------------------+
*/

INT i_APCI1516_ReadDigitalOutput(struct comedi_device * dev, comedi_subdevice * s,
	comedi_insn * insn, unsigned int * data)
{

	UINT ui_Temp;
	UINT ui_NoOfChannel = CR_CHAN(insn->chanspec);	// get the channel
	ui_Temp = data[0];
	*data = inw(devpriv->iobase + APCI1516_DIGITAL_OP_RW);
	if (ui_Temp == 0) {
		*data = (*data >> ui_NoOfChannel) & 0x1;
	}			//if(ui_Temp==0)
	else {
		if (ui_Temp == 1) {
			switch (ui_NoOfChannel) {

			case 2:
				*data = (*data >> (2 * data[1])) & 3;
				break;

			case 4:
				*data = (*data >> (4 * data[1])) & 15;
				break;

			case 7:
				break;

			default:
				comedi_error(dev, " chan spec wrong");
				return -EINVAL;	// "sorry channel spec wrong "

			}	//switch(ui_NoOfChannels)
		}		//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_APCI1516_ConfigWatchdog(struct comedi_device *dev,
                      comedi_subdevice *s,comedi_insn *insn,unsigned int *data)  |
|				                                                     |
+----------------------------------------------------------------------------+
| Task              : Configures The Watchdog                                |
+----------------------------------------------------------------------------+
| Input Parameters  :   struct comedi_device *dev      : Driver handle              |
|                     comedi_subdevice *s,   :pointer to subdevice structure
                      comedi_insn *insn      :pointer to insn structure      |
|                     unsigned int *data          : Data Pointer to read status                                                     |
+----------------------------------------------------------------------------+
| Output Parameters :	--													 |
+----------------------------------------------------------------------------+
| Return Value      : TRUE  : No error occur                                 |
|		            : FALSE : Error occur. Return the error          |
|			                                                         |
+----------------------------------------------------------------------------+
*/

int i_APCI1516_ConfigWatchdog(struct comedi_device * dev, comedi_subdevice * s,
	comedi_insn * insn, unsigned int * data)
{
	if (data[0] == 0) {
		//Disable the watchdog
		outw(0x0,
			devpriv->i_IobaseAddon +
			APCI1516_WATCHDOG_ENABLEDISABLE);
		//Loading the Reload value
		outw(data[1],
			devpriv->i_IobaseAddon +
			APCI1516_WATCHDOG_RELOAD_VALUE);
		data[1] = data[1] >> 16;
		outw(data[1],
			devpriv->i_IobaseAddon +
			APCI1516_WATCHDOG_RELOAD_VALUE + 2);
	}			//if(data[0]==0)
	else {
		printk("\nThe input parameters are wrong\n");
		return -EINVAL;
	}			//elseif(data[0]==0)

	return insn->n;
}

 /*
    +----------------------------------------------------------------------------+
    | Function   Name   : int i_APCI1516_StartStopWriteWatchdog                  |
    |                           (struct comedi_device *dev,comedi_subdevice *s,
    comedi_insn *insn,unsigned int *data);                      |
    +----------------------------------------------------------------------------+
    | Task              : Start / Stop The Watchdog                              |
    +----------------------------------------------------------------------------+
    | Input Parameters  : struct comedi_device *dev      : Driver handle                |
    |                     comedi_subdevice *s,   :pointer to subdevice structure
    comedi_insn *insn      :pointer to insn structure      |
    |                     unsigned int *data          : Data Pointer to read status  |
    +----------------------------------------------------------------------------+
    | Output Parameters :       --                                                                                                       |
    +----------------------------------------------------------------------------+
    | Return Value      : TRUE  : No error occur                                 |
    |                       : FALSE : Error occur. Return the error          |
    |                                                                            |
    +----------------------------------------------------------------------------+
  */

int i_APCI1516_StartStopWriteWatchdog(struct comedi_device * dev, comedi_subdevice * s,
	comedi_insn * insn, unsigned int * data)
{
	switch (data[0]) {
	case 0:		//stop the watchdog
		outw(0x0, devpriv->i_IobaseAddon + APCI1516_WATCHDOG_ENABLEDISABLE);	//disable the watchdog
		break;
	case 1:		//start the watchdog
		outw(0x0001,
			devpriv->i_IobaseAddon +
			APCI1516_WATCHDOG_ENABLEDISABLE);
		break;
	case 2:		//Software trigger
		outw(0x0201,
			devpriv->i_IobaseAddon +
			APCI1516_WATCHDOG_ENABLEDISABLE);
		break;
	default:
		printk("\nSpecified functionality does not exist\n");
		return -EINVAL;
	}			// switch(data[0])
	return insn->n;
}

/*
+----------------------------------------------------------------------------+
| Function   Name   : int i_APCI1516_ReadWatchdog                            |
|			(struct comedi_device *dev,comedi_subdevice *s,comedi_insn *insn,
                    unsigned int *data); 	                                     |
+----------------------------------------------------------------------------+
| Task              : Read The Watchdog                                      |
+----------------------------------------------------------------------------+
| Input Parameters  :   struct comedi_device *dev      : Driver handle              |
|                     comedi_subdevice *s,   :pointer to subdevice structure
                      comedi_insn *insn      :pointer to insn structure      |
|                     unsigned int *data          : Data Pointer to read status  |
+----------------------------------------------------------------------------+
| Output Parameters :	--													 |
+----------------------------------------------------------------------------+
| Return Value      : TRUE  : No error occur                                 |
|		            : FALSE : Error occur. Return the error          |
|			                                                         |
+----------------------------------------------------------------------------+
*/

int i_APCI1516_ReadWatchdog(struct comedi_device * dev, comedi_subdevice * s,
	comedi_insn * insn, unsigned int * data)
{
	data[0] = inw(devpriv->i_IobaseAddon + APCI1516_WATCHDOG_STATUS) & 0x1;
	return insn->n;
}

/*
+----------------------------------------------------------------------------+
| Function   Name   : int i_APCI1516_Reset(struct comedi_device *dev)               |                                                                                                          |
+----------------------------------------------------------------------------+
| Task              :resets all the registers                                |
+----------------------------------------------------------------------------+
| Input Parameters  : struct comedi_device *dev
+----------------------------------------------------------------------------+
| Output Parameters :	--													 |
+----------------------------------------------------------------------------+
| Return Value      :                                                        |
|			                                                         |
+----------------------------------------------------------------------------+
*/

INT i_APCI1516_Reset(struct comedi_device * dev)
{
	outw(0x0, devpriv->iobase + APCI1516_DIGITAL_OP);	//RESETS THE DIGITAL OUTPUTS
	outw(0x0, devpriv->i_IobaseAddon + APCI1516_WATCHDOG_ENABLEDISABLE);
	outw(0x0, devpriv->i_IobaseAddon + APCI1516_WATCHDOG_RELOAD_VALUE);
	outw(0x0, devpriv->i_IobaseAddon + APCI1516_WATCHDOG_RELOAD_VALUE + 2);
	return 0;
}
Commit	Line	Data
c995fe94 ADG	1	/**
	2	@verbatim
	3
	4	Copyright (C) 2004,2005 ADDI-DATA GmbH for the source code of this module.
	5
	6	ADDI-DATA GmbH
	7	Dieselstrasse 3
	8	D-77833 Ottersweier
	9	Tel: +19(0)7223/9493-0
	10	Fax: +49(0)7223/9493-92
	11	http://www.addi-data-com
	12	info@addi-data.com
	13
	14	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.
	15
	16	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.
	17
	18	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
	19
	20	You shoud also find the complete GPL in the COPYING file accompanying this source code.
	21
	22	@endverbatim
	23	*/
	24	/*
	25
	26	+-----------------------------------------------------------------------+
	27	\| (C) ADDI-DATA GmbH Dieselstraße 3 D-77833 Ottersweier \|
	28	+-----------------------------------------------------------------------+
	29	\| Tel : +49 (0) 7223/9493-0 \| email : info@addi-data.com \|
	30	\| Fax : +49 (0) 7223/9493-92 \| Internet : http://www.addi-data.com \|
	31	+-------------------------------+---------------------------------------+
	32	\| Project : APCI-1516 \| Compiler : GCC \|
	33	\| Module name : hwdrv_apci1516.c\| Version : 2.96 \|
	34	+-------------------------------+---------------------------------------+
	35	\| Project manager: Eric Stolz \| Date : 02/12/2002 \|
	36	+-------------------------------+---------------------------------------+
	37	\| Description : Hardware Layer Acces For APCI-1516 \|
	38	+-----------------------------------------------------------------------+
	39	\| UPDATES \|
	40	+----------+-----------+------------------------------------------------+
	41	\| Date \| Author \| Description of updates \|
	42	+----------+-----------+------------------------------------------------+
	43	\| \| \| \|
	44	\| \| \| \|
	45	\| \| \| \|
	46	+----------+-----------+------------------------------------------------+
	47	*/
	48
	49	/*
	50	+----------------------------------------------------------------------------+
	51	\| Included files \|
	52	+----------------------------------------------------------------------------+
	53	*/
	54	#include "hwdrv_apci1516.h"
	55
	56	/*
	57	+----------------------------------------------------------------------------+
	58	\| Function Name : int i_APCI1516_Read1DigitalInput \|
71b5f4f1	59	\| (struct comedi_device dev,comedi_subdevice s, \|
790c5541	60	\| comedi_insn insn,unsigned int data) \|
c995fe94 ADG	61	+----------------------------------------------------------------------------+
	62	\| Task : Return the status of the digital input \|
	63	+----------------------------------------------------------------------------+
71b5f4f1	64	\| Input Parameters : struct comedi_device *dev : Driver handle \|
c995fe94 ADG	65	\| comedi_subdevice *s, :pointer to subdevice structure
c995fe94 ADG	66	comedi_insn *insn :pointer to insn structure \|
790c5541	67	\| unsigned int *data : Data Pointer to read status \|
c995fe94 ADG	68	+----------------------------------------------------------------------------+
	69	\| Output Parameters : -- \|
	70	+----------------------------------------------------------------------------+
	71	\| Return Value : TRUE : No error occur \|
	72	\| : FALSE : Error occur. Return the error \|
	73	\| \|
	74	+----------------------------------------------------------------------------+
	75	*/
71b5f4f1	76	INT i_APCI1516_Read1DigitalInput(struct comedi_device * dev, comedi_subdevice * s,
790c5541	77	comedi_insn * insn, unsigned int * data)
c995fe94 ADG	78	{
	79	UINT ui_TmpValue = 0;
	80	UINT ui_Channel;
	81	ui_Channel = CR_CHAN(insn->chanspec);
	82	if (ui_Channel >= 0 && ui_Channel <= 7) {
	83	ui_TmpValue = (UINT) inw(devpriv->iobase + APCI1516_DIGITAL_IP);
	84	// since only 1 channel reqd to bring it to last bit it is rotated
	85	// 8 +(chan - 1) times then ANDed with 1 for last bit.
	86	*data = (ui_TmpValue >> ui_Channel) & 0x1;
	87	} //if(ui_Channel >= 0 && ui_Channel <=7)
	88	else {
	89	//comedi_error(dev," \n chan spec wrong\n");
	90	return -EINVAL; // "sorry channel spec wrong "
	91	} //else if(ui_Channel >= 0 && ui_Channel <=7)
	92
	93	return insn->n;
	94	}
	95
	96	/*
	97	+----------------------------------------------------------------------------+
	98	\| Function Name : int i_APCI1516_ReadMoreDigitalInput \|
71b5f4f1	99	\| (struct comedi_device dev,comedi_subdevice s, \|
790c5541	100	\| comedi_insn insn,unsigned int data) \|
c995fe94 ADG	101	+----------------------------------------------------------------------------+
	102	\| Task : Return the status of the Requested digital inputs \|
	103	+----------------------------------------------------------------------------+
71b5f4f1	104	\| Input Parameters : struct comedi_device *dev : Driver handle \|
c995fe94 ADG	105	\| comedi_subdevice *s, :pointer to subdevice structure
c995fe94 ADG	106	comedi_insn *insn :pointer to insn structure \|
790c5541	107	\| unsigned int *data : Data Pointer to read status \|
c995fe94 ADG	108	+----------------------------------------------------------------------------+
	109	\| Output Parameters : -- \|
	110	+----------------------------------------------------------------------------+
	111	\| Return Value : TRUE : No error occur \|
	112	\| : FALSE : Error occur. Return the error \|
	113	\| \|
	114	+----------------------------------------------------------------------------+
	115	*/
	116
71b5f4f1	117	INT i_APCI1516_ReadMoreDigitalInput(struct comedi_device * dev, comedi_subdevice * s,
790c5541	118	comedi_insn * insn, unsigned int * data)
c995fe94 ADG	119	{
	120
	121	UINT ui_PortValue = data[0];
	122	UINT ui_Mask = 0;
	123	UINT ui_NoOfChannels;
	124
	125	ui_NoOfChannels = CR_CHAN(insn->chanspec);
	126
	127	*data = (UINT) inw(devpriv->iobase + APCI1516_DIGITAL_IP);
	128	switch (ui_NoOfChannels) {
	129	case 2:
	130	ui_Mask = 3;
	131	data = (data >> (2 * ui_PortValue)) & ui_Mask;
	132	break;
	133	case 4:
	134	ui_Mask = 15;
	135	data = (data >> (4 * ui_PortValue)) & ui_Mask;
	136	break;
	137	case 7:
	138	break;
	139
	140	default:
	141	printk("\nWrong parameters\n");
	142	return -EINVAL; // "sorry channel spec wrong "
	143	break;
	144	} //switch(ui_NoOfChannels)
	145
	146	return insn->n;
	147	}
	148
	149	/*
	150	+----------------------------------------------------------------------------+
71b5f4f1	151	\| Function Name : int i_APCI1516_ConfigDigitalOutput (struct comedi_device *dev,
790c5541	152	comedi_subdevice s comedi_insn insn,unsigned int *data) \|
c995fe94 ADG	153	\| \|
	154	+----------------------------------------------------------------------------+
	155	\| Task : Configures The Digital Output Subdevice. \|
	156	+----------------------------------------------------------------------------+
71b5f4f1	157	\| Input Parameters : struct comedi_device *dev : Driver handle \|
790c5541	158	\| unsigned int *data : Data Pointer contains \|
c995fe94 ADG	159	\| configuration parameters as below \|
	160	\| comedi_subdevice *s, :pointer to subdevice structure
	161	comedi_insn *insn :pointer to insn structure \|
	162	\| data[0] :1:Memory on \|
	163	\| 0:Memory off \|
	164	\| \|
	165	\| \|
	166	+----------------------------------------------------------------------------+
	167	\| Output Parameters : -- \|
	168	+----------------------------------------------------------------------------+
	169	\| Return Value : TRUE : No error occur \|
	170	\| : FALSE : Error occur. Return the error \|
	171	\| \|
	172	+----------------------------------------------------------------------------+
	173	*/
71b5f4f1	174	int i_APCI1516_ConfigDigitalOutput(struct comedi_device * dev, comedi_subdevice * s,
790c5541	175	comedi_insn * insn, unsigned int * data)
c995fe94 ADG	176	{
	177	devpriv->b_OutputMemoryStatus = data[0];
	178	return insn->n;
	179	}
	180
	181	/*
	182	+----------------------------------------------------------------------------+
	183	\| Function Name : int i_APCI1516_WriteDigitalOutput \|
71b5f4f1	184	\| (struct comedi_device dev,comedi_subdevice s,comedi_insn *insn,
790c5541	185	unsigned int *data) \|
c995fe94 ADG	186	+----------------------------------------------------------------------------+
	187	\| Task : Writes port value To the selected port \|
	188	+----------------------------------------------------------------------------+
71b5f4f1	189	\| Input Parameters : struct comedi_device *dev : Driver handle \|
c995fe94 ADG	190	\| comedi_subdevice *s, :pointer to subdevice structure
c995fe94 ADG	191	comedi_insn *insn :pointer to insn structure \|
790c5541	192	\| unsigned int *data : Data Pointer to read status \|
c995fe94 ADG	193	+----------------------------------------------------------------------------+
	194	\| Output Parameters : -- \|
	195	+----------------------------------------------------------------------------+
	196	\| Return Value : TRUE : No error occur \|
	197	\| : FALSE : Error occur. Return the error \|
	198	\| \|
	199	+----------------------------------------------------------------------------+
	200	*/
	201
71b5f4f1	202	INT i_APCI1516_WriteDigitalOutput(struct comedi_device * dev, comedi_subdevice * s,
790c5541	203	comedi_insn * insn, unsigned int * data)
c995fe94 ADG	204	{
	205	UINT ui_Temp, ui_Temp1;
	206	UINT ui_NoOfChannel = CR_CHAN(insn->chanspec); // get the channel
	207
	208	printk("EL311003 : @=%x\n", devpriv->iobase + APCI1516_DIGITAL_OP);
	209
	210	if (devpriv->b_OutputMemoryStatus) {
	211	ui_Temp = inw(devpriv->iobase + APCI1516_DIGITAL_OP);
	212
	213	} //if(devpriv->b_OutputMemoryStatus )
	214	else {
	215	ui_Temp = 0;
	216	} //if(devpriv->b_OutputMemoryStatus )
	217	if (data[3] == 0) {
	218	if (data[1] == 0) {
	219	data[0] = (data[0] << ui_NoOfChannel) \| ui_Temp;
	220	outw(data[0], devpriv->iobase + APCI1516_DIGITAL_OP);
	221
	222	printk("EL311003 : d=%d @=%x\n", data[0],
	223	devpriv->iobase + APCI1516_DIGITAL_OP);
	224
	225	} //if(data[1]==0)
	226	else {
	227	if (data[1] == 1) {
	228	switch (ui_NoOfChannel) {
	229
	230	case 2:
	231	data[0] =
	232	(data[0] << (2 *
	233	data[2])) \| ui_Temp;
	234	break;
	235
	236	case 4:
	237	data[0] =
	238	(data[0] << (4 *
	239	data[2])) \| ui_Temp;
	240	break;
	241
	242	case 7:
	243	data[0] = data[0] \| ui_Temp;
	244	break;
	245
	246	default:
	247	comedi_error(dev, " chan spec wrong");
	248	return -EINVAL; // "sorry channel spec wrong "
	249
	250	} //switch(ui_NoOfChannels)
	251
	252	outw(data[0],
	253	devpriv->iobase + APCI1516_DIGITAL_OP);
	254
	255	printk("EL311003 : d=%d @=%x\n", data[0],
	256	devpriv->iobase + APCI1516_DIGITAL_OP);
	257	} // if(data[1]==1)
	258	else {
	259	printk("\nSpecified channel not supported\n");
	260	} //else if(data[1]==1)
	261	} //elseif(data[1]==0)
	262	} //if(data[3]==0)
	263	else {
	264	if (data[3] == 1) {
	265	if (data[1] == 0) {
	266	data[0] = ~data[0] & 0x1;
	267	ui_Temp1 = 1;
268	ui_Temp1 = ui_Temp1 << ui_NoOfChannel;
269	ui_Temp = ui_Temp \| ui_Temp1;
270	data[0] = (data[0] << ui_NoOfChannel) ^ 0xff;
271	data[0] = data[0] & ui_Temp;
272	outw(data[0],
273	devpriv->iobase + APCI1516_DIGITAL_OP);
274
275	printk("EL311003 : d=%d @=%x\n", data[0],
276	devpriv->iobase + APCI1516_DIGITAL_OP);
277
278	} //if(data[1]==0)
279	else {
280	if (data[1] == 1) {
281	switch (ui_NoOfChannel) {
282
283	case 2:
284	data[0] = ~data[0] & 0x3;
285	ui_Temp1 = 3;
286	ui_Temp1 =
287	ui_Temp1 << 2 * data[2];
288	ui_Temp = ui_Temp \| ui_Temp1;
289	data[0] =
290	((data[0] << (2 *
291	data
292	[2])) ^
293	0xff) & ui_Temp;
294	break;
295
296	case 4:
297	data[0] = ~data[0] & 0xf;
298	ui_Temp1 = 15;
299	ui_Temp1 =
300	ui_Temp1 << 4 * data[2];
301	ui_Temp = ui_Temp \| ui_Temp1;
302	data[0] =
303	((data[0] << (4 *
304	data
305	[2])) ^
306	0xff) & ui_Temp;
307	break;
308
309	case 7:
310	break;
311
312	default:
313	comedi_error(dev,
314	" chan spec wrong");
315	return -EINVAL; // "sorry channel spec wrong "
316
317	} //switch(ui_NoOfChannels)
318
319	outw(data[0],
320	devpriv->iobase +
321	APCI1516_DIGITAL_OP);
322
323	printk("EL311003 : d=%d @=%x\n",
324	data[0],
325	devpriv->iobase +
326	APCI1516_DIGITAL_OP);
327	} // if(data[1]==1)
328	else {
329	printk("\nSpecified channel not supported\n");
330	} //else if(data[1]==1)
331	} //elseif(data[1]==0)
332	} //if(data[3]==1);
333	else {
334	printk("\nSpecified functionality does not exist\n");
335	return -EINVAL;
336	} //if else data[3]==1)
337	} //if else data[3]==0)
338	return (insn->n);;
339	}
340
341	/*
342	+----------------------------------------------------------------------------+
343	\| Function Name : int i_APCI1516_ReadDigitalOutput \|
71b5f4f1	344	\| (struct comedi_device dev,comedi_subdevice s,comedi_insn *insn,
790c5541	345	unsigned int *data) \|
c995fe94 ADG	346	+----------------------------------------------------------------------------+
	347	\| Task : Read value of the selected channel or port \|
	348	+----------------------------------------------------------------------------+
71b5f4f1	349	\| Input Parameters : struct comedi_device *dev : Driver handle \|
c995fe94 ADG	350	\| comedi_subdevice *s, :pointer to subdevice structure
c995fe94 ADG	351	comedi_insn *insn :pointer to insn structure \|
790c5541	352	\| unsigned int *data : Data Pointer to read status \|
c995fe94 ADG	353	+----------------------------------------------------------------------------+
	354	\| Output Parameters : -- \|
	355	+----------------------------------------------------------------------------+
	356	\| Return Value : TRUE : No error occur \|
	357	\| : FALSE : Error occur. Return the error \|
	358	\| \|
	359	+----------------------------------------------------------------------------+
	360	*/
	361
71b5f4f1	362	INT i_APCI1516_ReadDigitalOutput(struct comedi_device * dev, comedi_subdevice * s,
790c5541	363	comedi_insn * insn, unsigned int * data)
c995fe94 ADG	364	{
	365
	366	UINT ui_Temp;
	367	UINT ui_NoOfChannel = CR_CHAN(insn->chanspec); // get the channel
	368	ui_Temp = data[0];
	369	*data = inw(devpriv->iobase + APCI1516_DIGITAL_OP_RW);
	370	if (ui_Temp == 0) {
	371	data = (data >> ui_NoOfChannel) & 0x1;
	372	} //if(ui_Temp==0)
	373	else {
	374	if (ui_Temp == 1) {
	375	switch (ui_NoOfChannel) {
	376
	377	case 2:
	378	data = (data >> (2 * data[1])) & 3;
	379	break;
	380
	381	case 4:
	382	data = (data >> (4 * data[1])) & 15;
	383	break;
	384
	385	case 7:
	386	break;
	387
	388	default:
	389	comedi_error(dev, " chan spec wrong");
	390	return -EINVAL; // "sorry channel spec wrong "
	391
	392	} //switch(ui_NoOfChannels)
	393	} //if(ui_Temp==1)
	394	else {
	395	printk("\nSpecified channel not supported \n");
	396	} //elseif(ui_Temp==1)
	397	} //elseif(ui_Temp==0)
	398	return insn->n;
	399	}
	400
	401	/*
	402	+----------------------------------------------------------------------------+
71b5f4f1	403	\| Function Name : int i_APCI1516_ConfigWatchdog(struct comedi_device *dev,
790c5541	404	comedi_subdevice s,comedi_insn insn,unsigned int *data) \|
c995fe94 ADG	405	\| \|
	406	+----------------------------------------------------------------------------+
	407	\| Task : Configures The Watchdog \|
	408	+----------------------------------------------------------------------------+
71b5f4f1	409	\| Input Parameters : struct comedi_device *dev : Driver handle \|
c995fe94 ADG	410	\| comedi_subdevice *s, :pointer to subdevice structure
c995fe94 ADG	411	comedi_insn *insn :pointer to insn structure \|
790c5541	412	\| unsigned int *data : Data Pointer to read status \|
c995fe94 ADG	413	+----------------------------------------------------------------------------+
	414	\| Output Parameters : -- \|
	415	+----------------------------------------------------------------------------+
	416	\| Return Value : TRUE : No error occur \|
	417	\| : FALSE : Error occur. Return the error \|
	418	\| \|
	419	+----------------------------------------------------------------------------+
	420	*/
	421
71b5f4f1	422	int i_APCI1516_ConfigWatchdog(struct comedi_device * dev, comedi_subdevice * s,
790c5541	423	comedi_insn * insn, unsigned int * data)
c995fe94 ADG	424	{
	425	if (data[0] == 0) {
	426	//Disable the watchdog
	427	outw(0x0,
	428	devpriv->i_IobaseAddon +
	429	APCI1516_WATCHDOG_ENABLEDISABLE);
	430	//Loading the Reload value
	431	outw(data[1],
	432	devpriv->i_IobaseAddon +
	433	APCI1516_WATCHDOG_RELOAD_VALUE);
	434	data[1] = data[1] >> 16;
	435	outw(data[1],
	436	devpriv->i_IobaseAddon +
	437	APCI1516_WATCHDOG_RELOAD_VALUE + 2);
	438	} //if(data[0]==0)
	439	else {
	440	printk("\nThe input parameters are wrong\n");
	441	return -EINVAL;
	442	} //elseif(data[0]==0)
	443
	444	return insn->n;
	445	}
	446
	447	/*
	448	+----------------------------------------------------------------------------+
	449	\| Function Name : int i_APCI1516_StartStopWriteWatchdog \|
71b5f4f1	450	\| (struct comedi_device dev,comedi_subdevice s,
790c5541	451	comedi_insn insn,unsigned int data); \|
c995fe94 ADG	452	+----------------------------------------------------------------------------+
	453	\| Task : Start / Stop The Watchdog \|
	454	+----------------------------------------------------------------------------+
71b5f4f1	455	\| Input Parameters : struct comedi_device *dev : Driver handle \|
c995fe94 ADG	456	\| comedi_subdevice *s, :pointer to subdevice structure
c995fe94 ADG	457	comedi_insn *insn :pointer to insn structure \|
790c5541	458	\| unsigned int *data : Data Pointer to read status \|
c995fe94 ADG	459	+----------------------------------------------------------------------------+
	460	\| Output Parameters : -- \|
	461	+----------------------------------------------------------------------------+
	462	\| Return Value : TRUE : No error occur \|
	463	\| : FALSE : Error occur. Return the error \|
	464	\| \|
	465	+----------------------------------------------------------------------------+
	466	*/
	467
71b5f4f1	468	int i_APCI1516_StartStopWriteWatchdog(struct comedi_device * dev, comedi_subdevice * s,
790c5541	469	comedi_insn * insn, unsigned int * data)
c995fe94 ADG	470	{
	471	switch (data[0]) {
	472	case 0: //stop the watchdog
	473	outw(0x0, devpriv->i_IobaseAddon + APCI1516_WATCHDOG_ENABLEDISABLE); //disable the watchdog
	474	break;
	475	case 1: //start the watchdog
	476	outw(0x0001,
	477	devpriv->i_IobaseAddon +
	478	APCI1516_WATCHDOG_ENABLEDISABLE);
	479	break;
	480	case 2: //Software trigger
	481	outw(0x0201,
	482	devpriv->i_IobaseAddon +
	483	APCI1516_WATCHDOG_ENABLEDISABLE);
	484	break;
	485	default:
	486	printk("\nSpecified functionality does not exist\n");
	487	return -EINVAL;
	488	} // switch(data[0])
	489	return insn->n;
	490	}
	491
	492	/*
	493	+----------------------------------------------------------------------------+
	494	\| Function Name : int i_APCI1516_ReadWatchdog \|
71b5f4f1	495	\| (struct comedi_device dev,comedi_subdevice s,comedi_insn *insn,
790c5541	496	unsigned int *data); \|
c995fe94 ADG	497	+----------------------------------------------------------------------------+
	498	\| Task : Read The Watchdog \|
	499	+----------------------------------------------------------------------------+
71b5f4f1	500	\| Input Parameters : struct comedi_device *dev : Driver handle \|
c995fe94 ADG	501	\| comedi_subdevice *s, :pointer to subdevice structure
c995fe94 ADG	502	comedi_insn *insn :pointer to insn structure \|
790c5541	503	\| unsigned int *data : Data Pointer to read status \|
c995fe94 ADG	504	+----------------------------------------------------------------------------+
	505	\| Output Parameters : -- \|
	506	+----------------------------------------------------------------------------+
	507	\| Return Value : TRUE : No error occur \|
	508	\| : FALSE : Error occur. Return the error \|
	509	\| \|
	510	+----------------------------------------------------------------------------+
	511	*/
	512
71b5f4f1	513	int i_APCI1516_ReadWatchdog(struct comedi_device * dev, comedi_subdevice * s,
790c5541	514	comedi_insn * insn, unsigned int * data)
c995fe94 ADG	515	{
	516	data[0] = inw(devpriv->i_IobaseAddon + APCI1516_WATCHDOG_STATUS) & 0x1;
	517	return insn->n;
	518	}
	519
	520	/*
	521	+----------------------------------------------------------------------------+
71b5f4f1	522	\| Function Name : int i_APCI1516_Reset(struct comedi_device *dev) \| \|
c995fe94 ADG	523	+----------------------------------------------------------------------------+
	524	\| Task :resets all the registers \|
	525	+----------------------------------------------------------------------------+
71b5f4f1	526	\| Input Parameters : struct comedi_device *dev
c995fe94 ADG	527	+----------------------------------------------------------------------------+
	528	\| Output Parameters : -- \|
	529	+----------------------------------------------------------------------------+
	530	\| Return Value : \|
	531	\| \|
	532	+----------------------------------------------------------------------------+
	533	*/
	534
71b5f4f1	535	INT i_APCI1516_Reset(struct comedi_device * dev)
c995fe94 ADG	536	{
	537	outw(0x0, devpriv->iobase + APCI1516_DIGITAL_OP); //RESETS THE DIGITAL OUTPUTS
	538	outw(0x0, devpriv->i_IobaseAddon + APCI1516_WATCHDOG_ENABLEDISABLE);
	539	outw(0x0, devpriv->i_IobaseAddon + APCI1516_WATCHDOG_RELOAD_VALUE);
	540	outw(0x0, devpriv->i_IobaseAddon + APCI1516_WATCHDOG_RELOAD_VALUE + 2);
	541	return 0;
	542	}