staging: comedi: das1800: remove depends on ISA_DMA_API limitation
Use the new comedi_isadma module to provide the ISA DMA support. This removes all the ISA_DMA_API code from this driver and allows the driver to be used on platforms that don't support the ISA_DMA_API. Signed-off-by: H Hartley Sweeten <hsweeten@visionengravers.com> Reviewed-by: Ian Abbott <abbotti@mev.co.uk> Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
This commit is contained in:
Родитель
1400964a2b
Коммит
99dfc3357e
|
@ -309,7 +309,7 @@ config COMEDI_DAS800
|
||||||
|
|
||||||
config COMEDI_DAS1800
|
config COMEDI_DAS1800
|
||||||
tristate "DAS1800 and compatible ISA card support"
|
tristate "DAS1800 and compatible ISA card support"
|
||||||
depends on ISA_DMA_API
|
select COMEDI_ISADMA if ISA_DMA_API
|
||||||
---help---
|
---help---
|
||||||
Enable support for DAS1800 and compatible ISA cards
|
Enable support for DAS1800 and compatible ISA cards
|
||||||
Keithley Metrabyte DAS-1701ST, DAS-1701ST-DA, DAS-1701/AO,
|
Keithley Metrabyte DAS-1701ST, DAS-1701ST-DA, DAS-1701/AO,
|
||||||
|
|
|
@ -98,12 +98,12 @@ TODO:
|
||||||
#include <linux/interrupt.h>
|
#include <linux/interrupt.h>
|
||||||
#include <linux/slab.h>
|
#include <linux/slab.h>
|
||||||
#include <linux/io.h>
|
#include <linux/io.h>
|
||||||
|
|
||||||
#include "../comedidev.h"
|
#include "../comedidev.h"
|
||||||
|
|
||||||
#include <asm/dma.h>
|
#include "comedi_isadma.h"
|
||||||
|
|
||||||
#include "8253.h"
|
|
||||||
#include "comedi_fc.h"
|
#include "comedi_fc.h"
|
||||||
|
#include "8253.h"
|
||||||
|
|
||||||
/* misc. defines */
|
/* misc. defines */
|
||||||
#define DAS1800_SIZE 16 /* uses 16 io addresses */
|
#define DAS1800_SIZE 16 /* uses 16 io addresses */
|
||||||
|
@ -420,22 +420,14 @@ static const struct das1800_board das1800_boards[] = {
|
||||||
},
|
},
|
||||||
};
|
};
|
||||||
|
|
||||||
struct das1800_dma_desc {
|
|
||||||
unsigned int chan; /* DMA channel */
|
|
||||||
void *virt_addr; /* virtual address of DMA buffer */
|
|
||||||
dma_addr_t hw_addr; /* hardware (bus) address of DMA buffer */
|
|
||||||
unsigned int size; /* transfer size (in bytes) */
|
|
||||||
};
|
|
||||||
|
|
||||||
struct das1800_private {
|
struct das1800_private {
|
||||||
|
struct comedi_isadma *dma;
|
||||||
unsigned int divisor1; /* value to load into board's counter 1 for timed conversions */
|
unsigned int divisor1; /* value to load into board's counter 1 for timed conversions */
|
||||||
unsigned int divisor2; /* value to load into board's counter 2 for timed conversions */
|
unsigned int divisor2; /* value to load into board's counter 2 for timed conversions */
|
||||||
int irq_dma_bits; /* bits for control register b */
|
int irq_dma_bits; /* bits for control register b */
|
||||||
/* dma bits for control register b, stored so that dma can be
|
/* dma bits for control register b, stored so that dma can be
|
||||||
* turned on and off */
|
* turned on and off */
|
||||||
int dma_bits;
|
int dma_bits;
|
||||||
struct das1800_dma_desc dma_desc[2];
|
|
||||||
int cur_dma;
|
|
||||||
uint16_t *fifo_buf; /* bounce buffer for analog input FIFO */
|
uint16_t *fifo_buf; /* bounce buffer for analog input FIFO */
|
||||||
unsigned long iobase2; /* secondary io address used for analog out on 'ao' boards */
|
unsigned long iobase2; /* secondary io address used for analog out on 'ao' boards */
|
||||||
unsigned short ao_update_bits; /* remembers the last write to the
|
unsigned short ao_update_bits; /* remembers the last write to the
|
||||||
|
@ -452,32 +444,6 @@ static const struct comedi_lrange range_ao_2 = {
|
||||||
};
|
};
|
||||||
*/
|
*/
|
||||||
|
|
||||||
static void das1800_isadma_program(struct das1800_dma_desc *dma)
|
|
||||||
{
|
|
||||||
unsigned long flags;
|
|
||||||
|
|
||||||
flags = claim_dma_lock();
|
|
||||||
clear_dma_ff(dma->chan);
|
|
||||||
set_dma_mode(dma->chan, DMA_MODE_READ);
|
|
||||||
set_dma_addr(dma->chan, dma->hw_addr);
|
|
||||||
set_dma_count(dma->chan, dma->size);
|
|
||||||
enable_dma(dma->chan);
|
|
||||||
release_dma_lock(flags);
|
|
||||||
}
|
|
||||||
|
|
||||||
static unsigned int das1800_isadma_disable(unsigned int dma_chan)
|
|
||||||
{
|
|
||||||
unsigned long flags;
|
|
||||||
unsigned int residue;
|
|
||||||
|
|
||||||
flags = claim_dma_lock();
|
|
||||||
disable_dma(dma_chan);
|
|
||||||
residue = get_dma_residue(dma_chan);
|
|
||||||
release_dma_lock(flags);
|
|
||||||
|
|
||||||
return residue;
|
|
||||||
}
|
|
||||||
|
|
||||||
static inline uint16_t munge_bipolar_sample(const struct comedi_device *dev,
|
static inline uint16_t munge_bipolar_sample(const struct comedi_device *dev,
|
||||||
uint16_t sample)
|
uint16_t sample)
|
||||||
{
|
{
|
||||||
|
@ -540,18 +506,18 @@ static void das1800_handle_fifo_not_empty(struct comedi_device *dev,
|
||||||
/* Utility function used by das1800_flush_dma() and das1800_handle_dma() */
|
/* Utility function used by das1800_flush_dma() and das1800_handle_dma() */
|
||||||
static void das1800_flush_dma_channel(struct comedi_device *dev,
|
static void das1800_flush_dma_channel(struct comedi_device *dev,
|
||||||
struct comedi_subdevice *s,
|
struct comedi_subdevice *s,
|
||||||
struct das1800_dma_desc *dma)
|
struct comedi_isadma_desc *desc)
|
||||||
{
|
{
|
||||||
unsigned int residue = das1800_isadma_disable(dma->chan);
|
unsigned int residue = comedi_isadma_disable(desc->chan);
|
||||||
unsigned int nbytes = dma->size - residue;
|
unsigned int nbytes = desc->size - residue;
|
||||||
unsigned int nsamples;
|
unsigned int nsamples;
|
||||||
|
|
||||||
/* figure out how many points to read */
|
/* figure out how many points to read */
|
||||||
nsamples = comedi_bytes_to_samples(s, nbytes);
|
nsamples = comedi_bytes_to_samples(s, nbytes);
|
||||||
nsamples = comedi_nsamples_left(s, nsamples);
|
nsamples = comedi_nsamples_left(s, nsamples);
|
||||||
|
|
||||||
munge_data(dev, dma->virt_addr, nsamples);
|
munge_data(dev, desc->virt_addr, nsamples);
|
||||||
comedi_buf_write_samples(s, dma->virt_addr, nsamples);
|
comedi_buf_write_samples(s, desc->virt_addr, nsamples);
|
||||||
}
|
}
|
||||||
|
|
||||||
/* flushes remaining data from board when external trigger has stopped acquisition
|
/* flushes remaining data from board when external trigger has stopped acquisition
|
||||||
|
@ -560,16 +526,17 @@ static void das1800_flush_dma(struct comedi_device *dev,
|
||||||
struct comedi_subdevice *s)
|
struct comedi_subdevice *s)
|
||||||
{
|
{
|
||||||
struct das1800_private *devpriv = dev->private;
|
struct das1800_private *devpriv = dev->private;
|
||||||
struct das1800_dma_desc *dma = &devpriv->dma_desc[devpriv->cur_dma];
|
struct comedi_isadma *dma = devpriv->dma;
|
||||||
|
struct comedi_isadma_desc *desc = &dma->desc[dma->cur_dma];
|
||||||
const int dual_dma = devpriv->irq_dma_bits & DMA_DUAL;
|
const int dual_dma = devpriv->irq_dma_bits & DMA_DUAL;
|
||||||
|
|
||||||
das1800_flush_dma_channel(dev, s, dma);
|
das1800_flush_dma_channel(dev, s, desc);
|
||||||
|
|
||||||
if (dual_dma) {
|
if (dual_dma) {
|
||||||
/* switch to other channel and flush it */
|
/* switch to other channel and flush it */
|
||||||
devpriv->cur_dma = 1 - devpriv->cur_dma;
|
dma->cur_dma = 1 - dma->cur_dma;
|
||||||
dma = &devpriv->dma_desc[devpriv->cur_dma];
|
desc = &dma->desc[dma->cur_dma];
|
||||||
das1800_flush_dma_channel(dev, s, dma);
|
das1800_flush_dma_channel(dev, s, desc);
|
||||||
}
|
}
|
||||||
|
|
||||||
/* get any remaining samples in fifo */
|
/* get any remaining samples in fifo */
|
||||||
|
@ -580,27 +547,29 @@ static void das1800_handle_dma(struct comedi_device *dev,
|
||||||
struct comedi_subdevice *s, unsigned int status)
|
struct comedi_subdevice *s, unsigned int status)
|
||||||
{
|
{
|
||||||
struct das1800_private *devpriv = dev->private;
|
struct das1800_private *devpriv = dev->private;
|
||||||
struct das1800_dma_desc *dma = &devpriv->dma_desc[devpriv->cur_dma];
|
struct comedi_isadma *dma = devpriv->dma;
|
||||||
|
struct comedi_isadma_desc *desc = &dma->desc[dma->cur_dma];
|
||||||
const int dual_dma = devpriv->irq_dma_bits & DMA_DUAL;
|
const int dual_dma = devpriv->irq_dma_bits & DMA_DUAL;
|
||||||
|
|
||||||
das1800_flush_dma_channel(dev, s, dma);
|
das1800_flush_dma_channel(dev, s, desc);
|
||||||
|
|
||||||
/* re-enable dma channel */
|
/* re-enable dma channel */
|
||||||
das1800_isadma_program(dma);
|
comedi_isadma_program(desc);
|
||||||
|
|
||||||
if (status & DMATC) {
|
if (status & DMATC) {
|
||||||
/* clear DMATC interrupt bit */
|
/* clear DMATC interrupt bit */
|
||||||
outb(CLEAR_INTR_MASK & ~DMATC, dev->iobase + DAS1800_STATUS);
|
outb(CLEAR_INTR_MASK & ~DMATC, dev->iobase + DAS1800_STATUS);
|
||||||
/* switch dma channels for next time, if appropriate */
|
/* switch dma channels for next time, if appropriate */
|
||||||
if (dual_dma)
|
if (dual_dma)
|
||||||
devpriv->cur_dma = 1 - devpriv->cur_dma;
|
dma->cur_dma = 1 - dma->cur_dma;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
static int das1800_cancel(struct comedi_device *dev, struct comedi_subdevice *s)
|
static int das1800_cancel(struct comedi_device *dev, struct comedi_subdevice *s)
|
||||||
{
|
{
|
||||||
struct das1800_private *devpriv = dev->private;
|
struct das1800_private *devpriv = dev->private;
|
||||||
struct das1800_dma_desc *dma;
|
struct comedi_isadma *dma = devpriv->dma;
|
||||||
|
struct comedi_isadma_desc *desc;
|
||||||
int i;
|
int i;
|
||||||
|
|
||||||
outb(0x0, dev->iobase + DAS1800_STATUS); /* disable conversions */
|
outb(0x0, dev->iobase + DAS1800_STATUS); /* disable conversions */
|
||||||
|
@ -608,9 +577,9 @@ static int das1800_cancel(struct comedi_device *dev, struct comedi_subdevice *s)
|
||||||
outb(0x0, dev->iobase + DAS1800_CONTROL_A); /* disable and clear fifo and stop triggering */
|
outb(0x0, dev->iobase + DAS1800_CONTROL_A); /* disable and clear fifo and stop triggering */
|
||||||
|
|
||||||
for (i = 0; i < 2; i++) {
|
for (i = 0; i < 2; i++) {
|
||||||
dma = &devpriv->dma_desc[i];
|
desc = &dma->desc[i];
|
||||||
if (dma->chan)
|
if (desc->chan)
|
||||||
das1800_isadma_disable(dma->chan);
|
comedi_isadma_disable(desc->chan);
|
||||||
}
|
}
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
|
@ -968,10 +937,11 @@ static void das1800_setup_counters(struct comedi_device *dev,
|
||||||
|
|
||||||
static unsigned int das1800_ai_transfer_size(struct comedi_device *dev,
|
static unsigned int das1800_ai_transfer_size(struct comedi_device *dev,
|
||||||
struct comedi_subdevice *s,
|
struct comedi_subdevice *s,
|
||||||
|
unsigned int maxbytes,
|
||||||
unsigned int ns)
|
unsigned int ns)
|
||||||
{
|
{
|
||||||
struct comedi_cmd *cmd = &s->async->cmd;
|
struct comedi_cmd *cmd = &s->async->cmd;
|
||||||
unsigned int max_samples = comedi_bytes_to_samples(s, DMA_BUF_SIZE);
|
unsigned int max_samples = comedi_bytes_to_samples(s, maxbytes);
|
||||||
unsigned int samples;
|
unsigned int samples;
|
||||||
|
|
||||||
samples = max_samples;
|
samples = max_samples;
|
||||||
|
@ -1002,25 +972,26 @@ static void das1800_ai_setup_dma(struct comedi_device *dev,
|
||||||
struct comedi_subdevice *s)
|
struct comedi_subdevice *s)
|
||||||
{
|
{
|
||||||
struct das1800_private *devpriv = dev->private;
|
struct das1800_private *devpriv = dev->private;
|
||||||
struct das1800_dma_desc *dma = &devpriv->dma_desc[0];
|
struct comedi_isadma *dma = devpriv->dma;
|
||||||
|
struct comedi_isadma_desc *desc = &dma->desc[0];
|
||||||
unsigned int bytes;
|
unsigned int bytes;
|
||||||
|
|
||||||
if ((devpriv->irq_dma_bits & DMA_ENABLED) == 0)
|
if ((devpriv->irq_dma_bits & DMA_ENABLED) == 0)
|
||||||
return;
|
return;
|
||||||
|
|
||||||
devpriv->cur_dma = 0;
|
dma->cur_dma = 0;
|
||||||
|
|
||||||
/* determine a dma transfer size to fill buffer in 0.3 sec */
|
/* determine a dma transfer size to fill buffer in 0.3 sec */
|
||||||
bytes = das1800_ai_transfer_size(dev, s, 300000000);
|
bytes = das1800_ai_transfer_size(dev, s, desc->maxsize, 300000000);
|
||||||
|
|
||||||
dma->size = bytes;
|
desc->size = bytes;
|
||||||
das1800_isadma_program(dma);
|
comedi_isadma_program(desc);
|
||||||
|
|
||||||
/* set up dual dma if appropriate */
|
/* set up dual dma if appropriate */
|
||||||
if (devpriv->irq_dma_bits & DMA_DUAL) {
|
if (devpriv->irq_dma_bits & DMA_DUAL) {
|
||||||
dma = &devpriv->dma_desc[1];
|
desc = &dma->desc[1];
|
||||||
dma->size = bytes;
|
desc->size = bytes;
|
||||||
das1800_isadma_program(dma);
|
comedi_isadma_program(desc);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -1220,13 +1191,11 @@ static int das1800_do_wbits(struct comedi_device *dev,
|
||||||
return insn->n;
|
return insn->n;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int das1800_init_dma(struct comedi_device *dev,
|
static void das1800_init_dma(struct comedi_device *dev,
|
||||||
struct comedi_devconfig *it)
|
struct comedi_devconfig *it)
|
||||||
{
|
{
|
||||||
struct das1800_private *devpriv = dev->private;
|
struct das1800_private *devpriv = dev->private;
|
||||||
struct das1800_dma_desc *dma;
|
|
||||||
unsigned int *dma_chan;
|
unsigned int *dma_chan;
|
||||||
int i;
|
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* it->options[2] is DMA channel 0
|
* it->options[2] is DMA channel 0
|
||||||
|
@ -1238,75 +1207,41 @@ static int das1800_init_dma(struct comedi_device *dev,
|
||||||
|
|
||||||
switch ((dma_chan[0] & 0x7) | (dma_chan[1] << 4)) {
|
switch ((dma_chan[0] & 0x7) | (dma_chan[1] << 4)) {
|
||||||
case 0x5: /* dma0 == 5 */
|
case 0x5: /* dma0 == 5 */
|
||||||
devpriv->dma_bits |= DMA_CH5;
|
devpriv->dma_bits = DMA_CH5;
|
||||||
break;
|
break;
|
||||||
case 0x6: /* dma0 == 6 */
|
case 0x6: /* dma0 == 6 */
|
||||||
devpriv->dma_bits |= DMA_CH6;
|
devpriv->dma_bits = DMA_CH6;
|
||||||
break;
|
break;
|
||||||
case 0x7: /* dma0 == 7 */
|
case 0x7: /* dma0 == 7 */
|
||||||
devpriv->dma_bits |= DMA_CH7;
|
devpriv->dma_bits = DMA_CH7;
|
||||||
break;
|
break;
|
||||||
case 0x65: /* dma0 == 5, dma1 == 6 */
|
case 0x65: /* dma0 == 5, dma1 == 6 */
|
||||||
devpriv->dma_bits |= DMA_CH5_CH6;
|
devpriv->dma_bits = DMA_CH5_CH6;
|
||||||
break;
|
break;
|
||||||
case 0x76: /* dma0 == 6, dma1 == 7 */
|
case 0x76: /* dma0 == 6, dma1 == 7 */
|
||||||
devpriv->dma_bits |= DMA_CH6_CH7;
|
devpriv->dma_bits = DMA_CH6_CH7;
|
||||||
break;
|
break;
|
||||||
case 0x57: /* dma0 == 7, dma1 == 5 */
|
case 0x57: /* dma0 == 7, dma1 == 5 */
|
||||||
devpriv->dma_bits |= DMA_CH7_CH5;
|
devpriv->dma_bits = DMA_CH7_CH5;
|
||||||
break;
|
break;
|
||||||
default:
|
default:
|
||||||
dev_err(dev->class_dev,
|
return;
|
||||||
"only supports dma channels 5 through 7\n");
|
|
||||||
dev_err(dev->class_dev,
|
|
||||||
"Dual dma only allows the following combinations:\n");
|
|
||||||
dev_err(dev->class_dev,
|
|
||||||
"dma 5,6 / 6,7 / or 7,5\n");
|
|
||||||
return -EINVAL;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
for (i = 0; i < 2; i++) {
|
/* DMA can use 1 or 2 buffers, each with a separate channel */
|
||||||
dma = &devpriv->dma_desc[i];
|
devpriv->dma = comedi_isadma_alloc(dev, dma_chan[1] ? 2 : 1,
|
||||||
|
dma_chan[0], dma_chan[1],
|
||||||
if (dma_chan[i] == 0)
|
DMA_BUF_SIZE, COMEDI_ISADMA_READ);
|
||||||
break;
|
if (!devpriv->dma)
|
||||||
|
devpriv->dma_bits = 0;
|
||||||
if (request_dma(dma_chan[i], dev->board_name)) {
|
|
||||||
dev_err(dev->class_dev,
|
|
||||||
"failed to allocate dma channel %i\n",
|
|
||||||
dma_chan[i]);
|
|
||||||
return -EINVAL;
|
|
||||||
}
|
|
||||||
dma->chan = dma_chan[i];
|
|
||||||
|
|
||||||
dma->virt_addr = dma_alloc_coherent(NULL, DMA_BUF_SIZE,
|
|
||||||
&dma->hw_addr, GFP_KERNEL);
|
|
||||||
if (!dma->virt_addr)
|
|
||||||
return -ENOMEM;
|
|
||||||
|
|
||||||
das1800_isadma_disable(dma->chan);
|
|
||||||
}
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static void das1800_free_dma(struct comedi_device *dev)
|
static void das1800_free_dma(struct comedi_device *dev)
|
||||||
{
|
{
|
||||||
struct das1800_private *devpriv = dev->private;
|
struct das1800_private *devpriv = dev->private;
|
||||||
struct das1800_dma_desc *dma;
|
|
||||||
int i;
|
|
||||||
|
|
||||||
if (!devpriv)
|
if (devpriv)
|
||||||
return;
|
comedi_isadma_free(devpriv->dma);
|
||||||
|
|
||||||
for (i = 0; i < 2; i++) {
|
|
||||||
dma = &devpriv->dma_desc[i];
|
|
||||||
if (dma->chan)
|
|
||||||
free_dma(dma->chan);
|
|
||||||
if (dma->virt_addr)
|
|
||||||
dma_free_coherent(NULL, DMA_BUF_SIZE,
|
|
||||||
dma->virt_addr, dma->hw_addr);
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static int das1800_probe(struct comedi_device *dev)
|
static int das1800_probe(struct comedi_device *dev)
|
||||||
|
@ -1436,11 +1371,8 @@ static int das1800_attach(struct comedi_device *dev,
|
||||||
}
|
}
|
||||||
|
|
||||||
/* an irq and one dma channel is required to use dma */
|
/* an irq and one dma channel is required to use dma */
|
||||||
if (dev->irq & it->options[2]) {
|
if (dev->irq & it->options[2])
|
||||||
ret = das1800_init_dma(dev, it);
|
das1800_init_dma(dev, it);
|
||||||
if (ret < 0)
|
|
||||||
return ret;
|
|
||||||
}
|
|
||||||
|
|
||||||
devpriv->fifo_buf = kmalloc(FIFO_SIZE * sizeof(uint16_t), GFP_KERNEL);
|
devpriv->fifo_buf = kmalloc(FIFO_SIZE * sizeof(uint16_t), GFP_KERNEL);
|
||||||
if (!devpriv->fifo_buf)
|
if (!devpriv->fifo_buf)
|
||||||
|
|
Загрузка…
Ссылка в новой задаче