Staging: comedi: add cb_pcidio driver
Driver for PCI-DIO24H & PCI-DIO48H of ComputerBoards (currently MeasurementComputing) From: Yoshiya Matsuzaka <matsuzay@mail.cc.tohoku.ac.jp> 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:
Yoshiya Matsuzaka
Greg Kroah-Hartman
parent
2c89e159cd
commit
028d486441
|
|
@ -0,0 +1,294 @@
|
||||||
|
/*
|
||||||
|
comedi/drivers/cb_pcidio.c
|
||||||
|
A Comedi driver for PCI-DIO24H & PCI-DIO48H of ComputerBoards (currently MeasurementComputing)
|
||||||
|
|
||||||
|
COMEDI - Linux Control and Measurement Device Interface
|
||||||
|
Copyright (C) 2000 David A. Schleef <ds@schleef.org>
|
||||||
|
|
||||||
|
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: cb_pcidio
|
||||||
|
Description: ComputerBoards' DIO boards with PCI interface
|
||||||
|
Devices: [Measurement Computing] PCI-DIO24 (cb_pcidio), PCI-DIO24H, PCI-DIO48H
|
||||||
|
Author: Yoshiya Matsuzaka
|
||||||
|
Updated: Mon, 29 Oct 2007 15:40:47 +0000
|
||||||
|
Status: experimental
|
||||||
|
|
||||||
|
This driver has been modified from skel.c of comedi-0.7.70.
|
||||||
|
|
||||||
|
Configuration Options:
|
||||||
|
[0] - PCI bus of device (optional)
|
||||||
|
[1] - PCI slot of device (optional)
|
||||||
|
If bus/slot is not specified, the first available PCI device will
|
||||||
|
be used.
|
||||||
|
|
||||||
|
Passing a zero for an option is the same as leaving it unspecified.
|
||||||
|
*/
|
||||||
|
|
||||||
|
/*------------------------------ HEADER FILES ---------------------------------*/
|
||||||
|
#include "../comedidev.h"
|
||||||
|
#include "comedi_pci.h"
|
||||||
|
#include "8255.h"
|
||||||
|
|
||||||
|
/*-------------------------- MACROS and DATATYPES -----------------------------*/
|
||||||
|
#define PCI_VENDOR_ID_CB 0x1307
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Board descriptions for two imaginary boards. Describing the
|
||||||
|
* boards in this way is optional, and completely driver-dependent.
|
||||||
|
* Some drivers use arrays such as this, other do not.
|
||||||
|
*/
|
||||||
|
typedef struct pcidio_board_struct {
|
||||||
|
const char *name; // anme of the board
|
||||||
|
int n_8255; // number of 8255 chips on board
|
||||||
|
|
||||||
|
// indices of base address regions
|
||||||
|
int pcicontroler_badrindex;
|
||||||
|
int dioregs_badrindex;
|
||||||
|
} pcidio_board;
|
||||||
|
|
||||||
|
static const pcidio_board pcidio_boards[] = {
|
||||||
|
{
|
||||||
|
name: "pci-dio24",
|
||||||
|
n_8255: 1,
|
||||||
|
pcicontroler_badrindex:1,
|
||||||
|
dioregs_badrindex:2,
|
||||||
|
},
|
||||||
|
{
|
||||||
|
name: "pci-dio24h",
|
||||||
|
n_8255: 1,
|
||||||
|
pcicontroler_badrindex:1,
|
||||||
|
dioregs_badrindex:2,
|
||||||
|
},
|
||||||
|
{
|
||||||
|
name: "pci-dio48h",
|
||||||
|
n_8255: 2,
|
||||||
|
pcicontroler_badrindex:0,
|
||||||
|
dioregs_badrindex:1,
|
||||||
|
},
|
||||||
|
};
|
||||||
|
|
||||||
|
/* This is used by modprobe to translate PCI IDs to drivers. Should
|
||||||
|
* only be used for PCI and ISA-PnP devices */
|
||||||
|
/* Please add your PCI vendor ID to comedidev.h, and it will be forwarded
|
||||||
|
* upstream. */
|
||||||
|
static DEFINE_PCI_DEVICE_TABLE(pcidio_pci_table) = {
|
||||||
|
{PCI_VENDOR_ID_CB, 0x0028, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
|
||||||
|
{PCI_VENDOR_ID_CB, 0x0014, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
|
||||||
|
{PCI_VENDOR_ID_CB, 0x000b, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
|
||||||
|
{0}
|
||||||
|
};
|
||||||
|
|
||||||
|
MODULE_DEVICE_TABLE(pci, pcidio_pci_table);
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Useful for shorthand access to the particular board structure
|
||||||
|
*/
|
||||||
|
#define thisboard ((const pcidio_board *)dev->board_ptr)
|
||||||
|
|
||||||
|
/* this structure is for data unique to this hardware driver. If
|
||||||
|
several hardware drivers keep similar information in this structure,
|
||||||
|
feel free to suggest moving the variable to the comedi_device struct. */
|
||||||
|
typedef struct {
|
||||||
|
int data; // curently unused
|
||||||
|
|
||||||
|
/* would be useful for a PCI device */
|
||||||
|
struct pci_dev *pci_dev;
|
||||||
|
|
||||||
|
/* used for DO readback, curently unused */
|
||||||
|
lsampl_t do_readback[4]; /* up to 4 lsampl_t suffice to hold 96 bits for PCI-DIO96 */
|
||||||
|
|
||||||
|
unsigned long dio_reg_base; // address of port A of the first 8255 chip on board
|
||||||
|
} pcidio_private;
|
||||||
|
|
||||||
|
/*
|
||||||
|
* most drivers define the following macro to make it easy to
|
||||||
|
* access the private structure.
|
||||||
|
*/
|
||||||
|
#define devpriv ((pcidio_private *)dev->private)
|
||||||
|
|
||||||
|
/*
|
||||||
|
* The comedi_driver structure tells the Comedi core module
|
||||||
|
* which functions to call to configure/deconfigure (attach/detach)
|
||||||
|
* the board, and also about the kernel module that contains
|
||||||
|
* the device code.
|
||||||
|
*/
|
||||||
|
static int pcidio_attach(comedi_device * dev, comedi_devconfig * it);
|
||||||
|
static int pcidio_detach(comedi_device * dev);
|
||||||
|
static comedi_driver driver_cb_pcidio = {
|
||||||
|
driver_name:"cb_pcidio",
|
||||||
|
module:THIS_MODULE,
|
||||||
|
attach:pcidio_attach,
|
||||||
|
detach:pcidio_detach,
|
||||||
|
/* It is not necessary to implement the following members if you are
|
||||||
|
* writing a driver for a ISA PnP or PCI card */
|
||||||
|
/* Most drivers will support multiple types of boards by
|
||||||
|
* having an array of board structures. These were defined
|
||||||
|
* in pcidio_boards[] above. Note that the element 'name'
|
||||||
|
* was first in the structure -- Comedi uses this fact to
|
||||||
|
* extract the name of the board without knowing any details
|
||||||
|
* about the structure except for its length.
|
||||||
|
* When a device is attached (by comedi_config), the name
|
||||||
|
* of the device is given to Comedi, and Comedi tries to
|
||||||
|
* match it by going through the list of board names. If
|
||||||
|
* there is a match, the address of the pointer is put
|
||||||
|
* into dev->board_ptr and driver->attach() is called.
|
||||||
|
*
|
||||||
|
* Note that these are not necessary if you can determine
|
||||||
|
* the type of board in software. ISA PnP, PCI, and PCMCIA
|
||||||
|
* devices are such boards.
|
||||||
|
*/
|
||||||
|
// The following fields should NOT be initialized if you are dealing with PCI devices
|
||||||
|
// board_name: pcidio_boards,
|
||||||
|
// offset: sizeof(pcidio_board),
|
||||||
|
// num_names: sizeof(pcidio_boards) / sizeof(pcidio_board),
|
||||||
|
};
|
||||||
|
|
||||||
|
/*------------------------------- FUNCTIONS -----------------------------------*/
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Attach is called by the Comedi core to configure the driver
|
||||||
|
* for a particular board. If you specified a board_name array
|
||||||
|
* in the driver structure, dev->board_ptr contains that
|
||||||
|
* address.
|
||||||
|
*/
|
||||||
|
static int pcidio_attach(comedi_device * dev, comedi_devconfig * it)
|
||||||
|
{
|
||||||
|
struct pci_dev *pcidev = NULL;
|
||||||
|
int index;
|
||||||
|
int i;
|
||||||
|
|
||||||
|
printk("comedi%d: cb_pcidio: \n", dev->minor);
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Allocate the private structure area. alloc_private() is a
|
||||||
|
* convenient macro defined in comedidev.h.
|
||||||
|
*/
|
||||||
|
if (alloc_private(dev, sizeof(pcidio_private)) < 0)
|
||||||
|
return -ENOMEM;
|
||||||
|
/*
|
||||||
|
* If you can probe the device to determine what device in a series
|
||||||
|
* it is, this is the place to do it. Otherwise, dev->board_ptr
|
||||||
|
* should already be initialized.
|
||||||
|
*/
|
||||||
|
/*
|
||||||
|
* Probe the device to determine what device in the series it is.
|
||||||
|
*/
|
||||||
|
|
||||||
|
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)) {
|
||||||
|
// is it not a computer boards card?
|
||||||
|
if (pcidev->vendor != PCI_VENDOR_ID_CB)
|
||||||
|
continue;
|
||||||
|
// loop through cards supported by this driver
|
||||||
|
for (index = 0;
|
||||||
|
index < sizeof pcidio_boards / sizeof(pcidio_board);
|
||||||
|
index++) {
|
||||||
|
if (pcidio_pci_table[index].device != pcidev->device)
|
||||||
|
continue;
|
||||||
|
|
||||||
|
// was a particular bus/slot requested?
|
||||||
|
if (it->options[0] || it->options[1]) {
|
||||||
|
// are we on the wrong bus/slot?
|
||||||
|
if (pcidev->bus->number != it->options[0] ||
|
||||||
|
PCI_SLOT(pcidev->devfn) !=
|
||||||
|
it->options[1]) {
|
||||||
|
continue;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
dev->board_ptr = pcidio_boards + index;
|
||||||
|
goto found;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
printk("No supported ComputerBoards/MeasurementComputing card found on "
|
||||||
|
"requested position\n");
|
||||||
|
return -EIO;
|
||||||
|
|
||||||
|
found:
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Initialize dev->board_name. Note that we can use the "thisboard"
|
||||||
|
* macro now, since we just initialized it in the last line.
|
||||||
|
*/
|
||||||
|
dev->board_name = thisboard->name;
|
||||||
|
|
||||||
|
devpriv->pci_dev = pcidev;
|
||||||
|
printk("Found %s on bus %i, slot %i\n", thisboard->name,
|
||||||
|
devpriv->pci_dev->bus->number,
|
||||||
|
PCI_SLOT(devpriv->pci_dev->devfn));
|
||||||
|
if (comedi_pci_enable(pcidev, thisboard->name)) {
|
||||||
|
printk("cb_pcidio: failed to enable PCI device and request regions\n");
|
||||||
|
return -EIO;
|
||||||
|
}
|
||||||
|
devpriv->dio_reg_base
|
||||||
|
=
|
||||||
|
pci_resource_start(devpriv->pci_dev,
|
||||||
|
pcidio_boards[index].dioregs_badrindex);
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Allocate the subdevice structures. alloc_subdevice() is a
|
||||||
|
* convenient macro defined in comedidev.h.
|
||||||
|
*/
|
||||||
|
if (alloc_subdevices(dev, thisboard->n_8255) < 0)
|
||||||
|
return -ENOMEM;
|
||||||
|
|
||||||
|
for (i = 0; i < thisboard->n_8255; i++) {
|
||||||
|
subdev_8255_init(dev, dev->subdevices + i,
|
||||||
|
NULL, devpriv->dio_reg_base + i * 4);
|
||||||
|
printk(" subdev %d: base = 0x%lx\n", i,
|
||||||
|
devpriv->dio_reg_base + i * 4);
|
||||||
|
}
|
||||||
|
|
||||||
|
printk("attached\n");
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* _detach is called to deconfigure a device. It should deallocate
|
||||||
|
* resources.
|
||||||
|
* This function is also called when _attach() fails, so it should be
|
||||||
|
* careful not to release resources that were not necessarily
|
||||||
|
* allocated by _attach(). dev->private and dev->subdevices are
|
||||||
|
* deallocated automatically by the core.
|
||||||
|
*/
|
||||||
|
static int pcidio_detach(comedi_device * dev)
|
||||||
|
{
|
||||||
|
printk("comedi%d: cb_pcidio: remove\n", dev->minor);
|
||||||
|
if (devpriv) {
|
||||||
|
if (devpriv->pci_dev) {
|
||||||
|
if (devpriv->dio_reg_base) {
|
||||||
|
comedi_pci_disable(devpriv->pci_dev);
|
||||||
|
}
|
||||||
|
pci_dev_put(devpriv->pci_dev);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
if (dev->subdevices) {
|
||||||
|
int i;
|
||||||
|
for (i = 0; i < thisboard->n_8255; i++) {
|
||||||
|
subdev_8255_cleanup(dev, dev->subdevices + i);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* A convenient macro that defines init_module() and cleanup_module(),
|
||||||
|
* as necessary.
|
||||||
|
*/
|
||||||
|
COMEDI_PCI_INITCLEANUP(driver_cb_pcidio, pcidio_pci_table);
|
||||||
Loading…
Reference in New Issue