Staging: comedi: add ni_labpc drivers
This supports National Instruments Lab-PC and compatibles From: Frank Mori Hess <fmhess@users.sourceforge.net> Cc: David Schleef <ds@schleef.org> Cc: Ian Abbott <abbotti@mev.co.uk> Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
This commit is contained in:
parent
59c7dd3dc3
commit
124b13b26d
3 changed files with 2664 additions and 0 deletions
2005
drivers/staging/comedi/drivers/ni_labpc.c
Normal file
2005
drivers/staging/comedi/drivers/ni_labpc.c
Normal file
File diff suppressed because it is too large
Load diff
85
drivers/staging/comedi/drivers/ni_labpc.h
Normal file
85
drivers/staging/comedi/drivers/ni_labpc.h
Normal file
|
@ -0,0 +1,85 @@
|
|||
/*
|
||||
ni_labpc.h
|
||||
|
||||
Header for ni_labpc.c and ni_labpc_cs.c
|
||||
|
||||
Copyright (C) 2003 Frank Mori Hess <fmhess@users.sourceforge.net>
|
||||
|
||||
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.
|
||||
|
||||
*/
|
||||
|
||||
#ifndef _NI_LABPC_H
|
||||
#define _NI_LABPC_H
|
||||
|
||||
#define EEPROM_SIZE 256 // 256 byte eeprom
|
||||
#define NUM_AO_CHAN 2 // boards have two analog output channels
|
||||
|
||||
enum labpc_bustype { isa_bustype, pci_bustype, pcmcia_bustype };
|
||||
enum labpc_register_layout { labpc_plus_layout, labpc_1200_layout };
|
||||
enum transfer_type { fifo_not_empty_transfer, fifo_half_full_transfer,
|
||||
isa_dma_transfer };
|
||||
|
||||
typedef struct labpc_board_struct {
|
||||
const char *name;
|
||||
int device_id; // device id for pci and pcmcia boards
|
||||
int ai_speed; // maximum input speed in nanoseconds
|
||||
enum labpc_bustype bustype; // ISA/PCI/etc.
|
||||
enum labpc_register_layout register_layout; // 1200 has extra registers compared to pc+
|
||||
int has_ao; // has analog output true/false
|
||||
const comedi_lrange *ai_range_table;
|
||||
const int *ai_range_code;
|
||||
const int *ai_range_is_unipolar;
|
||||
unsigned ai_scan_up:1; // board can auto scan up in ai channels, not just down
|
||||
unsigned memory_mapped_io:1; /* uses memory mapped io instead of ioports */
|
||||
} labpc_board;
|
||||
|
||||
typedef struct {
|
||||
struct mite_struct *mite; // for mite chip on pci-1200
|
||||
volatile unsigned long long count; /* number of data points left to be taken */
|
||||
unsigned int ao_value[NUM_AO_CHAN]; // software copy of analog output values
|
||||
// software copys of bits written to command registers
|
||||
volatile unsigned int command1_bits;
|
||||
volatile unsigned int command2_bits;
|
||||
volatile unsigned int command3_bits;
|
||||
volatile unsigned int command4_bits;
|
||||
volatile unsigned int command5_bits;
|
||||
volatile unsigned int command6_bits;
|
||||
// store last read of board status registers
|
||||
volatile unsigned int status1_bits;
|
||||
volatile unsigned int status2_bits;
|
||||
unsigned int divisor_a0; /* value to load into board's counter a0 (conversion pacing) for timed conversions */
|
||||
unsigned int divisor_b0; /* value to load into board's counter b0 (master) for timed conversions */
|
||||
unsigned int divisor_b1; /* value to load into board's counter b1 (scan pacing) for timed conversions */
|
||||
unsigned int dma_chan; // dma channel to use
|
||||
u16 *dma_buffer; // buffer ai will dma into
|
||||
unsigned int dma_transfer_size; // transfer size in bytes for current transfer
|
||||
enum transfer_type current_transfer; // we are using dma/fifo-half-full/etc.
|
||||
unsigned int eeprom_data[EEPROM_SIZE]; // stores contents of board's eeprom
|
||||
unsigned int caldac[16]; // stores settings of calibration dacs
|
||||
// function pointers so we can use inb/outb or readb/writeb as appropriate
|
||||
unsigned int (*read_byte) (unsigned long address);
|
||||
void (*write_byte) (unsigned int byte, unsigned long address);
|
||||
} labpc_private;
|
||||
|
||||
int labpc_common_attach(comedi_device * dev, unsigned long iobase,
|
||||
unsigned int irq, unsigned int dma);
|
||||
int labpc_common_detach(comedi_device * dev);
|
||||
|
||||
extern const int labpc_1200_is_unipolar[];
|
||||
extern const int labpc_1200_ai_gain_bits[];
|
||||
extern const comedi_lrange range_labpc_1200_ai;
|
||||
|
||||
#endif /* _NI_LABPC_H */
|
574
drivers/staging/comedi/drivers/ni_labpc_cs.c
Normal file
574
drivers/staging/comedi/drivers/ni_labpc_cs.c
Normal file
|
@ -0,0 +1,574 @@
|
|||
/*
|
||||
comedi/drivers/ni_labpc_cs.c
|
||||
Driver for National Instruments daqcard-1200 boards
|
||||
Copyright (C) 2001, 2002, 2003 Frank Mori Hess <fmhess@users.sourceforge.net>
|
||||
|
||||
PCMCIA crap is adapted from dummy_cs.c 1.31 2001/08/24 12:13:13
|
||||
from the pcmcia package.
|
||||
The initial developer of the pcmcia dummy_cs.c code is David A. Hinds
|
||||
<dahinds@users.sourceforge.net>. Portions created by David A. Hinds
|
||||
are Copyright (C) 1999 David A. Hinds.
|
||||
|
||||
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: ni_labpc_cs
|
||||
Description: National Instruments Lab-PC (& compatibles)
|
||||
Author: Frank Mori Hess <fmhess@users.sourceforge.net>
|
||||
Devices: [National Instruments] DAQCard-1200 (daqcard-1200)
|
||||
Status: works
|
||||
|
||||
Thanks go to Fredrik Lingvall for much testing and perseverance in
|
||||
helping to debug daqcard-1200 support.
|
||||
|
||||
The 1200 series boards have onboard calibration dacs for correcting
|
||||
analog input/output offsets and gains. The proper settings for these
|
||||
caldacs are stored on the board's eeprom. To read the caldac values
|
||||
from the eeprom and store them into a file that can be then be used by
|
||||
comedilib, use the comedi_calibrate program.
|
||||
|
||||
Configuration options:
|
||||
none
|
||||
|
||||
The daqcard-1200 has quirky chanlist requirements
|
||||
when scanning multiple channels. Multiple channel scan
|
||||
sequence must start at highest channel, then decrement down to
|
||||
channel 0. Chanlists consisting of all one channel
|
||||
are also legal, and allow you to pace conversions in bursts.
|
||||
|
||||
*/
|
||||
|
||||
/*
|
||||
|
||||
NI manuals:
|
||||
340988a (daqcard-1200)
|
||||
|
||||
*/
|
||||
|
||||
#undef LABPC_DEBUG
|
||||
//#define LABPC_DEBUG // enable debugging messages
|
||||
|
||||
#include "../comedidev.h"
|
||||
|
||||
#include <linux/delay.h>
|
||||
#include <linux/version.h>
|
||||
|
||||
#include "8253.h"
|
||||
#include "8255.h"
|
||||
#include "comedi_fc.h"
|
||||
#include "ni_labpc.h"
|
||||
|
||||
#include <pcmcia/cs_types.h>
|
||||
#include <pcmcia/cs.h>
|
||||
#include <pcmcia/cistpl.h>
|
||||
#include <pcmcia/cisreg.h>
|
||||
#include <pcmcia/ds.h>
|
||||
|
||||
static struct pcmcia_device *pcmcia_cur_dev = NULL;
|
||||
|
||||
static int labpc_attach(comedi_device * dev, comedi_devconfig * it);
|
||||
|
||||
static const labpc_board labpc_cs_boards[] = {
|
||||
{
|
||||
name: "daqcard-1200",
|
||||
device_id:0x103, // 0x10b is manufacturer id, 0x103 is device id
|
||||
ai_speed:10000,
|
||||
bustype: pcmcia_bustype,
|
||||
register_layout:labpc_1200_layout,
|
||||
has_ao: 1,
|
||||
ai_range_table:&range_labpc_1200_ai,
|
||||
ai_range_code:labpc_1200_ai_gain_bits,
|
||||
ai_range_is_unipolar:labpc_1200_is_unipolar,
|
||||
ai_scan_up:0,
|
||||
memory_mapped_io:0,
|
||||
},
|
||||
/* duplicate entry, to support using alternate name */
|
||||
{
|
||||
name: "ni_labpc_cs",
|
||||
device_id:0x103,
|
||||
ai_speed:10000,
|
||||
bustype: pcmcia_bustype,
|
||||
register_layout:labpc_1200_layout,
|
||||
has_ao: 1,
|
||||
ai_range_table:&range_labpc_1200_ai,
|
||||
ai_range_code:labpc_1200_ai_gain_bits,
|
||||
ai_range_is_unipolar:labpc_1200_is_unipolar,
|
||||
ai_scan_up:0,
|
||||
memory_mapped_io:0,
|
||||
},
|
||||
};
|
||||
|
||||
/*
|
||||
* Useful for shorthand access to the particular board structure
|
||||
*/
|
||||
#define thisboard ((const labpc_board *)dev->board_ptr)
|
||||
|
||||
static comedi_driver driver_labpc_cs = {
|
||||
.driver_name = "ni_labpc_cs",
|
||||
.module = THIS_MODULE,
|
||||
.attach = &labpc_attach,
|
||||
.detach = &labpc_common_detach,
|
||||
.num_names = sizeof(labpc_cs_boards) / sizeof(labpc_board),
|
||||
.board_name = &labpc_cs_boards[0].name,
|
||||
.offset = sizeof(labpc_board),
|
||||
};
|
||||
|
||||
static int labpc_attach(comedi_device * dev, comedi_devconfig * it)
|
||||
{
|
||||
unsigned long iobase = 0;
|
||||
unsigned int irq = 0;
|
||||
struct pcmcia_device *link;
|
||||
|
||||
/* allocate and initialize dev->private */
|
||||
if (alloc_private(dev, sizeof(labpc_private)) < 0)
|
||||
return -ENOMEM;
|
||||
|
||||
// get base address, irq etc. based on bustype
|
||||
switch (thisboard->bustype) {
|
||||
case pcmcia_bustype:
|
||||
link = pcmcia_cur_dev; /* XXX hack */
|
||||
if (!link)
|
||||
return -EIO;
|
||||
iobase = link->io.BasePort1;
|
||||
irq = link->irq.AssignedIRQ;
|
||||
break;
|
||||
default:
|
||||
printk("bug! couldn't determine board type\n");
|
||||
return -EINVAL;
|
||||
break;
|
||||
}
|
||||
return labpc_common_attach(dev, iobase, irq, 0);
|
||||
}
|
||||
|
||||
/*
|
||||
All the PCMCIA modules use PCMCIA_DEBUG to control debugging. If
|
||||
you do not define PCMCIA_DEBUG at all, all the debug code will be
|
||||
left out. If you compile with PCMCIA_DEBUG=0, the debug code will
|
||||
be present but disabled -- but it can then be enabled for specific
|
||||
modules at load time with a 'pc_debug=#' option to insmod.
|
||||
*/
|
||||
#ifdef PCMCIA_DEBUG
|
||||
static int pc_debug = PCMCIA_DEBUG;
|
||||
module_param(pc_debug, int, 0644);
|
||||
#define DEBUG(n, args...) if (pc_debug>(n)) printk(KERN_DEBUG args)
|
||||
static const char *version =
|
||||
"ni_labpc.c, based on dummy_cs.c 1.31 2001/08/24 12:13:13";
|
||||
#else
|
||||
#define DEBUG(n, args...)
|
||||
#endif
|
||||
|
||||
/*====================================================================*/
|
||||
|
||||
/*
|
||||
The event() function is this driver's Card Services event handler.
|
||||
It will be called by Card Services when an appropriate card status
|
||||
event is received. The config() and release() entry points are
|
||||
used to configure or release a socket, in response to card
|
||||
insertion and ejection events. They are invoked from the dummy
|
||||
event handler.
|
||||
|
||||
Kernel version 2.6.16 upwards uses suspend() and resume() functions
|
||||
instead of an event() function.
|
||||
*/
|
||||
|
||||
static void labpc_config(struct pcmcia_device *link);
|
||||
static void labpc_release(struct pcmcia_device *link);
|
||||
static int labpc_cs_suspend(struct pcmcia_device *p_dev);
|
||||
static int labpc_cs_resume(struct pcmcia_device *p_dev);
|
||||
|
||||
/*
|
||||
The attach() and detach() entry points are used to create and destroy
|
||||
"instances" of the driver, where each instance represents everything
|
||||
needed to manage one actual PCMCIA card.
|
||||
*/
|
||||
|
||||
static int labpc_cs_attach(struct pcmcia_device *);
|
||||
static void labpc_cs_detach(struct pcmcia_device *);
|
||||
|
||||
/*
|
||||
You'll also need to prototype all the functions that will actually
|
||||
be used to talk to your device. See 'memory_cs' for a good example
|
||||
of a fully self-sufficient driver; the other drivers rely more or
|
||||
less on other parts of the kernel.
|
||||
*/
|
||||
|
||||
/*
|
||||
The dev_info variable is the "key" that is used to match up this
|
||||
device driver with appropriate cards, through the card configuration
|
||||
database.
|
||||
*/
|
||||
|
||||
static const dev_info_t dev_info = "daqcard-1200";
|
||||
|
||||
typedef struct local_info_t {
|
||||
struct pcmcia_device *link;
|
||||
dev_node_t node;
|
||||
int stop;
|
||||
struct bus_operations *bus;
|
||||
} local_info_t;
|
||||
|
||||
/*======================================================================
|
||||
|
||||
labpc_cs_attach() creates an "instance" of the driver, allocating
|
||||
local data structures for one device. The device is registered
|
||||
with Card Services.
|
||||
|
||||
The dev_link structure is initialized, but we don't actually
|
||||
configure the card at this point -- we wait until we receive a
|
||||
card insertion event.
|
||||
|
||||
======================================================================*/
|
||||
|
||||
static int labpc_cs_attach(struct pcmcia_device *link)
|
||||
{
|
||||
local_info_t *local;
|
||||
|
||||
DEBUG(0, "labpc_cs_attach()\n");
|
||||
|
||||
/* Allocate space for private device-specific data */
|
||||
local = kzalloc(sizeof(local_info_t), GFP_KERNEL);
|
||||
if (!local)
|
||||
return -ENOMEM;
|
||||
local->link = link;
|
||||
link->priv = local;
|
||||
|
||||
/* Interrupt setup */
|
||||
link->irq.Attributes = IRQ_TYPE_EXCLUSIVE | IRQ_FORCED_PULSE;
|
||||
link->irq.IRQInfo1 = IRQ_INFO2_VALID | IRQ_PULSE_ID;
|
||||
link->irq.Handler = NULL;
|
||||
|
||||
/*
|
||||
General socket configuration defaults can go here. In this
|
||||
client, we assume very little, and rely on the CIS for almost
|
||||
everything. In most clients, many details (i.e., number, sizes,
|
||||
and attributes of IO windows) are fixed by the nature of the
|
||||
device, and can be hard-wired here.
|
||||
*/
|
||||
link->conf.Attributes = 0;
|
||||
link->conf.IntType = INT_MEMORY_AND_IO;
|
||||
|
||||
pcmcia_cur_dev = link;
|
||||
|
||||
labpc_config(link);
|
||||
|
||||
return 0;
|
||||
} /* labpc_cs_attach */
|
||||
|
||||
/*======================================================================
|
||||
|
||||
This deletes a driver "instance". The device is de-registered
|
||||
with Card Services. If it has been released, all local data
|
||||
structures are freed. Otherwise, the structures will be freed
|
||||
when the device is released.
|
||||
|
||||
======================================================================*/
|
||||
|
||||
static void labpc_cs_detach(struct pcmcia_device *link)
|
||||
{
|
||||
DEBUG(0, "labpc_cs_detach(0x%p)\n", link);
|
||||
|
||||
/*
|
||||
If the device is currently configured and active, we won't
|
||||
actually delete it yet. Instead, it is marked so that when
|
||||
the release() function is called, that will trigger a proper
|
||||
detach().
|
||||
*/
|
||||
if (link->dev_node) {
|
||||
((local_info_t *) link->priv)->stop = 1;
|
||||
labpc_release(link);
|
||||
}
|
||||
|
||||
/* This points to the parent local_info_t struct */
|
||||
if (link->priv)
|
||||
kfree(link->priv);
|
||||
|
||||
} /* labpc_cs_detach */
|
||||
|
||||
/*======================================================================
|
||||
|
||||
labpc_config() is scheduled to run after a CARD_INSERTION event
|
||||
is received, to configure the PCMCIA socket, and to make the
|
||||
device available to the system.
|
||||
|
||||
======================================================================*/
|
||||
|
||||
static void labpc_config(struct pcmcia_device *link)
|
||||
{
|
||||
local_info_t *dev = link->priv;
|
||||
tuple_t tuple;
|
||||
cisparse_t parse;
|
||||
int last_ret;
|
||||
u_char buf[64];
|
||||
win_req_t req;
|
||||
memreq_t map;
|
||||
cistpl_cftable_entry_t dflt = { 0 };
|
||||
|
||||
DEBUG(0, "labpc_config(0x%p)\n", link);
|
||||
|
||||
/*
|
||||
This reads the card's CONFIG tuple to find its configuration
|
||||
registers.
|
||||
*/
|
||||
tuple.DesiredTuple = CISTPL_CONFIG;
|
||||
tuple.Attributes = 0;
|
||||
tuple.TupleData = buf;
|
||||
tuple.TupleDataMax = sizeof(buf);
|
||||
tuple.TupleOffset = 0;
|
||||
if ((last_ret = pcmcia_get_first_tuple(link, &tuple))) {
|
||||
cs_error(link, GetFirstTuple, last_ret);
|
||||
goto cs_failed;
|
||||
}
|
||||
if ((last_ret = pcmcia_get_tuple_data(link, &tuple))) {
|
||||
cs_error(link, GetTupleData, last_ret);
|
||||
goto cs_failed;
|
||||
}
|
||||
if ((last_ret = pcmcia_parse_tuple(&tuple, &parse))) {
|
||||
cs_error(link, ParseTuple, last_ret);
|
||||
goto cs_failed;
|
||||
}
|
||||
link->conf.ConfigBase = parse.config.base;
|
||||
link->conf.Present = parse.config.rmask[0];
|
||||
|
||||
/*
|
||||
In this loop, we scan the CIS for configuration table entries,
|
||||
each of which describes a valid card configuration, including
|
||||
voltage, IO window, memory window, and interrupt settings.
|
||||
|
||||
We make no assumptions about the card to be configured: we use
|
||||
just the information available in the CIS. In an ideal world,
|
||||
this would work for any PCMCIA card, but it requires a complete
|
||||
and accurate CIS. In practice, a driver usually "knows" most of
|
||||
these things without consulting the CIS, and most client drivers
|
||||
will only use the CIS to fill in implementation-defined details.
|
||||
*/
|
||||
tuple.DesiredTuple = CISTPL_CFTABLE_ENTRY;
|
||||
if ((last_ret = pcmcia_get_first_tuple(link, &tuple))) {
|
||||
cs_error(link, GetFirstTuple, last_ret);
|
||||
goto cs_failed;
|
||||
}
|
||||
while (1) {
|
||||
cistpl_cftable_entry_t *cfg = &(parse.cftable_entry);
|
||||
if (pcmcia_get_tuple_data(link, &tuple))
|
||||
goto next_entry;
|
||||
if (pcmcia_parse_tuple(&tuple, &parse))
|
||||
goto next_entry;
|
||||
|
||||
if (cfg->flags & CISTPL_CFTABLE_DEFAULT)
|
||||
dflt = *cfg;
|
||||
if (cfg->index == 0)
|
||||
goto next_entry;
|
||||
link->conf.ConfigIndex = cfg->index;
|
||||
|
||||
/* Does this card need audio output? */
|
||||
if (cfg->flags & CISTPL_CFTABLE_AUDIO) {
|
||||
link->conf.Attributes |= CONF_ENABLE_SPKR;
|
||||
link->conf.Status = CCSR_AUDIO_ENA;
|
||||
}
|
||||
|
||||
/* Do we need to allocate an interrupt? */
|
||||
if (cfg->irq.IRQInfo1 || dflt.irq.IRQInfo1)
|
||||
link->conf.Attributes |= CONF_ENABLE_IRQ;
|
||||
|
||||
/* IO window settings */
|
||||
link->io.NumPorts1 = link->io.NumPorts2 = 0;
|
||||
if ((cfg->io.nwin > 0) || (dflt.io.nwin > 0)) {
|
||||
cistpl_io_t *io = (cfg->io.nwin) ? &cfg->io : &dflt.io;
|
||||
link->io.Attributes1 = IO_DATA_PATH_WIDTH_8;
|
||||
link->io.IOAddrLines = io->flags & CISTPL_IO_LINES_MASK;
|
||||
link->io.BasePort1 = io->win[0].base;
|
||||
link->io.NumPorts1 = io->win[0].len;
|
||||
if (io->nwin > 1) {
|
||||
link->io.Attributes2 = link->io.Attributes1;
|
||||
link->io.BasePort2 = io->win[1].base;
|
||||
link->io.NumPorts2 = io->win[1].len;
|
||||
}
|
||||
/* This reserves IO space but doesn't actually enable it */
|
||||
if (pcmcia_request_io(link, &link->io))
|
||||
goto next_entry;
|
||||
}
|
||||
|
||||
if ((cfg->mem.nwin > 0) || (dflt.mem.nwin > 0)) {
|
||||
cistpl_mem_t *mem =
|
||||
(cfg->mem.nwin) ? &cfg->mem : &dflt.mem;
|
||||
req.Attributes = WIN_DATA_WIDTH_16 | WIN_MEMORY_TYPE_CM;
|
||||
req.Attributes |= WIN_ENABLE;
|
||||
req.Base = mem->win[0].host_addr;
|
||||
req.Size = mem->win[0].len;
|
||||
if (req.Size < 0x1000)
|
||||
req.Size = 0x1000;
|
||||
req.AccessSpeed = 0;
|
||||
link->win = (window_handle_t) link;
|
||||
if (pcmcia_request_window(&link, &req, &link->win))
|
||||
goto next_entry;
|
||||
map.Page = 0;
|
||||
map.CardOffset = mem->win[0].card_addr;
|
||||
if (pcmcia_map_mem_page(link->win, &map))
|
||||
goto next_entry;
|
||||
}
|
||||
/* If we got this far, we're cool! */
|
||||
break;
|
||||
|
||||
next_entry:
|
||||
if ((last_ret = pcmcia_get_next_tuple(link, &tuple))) {
|
||||
cs_error(link, GetNextTuple, last_ret);
|
||||
goto cs_failed;
|
||||
}
|
||||
}
|
||||
|
||||
/*
|
||||
Allocate an interrupt line. Note that this does not assign a
|
||||
handler to the interrupt, unless the 'Handler' member of the
|
||||
irq structure is initialized.
|
||||
*/
|
||||
if (link->conf.Attributes & CONF_ENABLE_IRQ)
|
||||
if ((last_ret = pcmcia_request_irq(link, &link->irq))) {
|
||||
cs_error(link, RequestIRQ, last_ret);
|
||||
goto cs_failed;
|
||||
}
|
||||
|
||||
/*
|
||||
This actually configures the PCMCIA socket -- setting up
|
||||
the I/O windows and the interrupt mapping, and putting the
|
||||
card and host interface into "Memory and IO" mode.
|
||||
*/
|
||||
if ((last_ret = pcmcia_request_configuration(link, &link->conf))) {
|
||||
cs_error(link, RequestConfiguration, last_ret);
|
||||
goto cs_failed;
|
||||
}
|
||||
|
||||
/*
|
||||
At this point, the dev_node_t structure(s) need to be
|
||||
initialized and arranged in a linked list at link->dev.
|
||||
*/
|
||||
sprintf(dev->node.dev_name, "daqcard-1200");
|
||||
dev->node.major = dev->node.minor = 0;
|
||||
link->dev_node = &dev->node;
|
||||
|
||||
/* Finally, report what we've done */
|
||||
printk(KERN_INFO "%s: index 0x%02x",
|
||||
dev->node.dev_name, link->conf.ConfigIndex);
|
||||
if (link->conf.Attributes & CONF_ENABLE_IRQ)
|
||||
printk(", irq %d", link->irq.AssignedIRQ);
|
||||
if (link->io.NumPorts1)
|
||||
printk(", io 0x%04x-0x%04x", link->io.BasePort1,
|
||||
link->io.BasePort1 + link->io.NumPorts1 - 1);
|
||||
if (link->io.NumPorts2)
|
||||
printk(" & 0x%04x-0x%04x", link->io.BasePort2,
|
||||
link->io.BasePort2 + link->io.NumPorts2 - 1);
|
||||
if (link->win)
|
||||
printk(", mem 0x%06lx-0x%06lx", req.Base,
|
||||
req.Base + req.Size - 1);
|
||||
printk("\n");
|
||||
|
||||
return;
|
||||
|
||||
cs_failed:
|
||||
labpc_release(link);
|
||||
|
||||
} /* labpc_config */
|
||||
|
||||
static void labpc_release(struct pcmcia_device *link)
|
||||
{
|
||||
DEBUG(0, "labpc_release(0x%p)\n", link);
|
||||
|
||||
pcmcia_disable_device(link);
|
||||
} /* labpc_release */
|
||||
|
||||
/*======================================================================
|
||||
|
||||
The card status event handler. Mostly, this schedules other
|
||||
stuff to run after an event is received.
|
||||
|
||||
When a CARD_REMOVAL event is received, we immediately set a
|
||||
private flag to block future accesses to this device. All the
|
||||
functions that actually access the device should check this flag
|
||||
to make sure the card is still present.
|
||||
|
||||
======================================================================*/
|
||||
|
||||
static int labpc_cs_suspend(struct pcmcia_device *link)
|
||||
{
|
||||
local_info_t *local = link->priv;
|
||||
|
||||
/* Mark the device as stopped, to block IO until later */
|
||||
local->stop = 1;
|
||||
return 0;
|
||||
} /* labpc_cs_suspend */
|
||||
|
||||
static int labpc_cs_resume(struct pcmcia_device *link)
|
||||
{
|
||||
local_info_t *local = link->priv;
|
||||
|
||||
local->stop = 0;
|
||||
return 0;
|
||||
} /* labpc_cs_resume */
|
||||
|
||||
/*====================================================================*/
|
||||
|
||||
static struct pcmcia_device_id labpc_cs_ids[] = {
|
||||
/* N.B. These IDs should match those in labpc_cs_boards (ni_labpc.c) */
|
||||
PCMCIA_DEVICE_MANF_CARD(0x010b, 0x0103), /* daqcard-1200 */
|
||||
PCMCIA_DEVICE_NULL
|
||||
};
|
||||
|
||||
MODULE_DEVICE_TABLE(pcmcia, labpc_cs_ids);
|
||||
|
||||
struct pcmcia_driver labpc_cs_driver = {
|
||||
.probe = labpc_cs_attach,
|
||||
.remove = labpc_cs_detach,
|
||||
.suspend = labpc_cs_suspend,
|
||||
.resume = labpc_cs_resume,
|
||||
.id_table = labpc_cs_ids,
|
||||
.owner = THIS_MODULE,
|
||||
.drv = {
|
||||
.name = dev_info,
|
||||
},
|
||||
};
|
||||
|
||||
static int __init init_labpc_cs(void)
|
||||
{
|
||||
DEBUG(0, "%s\n", version);
|
||||
pcmcia_register_driver(&labpc_cs_driver);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void __exit exit_labpc_cs(void)
|
||||
{
|
||||
DEBUG(0, "ni_labpc: unloading\n");
|
||||
pcmcia_unregister_driver(&labpc_cs_driver);
|
||||
}
|
||||
|
||||
int __init labpc_init_module(void)
|
||||
{
|
||||
int ret;
|
||||
|
||||
ret = init_labpc_cs();
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
return comedi_driver_register(&driver_labpc_cs);
|
||||
}
|
||||
|
||||
void __exit labpc_exit_module(void)
|
||||
{
|
||||
exit_labpc_cs();
|
||||
comedi_driver_unregister(&driver_labpc_cs);
|
||||
}
|
||||
|
||||
MODULE_LICENSE("GPL");
|
||||
module_init(labpc_init_module);
|
||||
module_exit(labpc_exit_module);
|
Loading…
Add table
Reference in a new issue