Techwizz/kernel-fxtec-pro1x
1
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity

Staging: comedi: add pcm3730 driver

Browse source 
Driver for PCM3730 and clones

From: Blaine Lee <blee@tellurian-inc.com>
Cc: David Schleef <ds@schleef.org>
Cc: Ian Abbott <abbotti@mev.co.uk>
Cc: Frank Mori Hess <fmhess@users.sourceforge.net>
Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
This commit is contained in:
Blaine Lee 2009-02-19 10:24:49 -08:00 committed by Greg Kroah-Hartman
parent 028d486441
commit be06e5d50e
1 changed files with 152 additions and 0 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

152
drivers/staging/comedi/drivers/pcm3730.c Normal file
View file

@ -0,0 +1,152 @@
/*
* comedi/drivers/pcm3730.c
* Driver for PCM3730 and clones
* Blaine Lee
* from pcl725 by David S.
*/
/*
Driver: pcm3730
Description: PCM3730
Author: Blaine Lee
Devices: [Advantech] PCM-3730 (pcm3730)
Status: unknown
Configuration options:
[0] - I/O port base
*/
#include "../comedidev.h"
#include <linux/ioport.h>
#define PCM3730_SIZE 4 // consecutive io port addresses
#define PCM3730_DOA 0 // offsets for each port
#define PCM3730_DOB 2
#define PCM3730_DOC 3
#define PCM3730_DIA 0
#define PCM3730_DIB 2
#define PCM3730_DIC 3
static int pcm3730_attach(comedi_device * dev, comedi_devconfig * it);
static int pcm3730_detach(comedi_device * dev);
static comedi_driver driver_pcm3730 = {
driver_name:"pcm3730",
module:THIS_MODULE,
attach:pcm3730_attach,
detach:pcm3730_detach,
};
COMEDI_INITCLEANUP(driver_pcm3730);
static int pcm3730_do_insn_bits(comedi_device * dev, comedi_subdevice * s,
comedi_insn * insn, lsampl_t * data)
{
if (insn->n != 2)
return -EINVAL;
if (data[0]) {
s->state &= ~data[0];
s->state |= (data[0] & data[1]);
outb(s->state, dev->iobase + (unsigned long)(s->private));
}
data[1] = s->state;
return 2;
}
static int pcm3730_di_insn_bits(comedi_device * dev, comedi_subdevice * s,
comedi_insn * insn, lsampl_t * data)
{
if (insn->n != 2)
return -EINVAL;
data[1] = inb(dev->iobase + (unsigned long)(s->private));
return 2;
}
static int pcm3730_attach(comedi_device * dev, comedi_devconfig * it)
{
comedi_subdevice *s;
unsigned long iobase;
iobase = it->options[0];
printk("comedi%d: pcm3730: 0x%04lx ", dev->minor, iobase);
if (!request_region(iobase, PCM3730_SIZE, "pcm3730")) {
printk("I/O port conflict\n");
return -EIO;
}
dev->iobase = iobase;
dev->board_name = "pcm3730";
dev->iobase = dev->iobase;
dev->irq = 0;
if (alloc_subdevices(dev, 6) < 0)
return -ENOMEM;
s = dev->subdevices + 0;
s->type = COMEDI_SUBD_DO;
s->subdev_flags = SDF_WRITABLE;
s->maxdata = 1;
s->n_chan = 8;
s->insn_bits = pcm3730_do_insn_bits;
s->range_table = &range_digital;
s->private = (void *)PCM3730_DOA;
s = dev->subdevices + 1;
s->type = COMEDI_SUBD_DO;
s->subdev_flags = SDF_WRITABLE;
s->maxdata = 1;
s->n_chan = 8;
s->insn_bits = pcm3730_do_insn_bits;
s->range_table = &range_digital;
s->private = (void *)PCM3730_DOB;
s = dev->subdevices + 2;
s->type = COMEDI_SUBD_DO;
s->subdev_flags = SDF_WRITABLE;
s->maxdata = 1;
s->n_chan = 8;
s->insn_bits = pcm3730_do_insn_bits;
s->range_table = &range_digital;
s->private = (void *)PCM3730_DOC;
s = dev->subdevices + 3;
s->type = COMEDI_SUBD_DI;
s->subdev_flags = SDF_READABLE;
s->maxdata = 1;
s->n_chan = 8;
s->insn_bits = pcm3730_di_insn_bits;
s->range_table = &range_digital;
s->private = (void *)PCM3730_DIA;
s = dev->subdevices + 4;
s->type = COMEDI_SUBD_DI;
s->subdev_flags = SDF_READABLE;
s->maxdata = 1;
s->n_chan = 8;
s->insn_bits = pcm3730_di_insn_bits;
s->range_table = &range_digital;
s->private = (void *)PCM3730_DIB;
s = dev->subdevices + 5;
s->type = COMEDI_SUBD_DI;
s->subdev_flags = SDF_READABLE;
s->maxdata = 1;
s->n_chan = 8;
s->insn_bits = pcm3730_di_insn_bits;
s->range_table = &range_digital;
s->private = (void *)PCM3730_DIC;
printk("\n");
return 0;
}
static int pcm3730_detach(comedi_device * dev)
{
printk("comedi%d: pcm3730: remove\n", dev->minor);
if (dev->iobase)
release_region(dev->iobase, PCM3730_SIZE);
return 0;
}