staging: comedi: adl_pci9118: use comedi_timeout()
authorH Hartley Sweeten <hsweeten@visionengravers.com>
Mon, 10 Feb 2014 18:49:28 +0000 (11:49 -0700)
committerGreg Kroah-Hartman <gregkh@linuxfoundation.org>
Fri, 14 Feb 2014 17:28:45 +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/adl_pci9118.c

index ef5afdb..6492bd8 100644 (file)
@@ -571,12 +571,26 @@ static int setup_channel_list(struct comedi_device *dev,
        return 1;               /* we can serve this with scan logic */
 }
 
+static int pci9118_ai_eoc(struct comedi_device *dev,
+                         struct comedi_subdevice *s,
+                         struct comedi_insn *insn,
+                         unsigned long context)
+{
+       unsigned int status;
+
+       status = inl(dev->iobase + PCI9118_ADSTAT);
+       if (status & AdStatus_ADrdy)
+               return 0;
+       return -EBUSY;
+}
+
 static int pci9118_insn_read_ai(struct comedi_device *dev,
                                struct comedi_subdevice *s,
                                struct comedi_insn *insn, unsigned int *data)
 {
        struct pci9118_private *devpriv = dev->private;
-       int n, timeout;
+       int ret;
+       int n;
 
        devpriv->AdControlReg = AdControl_Int & 0xff;
        devpriv->AdFunctionReg = AdFunction_PDTrg | AdFunction_PETrg;
@@ -597,19 +611,15 @@ static int pci9118_insn_read_ai(struct comedi_device *dev,
        for (n = 0; n < insn->n; n++) {
                outw(0, dev->iobase + PCI9118_SOFTTRG); /* start conversion */
                udelay(2);
-               timeout = 100;
-               while (timeout--) {
-                       if (inl(dev->iobase + PCI9118_ADSTAT) & AdStatus_ADrdy)
-                               goto conv_finish;
-                       udelay(1);
-               }
 
-               comedi_error(dev, "A/D insn timeout");
-               data[n] = 0;
-               outl(0, dev->iobase + PCI9118_DELFIFO); /* flush FIFO */
-               return -ETIME;
+               ret = comedi_timeout(dev, s, insn, pci9118_ai_eoc, 0);
+               if (ret) {
+                       comedi_error(dev, "A/D insn timeout");
+                       data[n] = 0;
+                       outl(0, dev->iobase + PCI9118_DELFIFO); /* flush FIFO */
+                       return ret;
+               }
 
-conv_finish:
                if (devpriv->ai16bits) {
                        data[n] =
                            (inl(dev->iobase +