Commit 38a7d499 authored by H Hartley Sweeten's avatar H Hartley Sweeten Committed by Greg Kroah-Hartman

staging: comedi: das16: introduce struct das16_dma_desc

For aesthetics, introduce a struct to hold the DMA descriptor data.
Signed-off-by: default avatarH Hartley Sweeten <hsweeten@visionengravers.com>
Reviewed-by: default avatarIan Abbott <abbotti@mev.co.uk>
Signed-off-by: default avatarGreg Kroah-Hartman <gregkh@linuxfoundation.org>
parent ef98a104
...@@ -439,6 +439,11 @@ static inline int timer_period(void) ...@@ -439,6 +439,11 @@ static inline int timer_period(void)
return HZ / 20; return HZ / 20;
} }
struct das16_dma_desc {
uint16_t *virt_addr; /* virtual address of DMA buffer */
dma_addr_t hw_addr; /* hardware (bus) address of DMA buffer */
};
struct das16_private_struct { struct das16_private_struct {
unsigned int clockbase; unsigned int clockbase;
unsigned int ctrl_reg; unsigned int ctrl_reg;
...@@ -446,9 +451,8 @@ struct das16_private_struct { ...@@ -446,9 +451,8 @@ struct das16_private_struct {
unsigned int divisor1; unsigned int divisor1;
unsigned int divisor2; unsigned int divisor2;
unsigned int dma_chan; unsigned int dma_chan;
uint16_t *dma_buffer[2]; struct das16_dma_desc dma_desc[2];
dma_addr_t dma_buffer_addr[2]; unsigned int cur_dma;
unsigned int current_buffer;
unsigned int dma_transfer_size; unsigned int dma_transfer_size;
struct comedi_lrange *user_ai_range_table; struct comedi_lrange *user_ai_range_table;
struct comedi_lrange *user_ao_range_table; struct comedi_lrange *user_ao_range_table;
...@@ -528,11 +532,12 @@ static void das16_interrupt(struct comedi_device *dev) ...@@ -528,11 +532,12 @@ static void das16_interrupt(struct comedi_device *dev)
struct comedi_subdevice *s = dev->read_subdev; struct comedi_subdevice *s = dev->read_subdev;
struct comedi_async *async = s->async; struct comedi_async *async = s->async;
struct comedi_cmd *cmd = &async->cmd; struct comedi_cmd *cmd = &async->cmd;
struct das16_dma_desc *dma = &devpriv->dma_desc[devpriv->cur_dma];
struct das16_dma_desc *nxt_dma;
unsigned long spin_flags; unsigned long spin_flags;
unsigned long dma_flags; unsigned long dma_flags;
unsigned int nsamples; unsigned int nsamples;
int num_bytes, residue; int num_bytes, residue;
int buffer_index;
spin_lock_irqsave(&dev->spinlock, spin_flags); spin_lock_irqsave(&dev->spinlock, spin_flags);
if (!(devpriv->ctrl_reg & DAS16_CTRL_DMAE)) { if (!(devpriv->ctrl_reg & DAS16_CTRL_DMAE)) {
...@@ -558,14 +563,13 @@ static void das16_interrupt(struct comedi_device *dev) ...@@ -558,14 +563,13 @@ static void das16_interrupt(struct comedi_device *dev)
async->events |= COMEDI_CB_EOA; async->events |= COMEDI_CB_EOA;
} }
buffer_index = devpriv->current_buffer; devpriv->cur_dma = 1 - devpriv->cur_dma;
devpriv->current_buffer = (devpriv->current_buffer + 1) % 2;
devpriv->adc_byte_count -= num_bytes; devpriv->adc_byte_count -= num_bytes;
/* re-enable dma */ /* re-enable dma */
if ((async->events & COMEDI_CB_EOA) == 0) { if ((async->events & COMEDI_CB_EOA) == 0) {
set_dma_addr(devpriv->dma_chan, nxt_dma = &devpriv->dma_desc[devpriv->cur_dma];
devpriv->dma_buffer_addr[devpriv->current_buffer]); set_dma_addr(devpriv->dma_chan, nxt_dma->hw_addr);
set_dma_count(devpriv->dma_chan, devpriv->dma_transfer_size); set_dma_count(devpriv->dma_chan, devpriv->dma_transfer_size);
enable_dma(devpriv->dma_chan); enable_dma(devpriv->dma_chan);
} }
...@@ -574,8 +578,7 @@ static void das16_interrupt(struct comedi_device *dev) ...@@ -574,8 +578,7 @@ static void das16_interrupt(struct comedi_device *dev)
spin_unlock_irqrestore(&dev->spinlock, spin_flags); spin_unlock_irqrestore(&dev->spinlock, spin_flags);
nsamples = comedi_bytes_to_samples(s, num_bytes); nsamples = comedi_bytes_to_samples(s, num_bytes);
comedi_buf_write_samples(s, devpriv->dma_buffer[buffer_index], comedi_buf_write_samples(s, dma->virt_addr, nsamples);
nsamples);
comedi_handle_events(dev, s); comedi_handle_events(dev, s);
} }
...@@ -746,6 +749,7 @@ static int das16_cmd_exec(struct comedi_device *dev, struct comedi_subdevice *s) ...@@ -746,6 +749,7 @@ static int das16_cmd_exec(struct comedi_device *dev, struct comedi_subdevice *s)
{ {
const struct das16_board *board = dev->board_ptr; const struct das16_board *board = dev->board_ptr;
struct das16_private_struct *devpriv = dev->private; struct das16_private_struct *devpriv = dev->private;
struct das16_dma_desc *dma = &devpriv->dma_desc[0];
struct comedi_async *async = s->async; struct comedi_async *async = s->async;
struct comedi_cmd *cmd = &async->cmd; struct comedi_cmd *cmd = &async->cmd;
unsigned int byte; unsigned int byte;
...@@ -800,9 +804,8 @@ static int das16_cmd_exec(struct comedi_device *dev, struct comedi_subdevice *s) ...@@ -800,9 +804,8 @@ static int das16_cmd_exec(struct comedi_device *dev, struct comedi_subdevice *s)
/* clear flip-flop to make sure 2-byte registers for /* clear flip-flop to make sure 2-byte registers for
* count and address get set correctly */ * count and address get set correctly */
clear_dma_ff(devpriv->dma_chan); clear_dma_ff(devpriv->dma_chan);
devpriv->current_buffer = 0; devpriv->cur_dma = 0;
set_dma_addr(devpriv->dma_chan, set_dma_addr(devpriv->dma_chan, dma->hw_addr);
devpriv->dma_buffer_addr[devpriv->current_buffer]);
devpriv->dma_transfer_size = DAS16_DMA_SIZE; devpriv->dma_transfer_size = DAS16_DMA_SIZE;
set_dma_count(devpriv->dma_chan, devpriv->dma_transfer_size); set_dma_count(devpriv->dma_chan, devpriv->dma_transfer_size);
enable_dma(devpriv->dma_chan); enable_dma(devpriv->dma_chan);
...@@ -1067,13 +1070,13 @@ static int das16_attach(struct comedi_device *dev, struct comedi_devconfig *it) ...@@ -1067,13 +1070,13 @@ static int das16_attach(struct comedi_device *dev, struct comedi_devconfig *it)
/* allocate dma buffers */ /* allocate dma buffers */
for (i = 0; i < 2; i++) { for (i = 0; i < 2; i++) {
void *p; struct das16_dma_desc *dma = &devpriv->dma_desc[i];
p = pci_alloc_consistent(NULL, DAS16_DMA_SIZE, dma->virt_addr = pci_alloc_consistent(NULL,
&devpriv->dma_buffer_addr[i]); DAS16_DMA_SIZE,
if (!p) &dma->hw_addr);
if (!dma->virt_addr)
return -ENOMEM; return -ENOMEM;
devpriv->dma_buffer[i] = p;
} }
flags = claim_dma_lock(); flags = claim_dma_lock();
...@@ -1219,6 +1222,7 @@ static void das16_detach(struct comedi_device *dev) ...@@ -1219,6 +1222,7 @@ static void das16_detach(struct comedi_device *dev)
{ {
const struct das16_board *board = dev->board_ptr; const struct das16_board *board = dev->board_ptr;
struct das16_private_struct *devpriv = dev->private; struct das16_private_struct *devpriv = dev->private;
struct das16_dma_desc *dma;
int i; int i;
if (devpriv) { if (devpriv) {
...@@ -1228,11 +1232,11 @@ static void das16_detach(struct comedi_device *dev) ...@@ -1228,11 +1232,11 @@ static void das16_detach(struct comedi_device *dev)
das16_reset(dev); das16_reset(dev);
for (i = 0; i < 2; i++) { for (i = 0; i < 2; i++) {
if (devpriv->dma_buffer[i]) dma = &devpriv->dma_desc[i];
if (dma->virt_addr)
pci_free_consistent(NULL, DAS16_DMA_SIZE, pci_free_consistent(NULL, DAS16_DMA_SIZE,
devpriv->dma_buffer[i], dma->virt_addr,
devpriv-> dma->hw_addr);
dma_buffer_addr[i]);
} }
if (devpriv->dma_chan) if (devpriv->dma_chan)
free_dma(devpriv->dma_chan); free_dma(devpriv->dma_chan);
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment