renegade-project/linux-next
2
0
Fork 0
mirror of https://github.com/edk2-porting/linux-next.git synced 2025-01-08 13:44:01 +08:00
Code

Staging: comedi: add fl212 driver

Browse Source 
Driver for FL512 board

From: Anders Gnistrup <ex18@kalman.iau.dtu.dk>
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:
Anders Gnistrup 2009-02-17 16:29:02 -08:00 committed by Greg Kroah-Hartman
parent 77e01cdbad
commit 9e27db79cc
1 changed files with 184 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

184
drivers/staging/comedi/drivers/fl512.c Normal file
View File

@ -0,0 +1,184 @@
/*
comedi/drivers/fl512.c
Anders Gnistrup <ex18@kalman.iau.dtu.dk>
*/
/*
Driver: fl512
Description: unknown
Author: Anders Gnistrup <ex18@kalman.iau.dtu.dk>
Devices: [unknown] FL512 (fl512)
Status: unknown
Digital I/O is not supported.
Configuration options:
[0] - I/O port base address
*/
#define DEBUG 0
#include "../comedidev.h"
#include <linux/delay.h>
#include <linux/ioport.h>
#define FL512_SIZE 16 /* the size of the used memory */
typedef struct {
sampl_t ao_readback[2];
} fl512_private;
#define devpriv ((fl512_private *) dev->private)
static const comedi_lrange range_fl512 = { 4, {
BIP_RANGE(0.5),
BIP_RANGE(1),
BIP_RANGE(5),
BIP_RANGE(10),
UNI_RANGE(1),
UNI_RANGE(5),
UNI_RANGE(10),
}
};
static int fl512_attach(comedi_device * dev, comedi_devconfig * it);
static int fl512_detach(comedi_device * dev);
static comedi_driver driver_fl512 = {
driver_name:"fl512",
module:THIS_MODULE,
attach:fl512_attach,
detach:fl512_detach,
};
COMEDI_INITCLEANUP(driver_fl512);
static int fl512_ai_insn(comedi_device * dev,
comedi_subdevice * s, comedi_insn * insn, lsampl_t * data);
static int fl512_ao_insn(comedi_device * dev,
comedi_subdevice * s, comedi_insn * insn, lsampl_t * data);
static int fl512_ao_insn_readback(comedi_device * dev,
comedi_subdevice * s, comedi_insn * insn, lsampl_t * data);
/*
* fl512_ai_insn : this is the analog input function
*/
static int fl512_ai_insn(comedi_device * dev,
comedi_subdevice * s, comedi_insn * insn, lsampl_t * data)
{
int n;
unsigned int lo_byte, hi_byte;
char chan = CR_CHAN(insn->chanspec);
unsigned long iobase = dev->iobase;
for (n = 0; n < insn->n; n++) { /* sample n times on selected channel */
/* XXX probably can move next step out of for() loop -- will make
* AI a little bit faster. */
outb(chan, iobase + 2); /* select chan */
outb(0, iobase + 3); /* start conversion */
/* XXX should test "done" flag instead of delay */
comedi_udelay(30); /* sleep 30 usec */
lo_byte = inb(iobase + 2); /* low 8 byte */
hi_byte = inb(iobase + 3) & 0xf; /* high 4 bit and mask */
data[n] = lo_byte + (hi_byte << 8);
}
return n;
}
/*
* fl512_ao_insn : used to write to a DA port n times
*/
static int fl512_ao_insn(comedi_device * dev,
comedi_subdevice * s, comedi_insn * insn, lsampl_t * data)
{
int n;
int chan = CR_CHAN(insn->chanspec); /* get chan to write */
unsigned long iobase = dev->iobase; /* get base address */
for (n = 0; n < insn->n; n++) { /* write n data set */
outb(data[n] & 0x0ff, iobase + 4 + 2 * chan); /* write low byte */
outb((data[n] & 0xf00) >> 8, iobase + 4 + 2 * chan); /* write high byte */
inb(iobase + 4 + 2 * chan); /* trig */
devpriv->ao_readback[chan] = data[n];
}
return n;
}
/*
* fl512_ao_insn_readback : used to read previous values written to
* DA port
*/
static int fl512_ao_insn_readback(comedi_device * dev,
comedi_subdevice * s, comedi_insn * insn, lsampl_t * data)
{
int n;
int chan = CR_CHAN(insn->chanspec);
for (n = 0; n < insn->n; n++) {
data[n] = devpriv->ao_readback[chan];
}
return n;
}
/*
* start attach
*/
static int fl512_attach(comedi_device * dev, comedi_devconfig * it)
{
unsigned long iobase;
comedi_subdevice *s; /* pointer to the subdevice:
Analog in, Analog out, ( not made ->and Digital IO) */
iobase = it->options[0];
printk("comedi:%d fl512: 0x%04lx", dev->minor, iobase);
if (!request_region(iobase, FL512_SIZE, "fl512")) {
printk(" I/O port conflict\n");
return -EIO;
}
dev->iobase = iobase;
dev->board_name = "fl512";
if (alloc_private(dev, sizeof(fl512_private)) < 0)
return -ENOMEM;
#if DEBUG
printk("malloc ok\n");
#endif
if (alloc_subdevices(dev, 2) < 0)
return -ENOMEM;
/*
* this if the definitions of the supdevices, 2 have been defined
*/
/* Analog indput */
s = dev->subdevices + 0;
s->type = COMEDI_SUBD_AI; /* define subdevice as Analog In */
s->subdev_flags = SDF_READABLE | SDF_GROUND; /* you can read it from userspace */
s->n_chan = 16; /* Number of Analog input channels */
s->maxdata = 0x0fff; /* accept only 12 bits of data */
s->range_table = &range_fl512; /* device use one of the ranges */
s->insn_read = fl512_ai_insn; /* function to call when read AD */
printk("comedi: fl512: subdevice 0 initialized\n");
/* Analog output */
s = dev->subdevices + 1;
s->type = COMEDI_SUBD_AO; /* define subdevice as Analog OUT */
s->subdev_flags = SDF_WRITABLE; /* you can write it from userspace */
s->n_chan = 2; /* Number of Analog output channels */
s->maxdata = 0x0fff; /* accept only 12 bits of data */
s->range_table = &range_fl512; /* device use one of the ranges */
s->insn_write = fl512_ao_insn; /* function to call when write DA */
s->insn_read = fl512_ao_insn_readback; /* function to call when reading DA */
printk("comedi: fl512: subdevice 1 initialized\n");
return 1;
}
static int fl512_detach(comedi_device * dev)
{
if (dev->iobase)
release_region(dev->iobase, FL512_SIZE);
printk("comedi%d: fl512: dummy i detach\n", dev->minor);
return 0;
}