mirror of https://gitee.com/openkylin/linux.git
Staging: comedi: add dyna_pci10xx driver
For Dynalog PCI DAQ cards: PCI-1050 Signed-off-by: Prashant P. Shah <pshah.mumbai@gmail.com> Reviewed-by: Ian Abbott <abbotti@mev.co.uk> Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
This commit is contained in:
Prashant P. Shah
Greg Kroah-Hartman
parent
e4d59ac5c6
commit
16a7373a8e
|
|
@ -0,0 +1,462 @@
|
||||||
|
/*
|
||||||
|
* comedi/drivers/dyna_pci10xx.c
|
||||||
|
* Copyright (C) 2011 Prashant Shah, pshah.mumbai@gmail.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., 675 Mass Ave, Cambridge, MA 02139, USA.
|
||||||
|
*/
|
||||||
|
|
||||||
|
/*
|
||||||
|
Driver: dyna_pci10xx
|
||||||
|
Devices: Dynalog India PCI DAQ Cards, http://www.dynalogindia.com/
|
||||||
|
Author: Prashant Shah <pshah.mumbai@gmail.com>
|
||||||
|
Developed at Automation Labs, Chemical Dept., IIT Bombay, India.
|
||||||
|
Prof. Kannan Moudgalya <kannan@iitb.ac.in>
|
||||||
|
http://www.iitb.ac.in
|
||||||
|
Status: Stable
|
||||||
|
Version: 1.0
|
||||||
|
Device Supported :
|
||||||
|
- Dynalog PCI 1050
|
||||||
|
|
||||||
|
Notes :
|
||||||
|
- Dynalog India Pvt. Ltd. does not have a registered PCI Vendor ID and
|
||||||
|
they are using the PLX Technlogies Vendor ID since that is the PCI Chip used
|
||||||
|
in the card.
|
||||||
|
- Dynalog India Pvt. Ltd. has provided the internal register specification for
|
||||||
|
their cards in their manuals.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include "../comedidev.h"
|
||||||
|
#include "comedi_pci.h"
|
||||||
|
#include <linux/mutex.h>
|
||||||
|
|
||||||
|
#define PCI_VENDOR_ID_DYNALOG 0x10b5
|
||||||
|
#define DRV_NAME "dyna_pci10xx"
|
||||||
|
|
||||||
|
#define READ_TIMEOUT 50
|
||||||
|
|
||||||
|
static DEFINE_MUTEX(start_stop_sem);
|
||||||
|
|
||||||
|
static DEFINE_PCI_DEVICE_TABLE(dyna_pci10xx_pci_table) = {
|
||||||
|
{ PCI_DEVICE(PCI_VENDOR_ID_DYNALOG, 0x1050) },
|
||||||
|
{ 0 }
|
||||||
|
};
|
||||||
|
|
||||||
|
MODULE_DEVICE_TABLE(pci, dyna_pci10xx_pci_table);
|
||||||
|
|
||||||
|
static int dyna_pci10xx_attach(struct comedi_device *dev,
|
||||||
|
struct comedi_devconfig *it);
|
||||||
|
static int dyna_pci10xx_detach(struct comedi_device *dev);
|
||||||
|
|
||||||
|
static const struct comedi_lrange range_pci1050_ai = { 3, {
|
||||||
|
BIP_RANGE(10),
|
||||||
|
BIP_RANGE(5),
|
||||||
|
UNI_RANGE(10)
|
||||||
|
}
|
||||||
|
};
|
||||||
|
|
||||||
|
static const char range_codes_pci1050_ai[] = { 0x00, 0x10, 0x30 };
|
||||||
|
|
||||||
|
static const struct comedi_lrange range_pci1050_ao = { 1, {
|
||||||
|
UNI_RANGE(10)
|
||||||
|
}
|
||||||
|
};
|
||||||
|
|
||||||
|
static const char range_codes_pci1050_ao[] = { 0x00 };
|
||||||
|
|
||||||
|
struct boardtype {
|
||||||
|
const char *name;
|
||||||
|
int device_id;
|
||||||
|
int ai_chans;
|
||||||
|
int ai_bits;
|
||||||
|
int ao_chans;
|
||||||
|
int ao_bits;
|
||||||
|
int di_chans;
|
||||||
|
int di_bits;
|
||||||
|
int do_chans;
|
||||||
|
int do_bits;
|
||||||
|
const struct comedi_lrange *range_ai;
|
||||||
|
const char *range_codes_ai;
|
||||||
|
const struct comedi_lrange *range_ao;
|
||||||
|
const char *range_codes_ao;
|
||||||
|
};
|
||||||
|
|
||||||
|
static const struct boardtype boardtypes[] = {
|
||||||
|
{
|
||||||
|
.name = "dyna_pci1050",
|
||||||
|
.device_id = 0x1050,
|
||||||
|
.ai_chans = 16,
|
||||||
|
.ai_bits = 12,
|
||||||
|
.ao_chans = 16,
|
||||||
|
.ao_bits = 12,
|
||||||
|
.di_chans = 16,
|
||||||
|
.di_bits = 16,
|
||||||
|
.do_chans = 16,
|
||||||
|
.do_bits = 16,
|
||||||
|
.range_ai = &range_pci1050_ai,
|
||||||
|
.range_codes_ai = range_codes_pci1050_ai,
|
||||||
|
.range_ao = &range_pci1050_ao,
|
||||||
|
.range_codes_ao = range_codes_pci1050_ao,
|
||||||
|
},
|
||||||
|
/* dummy entry corresponding to driver name */
|
||||||
|
{.name = DRV_NAME},
|
||||||
|
};
|
||||||
|
|
||||||
|
static struct comedi_driver driver_dyna_pci10xx = {
|
||||||
|
.driver_name = DRV_NAME,
|
||||||
|
.module = THIS_MODULE,
|
||||||
|
.attach = dyna_pci10xx_attach,
|
||||||
|
.detach = dyna_pci10xx_detach,
|
||||||
|
.board_name = &boardtypes[0].name,
|
||||||
|
.offset = sizeof(struct boardtype),
|
||||||
|
.num_names = ARRAY_SIZE(boardtypes),
|
||||||
|
};
|
||||||
|
|
||||||
|
struct dyna_pci10xx_private {
|
||||||
|
struct pci_dev *pci_dev; /* ptr to PCI device */
|
||||||
|
char valid; /* card is usable */
|
||||||
|
struct mutex mutex;
|
||||||
|
|
||||||
|
/* device base address registers */
|
||||||
|
unsigned long BADR0, BADR1, BADR2, BADR3, BADR4, BADR5;
|
||||||
|
};
|
||||||
|
|
||||||
|
#define thisboard ((const struct boardtype *)dev->board_ptr)
|
||||||
|
#define devpriv ((struct dyna_pci10xx_private *)dev->private)
|
||||||
|
|
||||||
|
/******************************************************************************/
|
||||||
|
/************************** READ WRITE FUNCTIONS ******************************/
|
||||||
|
/******************************************************************************/
|
||||||
|
|
||||||
|
/* analog input callback */
|
||||||
|
static int dyna_pci10xx_insn_read_ai(struct comedi_device *dev,
|
||||||
|
struct comedi_subdevice *s,
|
||||||
|
struct comedi_insn *insn, unsigned int *data)
|
||||||
|
{
|
||||||
|
int n, counter;
|
||||||
|
u16 d = 0;
|
||||||
|
unsigned int chan, range;
|
||||||
|
|
||||||
|
/* get the channel number and range */
|
||||||
|
chan = CR_CHAN(insn->chanspec);
|
||||||
|
range = thisboard->range_codes_ai[CR_RANGE((insn->chanspec))];
|
||||||
|
|
||||||
|
mutex_lock(&devpriv->mutex);
|
||||||
|
/* convert n samples */
|
||||||
|
for (n = 0; n < insn->n; n++) {
|
||||||
|
/* trigger conversion */
|
||||||
|
smp_mb();
|
||||||
|
outw_p(0x0000 + range + chan, devpriv->BADR2 + 2);
|
||||||
|
udelay(10);
|
||||||
|
/* read data */
|
||||||
|
for (counter = 0; counter < READ_TIMEOUT; counter++) {
|
||||||
|
d = inw_p(devpriv->BADR2);
|
||||||
|
|
||||||
|
/* check if read is successfull if the EOC bit is set */
|
||||||
|
if (d & (1 << 15))
|
||||||
|
goto conv_finish;
|
||||||
|
}
|
||||||
|
data[n] = 0;
|
||||||
|
printk(KERN_DEBUG "comedi: dyna_pci10xx: "
|
||||||
|
"timeout reading analog input\n");
|
||||||
|
continue;
|
||||||
|
conv_finish:
|
||||||
|
/* mask the first 4 bits - EOC bits */
|
||||||
|
d &= 0x0FFF;
|
||||||
|
data[n] = d;
|
||||||
|
}
|
||||||
|
mutex_unlock(&devpriv->mutex);
|
||||||
|
|
||||||
|
/* return the number of samples read/written */
|
||||||
|
return n;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* analog output callback */
|
||||||
|
static int dyna_pci10xx_insn_write_ao(struct comedi_device *dev,
|
||||||
|
struct comedi_subdevice *s,
|
||||||
|
struct comedi_insn *insn, unsigned int *data)
|
||||||
|
{
|
||||||
|
int n;
|
||||||
|
unsigned int chan, range;
|
||||||
|
|
||||||
|
chan = CR_CHAN(insn->chanspec);
|
||||||
|
range = thisboard->range_codes_ai[CR_RANGE((insn->chanspec))];
|
||||||
|
|
||||||
|
mutex_lock(&devpriv->mutex);
|
||||||
|
for (n = 0; n < insn->n; n++) {
|
||||||
|
smp_mb();
|
||||||
|
/* trigger conversion and write data */
|
||||||
|
outw_p(data[n], devpriv->BADR2);
|
||||||
|
udelay(10);
|
||||||
|
}
|
||||||
|
mutex_unlock(&devpriv->mutex);
|
||||||
|
return n;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* digital input bit interface */
|
||||||
|
static int dyna_pci10xx_di_insn_bits(struct comedi_device *dev,
|
||||||
|
struct comedi_subdevice *s,
|
||||||
|
struct comedi_insn *insn, unsigned int *data)
|
||||||
|
{
|
||||||
|
u16 d = 0;
|
||||||
|
|
||||||
|
if (insn->n != 2)
|
||||||
|
return -EINVAL;
|
||||||
|
|
||||||
|
mutex_lock(&devpriv->mutex);
|
||||||
|
smp_mb();
|
||||||
|
d = inw_p(devpriv->BADR3);
|
||||||
|
udelay(10);
|
||||||
|
|
||||||
|
/* on return the data[0] contains output and data[1] contains input */
|
||||||
|
data[1] = d;
|
||||||
|
data[0] = s->state;
|
||||||
|
mutex_unlock(&devpriv->mutex);
|
||||||
|
return 2;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* digital output bit interface */
|
||||||
|
static int dyna_pci10xx_do_insn_bits(struct comedi_device *dev,
|
||||||
|
struct comedi_subdevice *s,
|
||||||
|
struct comedi_insn *insn, unsigned int *data)
|
||||||
|
{
|
||||||
|
if (insn->n != 2)
|
||||||
|
return -EINVAL;
|
||||||
|
|
||||||
|
/* The insn data is a mask in data[0] and the new data
|
||||||
|
* in data[1], each channel cooresponding to a bit.
|
||||||
|
* s->state contains the previous write data
|
||||||
|
*/
|
||||||
|
mutex_lock(&devpriv->mutex);
|
||||||
|
if (data[0]) {
|
||||||
|
s->state &= ~data[0];
|
||||||
|
s->state |= (data[0] & data[1]);
|
||||||
|
smp_mb();
|
||||||
|
outw_p(s->state, devpriv->BADR3);
|
||||||
|
udelay(10);
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* On return, data[1] contains the value of the digital
|
||||||
|
* input and output lines. We just return the software copy of the
|
||||||
|
* output values if it was a purely digital output subdevice.
|
||||||
|
*/
|
||||||
|
data[1] = s->state;
|
||||||
|
mutex_unlock(&devpriv->mutex);
|
||||||
|
return 2;
|
||||||
|
}
|
||||||
|
|
||||||
|
/******************************************************************************/
|
||||||
|
/*********************** INITIALIZATION FUNCTIONS *****************************/
|
||||||
|
/******************************************************************************/
|
||||||
|
|
||||||
|
static int dyna_pci10xx_attach(struct comedi_device *dev,
|
||||||
|
struct comedi_devconfig *it)
|
||||||
|
{
|
||||||
|
struct comedi_subdevice *s;
|
||||||
|
struct pci_dev *pcidev;
|
||||||
|
unsigned int opt_bus, opt_slot;
|
||||||
|
int board_index, i;
|
||||||
|
|
||||||
|
mutex_lock(&start_stop_sem);
|
||||||
|
|
||||||
|
if (alloc_private(dev, sizeof(struct dyna_pci10xx_private)) < 0) {
|
||||||
|
printk(KERN_ERR "comedi: dyna_pci10xx: "
|
||||||
|
"failed to allocate memory!\n");
|
||||||
|
mutex_unlock(&start_stop_sem);
|
||||||
|
return -ENOMEM;
|
||||||
|
}
|
||||||
|
|
||||||
|
opt_bus = it->options[0];
|
||||||
|
opt_slot = it->options[1];
|
||||||
|
dev->board_name = thisboard->name;
|
||||||
|
dev->irq = 0;
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Probe the PCI bus and located the matching device
|
||||||
|
*/
|
||||||
|
for (pcidev = pci_get_device(PCI_ANY_ID, PCI_ANY_ID, NULL);
|
||||||
|
pcidev != NULL;
|
||||||
|
pcidev = pci_get_device(PCI_ANY_ID, PCI_ANY_ID, pcidev)) {
|
||||||
|
|
||||||
|
board_index = -1;
|
||||||
|
for (i = 0; i < ARRAY_SIZE(boardtypes); ++i) {
|
||||||
|
if ((pcidev->vendor == PCI_VENDOR_ID_DYNALOG) &&
|
||||||
|
(pcidev->device == boardtypes[i].device_id)) {
|
||||||
|
board_index = i;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
if (board_index < 0)
|
||||||
|
continue;
|
||||||
|
|
||||||
|
/* Found matching vendor/device. */
|
||||||
|
if (opt_bus || opt_slot) {
|
||||||
|
/* Check bus/slot. */
|
||||||
|
if (opt_bus != pcidev->bus->number
|
||||||
|
|| opt_slot != PCI_SLOT(pcidev->devfn))
|
||||||
|
continue; /* no match */
|
||||||
|
}
|
||||||
|
|
||||||
|
goto found;
|
||||||
|
}
|
||||||
|
printk(KERN_ERR "comedi: dyna_pci10xx: no supported device found!\n");
|
||||||
|
mutex_unlock(&start_stop_sem);
|
||||||
|
return -EIO;
|
||||||
|
|
||||||
|
found:
|
||||||
|
|
||||||
|
if (!pcidev) {
|
||||||
|
if (opt_bus || opt_slot) {
|
||||||
|
printk(KERN_ERR "comedi: dyna_pci10xx: "
|
||||||
|
"invalid PCI device at b:s %d:%d\n",
|
||||||
|
opt_bus, opt_slot);
|
||||||
|
} else {
|
||||||
|
printk(KERN_ERR "comedi: dyna_pci10xx: "
|
||||||
|
"invalid PCI device\n");
|
||||||
|
}
|
||||||
|
mutex_unlock(&start_stop_sem);
|
||||||
|
return -EIO;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (comedi_pci_enable(pcidev, DRV_NAME)) {
|
||||||
|
printk(KERN_ERR "comedi: dyna_pci10xx: "
|
||||||
|
"failed to enable PCI device and request regions!");
|
||||||
|
mutex_unlock(&start_stop_sem);
|
||||||
|
return -EIO;
|
||||||
|
}
|
||||||
|
|
||||||
|
mutex_init(&devpriv->mutex);
|
||||||
|
dev->board_ptr = &boardtypes[board_index];
|
||||||
|
devpriv->pci_dev = pcidev;
|
||||||
|
|
||||||
|
printk(KERN_INFO "comedi: dyna_pci10xx: device found!\n");
|
||||||
|
|
||||||
|
/* initialize device base address registers */
|
||||||
|
devpriv->BADR0 = pci_resource_start(pcidev, 0);
|
||||||
|
devpriv->BADR1 = pci_resource_start(pcidev, 1);
|
||||||
|
devpriv->BADR2 = pci_resource_start(pcidev, 2);
|
||||||
|
devpriv->BADR3 = pci_resource_start(pcidev, 3);
|
||||||
|
devpriv->BADR4 = pci_resource_start(pcidev, 4);
|
||||||
|
devpriv->BADR5 = pci_resource_start(pcidev, 5);
|
||||||
|
|
||||||
|
if (alloc_subdevices(dev, 4) < 0) {
|
||||||
|
printk(KERN_ERR "comedi: dyna_pci10xx: "
|
||||||
|
"failed allocating subdevices\n");
|
||||||
|
mutex_unlock(&start_stop_sem);
|
||||||
|
return -ENOMEM;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* analog input */
|
||||||
|
s = dev->subdevices + 0;
|
||||||
|
s->type = COMEDI_SUBD_AI;
|
||||||
|
s->subdev_flags = SDF_READABLE | SDF_GROUND | SDF_DIFF;
|
||||||
|
s->n_chan = thisboard->ai_chans;
|
||||||
|
s->maxdata = 0x0FFF;
|
||||||
|
s->range_table = thisboard->range_ai;
|
||||||
|
s->len_chanlist = 16;
|
||||||
|
s->insn_read = dyna_pci10xx_insn_read_ai;
|
||||||
|
|
||||||
|
/* analog output */
|
||||||
|
s = dev->subdevices + 1;
|
||||||
|
s->type = COMEDI_SUBD_AO;
|
||||||
|
s->subdev_flags = SDF_WRITABLE;
|
||||||
|
s->n_chan = thisboard->ao_chans;
|
||||||
|
s->maxdata = 0x0FFF;
|
||||||
|
s->range_table = thisboard->range_ao;
|
||||||
|
s->len_chanlist = 16;
|
||||||
|
s->insn_write = dyna_pci10xx_insn_write_ao;
|
||||||
|
|
||||||
|
/* digital input */
|
||||||
|
s = dev->subdevices + 2;
|
||||||
|
s->type = COMEDI_SUBD_DI;
|
||||||
|
s->subdev_flags = SDF_READABLE | SDF_GROUND;
|
||||||
|
s->n_chan = thisboard->di_chans;
|
||||||
|
s->maxdata = 1;
|
||||||
|
s->range_table = &range_digital;
|
||||||
|
s->len_chanlist = thisboard->di_chans;
|
||||||
|
s->insn_bits = dyna_pci10xx_di_insn_bits;
|
||||||
|
|
||||||
|
/* digital output */
|
||||||
|
s = dev->subdevices + 3;
|
||||||
|
s->type = COMEDI_SUBD_DO;
|
||||||
|
s->subdev_flags = SDF_WRITABLE | SDF_GROUND;
|
||||||
|
s->n_chan = thisboard->do_chans;
|
||||||
|
s->maxdata = 1;
|
||||||
|
s->range_table = &range_digital;
|
||||||
|
s->len_chanlist = thisboard->do_chans;
|
||||||
|
s->state = 0;
|
||||||
|
s->insn_bits = dyna_pci10xx_do_insn_bits;
|
||||||
|
|
||||||
|
devpriv->valid = 1;
|
||||||
|
mutex_unlock(&start_stop_sem);
|
||||||
|
|
||||||
|
printk(KERN_INFO "comedi: dyna_pci10xx: %s - device setup completed!\n",
|
||||||
|
boardtypes[board_index].name);
|
||||||
|
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int dyna_pci10xx_detach(struct comedi_device *dev)
|
||||||
|
{
|
||||||
|
if (devpriv && devpriv->pci_dev) {
|
||||||
|
comedi_pci_disable(devpriv->pci_dev);
|
||||||
|
mutex_destroy(&devpriv->mutex);
|
||||||
|
}
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int __devinit driver_dyna_pci10xx_pci_probe(struct pci_dev *dev,
|
||||||
|
const struct pci_device_id *ent)
|
||||||
|
{
|
||||||
|
return comedi_pci_auto_config(dev, driver_dyna_pci10xx.driver_name);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void __devexit driver_dyna_pci10xx_pci_remove(struct pci_dev *dev)
|
||||||
|
{
|
||||||
|
comedi_pci_auto_unconfig(dev);
|
||||||
|
}
|
||||||
|
|
||||||
|
static struct pci_driver driver_dyna_pci10xx_pci_driver = {
|
||||||
|
.id_table = dyna_pci10xx_pci_table,
|
||||||
|
.probe = &driver_dyna_pci10xx_pci_probe,
|
||||||
|
.remove = __devexit_p(&driver_dyna_pci10xx_pci_remove)
|
||||||
|
};
|
||||||
|
|
||||||
|
static int __init driver_dyna_pci10xx_init_module(void)
|
||||||
|
{
|
||||||
|
int retval;
|
||||||
|
|
||||||
|
retval = comedi_driver_register(&driver_dyna_pci10xx);
|
||||||
|
if (retval < 0)
|
||||||
|
return retval;
|
||||||
|
|
||||||
|
driver_dyna_pci10xx_pci_driver.name =
|
||||||
|
(char *)driver_dyna_pci10xx.driver_name;
|
||||||
|
return pci_register_driver(&driver_dyna_pci10xx_pci_driver);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void __exit driver_dyna_pci10xx_cleanup_module(void)
|
||||||
|
{
|
||||||
|
pci_unregister_driver(&driver_dyna_pci10xx_pci_driver);
|
||||||
|
comedi_driver_unregister(&driver_dyna_pci10xx);
|
||||||
|
}
|
||||||
|
|
||||||
|
module_init(driver_dyna_pci10xx_init_module);
|
||||||
|
module_exit(driver_dyna_pci10xx_cleanup_module);
|
||||||
|
|
||||||
|
MODULE_LICENSE("GPL");
|
||||||
|
MODULE_AUTHOR("Prashant Shah <pshah.mumbai@gmail.com>");
|
||||||
|
MODULE_DESCRIPTION("Comedi based drivers for Dynalog PCI DAQ cards");
|
||||||
Loading…
Reference in New Issue