staging: comedi: cb_pcidas64: use comedi_timeout()
authorH Hartley Sweeten <hsweeten@visionengravers.com>
Mon, 10 Feb 2014 18:49:16 +0000 (11:49 -0700)
committerGreg Kroah-Hartman <gregkh@linuxfoundation.org>
Fri, 14 Feb 2014 17:28:44 +0000 (09:28 -0800)
Use comedi_timeout() to wait for the analog input end-of-conversion.

Signed-off-by: H Hartley Sweeten <hsweeten@visionengravers.com>
Cc: Ian Abbott <abbotti@mev.co.uk>
Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
drivers/staging/comedi/drivers/cb_pcidas64.c

index 464c783e566ef3089e69493fb26343706c299b6e..21e13a5cea11edd9161f4f4dee498b4884b7b93e 100644 (file)
@@ -1664,15 +1664,36 @@ static void i2c_write(struct comedi_device *dev, unsigned int address,
        i2c_stop(dev);
 }
 
+static int cb_pcidas64_ai_eoc(struct comedi_device *dev,
+                             struct comedi_subdevice *s,
+                             struct comedi_insn *insn,
+                             unsigned long context)
+{
+       const struct pcidas64_board *thisboard = comedi_board(dev);
+       struct pcidas64_private *devpriv = dev->private;
+       unsigned int status;
+
+       status = readw(devpriv->main_iobase + HW_STATUS_REG);
+       if (thisboard->layout == LAYOUT_4020) {
+               status = readw(devpriv->main_iobase + ADC_WRITE_PNTR_REG);
+               if (status)
+                       return 0;
+       } else {
+               if (pipe_full_bits(status))
+                       return 0;
+       }
+       return -EBUSY;
+}
+
 static int ai_rinsn(struct comedi_device *dev, struct comedi_subdevice *s,
                    struct comedi_insn *insn, unsigned int *data)
 {
        const struct pcidas64_board *thisboard = comedi_board(dev);
        struct pcidas64_private *devpriv = dev->private;
-       unsigned int bits = 0, n, i;
+       unsigned int bits = 0, n;
        unsigned int channel, range, aref;
        unsigned long flags;
-       static const int timeout = 100;
+       int ret;
 
        channel = CR_CHAN(insn->chanspec);
        range = CR_RANGE(insn->chanspec);
@@ -1770,23 +1791,12 @@ static int ai_rinsn(struct comedi_device *dev, struct comedi_subdevice *s,
                       devpriv->main_iobase + ADC_CONVERT_REG);
 
                /*  wait for data */
-               for (i = 0; i < timeout; i++) {
-                       bits = readw(devpriv->main_iobase + HW_STATUS_REG);
-                       if (thisboard->layout == LAYOUT_4020) {
-                               if (readw(devpriv->main_iobase +
-                                         ADC_WRITE_PNTR_REG))
-                                       break;
-                       } else {
-                               if (pipe_full_bits(bits))
-                                       break;
-                       }
-                       udelay(1);
-               }
-               if (i == timeout) {
+               ret = comedi_timeout(dev, s, insn, cb_pcidas64_ai_eoc, 0);
+               if (ret) {
                        comedi_error(dev, " analog input read insn timed out");
-                       dev_info(dev->class_dev, "status 0x%x\n", bits);
-                       return -ETIME;
+                       return ret;
                }
+
                if (thisboard->layout == LAYOUT_4020)
                        data[n] = readl(devpriv->dio_counter_iobase +
                                        ADC_FIFO_REG) & 0xffff;