]> www.pilppa.org Git - linux-2.6-omap-h63xx.git/blobdiff - drivers/staging/comedi/drivers/addi-data/hwdrv_apci2200.c
Merge branch 'omap-pool'
[linux-2.6-omap-h63xx.git] / drivers / staging / comedi / drivers / addi-data / hwdrv_apci2200.c
diff --git a/drivers/staging/comedi/drivers/addi-data/hwdrv_apci2200.c b/drivers/staging/comedi/drivers/addi-data/hwdrv_apci2200.c
new file mode 100644 (file)
index 0000000..947e18e
--- /dev/null
@@ -0,0 +1,549 @@
+/**
+@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-2200       | Compiler   : GCC                      |
+  | Module name : hwdrv_apci2200.c| Version    : 2.96                     |
+  +-------------------------------+---------------------------------------+
+  | Project manager: Eric Stolz   | Date       :  02/12/2002              |
+  +-------------------------------+---------------------------------------+
+  | Description :   Hardware Layer Acces For APCI-2200                    |
+  +-----------------------------------------------------------------------+
+  |                             UPDATES                                   |
+  +----------+-----------+------------------------------------------------+
+  |   Date   |   Author  |          Description of updates                |
+  +----------+-----------+------------------------------------------------+
+  |          |           |                                                |
+  |          |           |                                                |
+  |          |           |                                                |
+  +----------+-----------+------------------------------------------------+
+*/
+
+/*
++----------------------------------------------------------------------------+
+|                               Included files                               |
++----------------------------------------------------------------------------+
+*/
+#include "hwdrv_apci2200.h"
+
+/*
++----------------------------------------------------------------------------+
+| Function   Name   : int i_APCI2200_Read1DigitalInput                       |
+|                        (struct comedi_device *dev,struct comedi_subdevice *s,               |
+|                      struct comedi_insn *insn,unsigned int *data)                     |
++----------------------------------------------------------------------------+
+| Task              : Return the status of the digital input                 |
++----------------------------------------------------------------------------+
+| Input Parameters  : struct comedi_device *dev      : Driver handle                |
+|                     struct comedi_subdevice *s,   :pointer to subdevice structure
+                       struct 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_APCI2200_Read1DigitalInput(struct comedi_device * dev, struct comedi_subdevice * s,
+       struct 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 + APCI2200_DIGITAL_IP);
+               *data = (ui_TmpValue >> ui_Channel) & 0x1;
+       }                       //if(ui_Channel >= 0 && ui_Channel <=7)
+       else {
+               printk("\nThe specified channel does not exist\n");
+               return -EINVAL; // "sorry channel spec wrong "
+       }                       //else if(ui_Channel >= 0 && ui_Channel <=7)
+
+       return insn->n;
+}
+
+/*
++----------------------------------------------------------------------------+
+| Function   Name   : int i_APCI2200_ReadMoreDigitalInput                    |
+|                        (struct comedi_device *dev,struct comedi_subdevice *s,               |
+|                     struct comedi_insn *insn,unsigned int *data)                      |
++----------------------------------------------------------------------------+
+| Task              : Return the status of the Requested digital inputs      |
++----------------------------------------------------------------------------+
+| Input Parameters  : struct comedi_device *dev      : Driver handle                |
+|                      struct comedi_subdevice *s,   :pointer to subdevice structure
+                       struct 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_APCI2200_ReadMoreDigitalInput(struct comedi_device * dev, struct comedi_subdevice * s,
+       struct 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 + APCI2200_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_APCI2200_ConfigDigitalOutput (struct comedi_device *dev,
+                    struct comedi_subdevice *s struct 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 |
+|                      struct comedi_subdevice *s,   :pointer to subdevice structure
+                       struct 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_APCI2200_ConfigDigitalOutput(struct comedi_device * dev, struct comedi_subdevice * s,
+       struct comedi_insn * insn, unsigned int * data)
+{
+       devpriv->b_OutputMemoryStatus = data[0];
+       return insn->n;
+}
+
+/*
++----------------------------------------------------------------------------+
+| Function   Name   : int i_APCI2200_WriteDigitalOutput                      |
+|                      (struct comedi_device *dev,struct comedi_subdevice *s,struct comedi_insn *insn,
+                     unsigned int *data)                                         |
++----------------------------------------------------------------------------+
+| Task              : Writes port value  To the selected port                |
++----------------------------------------------------------------------------+
+| Input Parameters  : struct comedi_device *dev      : Driver handle                |
+|                     struct comedi_subdevice *s,   :pointer to subdevice structure
+                      struct 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_APCI2200_WriteDigitalOutput(struct comedi_device * dev, struct comedi_subdevice * s,
+       struct comedi_insn * insn, unsigned int * data)
+{
+       UINT ui_Temp, ui_Temp1;
+       UINT ui_NoOfChannel = CR_CHAN(insn->chanspec);  // get the channel
+       if (devpriv->b_OutputMemoryStatus) {
+               ui_Temp = inw(devpriv->iobase + APCI2200_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 + APCI2200_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 + APCI2200_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) ^ 0xffff;
+                               data[0] = data[0] & ui_Temp;
+                               outw(data[0],
+                                       devpriv->iobase + APCI2200_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 +
+                                               APCI2200_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_APCI2200_ReadDigitalOutput                       |
+|                      (struct comedi_device *dev,struct comedi_subdevice *s,struct comedi_insn *insn,
+                    unsigned int *data)                                             |
++----------------------------------------------------------------------------+
+| Task              : Read  value  of the selected channel or port           |
++----------------------------------------------------------------------------+
+| Input Parameters  : struct comedi_device *dev      : Driver handle                |
+|                     struct comedi_subdevice *s,   :pointer to subdevice structure
+                      struct 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_APCI2200_ReadDigitalOutput(struct comedi_device * dev, struct comedi_subdevice * s,
+       struct 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 + APCI2200_DIGITAL_OP);
+       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 8:
+                               *data = (*data >> (8 * data[1])) & 255;
+                               break;
+
+                       case 15:
+                               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_APCI2200_ConfigWatchdog(struct comedi_device *dev,
+                      struct comedi_subdevice *s,struct comedi_insn *insn,unsigned int *data)  |
+|                                                                                   |
++----------------------------------------------------------------------------+
+| Task              : Configures The Watchdog                                |
++----------------------------------------------------------------------------+
+| Input Parameters  :   struct comedi_device *dev      : Driver handle              |
+|                     struct comedi_subdevice *s,   :pointer to subdevice structure
+                      struct 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_APCI2200_ConfigWatchdog(struct comedi_device * dev, struct comedi_subdevice * s,
+       struct comedi_insn * insn, unsigned int * data)
+{
+       if (data[0] == 0) {
+               //Disable the watchdog
+               outw(0x0,
+                       devpriv->iobase + APCI2200_WATCHDOG +
+                       APCI2200_WATCHDOG_ENABLEDISABLE);
+               //Loading the Reload value
+               outw(data[1],
+                       devpriv->iobase + APCI2200_WATCHDOG +
+                       APCI2200_WATCHDOG_RELOAD_VALUE);
+               data[1] = data[1] >> 16;
+               outw(data[1],
+                       devpriv->iobase + APCI2200_WATCHDOG +
+                       APCI2200_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_APCI2200_StartStopWriteWatchdog                  |
+    |                           (struct comedi_device *dev,struct comedi_subdevice *s,
+    struct comedi_insn *insn,unsigned int *data);                      |
+    +----------------------------------------------------------------------------+
+    | Task              : Start / Stop The Watchdog                              |
+    +----------------------------------------------------------------------------+
+    | Input Parameters  : struct comedi_device *dev      : Driver handle                |
+    |                     struct comedi_subdevice *s,   :pointer to subdevice structure
+    struct 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_APCI2200_StartStopWriteWatchdog(struct comedi_device * dev, struct comedi_subdevice * s,
+       struct comedi_insn * insn, unsigned int * data)
+{
+       switch (data[0]) {
+       case 0:         //stop the watchdog
+               outw(0x0, devpriv->iobase + APCI2200_WATCHDOG + APCI2200_WATCHDOG_ENABLEDISABLE);       //disable the watchdog
+               break;
+       case 1:         //start the watchdog
+               outw(0x0001,
+                       devpriv->iobase + APCI2200_WATCHDOG +
+                       APCI2200_WATCHDOG_ENABLEDISABLE);
+               break;
+       case 2:         //Software trigger
+               outw(0x0201,
+                       devpriv->iobase + APCI2200_WATCHDOG +
+                       APCI2200_WATCHDOG_ENABLEDISABLE);
+               break;
+       default:
+               printk("\nSpecified functionality does not exist\n");
+               return -EINVAL;
+       }                       // switch(data[0])
+       return insn->n;
+}
+
+/*
++----------------------------------------------------------------------------+
+| Function   Name   : int i_APCI2200_ReadWatchdog                            |
+|                      (struct comedi_device *dev,struct comedi_subdevice *s,struct comedi_insn *insn,
+                    unsigned int *data);                                            |
++----------------------------------------------------------------------------+
+| Task              : Read The Watchdog                                      |
++----------------------------------------------------------------------------+
+| Input Parameters  :   struct comedi_device *dev      : Driver handle              |
+|                     struct comedi_subdevice *s,   :pointer to subdevice structure
+                      struct 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_APCI2200_ReadWatchdog(struct comedi_device * dev, struct comedi_subdevice * s,
+       struct comedi_insn * insn, unsigned int * data)
+{
+       data[0] =
+               inw(devpriv->iobase + APCI2200_WATCHDOG +
+               APCI2200_WATCHDOG_STATUS) & 0x1;
+       return insn->n;
+}
+
+/*
++----------------------------------------------------------------------------+
+| Function   Name   : int i_APCI2200_Reset(struct comedi_device *dev)               |                                                                                                          |
++----------------------------------------------------------------------------+
+| Task              :resets all the registers                                |
++----------------------------------------------------------------------------+
+| Input Parameters  : struct comedi_device *dev
++----------------------------------------------------------------------------+
+| Output Parameters :  --                                                                                                       |
++----------------------------------------------------------------------------+
+| Return Value      :                                                        |
+|                                                                               |
++----------------------------------------------------------------------------+
+*/
+
+INT i_APCI2200_Reset(struct comedi_device * dev)
+{
+       outw(0x0, devpriv->iobase + APCI2200_DIGITAL_OP);       //RESETS THE DIGITAL OUTPUTS
+       outw(0x0,
+               devpriv->iobase + APCI2200_WATCHDOG +
+               APCI2200_WATCHDOG_ENABLEDISABLE);
+       outw(0x0,
+               devpriv->iobase + APCI2200_WATCHDOG +
+               APCI2200_WATCHDOG_RELOAD_VALUE);
+       outw(0x0,
+               devpriv->iobase + APCI2200_WATCHDOG +
+               APCI2200_WATCHDOG_RELOAD_VALUE + 2);
+       return 0;
+}