staging: comedi: pcl812: tidy up the analog input (*insn_read)
authorH Hartley Sweeten <hsweeten@visionengravers.com>
Tue, 4 Mar 2014 18:30:02 +0000 (11:30 -0700)
committerGreg Kroah-Hartman <gregkh@linuxfoundation.org>
Fri, 7 Mar 2014 01:06:16 +0000 (17:06 -0800)
For aesthetics, move this function out of the async command support
code.

For safety, the INT request (end-of-conversion flag) should be cleared
before doing each conversion and after the final data sample is read.
The driver currently does not do this.

Refactor the function a bit so it's more like the pcl818 and pcl816
drivers and use common code to clear the flag for a timeout and after
the last sample.

Do a bit of other tidying up during the move.

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

index 734226eabaf1bb2e546633ff181e9b9008bf8ff1..cf183c86fb5bccb2a58266fdb2cad578c5b04638 100644 (file)
@@ -667,34 +667,6 @@ static int pcl812_ai_eoc(struct comedi_device *dev,
        return -EBUSY;
 }
 
-static int pcl812_ai_insn_read(struct comedi_device *dev,
-                              struct comedi_subdevice *s,
-                              struct comedi_insn *insn, unsigned int *data)
-{
-       struct pcl812_private *devpriv = dev->private;
-       int ret = 0;
-       int n;
-
-       /* select software trigger */
-       outb(devpriv->mode_reg_int | 1, dev->iobase + PCL812_MODE);
-       /*  select channel and renge */
-       setup_range_channel(dev, s, insn->chanspec, 1);
-       for (n = 0; n < insn->n; n++) {
-               /* start conversion */
-               outb(255, dev->iobase + PCL812_SOFTTRIG);
-               udelay(5);
-
-               ret = comedi_timeout(dev, s, insn, pcl812_ai_eoc, 0);
-               if (ret)
-                       break;
-
-               data[n] = pcl812_ai_get_sample(dev, s);
-       }
-       outb(devpriv->mode_reg_int | 0, dev->iobase + PCL812_MODE);
-
-       return ret ? ret : n;
-}
-
 static int pcl812_ai_cmdtest(struct comedi_device *dev,
                             struct comedi_subdevice *s, struct comedi_cmd *cmd)
 {
@@ -1033,6 +1005,40 @@ static int pcl812_ai_cancel(struct comedi_device *dev,
        return 0;
 }
 
+static int pcl812_ai_insn_read(struct comedi_device *dev,
+                              struct comedi_subdevice *s,
+                              struct comedi_insn *insn,
+                              unsigned int *data)
+{
+       struct pcl812_private *devpriv = dev->private;
+       int ret = 0;
+       int i;
+
+       /* select software trigger */
+       outb(devpriv->mode_reg_int | 1, dev->iobase + PCL812_MODE);
+
+       /*  select channel and renge */
+       setup_range_channel(dev, s, insn->chanspec, 1);
+
+       for (i = 0; i < insn->n; i++) {
+               /* clear INT request */
+               outb(0, dev->iobase + PCL812_CLRINT);
+               /* start conversion */
+               outb(255, dev->iobase + PCL812_SOFTTRIG);
+
+               ret = comedi_timeout(dev, s, insn, pcl812_ai_eoc, 0);
+               if (ret)
+                       break;
+
+               data[i] = pcl812_ai_get_sample(dev, s);
+       }
+       /* clear INT request */
+       outb(0, dev->iobase + PCL812_CLRINT);
+       outb(devpriv->mode_reg_int | 0, dev->iobase + PCL812_MODE);
+
+       return ret ? ret : insn->n;
+}
+
 static int pcl812_ao_insn_write(struct comedi_device *dev,
                                struct comedi_subdevice *s,
                                struct comedi_insn *insn,