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

index e9d47045993308510060d5705b3d879164f0eaa0..db00d079c9c93b48439219d1dc59734e23f006ce 100644 (file)
@@ -160,16 +160,25 @@ static int pcl816_ai_cmdtest(struct comedi_device *dev,
                             struct comedi_cmd *cmd);
 static int pcl816_ai_cmd(struct comedi_device *dev, struct comedi_subdevice *s);
 
-/*
-==============================================================================
-   ANALOG INPUT MODE0, 816 cards, slow version
-*/
+static int pcl816_ai_eoc(struct comedi_device *dev,
+                        struct comedi_subdevice *s,
+                        struct comedi_insn *insn,
+                        unsigned long context)
+{
+       unsigned int status;
+
+       status = inb(dev->iobase + PCL816_STATUS);
+       if ((status & PCL816_STATUS_DRDY_MASK) == 0)
+               return 0;
+       return -EBUSY;
+}
+
 static int pcl816_ai_insn_read(struct comedi_device *dev,
                               struct comedi_subdevice *s,
                               struct comedi_insn *insn, unsigned int *data)
 {
+       int ret;
        int n;
-       int timeout;
 
        /*  software trigger, DMA and INT off */
        outb(0, dev->iobase + PCL816_CONTROL);
@@ -185,30 +194,20 @@ static int pcl816_ai_insn_read(struct comedi_device *dev,
 
                outb(0, dev->iobase + PCL816_AD_LO);    /* start conversion */
 
-               timeout = 100;
-               while (timeout--) {
-                       if (!(inb(dev->iobase + PCL816_STATUS) &
-                             PCL816_STATUS_DRDY_MASK)) {
-                               /*  return read value */
-                               data[n] =
-                                   ((inb(dev->iobase +
-                                         PCL816_AD_HI) << 8) |
-                                    (inb(dev->iobase + PCL816_AD_LO)));
-                               /* clear INT (conversion end) flag */
-                               outb(0, dev->iobase + PCL816_CLRINT);
-                               break;
-                       }
-                       udelay(1);
-               }
-               /*  Return timeout error */
-               if (!timeout) {
+               ret = comedi_timeout(dev, s, insn, pcl816_ai_eoc, 0);
+               if (ret) {
                        comedi_error(dev, "A/D insn timeout\n");
                        data[0] = 0;
                        /* clear INT (conversion end) flag */
                        outb(0, dev->iobase + PCL816_CLRINT);
-                       return -EIO;
+                       return ret;
                }
 
+               /*  return read value */
+               data[n] = ((inb(dev->iobase + PCL816_AD_HI) << 8) |
+                         (inb(dev->iobase + PCL816_AD_LO)));
+               /* clear INT (conversion end) flag */
+               outb(0, dev->iobase + PCL816_CLRINT);
        }
        return n;
 }