diff --git a/drivers/staging/comedi/drivers/ni_labpc_isadma.c b/drivers/staging/comedi/drivers/ni_labpc_isadma.c index b7217a76df67c29b8d27b15e16789db55005a22a..829c4e447912780ff1674d06df609b9ba8ba962c 100644 --- a/drivers/staging/comedi/drivers/ni_labpc_isadma.c +++ b/drivers/staging/comedi/drivers/ni_labpc_isadma.c @@ -163,28 +163,24 @@ void labpc_handle_dma_status(struct comedi_device *dev) } EXPORT_SYMBOL_GPL(labpc_handle_dma_status); -int labpc_init_dma_chan(struct comedi_device *dev, unsigned int dma_chan) +void labpc_init_dma_chan(struct comedi_device *dev, unsigned int dma_chan) { struct labpc_private *devpriv = dev->private; struct labpc_dma_desc *dma = &devpriv->dma_desc; - void *dma_buffer; unsigned long dma_flags; - int ret; if (dma_chan != 1 && dma_chan != 3) - return -EINVAL; + return; - dma_buffer = kmalloc(dma_buffer_size, GFP_KERNEL | GFP_DMA); - if (!dma_buffer) - return -ENOMEM; + if (request_dma(dma_chan, dev->board_name)) + return; - ret = request_dma(dma_chan, dev->board_name); - if (ret) { - kfree(dma_buffer); - return ret; + dma->virt_addr = kmalloc(dma_buffer_size, GFP_KERNEL | GFP_DMA); + if (!dma->virt_addr) { + free_dma(dma_chan); + return; } - dma->virt_addr = dma_buffer; dma->chan = dma_chan; dma->hw_addr = virt_to_bus(dma->virt_addr); @@ -192,8 +188,6 @@ int labpc_init_dma_chan(struct comedi_device *dev, unsigned int dma_chan) disable_dma(dma->chan); set_dma_mode(dma->chan, DMA_MODE_READ); release_dma_lock(dma_flags); - - return 0; } EXPORT_SYMBOL_GPL(labpc_init_dma_chan); diff --git a/drivers/staging/comedi/drivers/ni_labpc_isadma.h b/drivers/staging/comedi/drivers/ni_labpc_isadma.h index 2582f22c5cdd8745b1a2bc1c1d447e03a0a9f460..8f062f70588367d29c31ae19999ffa403ce86a94 100644 --- a/drivers/staging/comedi/drivers/ni_labpc_isadma.h +++ b/drivers/staging/comedi/drivers/ni_labpc_isadma.h @@ -16,7 +16,7 @@ static inline bool labpc_have_dma_chan(struct comedi_device *dev) return (bool)devpriv->dma_desc.chan; } -int labpc_init_dma_chan(struct comedi_device *dev, unsigned int dma_chan); +void labpc_init_dma_chan(struct comedi_device *dev, unsigned int dma_chan); void labpc_free_dma_chan(struct comedi_device *dev); void labpc_setup_dma(struct comedi_device *dev, struct comedi_subdevice *s); void labpc_drain_dma(struct comedi_device *dev); @@ -29,10 +29,9 @@ static inline bool labpc_have_dma_chan(struct comedi_device *dev) return false; } -static inline int labpc_init_dma_chan(struct comedi_device *dev, - unsigned int dma_chan) +static inline void labpc_init_dma_chan(struct comedi_device *dev, + unsigned int dma_chan) { - return -ENOTSUPP; } static inline void labpc_free_dma_chan(struct comedi_device *dev)