Staging: comedi: add ii_pci20kc driver
Driver for Intelligent Instruments PCI-20001C carrier board and modules. From: Markus Kempf <kempf@matsci.uni-sb.de> Cc: David Schleef <ds@schleef.org> Cc: Frank Mori Hess <fmhess@users.sourceforge.net> Cc: Ian Abbott <abbotti@mev.co.uk> Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
This commit is contained in:
parent
f26c569b41
commit
eb3a3c1b7c
|
@ -0,0 +1,610 @@
|
||||||
|
/*
|
||||||
|
* comedi/drivers/ii_pci20kc.c
|
||||||
|
* Driver for Intelligent Instruments PCI-20001C carrier board
|
||||||
|
* and modules.
|
||||||
|
*
|
||||||
|
* Copyright (C) 2000 Markus Kempf <kempf@matsci.uni-sb.de>
|
||||||
|
* with suggestions from David Schleef
|
||||||
|
* 16.06.2000
|
||||||
|
*
|
||||||
|
* Linux device driver for COMEDI
|
||||||
|
* Intelligent Instrumentation
|
||||||
|
* PCI-20001 C-2A Carrier Board
|
||||||
|
* PCI-20341 M-1A 16-Bit analog input module
|
||||||
|
* - differential
|
||||||
|
* - range (-5V - +5V)
|
||||||
|
* - 16 bit
|
||||||
|
* PCI-20006 M-2 16-Bit analog output module
|
||||||
|
* - ranges (-10V - +10V) (0V - +10V) (-5V - +5V)
|
||||||
|
* - 16 bit
|
||||||
|
*
|
||||||
|
* only ONE PCI-20341 module possible
|
||||||
|
* only ONE PCI-20006 module possible
|
||||||
|
* no extern trigger implemented
|
||||||
|
*
|
||||||
|
* NOT WORKING (but soon) only 4 on-board differential channels supported
|
||||||
|
* NOT WORKING (but soon) only ONE di-port and ONE do-port supported instead of 4 digital ports
|
||||||
|
* di-port == Port 0
|
||||||
|
* do-port == Port 1
|
||||||
|
*
|
||||||
|
* The state of this driver is only a starting point for a complete
|
||||||
|
* COMEDI-driver. The final driver should support all features of the
|
||||||
|
* carrier board and modules.
|
||||||
|
*
|
||||||
|
* The test configuration:
|
||||||
|
*
|
||||||
|
* kernel 2.2.14 with RTAI v1.2 and patch-2.2.14rthal2
|
||||||
|
* COMEDI 0.7.45
|
||||||
|
* COMEDILIB 0.7.9
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
/*
|
||||||
|
Driver: ii_pci20kc
|
||||||
|
Description: Intelligent Instruments PCI-20001C carrier board
|
||||||
|
Author: Markus Kempf <kempf@matsci.uni-sb.de>
|
||||||
|
Devices: [Intelligent Instrumentation] PCI-20001C (ii_pci20kc)
|
||||||
|
Status: works
|
||||||
|
|
||||||
|
Supports the PCI-20001 C-2a Carrier board, and could probably support
|
||||||
|
the other carrier boards with small modifications. Modules supported
|
||||||
|
are:
|
||||||
|
PCI-20006 M-2 16-bit analog output module
|
||||||
|
PCI-20341 M-1A 16-bit analog input module
|
||||||
|
|
||||||
|
Options:
|
||||||
|
0 Board base address
|
||||||
|
1 IRQ
|
||||||
|
2 first option for module 1
|
||||||
|
3 second option for module 1
|
||||||
|
4 first option for module 2
|
||||||
|
5 second option for module 2
|
||||||
|
6 first option for module 3
|
||||||
|
7 second option for module 3
|
||||||
|
|
||||||
|
options for PCI-20006M:
|
||||||
|
first: Analog output channel 0 range configuration
|
||||||
|
0 bipolar 10 (-10V -- +10V)
|
||||||
|
1 unipolar 10 (0V -- +10V)
|
||||||
|
2 bipolar 5 (-5V -- 5V)
|
||||||
|
second: Analog output channel 1 range configuration
|
||||||
|
|
||||||
|
options for PCI-20341M:
|
||||||
|
first: Analog input gain configuration
|
||||||
|
0 1
|
||||||
|
1 10
|
||||||
|
2 100
|
||||||
|
3 200
|
||||||
|
*/
|
||||||
|
|
||||||
|
/* XXX needs to use ioremap() for compatibility with 2.4 kernels. Should also
|
||||||
|
* check_mem_region() etc. - fmhess */
|
||||||
|
|
||||||
|
#include "../comedidev.h"
|
||||||
|
|
||||||
|
#define PCI20000_ID 0x1d
|
||||||
|
#define PCI20341_ID 0x77
|
||||||
|
#define PCI20006_ID 0xe3
|
||||||
|
#define PCI20xxx_EMPTY_ID 0xff
|
||||||
|
|
||||||
|
#define PCI20000_OFFSET 0x100
|
||||||
|
#define PCI20000_MODULES 3
|
||||||
|
|
||||||
|
#define PCI20000_DIO_0 0x80
|
||||||
|
#define PCI20000_DIO_1 0x81
|
||||||
|
#define PCI20000_DIO_2 0xc0
|
||||||
|
#define PCI20000_DIO_3 0xc1
|
||||||
|
#define PCI20000_DIO_CONTROL_01 0x83 /* port 0, 1 control */
|
||||||
|
#define PCI20000_DIO_CONTROL_23 0xc3 /* port 2, 3 control */
|
||||||
|
#define PCI20000_DIO_BUFFER 0x82 /* buffer direction and enable */
|
||||||
|
#define PCI20000_DIO_EOC 0xef /* even port, control output */
|
||||||
|
#define PCI20000_DIO_OOC 0xfd /* odd port, control output */
|
||||||
|
#define PCI20000_DIO_EIC 0x90 /* even port, control input */
|
||||||
|
#define PCI20000_DIO_OIC 0x82 /* odd port, control input */
|
||||||
|
#define DIO_CAND 0x12 /* and bit 1, bit 4 of control */
|
||||||
|
#define DIO_BE 0x01 /* buffer: port enable */
|
||||||
|
#define DIO_BO 0x04 /* buffer: output */
|
||||||
|
#define DIO_BI 0x05 /* buffer: input */
|
||||||
|
#define DIO_PS_0 0x00 /* buffer: port shift 0 */
|
||||||
|
#define DIO_PS_1 0x01 /* buffer: port shift 1 */
|
||||||
|
#define DIO_PS_2 0x04 /* buffer: port shift 2 */
|
||||||
|
#define DIO_PS_3 0x05 /* buffer: port shift 3 */
|
||||||
|
|
||||||
|
#define PCI20006_LCHAN0 0x0d
|
||||||
|
#define PCI20006_STROBE0 0x0b
|
||||||
|
#define PCI20006_LCHAN1 0x15
|
||||||
|
#define PCI20006_STROBE1 0x13
|
||||||
|
|
||||||
|
#define PCI20341_INIT 0x04
|
||||||
|
#define PCI20341_REPMODE 0x00 /* single shot mode */
|
||||||
|
#define PCI20341_PACER 0x00 /* Hardware Pacer disabled */
|
||||||
|
#define PCI20341_CHAN_NR 0x04 /* number of input channels */
|
||||||
|
#define PCI20341_CONFIG_REG 0x10
|
||||||
|
#define PCI20341_MOD_STATUS 0x01
|
||||||
|
#define PCI20341_OPT_REG 0x11
|
||||||
|
#define PCI20341_SET_TIME_REG 0x15
|
||||||
|
#define PCI20341_LCHAN_ADDR_REG 0x13
|
||||||
|
#define PCI20341_CHAN_LIST 0x80
|
||||||
|
#define PCI20341_CC_RESET 0x1b
|
||||||
|
#define PCI20341_CHAN_RESET 0x19
|
||||||
|
#define PCI20341_SOFT_PACER 0x04
|
||||||
|
#define PCI20341_STATUS_REG 0x12
|
||||||
|
#define PCI20341_LDATA 0x02
|
||||||
|
#define PCI20341_DAISY_CHAIN 0x20 /* On-board inputs only */
|
||||||
|
#define PCI20341_MUX 0x04 /* Enable on-board MUX */
|
||||||
|
#define PCI20341_SCANLIST 0x80 /* Channel/Gain Scan List */
|
||||||
|
|
||||||
|
typedef union {
|
||||||
|
void *iobase;
|
||||||
|
struct {
|
||||||
|
void *iobase;
|
||||||
|
const comedi_lrange *ao_range_list[2]; /* range of channels of ao module */
|
||||||
|
lsampl_t last_data[2];
|
||||||
|
} pci20006;
|
||||||
|
struct {
|
||||||
|
void *iobase;
|
||||||
|
int timebase;
|
||||||
|
int settling_time;
|
||||||
|
int ai_gain;
|
||||||
|
} pci20341;
|
||||||
|
} pci20xxx_subdev_private;
|
||||||
|
|
||||||
|
typedef struct {
|
||||||
|
void *ioaddr;
|
||||||
|
pci20xxx_subdev_private subdev_private[PCI20000_MODULES];
|
||||||
|
} pci20xxx_private;
|
||||||
|
|
||||||
|
#define devpriv ((pci20xxx_private *)dev->private)
|
||||||
|
#define CHAN (CR_CHAN(it->chanlist[0]))
|
||||||
|
|
||||||
|
static int pci20xxx_attach(comedi_device * dev, comedi_devconfig * it);
|
||||||
|
static int pci20xxx_detach(comedi_device * dev);
|
||||||
|
|
||||||
|
static comedi_driver driver_pci20xxx = {
|
||||||
|
driver_name:"ii_pci20kc",
|
||||||
|
module:THIS_MODULE,
|
||||||
|
attach:pci20xxx_attach,
|
||||||
|
detach:pci20xxx_detach,
|
||||||
|
};
|
||||||
|
|
||||||
|
static int pci20006_init(comedi_device * dev, comedi_subdevice * s,
|
||||||
|
int opt0, int opt1);
|
||||||
|
static int pci20341_init(comedi_device * dev, comedi_subdevice * s,
|
||||||
|
int opt0, int opt1);
|
||||||
|
static int pci20xxx_dio_init(comedi_device * dev, comedi_subdevice * s);
|
||||||
|
|
||||||
|
/*
|
||||||
|
options[0] Board base address
|
||||||
|
options[1] IRQ
|
||||||
|
options[2] first option for module 1
|
||||||
|
options[3] second option for module 1
|
||||||
|
options[4] first option for module 2
|
||||||
|
options[5] second option for module 2
|
||||||
|
options[6] first option for module 3
|
||||||
|
options[7] second option for module 3
|
||||||
|
|
||||||
|
options for PCI-20341M:
|
||||||
|
first Analog input gain configuration
|
||||||
|
0 == 1
|
||||||
|
1 == 10
|
||||||
|
2 == 100
|
||||||
|
3 == 200
|
||||||
|
|
||||||
|
options for PCI-20006M:
|
||||||
|
first Analog output channel 0 range configuration
|
||||||
|
0 == bipolar 10 (-10V -- +10V)
|
||||||
|
1 == unipolar 10V (0V -- +10V)
|
||||||
|
2 == bipolar 5V (-5V -- +5V)
|
||||||
|
second Analog output channel 1 range configuration
|
||||||
|
0 == bipolar 10 (-10V -- +10V)
|
||||||
|
1 == unipolar 10V (0V -- +10V)
|
||||||
|
2 == bipolar 5V (-5V -- +5V)
|
||||||
|
*/
|
||||||
|
static int pci20xxx_attach(comedi_device * dev, comedi_devconfig * it)
|
||||||
|
{
|
||||||
|
unsigned char i;
|
||||||
|
int ret;
|
||||||
|
int id;
|
||||||
|
comedi_subdevice *s;
|
||||||
|
pci20xxx_subdev_private *sdp;
|
||||||
|
|
||||||
|
if ((ret = alloc_subdevices(dev, 1 + PCI20000_MODULES)) < 0)
|
||||||
|
return ret;
|
||||||
|
if ((ret = alloc_private(dev, sizeof(pci20xxx_private))) < 0)
|
||||||
|
return ret;
|
||||||
|
|
||||||
|
devpriv->ioaddr = (void *)(unsigned long)it->options[0];
|
||||||
|
dev->board_name = "pci20kc";
|
||||||
|
|
||||||
|
/* Check PCI-20001 C-2A Carrier Board ID */
|
||||||
|
if ((readb(devpriv->ioaddr) & PCI20000_ID) != PCI20000_ID) {
|
||||||
|
printk("comedi%d: ii_pci20kc", dev->minor);
|
||||||
|
printk(" PCI-20001 C-2A Carrier Board at base=0x%p not found !\n", devpriv->ioaddr);
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
printk("comedi%d:\n", dev->minor);
|
||||||
|
printk("ii_pci20kc: PCI-20001 C-2A at base=0x%p\n", devpriv->ioaddr);
|
||||||
|
|
||||||
|
for (i = 0; i < PCI20000_MODULES; i++) {
|
||||||
|
s = dev->subdevices + i;
|
||||||
|
id = readb(devpriv->ioaddr + (i + 1) * PCI20000_OFFSET);
|
||||||
|
s->private = devpriv->subdev_private + i;
|
||||||
|
sdp = s->private;
|
||||||
|
switch (id) {
|
||||||
|
case PCI20006_ID:
|
||||||
|
sdp->pci20006.iobase =
|
||||||
|
devpriv->ioaddr + (i + 1) * PCI20000_OFFSET;
|
||||||
|
pci20006_init(dev, s, it->options[2 * i + 2],
|
||||||
|
it->options[2 * i + 3]);
|
||||||
|
printk("comedi%d: ii_pci20kc", dev->minor);
|
||||||
|
printk(" PCI-20006 module in slot %d \n", i + 1);
|
||||||
|
break;
|
||||||
|
case PCI20341_ID:
|
||||||
|
sdp->pci20341.iobase =
|
||||||
|
devpriv->ioaddr + (i + 1) * PCI20000_OFFSET;
|
||||||
|
pci20341_init(dev, s, it->options[2 * i + 2],
|
||||||
|
it->options[2 * i + 3]);
|
||||||
|
printk("comedi%d: ii_pci20kc", dev->minor);
|
||||||
|
printk(" PCI-20341 module in slot %d \n", i + 1);
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
printk("ii_pci20kc: unknown module code 0x%02x in slot %d: module disabled\n", id, i);
|
||||||
|
/* fall through */
|
||||||
|
case PCI20xxx_EMPTY_ID:
|
||||||
|
s->type = COMEDI_SUBD_UNUSED;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/* initialize pci20xxx_private */
|
||||||
|
pci20xxx_dio_init(dev, dev->subdevices + PCI20000_MODULES);
|
||||||
|
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int pci20xxx_detach(comedi_device * dev)
|
||||||
|
{
|
||||||
|
printk("comedi%d: pci20xxx: remove\n", dev->minor);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* pci20006m */
|
||||||
|
|
||||||
|
static int pci20006_insn_read(comedi_device * dev, comedi_subdevice * s,
|
||||||
|
comedi_insn * insn, lsampl_t * data);
|
||||||
|
static int pci20006_insn_write(comedi_device * dev, comedi_subdevice * s,
|
||||||
|
comedi_insn * insn, lsampl_t * data);
|
||||||
|
|
||||||
|
static const comedi_lrange *pci20006_range_list[] = {
|
||||||
|
&range_bipolar10,
|
||||||
|
&range_unipolar10,
|
||||||
|
&range_bipolar5,
|
||||||
|
};
|
||||||
|
|
||||||
|
static int pci20006_init(comedi_device * dev, comedi_subdevice * s,
|
||||||
|
int opt0, int opt1)
|
||||||
|
{
|
||||||
|
pci20xxx_subdev_private *sdp = s->private;
|
||||||
|
|
||||||
|
if (opt0 < 0 || opt0 > 2)
|
||||||
|
opt0 = 0;
|
||||||
|
if (opt1 < 0 || opt1 > 2)
|
||||||
|
opt1 = 0;
|
||||||
|
|
||||||
|
sdp->pci20006.ao_range_list[0] = pci20006_range_list[opt0];
|
||||||
|
sdp->pci20006.ao_range_list[1] = pci20006_range_list[opt1];
|
||||||
|
|
||||||
|
/* ao subdevice */
|
||||||
|
s->type = COMEDI_SUBD_AO;
|
||||||
|
s->subdev_flags = SDF_WRITABLE;
|
||||||
|
s->n_chan = 2;
|
||||||
|
s->len_chanlist = 2;
|
||||||
|
s->insn_read = pci20006_insn_read;
|
||||||
|
s->insn_write = pci20006_insn_write;
|
||||||
|
s->maxdata = 0xffff;
|
||||||
|
s->range_table_list = sdp->pci20006.ao_range_list;
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int pci20006_insn_read(comedi_device * dev, comedi_subdevice * s,
|
||||||
|
comedi_insn * insn, lsampl_t * data)
|
||||||
|
{
|
||||||
|
pci20xxx_subdev_private *sdp = s->private;
|
||||||
|
|
||||||
|
data[0] = sdp->pci20006.last_data[CR_CHAN(insn->chanspec)];
|
||||||
|
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int pci20006_insn_write(comedi_device * dev, comedi_subdevice * s,
|
||||||
|
comedi_insn * insn, lsampl_t * data)
|
||||||
|
{
|
||||||
|
pci20xxx_subdev_private *sdp = s->private;
|
||||||
|
int hi, lo;
|
||||||
|
unsigned int boarddata;
|
||||||
|
|
||||||
|
sdp->pci20006.last_data[CR_CHAN(insn->chanspec)] = data[0];
|
||||||
|
boarddata = (((unsigned int)data[0] + 0x8000) & 0xffff); /* comedi-data -> board-data */
|
||||||
|
lo = (boarddata & 0xff);
|
||||||
|
hi = ((boarddata >> 8) & 0xff);
|
||||||
|
|
||||||
|
switch (CR_CHAN(insn->chanspec)) {
|
||||||
|
case 0:
|
||||||
|
writeb(lo, sdp->iobase + PCI20006_LCHAN0);
|
||||||
|
writeb(hi, sdp->iobase + PCI20006_LCHAN0 + 1);
|
||||||
|
writeb(0x00, sdp->iobase + PCI20006_STROBE0);
|
||||||
|
break;
|
||||||
|
case 1:
|
||||||
|
writeb(lo, sdp->iobase + PCI20006_LCHAN1);
|
||||||
|
writeb(hi, sdp->iobase + PCI20006_LCHAN1 + 1);
|
||||||
|
writeb(0x00, sdp->iobase + PCI20006_STROBE1);
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
printk(" comedi%d: pci20xxx: ao channel Error!\n", dev->minor);
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* PCI20341M */
|
||||||
|
|
||||||
|
static int pci20341_insn_read(comedi_device * dev, comedi_subdevice * s,
|
||||||
|
comedi_insn * insn, lsampl_t * data);
|
||||||
|
|
||||||
|
static const int pci20341_timebase[] = { 0x00, 0x00, 0x00, 0x04 };
|
||||||
|
static const int pci20341_settling_time[] = { 0x58, 0x58, 0x93, 0x99 };
|
||||||
|
|
||||||
|
static const comedi_lrange range_bipolar0_5 = { 1, {BIP_RANGE(0.5)} };
|
||||||
|
static const comedi_lrange range_bipolar0_05 = { 1, {BIP_RANGE(0.05)} };
|
||||||
|
static const comedi_lrange range_bipolar0_025 = { 1, {BIP_RANGE(0.025)} };
|
||||||
|
|
||||||
|
static const comedi_lrange *const pci20341_ranges[] = {
|
||||||
|
&range_bipolar5,
|
||||||
|
&range_bipolar0_5,
|
||||||
|
&range_bipolar0_05,
|
||||||
|
&range_bipolar0_025,
|
||||||
|
};
|
||||||
|
|
||||||
|
static int pci20341_init(comedi_device * dev, comedi_subdevice * s,
|
||||||
|
int opt0, int opt1)
|
||||||
|
{
|
||||||
|
pci20xxx_subdev_private *sdp = s->private;
|
||||||
|
int option;
|
||||||
|
|
||||||
|
/* options handling */
|
||||||
|
if (opt0 < 0 || opt0 > 3)
|
||||||
|
opt0 = 0;
|
||||||
|
sdp->pci20341.timebase = pci20341_timebase[opt0];
|
||||||
|
sdp->pci20341.settling_time = pci20341_settling_time[opt0];
|
||||||
|
|
||||||
|
/* ai subdevice */
|
||||||
|
s->type = COMEDI_SUBD_AI;
|
||||||
|
s->subdev_flags = SDF_READABLE;
|
||||||
|
s->n_chan = PCI20341_CHAN_NR;
|
||||||
|
s->len_chanlist = PCI20341_SCANLIST;
|
||||||
|
s->insn_read = pci20341_insn_read;
|
||||||
|
s->maxdata = 0xffff;
|
||||||
|
s->range_table = pci20341_ranges[opt0];
|
||||||
|
|
||||||
|
option = sdp->pci20341.timebase | PCI20341_REPMODE; /* depends on gain, trigger, repetition mode */
|
||||||
|
|
||||||
|
writeb(PCI20341_INIT, sdp->iobase + PCI20341_CONFIG_REG); /* initialize Module */
|
||||||
|
writeb(PCI20341_PACER, sdp->iobase + PCI20341_MOD_STATUS); /* set Pacer */
|
||||||
|
writeb(option, sdp->iobase + PCI20341_OPT_REG); /* option register */
|
||||||
|
writeb(sdp->pci20341.settling_time, sdp->iobase + PCI20341_SET_TIME_REG); /* settling time counter */
|
||||||
|
/* trigger not implemented */
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int pci20341_insn_read(comedi_device * dev, comedi_subdevice * s,
|
||||||
|
comedi_insn * insn, lsampl_t * data)
|
||||||
|
{
|
||||||
|
pci20xxx_subdev_private *sdp = s->private;
|
||||||
|
unsigned int i = 0, j = 0;
|
||||||
|
int lo, hi;
|
||||||
|
unsigned char eoc; /* end of conversion */
|
||||||
|
unsigned int clb; /* channel list byte */
|
||||||
|
unsigned int boarddata;
|
||||||
|
|
||||||
|
writeb(1, sdp->iobase + PCI20341_LCHAN_ADDR_REG); /* write number of input channels */
|
||||||
|
clb = PCI20341_DAISY_CHAIN | PCI20341_MUX | (sdp->pci20341.ai_gain << 3)
|
||||||
|
| CR_CHAN(insn->chanspec);
|
||||||
|
writeb(clb, sdp->iobase + PCI20341_CHAN_LIST);
|
||||||
|
writeb(0x00, sdp->iobase + PCI20341_CC_RESET); /* reset settling time counter and trigger delay counter */
|
||||||
|
writeb(0x00, sdp->iobase + PCI20341_CHAN_RESET);
|
||||||
|
|
||||||
|
/* generate Pacer */
|
||||||
|
|
||||||
|
for (i = 0; i < insn->n; i++) {
|
||||||
|
/* data polling isn't the niciest way to get the data, I know,
|
||||||
|
* but there are only 6 cycles (mean) and it is easier than
|
||||||
|
* the whole interrupt stuff
|
||||||
|
*/
|
||||||
|
j = 0;
|
||||||
|
readb(sdp->iobase + PCI20341_SOFT_PACER); /* generate Pacer */
|
||||||
|
eoc = readb(sdp->iobase + PCI20341_STATUS_REG);
|
||||||
|
while ((eoc < 0x80) && j < 100) { /* poll Interrupt Flag */
|
||||||
|
j++;
|
||||||
|
eoc = readb(sdp->iobase + PCI20341_STATUS_REG);
|
||||||
|
}
|
||||||
|
if (j >= 100) {
|
||||||
|
printk("comedi%d: pci20xxx: AI interrupt channel %i polling exit !\n", dev->minor, i);
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
lo = readb(sdp->iobase + PCI20341_LDATA);
|
||||||
|
hi = readb(sdp->iobase + PCI20341_LDATA + 1);
|
||||||
|
boarddata = lo + 0x100 * hi;
|
||||||
|
data[i] = (sampl_t) ((boarddata + 0x8000) & 0xffff); /* board-data -> comedi-data */
|
||||||
|
}
|
||||||
|
|
||||||
|
return i;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* native DIO */
|
||||||
|
|
||||||
|
static void pci20xxx_dio_config(comedi_device * dev, comedi_subdevice * s);
|
||||||
|
static int pci20xxx_dio_insn_bits(comedi_device * dev, comedi_subdevice * s,
|
||||||
|
comedi_insn * insn, lsampl_t * data);
|
||||||
|
static int pci20xxx_dio_insn_config(comedi_device * dev, comedi_subdevice * s,
|
||||||
|
comedi_insn * insn, lsampl_t * data);
|
||||||
|
|
||||||
|
/* initialize pci20xxx_private */
|
||||||
|
static int pci20xxx_dio_init(comedi_device * dev, comedi_subdevice * s)
|
||||||
|
{
|
||||||
|
|
||||||
|
s->type = COMEDI_SUBD_DIO;
|
||||||
|
s->subdev_flags = SDF_READABLE | SDF_WRITABLE;
|
||||||
|
s->n_chan = 32;
|
||||||
|
s->insn_bits = pci20xxx_dio_insn_bits;
|
||||||
|
s->insn_config = pci20xxx_dio_insn_config;
|
||||||
|
s->maxdata = 1;
|
||||||
|
s->len_chanlist = 32;
|
||||||
|
s->range_table = &range_digital;
|
||||||
|
s->io_bits = 0;
|
||||||
|
|
||||||
|
/* digital I/O lines default to input on board reset. */
|
||||||
|
pci20xxx_dio_config(dev, s);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int pci20xxx_dio_insn_config(comedi_device * dev, comedi_subdevice * s,
|
||||||
|
comedi_insn * insn, lsampl_t * data)
|
||||||
|
{
|
||||||
|
int mask, bits;
|
||||||
|
|
||||||
|
mask = 1 << CR_CHAN(insn->chanspec);
|
||||||
|
if (mask & 0x000000ff) {
|
||||||
|
bits = 0x000000ff;
|
||||||
|
} else if (mask & 0x0000ff00) {
|
||||||
|
bits = 0x0000ff00;
|
||||||
|
} else if (mask & 0x00ff0000) {
|
||||||
|
bits = 0x00ff0000;
|
||||||
|
} else {
|
||||||
|
bits = 0xff000000;
|
||||||
|
}
|
||||||
|
if (data[0]) {
|
||||||
|
s->io_bits |= bits;
|
||||||
|
} else {
|
||||||
|
s->io_bits &= ~bits;
|
||||||
|
}
|
||||||
|
pci20xxx_dio_config(dev, s);
|
||||||
|
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int pci20xxx_dio_insn_bits(comedi_device * dev, comedi_subdevice * s,
|
||||||
|
comedi_insn * insn, lsampl_t * data)
|
||||||
|
{
|
||||||
|
unsigned int mask = data[0];
|
||||||
|
|
||||||
|
s->state &= ~mask;
|
||||||
|
s->state |= (mask & data[1]);
|
||||||
|
|
||||||
|
mask &= s->io_bits;
|
||||||
|
if (mask & 0x000000ff)
|
||||||
|
writeb((s->state >> 0) & 0xff,
|
||||||
|
devpriv->ioaddr + PCI20000_DIO_0);
|
||||||
|
if (mask & 0x0000ff00)
|
||||||
|
writeb((s->state >> 8) & 0xff,
|
||||||
|
devpriv->ioaddr + PCI20000_DIO_1);
|
||||||
|
if (mask & 0x00ff0000)
|
||||||
|
writeb((s->state >> 16) & 0xff,
|
||||||
|
devpriv->ioaddr + PCI20000_DIO_2);
|
||||||
|
if (mask & 0xff000000)
|
||||||
|
writeb((s->state >> 24) & 0xff,
|
||||||
|
devpriv->ioaddr + PCI20000_DIO_3);
|
||||||
|
|
||||||
|
data[1] = readb(devpriv->ioaddr + PCI20000_DIO_0);
|
||||||
|
data[1] |= readb(devpriv->ioaddr + PCI20000_DIO_1) << 8;
|
||||||
|
data[1] |= readb(devpriv->ioaddr + PCI20000_DIO_2) << 16;
|
||||||
|
data[1] |= readb(devpriv->ioaddr + PCI20000_DIO_3) << 24;
|
||||||
|
|
||||||
|
return 2;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void pci20xxx_dio_config(comedi_device * dev, comedi_subdevice * s)
|
||||||
|
{
|
||||||
|
unsigned char control_01;
|
||||||
|
unsigned char control_23;
|
||||||
|
unsigned char buffer;
|
||||||
|
|
||||||
|
control_01 = readb(devpriv->ioaddr + PCI20000_DIO_CONTROL_01);
|
||||||
|
control_23 = readb(devpriv->ioaddr + PCI20000_DIO_CONTROL_23);
|
||||||
|
buffer = readb(devpriv->ioaddr + PCI20000_DIO_BUFFER);
|
||||||
|
|
||||||
|
if (s->io_bits & 0x000000ff) {
|
||||||
|
/* output port 0 */
|
||||||
|
control_01 &= PCI20000_DIO_EOC;
|
||||||
|
buffer = (buffer & (~(DIO_BE << DIO_PS_0))) | (DIO_BO <<
|
||||||
|
DIO_PS_0);
|
||||||
|
} else {
|
||||||
|
/* input port 0 */
|
||||||
|
control_01 = (control_01 & DIO_CAND) | PCI20000_DIO_EIC;
|
||||||
|
buffer = (buffer & (~(DIO_BI << DIO_PS_0)));
|
||||||
|
}
|
||||||
|
if (s->io_bits & 0x0000ff00) {
|
||||||
|
/* output port 1 */
|
||||||
|
control_01 &= PCI20000_DIO_OOC;
|
||||||
|
buffer = (buffer & (~(DIO_BE << DIO_PS_1))) | (DIO_BO <<
|
||||||
|
DIO_PS_1);
|
||||||
|
} else {
|
||||||
|
/* input port 1 */
|
||||||
|
control_01 = (control_01 & DIO_CAND) | PCI20000_DIO_OIC;
|
||||||
|
buffer = (buffer & (~(DIO_BI << DIO_PS_1)));
|
||||||
|
}
|
||||||
|
if (s->io_bits & 0x00ff0000) {
|
||||||
|
/* output port 2 */
|
||||||
|
control_23 &= PCI20000_DIO_EOC;
|
||||||
|
buffer = (buffer & (~(DIO_BE << DIO_PS_2))) | (DIO_BO <<
|
||||||
|
DIO_PS_2);
|
||||||
|
} else {
|
||||||
|
/* input port 2 */
|
||||||
|
control_23 = (control_23 & DIO_CAND) | PCI20000_DIO_EIC;
|
||||||
|
buffer = (buffer & (~(DIO_BI << DIO_PS_2)));
|
||||||
|
}
|
||||||
|
if (s->io_bits & 0xff000000) {
|
||||||
|
/* output port 3 */
|
||||||
|
control_23 &= PCI20000_DIO_OOC;
|
||||||
|
buffer = (buffer & (~(DIO_BE << DIO_PS_3))) | (DIO_BO <<
|
||||||
|
DIO_PS_3);
|
||||||
|
} else {
|
||||||
|
/* input port 3 */
|
||||||
|
control_23 = (control_23 & DIO_CAND) | PCI20000_DIO_OIC;
|
||||||
|
buffer = (buffer & (~(DIO_BI << DIO_PS_3)));
|
||||||
|
}
|
||||||
|
writeb(control_01, devpriv->ioaddr + PCI20000_DIO_CONTROL_01);
|
||||||
|
writeb(control_23, devpriv->ioaddr + PCI20000_DIO_CONTROL_23);
|
||||||
|
writeb(buffer, devpriv->ioaddr + PCI20000_DIO_BUFFER);
|
||||||
|
}
|
||||||
|
|
||||||
|
#if 0
|
||||||
|
static void pci20xxx_do(comedi_device * dev, comedi_subdevice * s)
|
||||||
|
{
|
||||||
|
/* XXX if the channel is configured for input, does this
|
||||||
|
do bad things? */
|
||||||
|
/* XXX it would be a good idea to only update the registers
|
||||||
|
that _need_ to be updated. This requires changes to
|
||||||
|
comedi, however. */
|
||||||
|
writeb((s->state >> 0) & 0xff, devpriv->ioaddr + PCI20000_DIO_0);
|
||||||
|
writeb((s->state >> 8) & 0xff, devpriv->ioaddr + PCI20000_DIO_1);
|
||||||
|
writeb((s->state >> 16) & 0xff, devpriv->ioaddr + PCI20000_DIO_2);
|
||||||
|
writeb((s->state >> 24) & 0xff, devpriv->ioaddr + PCI20000_DIO_3);
|
||||||
|
}
|
||||||
|
|
||||||
|
static unsigned int pci20xxx_di(comedi_device * dev, comedi_subdevice * s)
|
||||||
|
{
|
||||||
|
/* XXX same note as above */
|
||||||
|
unsigned int bits;
|
||||||
|
|
||||||
|
bits = readb(devpriv->ioaddr + PCI20000_DIO_0);
|
||||||
|
bits |= readb(devpriv->ioaddr + PCI20000_DIO_1) << 8;
|
||||||
|
bits |= readb(devpriv->ioaddr + PCI20000_DIO_2) << 16;
|
||||||
|
bits |= readb(devpriv->ioaddr + PCI20000_DIO_3) << 24;
|
||||||
|
|
||||||
|
return bits;
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
COMEDI_INITCLEANUP(driver_pci20xxx);
|
Loading…
Reference in New Issue