?? hwdrv_apci2016.c
字號:
/**@verbatimCopyright (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 USAYou 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-2016 | Compiler : GCC | | Module name : hwdrv_apci2016.c| Version : 2.96 | +-------------------------------+---------------------------------------+ | Project manager: Eric Stolz | Date : 02/12/2002 | +-------------------------------+---------------------------------------+ | Description : Hardware Layer Acces For APCI-2016 | +-----------------------------------------------------------------------+ | UPDATES | +----------+-----------+------------------------------------------------+ | Date | Author | Description of updates | +----------+-----------+------------------------------------------------+ | | | | | | | | | | | | +----------+-----------+------------------------------------------------+*//*+----------------------------------------------------------------------------+| Included files |+----------------------------------------------------------------------------+*/#include "hwdrv_apci2016.h"/*+----------------------------------------------------------------------------+| Function Name : int i_APCI2016_ConfigDigitalOutput || (comedi_device *dev,comedi_subdevice *s, | | comedi_insn *insn,lsampl_t *data) |+----------------------------------------------------------------------------+| Task : Configures The Digital Output Subdevice. |+----------------------------------------------------------------------------+| Input Parameters : comedi_device *dev : Driver handle || UINT *data : Data Pointer contains || configuration parameters as below || | | data[0] : 1 Digital Memory On | | 0 Digital Memory Off | +----------------------------------------------------------------------------+| Output Parameters : -- |+----------------------------------------------------------------------------+| Return Value : TRUE : No error occur || : FALSE : Error occur. Return the error || |+----------------------------------------------------------------------------+*/int i_APCI2016_ConfigDigitalOutput(comedi_device *dev,comedi_subdevice *s,comedi_insn *insn,lsampl_t *data) { if ((data[0]!=0) && (data[0]!=1)) { comedi_error(dev,"Not a valid Data !!! ,Data should be 1 or 0\n"); return -EINVAL; } // if ((data[0]!=0) && (data[0]!=1)) if (data[0]) { devpriv->b_OutputMemoryStatus = ADDIDATA_ENABLE ; } // if (data[0] else { devpriv->b_OutputMemoryStatus = ADDIDATA_DISABLE; } // else if (data[0] return insn->n;}/*+----------------------------------------------------------------------------+| Function Name : int i_APCI2016_WriteDigitalOutput || (comedi_device *dev,comedi_subdevice *s, || comedi_insn *insn,lsampl_t *data) |+----------------------------------------------------------------------------+| Task : Writes port value To the selected port |+----------------------------------------------------------------------------+| Input Parameters : comedi_device *dev : Driver handle || UINT ui_NoOfChannels : No Of Channels To Write || UINT *data : Data Pointer to read status |+----------------------------------------------------------------------------+| Output Parameters : -- |+----------------------------------------------------------------------------+| Return Value : TRUE : No error occur || : FALSE : Error occur. Return the error || |+----------------------------------------------------------------------------+*/int i_APCI2016_WriteDigitalOutput(comedi_device *dev,comedi_subdevice *s,comedi_insn *insn,lsampl_t *data) { UINT ui_NoOfChannel; UINT ui_Temp,ui_Temp1; ui_NoOfChannel=CR_CHAN(insn->chanspec); if ((ui_NoOfChannel<0) || (ui_NoOfChannel>15)) { comedi_error(dev,"Invalid Channel Numbers !!!, Channel Numbers must be between 0 and 15\n"); return -EINVAL; } // if ((ui_NoOfChannel<0) || (ui_NoOfChannel>15)) if (devpriv->b_OutputMemoryStatus ) { ui_Temp=inw(devpriv->iobase+APCI2016_DIGITAL_OP); } // if (devpriv->b_OutputMemoryStatus ) else { ui_Temp=0; } // else if (devpriv->b_OutputMemoryStatus ) if ((data[1]!=0) && (data[1]!=1)) { comedi_error(dev,"Invalid Data[1] value !!!, Data[1] should be 0 or 1\n"); return -EINVAL; } // if ((data[1]!=0) && (data[1]!=1)) if (data[3]==0) { if (data[1]==0) { data[0]=(data[0] << ui_NoOfChannel)|ui_Temp; outw(data[0],devpriv->iobase+APCI2016_DIGITAL_OP); } // if (data[1]==0) else { if (data[1]==1) { switch (ui_NoOfChannel) { case 2: data[0]=(data[0] << (2*data[2]))|ui_Temp; break; case 4: data[0]=(data[0] << (4*data[2]))|ui_Temp; break; case 8: data[0]=(data[0] << (8*data[2]))|ui_Temp; break; case 15: data[0]=data[0]|ui_Temp; break; default: comedi_error(dev," chan spec wrong"); return -EINVAL; // "sorry channel spec wrong " }//switch(ui_NoOfChannels) outw(data[0],devpriv->iobase+APCI2016_DIGITAL_OP); }// if (data[1]==1) else { printk("\nSpecified channel not supported\n"); } // else if (data[1]==1) } // else if (data[1]==0) } // if (data[3]==0) else { if (data[3]==1) { if (data[1]==0) { data[0]=~data[0]&0x1; ui_Temp1=1; ui_Temp1=ui_Temp1<<ui_NoOfChannel; ui_Temp=ui_Temp|ui_Temp1; data[0]=(data[0] << ui_NoOfChannel)^0xffff; data[0]=data[0]& ui_Temp; outw(data[0],devpriv->iobase+APCI2016_DIGITAL_OP); } // if (data[1]==0) else { if (data[1]==1) { switch (ui_NoOfChannel) { case 2: data[0]=~data[0]&0x3; ui_Temp1=3; ui_Temp1=ui_Temp1<<2*data[2]; ui_Temp=ui_Temp|ui_Temp1; data[0]=((data[0] << (2*data[2]))^0xffff)& ui_Temp; break; case 4: data[0]=~data[0]&0xf; ui_Temp1=15; ui_Temp1=ui_Temp1<<4*data[2]; ui_Temp=ui_Temp|ui_Temp1; data[0]=((data[0] << (4*data[2]))^0xffff)&ui_Temp; break; case 8: data[0]=~data[0]&0xff; ui_Temp1=255; ui_Temp1=ui_Temp1<<8*data[2]; ui_Temp=ui_Temp|ui_Temp1; data[0]=((data[0] << (8*data[2]))^0xffff)&ui_Temp; break; case 15: break; default: comedi_error(dev," chan spec wrong"); return -EINVAL; // "sorry channel spec wrong " }//switch(ui_NoOfChannels) outw(data[0],devpriv->iobase+APCI2016_DIGITAL_OP); }// if(data[1]==1) else { printk("\nSpecified channel not supported\n");
?? 快捷鍵說明
復制代碼
Ctrl + C
搜索代碼
Ctrl + F
全屏模式
F11
切換主題
Ctrl + Shift + D
顯示快捷鍵
?
增大字號
Ctrl + =
減小字號
Ctrl + -