| /** |
| @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 should 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-2032 | Compiler : GCC | |
| | Module name : hwdrv_apci2032.c| Version : 2.96 | |
| +-------------------------------+---------------------------------------+ |
| | Project manager: Eric Stolz | Date : 02/12/2002 | |
| +-------------------------------+---------------------------------------+ |
| | Description : Hardware Layer Access For APCI-2032 | |
| +-----------------------------------------------------------------------+ |
| | UPDATES | |
| +----------+-----------+------------------------------------------------+ |
| | Date | Author | Description of updates | |
| +----------+-----------+------------------------------------------------+ |
| | | | | |
| | | | | |
| | | | | |
| +----------+-----------+------------------------------------------------+ |
| */ |
| |
| /* |
| +----------------------------------------------------------------------------+ |
| | Included files | |
| +----------------------------------------------------------------------------+ |
| */ |
| |
| #include "hwdrv_apci2032.h" |
| static unsigned int ui_InterruptData, ui_Type; |
| /* |
| +----------------------------------------------------------------------------+ |
| | Function Name : int i_APCI2032_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 | |
| | | |
| | data[1] : 1 Enable VCC Interrupt | |
| | 0 Disable VCC Interrupt | |
| | data[2] : 1 Enable CC Interrupt | |
| | 0 Disable CC Interrupt | |
| | | |
| +----------------------------------------------------------------------------+ |
| | Output Parameters : -- | |
| +----------------------------------------------------------------------------+ |
| | Return Value : TRUE : No error occur | |
| | : FALSE : Error occur. Return the error | |
| | | |
| +----------------------------------------------------------------------------+ |
| */ |
| int i_APCI2032_ConfigDigitalOutput(struct comedi_device *dev, struct comedi_subdevice *s, |
| struct comedi_insn *insn, unsigned int *data) |
| { |
| unsigned int ul_Command = 0; |
| devpriv->tsk_Current = current; |
| |
| if ((data[0] != 0) && (data[0] != 1)) { |
| comedi_error(dev, |
| "Not a valid Data !!! ,Data should be 1 or 0\n"); |
| return -EINVAL; |
| } /* if ( (data[0]!=0) && (data[0]!=1) ) */ |
| if (data[0]) { |
| devpriv->b_OutputMemoryStatus = ADDIDATA_ENABLE; |
| } /* if (data[0]) */ |
| else { |
| devpriv->b_OutputMemoryStatus = ADDIDATA_DISABLE; |
| } /* else if (data[0]) */ |
| |
| if (data[1] == ADDIDATA_ENABLE) { |
| ul_Command = ul_Command | 0x1; |
| } /* if (data[1] == ADDIDATA_ENABLE) */ |
| else { |
| ul_Command = ul_Command & 0xFFFFFFFE; |
| } /* elseif (data[1] == ADDIDATA_ENABLE) */ |
| if (data[2] == ADDIDATA_ENABLE) { |
| ul_Command = ul_Command | 0x2; |
| } /* if (data[2] == ADDIDATA_ENABLE) */ |
| else { |
| ul_Command = ul_Command & 0xFFFFFFFD; |
| } /* elseif (data[2] == ADDIDATA_ENABLE) */ |
| outl(ul_Command, devpriv->iobase + APCI2032_DIGITAL_OP_INTERRUPT); |
| ui_InterruptData = inl(devpriv->iobase + APCI2032_DIGITAL_OP_INTERRUPT); |
| return insn->n; |
| } |
| |
| /* |
| +----------------------------------------------------------------------------+ |
| | Function Name : int i_APCI2032_WriteDigitalOutput | |
| | (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 | |
| | unsigned int ui_NoOfChannels : No Of Channels To Write | |
| | unsigned int *data : Data Pointer to read status | |
| +----------------------------------------------------------------------------+ |
| | Output Parameters : -- | |
| +----------------------------------------------------------------------------+ |
| | Return Value : TRUE : No error occur | |
| | : FALSE : Error occur. Return the error | |
| | | |
| +----------------------------------------------------------------------------+ |
| */ |
| |
| int i_APCI2032_WriteDigitalOutput(struct comedi_device *dev, struct comedi_subdevice *s, |
| struct comedi_insn *insn, unsigned int *data) |
| { |
| unsigned int ui_Temp, ui_Temp1; |
| unsigned int ui_NoOfChannel = CR_CHAN(insn->chanspec); /* get the channel */ |
| if (devpriv->b_OutputMemoryStatus) { |
| ui_Temp = inl(devpriv->iobase + APCI2032_DIGITAL_OP); |
| |
| } /* if(devpriv->b_OutputMemoryStatus ) */ |
| else { |
| ui_Temp = 0; |
| } /* if(devpriv->b_OutputMemoryStatus ) */ |
| if (data[3] == 0) { |
| if (data[1] == 0) { |
| data[0] = (data[0] << ui_NoOfChannel) | ui_Temp; |
| outl(data[0], devpriv->iobase + APCI2032_DIGITAL_OP); |
| } /* if(data[1]==0) */ |
| else { |
| if (data[1] == 1) { |
| switch (ui_NoOfChannel) { |
| |
| case 2: |
| data[0] = |
| (data[0] << (2 * |
| data[2])) | ui_Temp; |
| break; |
| |
| case 4: |
| data[0] = |
| (data[0] << (4 * |
| data[2])) | ui_Temp; |
| break; |
| |
| case 8: |
| data[0] = |
| (data[0] << (8 * |
| data[2])) | ui_Temp; |
| break; |
| |
| case 16: |
| data[0] = |
| (data[0] << (16 * |
| data[2])) | ui_Temp; |
| break; |
| case 31: |
| data[0] = data[0] | ui_Temp; |
| break; |
| |
| default: |
| comedi_error(dev, " chan spec wrong"); |
| return -EINVAL; /* "sorry channel spec wrong " */ |
| |
| } /* switch(ui_NoOfChannels) */ |
| |
| outl(data[0], |
| devpriv->iobase + APCI2032_DIGITAL_OP); |
| } /* if(data[1]==1) */ |
| else { |
| printk("\nSpecified channel not supported\n"); |
| } /* else if(data[1]==1) */ |
| } /* elseif(data[1]==0) */ |
| } /* if(data[3]==0) */ |
| else { |
| if (data[3] == 1) { |
| if (data[1] == 0) { |
| data[0] = ~data[0] & 0x1; |
| ui_Temp1 = 1; |
| ui_Temp1 = ui_Temp1 << ui_NoOfChannel; |
| ui_Temp = ui_Temp | ui_Temp1; |
| data[0] = |
| (data[0] << ui_NoOfChannel) ^ |
| 0xffffffff; |
| data[0] = data[0] & ui_Temp; |
| outl(data[0], |
| devpriv->iobase + APCI2032_DIGITAL_OP); |
| } /* if(data[1]==0) */ |
| else { |
| if (data[1] == 1) { |
| switch (ui_NoOfChannel) { |
| |
| case 2: |
| data[0] = ~data[0] & 0x3; |
| ui_Temp1 = 3; |
| ui_Temp1 = |
| ui_Temp1 << 2 * data[2]; |
| ui_Temp = ui_Temp | ui_Temp1; |
| data[0] = |
| ((data[0] << (2 * |
| data |
| [2])) ^ |
| 0xffffffff) & ui_Temp; |
| break; |
| |
| case 4: |
| data[0] = ~data[0] & 0xf; |
| ui_Temp1 = 15; |
| ui_Temp1 = |
| ui_Temp1 << 4 * data[2]; |
| ui_Temp = ui_Temp | ui_Temp1; |
| data[0] = |
| ((data[0] << (4 * |
| data |
| [2])) ^ |
| 0xffffffff) & ui_Temp; |
| break; |
| |
| case 8: |
| data[0] = ~data[0] & 0xff; |
| ui_Temp1 = 255; |
| ui_Temp1 = |
| ui_Temp1 << 8 * data[2]; |
| ui_Temp = ui_Temp | ui_Temp1; |
| data[0] = |
| ((data[0] << (8 * |
| data |
| [2])) ^ |
| 0xffffffff) & ui_Temp; |
| break; |
| |
| case 16: |
| data[0] = ~data[0] & 0xffff; |
| ui_Temp1 = 65535; |
| ui_Temp1 = |
| ui_Temp1 << 16 * |
| data[2]; |
| ui_Temp = ui_Temp | ui_Temp1; |
| data[0] = |
| ((data[0] << (16 * |
| data |
| [2])) ^ |
| 0xffffffff) & ui_Temp; |
| break; |
| |
| case 31: |
| break; |
| default: |
| comedi_error(dev, |
| " chan spec wrong"); |
| return -EINVAL; /* "sorry channel spec wrong " */ |
| |
| } /* switch(ui_NoOfChannels) */ |
| |
| outl(data[0], |
| devpriv->iobase + |
| APCI2032_DIGITAL_OP); |
| } /* if(data[1]==1) */ |
| else { |
| printk("\nSpecified channel not supported\n"); |
| } /* else if(data[1]==1) */ |
| } /* elseif(data[1]==0) */ |
| } /* if(data[3]==1); */ |
| else { |
| printk("\nSpecified functionality does not exist\n"); |
| return -EINVAL; |
| } /* if else data[3]==1) */ |
| } /* if else data[3]==0) */ |
| return insn->n; |
| } |
| |
| /* |
| +----------------------------------------------------------------------------+ |
| | Function Name : int i_APCI2032_ReadDigitalOutput | |
| | (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 | |
| | unsigned int ui_NoOfChannels : No Of Channels To read | |
| | unsigned int *data : Data Pointer to read status | |
| +----------------------------------------------------------------------------+ |
| | Output Parameters : -- | |
| +----------------------------------------------------------------------------+ |
| | Return Value : TRUE : No error occur | |
| | : FALSE : Error occur. Return the error | |
| | | |
| +----------------------------------------------------------------------------+ |
| */ |
| |
| int i_APCI2032_ReadDigitalOutput(struct comedi_device *dev, struct comedi_subdevice *s, |
| struct comedi_insn *insn, unsigned int *data) |
| { |
| unsigned int ui_Temp; |
| unsigned int ui_NoOfChannel; |
| ui_NoOfChannel = CR_CHAN(insn->chanspec); |
| ui_Temp = data[0]; |
| *data = inl(devpriv->iobase + APCI2032_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 8: |
| *data = (*data >> (8 * data[1])) & 255; |
| break; |
| |
| case 16: |
| *data = (*data >> (16 * data[1])) & 65535; |
| break; |
| |
| case 31: |
| 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) */ |
| } |
| return insn->n; |
| } |
| |
| /* |
| +----------------------------------------------------------------------------+ |
| | Function Name : int i_APCI2032_ConfigWatchdog(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_APCI2032_ConfigWatchdog(struct comedi_device *dev, struct comedi_subdevice *s, |
| struct comedi_insn *insn, unsigned int *data) |
| { |
| if (data[0] == 0) { |
| /* Disable the watchdog */ |
| outl(0x0, |
| devpriv->iobase + APCI2032_DIGITAL_OP_WATCHDOG + |
| APCI2032_TCW_PROG); |
| /* Loading the Reload value */ |
| outl(data[1], |
| devpriv->iobase + APCI2032_DIGITAL_OP_WATCHDOG + |
| APCI2032_TCW_RELOAD_VALUE); |
| } else { |
| printk("\nThe input parameters are wrong\n"); |
| return -EINVAL; |
| } |
| |
| return insn->n; |
| } |
| |
| /* |
| +----------------------------------------------------------------------------+ |
| | Function Name : int i_APCI2032_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_APCI2032_StartStopWriteWatchdog(struct comedi_device *dev, struct comedi_subdevice *s, |
| struct comedi_insn *insn, unsigned int *data) |
| { |
| switch (data[0]) { |
| case 0: /* stop the watchdog */ |
| outl(0x0, devpriv->iobase + APCI2032_DIGITAL_OP_WATCHDOG + APCI2032_TCW_PROG); /* disable the watchdog */ |
| break; |
| case 1: /* start the watchdog */ |
| outl(0x0001, |
| devpriv->iobase + APCI2032_DIGITAL_OP_WATCHDOG + |
| APCI2032_TCW_PROG); |
| break; |
| case 2: /* Software trigger */ |
| outl(0x0201, |
| devpriv->iobase + APCI2032_DIGITAL_OP_WATCHDOG + |
| APCI2032_TCW_PROG); |
| break; |
| default: |
| printk("\nSpecified functionality does not exist\n"); |
| return -EINVAL; |
| } |
| return insn->n; |
| } |
| |
| /* |
| +----------------------------------------------------------------------------+ |
| | Function Name : int i_APCI2032_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_APCI2032_ReadWatchdog(struct comedi_device *dev, struct comedi_subdevice *s, |
| struct comedi_insn *insn, unsigned int *data) |
| { |
| |
| data[0] = |
| inl(devpriv->iobase + APCI2032_DIGITAL_OP_WATCHDOG + |
| APCI2032_TCW_TRIG_STATUS) & 0x1; |
| return insn->n; |
| } |
| |
| /* |
| +----------------------------------------------------------------------------+ |
| | Function Name : void v_APCI2032_Interrupt | |
| | (int irq , void *d) | |
| +----------------------------------------------------------------------------+ |
| | Task : Writes port value To the selected port | |
| +----------------------------------------------------------------------------+ |
| | Input Parameters : int irq : irq number | |
| | void *d : void pointer | |
| +----------------------------------------------------------------------------+ |
| | Output Parameters : -- | |
| +----------------------------------------------------------------------------+ |
| | Return Value : TRUE : No error occur | |
| | : FALSE : Error occur. Return the error | |
| | | |
| +----------------------------------------------------------------------------+ |
| */ |
| void v_APCI2032_Interrupt(int irq, void *d) |
| { |
| struct comedi_device *dev = d; |
| unsigned int ui_DO; |
| |
| ui_DO = inl(devpriv->iobase + APCI2032_DIGITAL_OP_IRQ) & 0x1; /* Check if VCC OR CC interrupt has occurred. */ |
| |
| if (ui_DO == 0) { |
| printk("\nInterrupt from unKnown source\n"); |
| } /* if(ui_DO==0) */ |
| if (ui_DO) { |
| /* Check for Digital Output interrupt Type - 1: Vcc interrupt 2: CC interrupt. */ |
| ui_Type = |
| inl(devpriv->iobase + |
| APCI2032_DIGITAL_OP_INTERRUPT_STATUS) & 0x3; |
| outl(0x0, |
| devpriv->iobase + APCI2032_DIGITAL_OP + |
| APCI2032_DIGITAL_OP_INTERRUPT); |
| if (ui_Type == 1) { |
| /* Sends signal to user space */ |
| send_sig(SIGIO, devpriv->tsk_Current, 0); |
| } /* if (ui_Type==1) */ |
| else { |
| if (ui_Type == 2) { |
| /* Sends signal to user space */ |
| send_sig(SIGIO, devpriv->tsk_Current, 0); |
| } /* if (ui_Type==2) */ |
| } /* else if (ui_Type==1) */ |
| } /* if(ui_DO) */ |
| |
| return; |
| |
| } |
| |
| /* |
| +----------------------------------------------------------------------------+ |
| | Function Name : int i_APCI2032_ReadInterruptStatus | |
| | (struct comedi_device *dev,struct comedi_subdevice *s, | |
| | struct comedi_insn *insn,unsigned int *data) | |
| +----------------------------------------------------------------------------+ |
| | Task :Reads the interrupt status register | |
| +----------------------------------------------------------------------------+ |
| | Input Parameters : | |
| +----------------------------------------------------------------------------+ |
| | Output Parameters : -- | |
| +----------------------------------------------------------------------------+ |
| | Return Value : | |
| | | |
| +----------------------------------------------------------------------------+ |
| */ |
| |
| int i_APCI2032_ReadInterruptStatus(struct comedi_device *dev, struct comedi_subdevice *s, |
| struct comedi_insn *insn, unsigned int *data) |
| { |
| *data = ui_Type; |
| return insn->n; |
| } |
| |
| /* |
| +----------------------------------------------------------------------------+ |
| | Function Name : int i_APCI2032_Reset(struct comedi_device *dev) | |
| | | |
| +----------------------------------------------------------------------------+ |
| | Task :Resets the registers of the card | |
| +----------------------------------------------------------------------------+ |
| | Input Parameters : | |
| +----------------------------------------------------------------------------+ |
| | Output Parameters : -- | |
| +----------------------------------------------------------------------------+ |
| | Return Value : | |
| | | |
| +----------------------------------------------------------------------------+ |
| */ |
| |
| int i_APCI2032_Reset(struct comedi_device *dev) |
| { |
| devpriv->b_DigitalOutputRegister = 0; |
| ui_Type = 0; |
| outl(0x0, devpriv->iobase + APCI2032_DIGITAL_OP); /* Resets the output channels */ |
| outl(0x0, devpriv->iobase + APCI2032_DIGITAL_OP_INTERRUPT); /* Disables the interrupt. */ |
| outl(0x0, devpriv->iobase + APCI2032_DIGITAL_OP_WATCHDOG + APCI2032_TCW_PROG); /* disable the watchdog */ |
| outl(0x0, devpriv->iobase + APCI2032_DIGITAL_OP_WATCHDOG + APCI2032_TCW_RELOAD_VALUE); /* reload=0 */ |
| return 0; |
| } |