As pointed out by Ian Abbott, the i8254_load() function does not
use the I8254_MODE* values to specify the "mode".

Refactor the 8254 timer programming to use the i8254_set_mode()
and i8254_write() helpers instead of i8254_load(). This allows
us to use the I8254_MODE* defines to clarify the code.

For aesthetics, factor the timer programming out as a separate
function.

Signed-off-by: H Hartley Sweeten <hswee...@visionengravers.com>
Cc: Ian Abbott <abbo...@mev.co.uk>
Cc: Greg Kroah-Hartman <gre...@linuxfoundation.org>
---
 drivers/staging/comedi/drivers/pcl711.c | 19 +++++++++++++------
 1 file changed, 13 insertions(+), 6 deletions(-)

diff --git a/drivers/staging/comedi/drivers/pcl711.c 
b/drivers/staging/comedi/drivers/pcl711.c
index 7c03a5d..2da6fec 100644
--- a/drivers/staging/comedi/drivers/pcl711.c
+++ b/drivers/staging/comedi/drivers/pcl711.c
@@ -360,6 +360,18 @@ static int pcl711_ai_cmdtest(struct comedi_device *dev,
        return 0;
 }
 
+static void pcl711_ai_load_counters(struct comedi_device *dev)
+{
+       struct pcl711_private *devpriv = dev->private;
+       unsigned long timer_base = dev->iobase + PCL711_TIMER_BASE;
+
+       i8254_set_mode(timer_base, 0, 1, I8254_MODE2 | I8254_BINARY);
+       i8254_set_mode(timer_base, 0, 2, I8254_MODE2 | I8254_BINARY);
+
+       i8254_write(timer_base, 0, 1, devpriv->divisor1);
+       i8254_write(timer_base, 0, 2, devpriv->divisor2);
+}
+
 static int pcl711_ai_cmd(struct comedi_device *dev, struct comedi_subdevice *s)
 {
        struct pcl711_private *devpriv = dev->private;
@@ -378,13 +390,8 @@ static int pcl711_ai_cmd(struct comedi_device *dev, struct 
comedi_subdevice *s)
        }
 
        if (cmd->scan_begin_src == TRIG_TIMER) {
-               i8254_load(dev->iobase + PCL711_TIMER_BASE, 0,
-                          1, devpriv->divisor1, I8254_MODE2 | I8254_BINARY);
-               i8254_load(dev->iobase + PCL711_TIMER_BASE, 0,
-                          2, devpriv->divisor2, I8254_MODE2 | I8254_BINARY);
-
+               pcl711_ai_load_counters(dev);
                outb(PCL711_INT_STAT_CLR, dev->iobase + PCL711_INT_STAT_REG);
-
                pcl711_ai_set_mode(dev, PCL711_MODE_PACER_IRQ);
        } else {
                pcl711_ai_set_mode(dev, PCL711_MODE_EXT_IRQ);
-- 
1.9.2

_______________________________________________
devel mailing list
de...@linuxdriverproject.org
http://driverdev.linuxdriverproject.org/mailman/listinfo/driverdev-devel

Reply via email to