pcm3730.c

最新rtlinux内核源码

/*
 * Driver for PCM3730 and clones
 * Blaine Lee
 * from pcl725 by David S.
 */
/*
Driver: pcm3730.o
Description: PCM3730
Author: Blaine Lee
Devices: [Advantech] PCM-3730 (pcm3730)
Status: unknown

Configuration options:
  [0] - I/O port base
*/

#include <linux/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+(int)(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+(int)(s->private));
	return 2;
}

static int pcm3730_attach(comedi_device *dev,comedi_devconfig *it)
{
	comedi_subdevice *s;
	int iobase;

	iobase=it->options[0];
	printk("comedi%d: pcm3730: 0x%04x ",dev->minor,iobase);
	if(check_region(iobase,PCM3730_SIZE)<0){
		printk("I/O port conflict\n");
		return -EIO;
	}
	request_region(iobase,PCM3730_SIZE,"pcm3730");
	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;
}