staging: comedi: das_08: unwind the 8254 timer support
Refactor the 8254 timer support by removing the various functions
that handle the io and consolidating the logic into the initialize,
read, write, and config functions used by the driver.
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>
diff --git a/drivers/staging/comedi/drivers/das08.c b/drivers/staging/comedi/drivers/das08.c
index 036953e..78c3314 100644
--- a/drivers/staging/comedi/drivers/das08.c
+++ b/drivers/staging/comedi/drivers/das08.c
@@ -433,64 +433,12 @@
return n;
}
-static unsigned int i8254_read_channel_low(unsigned int base, int chan)
-{
- return i8254_read(base, 0, chan);
-}
-
-static void i8254_write_channel_low(unsigned int base, int chan,
- unsigned int value)
-{
- i8254_write(base, 0, chan, value);
-}
-
-static unsigned int i8254_read_channel(struct i8254_struct *st, int channel)
-{
- int chan = st->logic2phys[channel];
-
- return i8254_read_channel_low(st->iobase, chan);
-}
-
-static void i8254_write_channel(struct i8254_struct *st, int channel,
- unsigned int value)
-{
- int chan = st->logic2phys[channel];
-
- i8254_write_channel_low(st->iobase, chan, value);
-}
-
-static void i8254_set_mode_low(unsigned int base, int channel,
- unsigned int mode)
-{
- i8254_set_mode(base, 0, channel, mode);
-}
-
-static void __i8254_set_mode(struct i8254_struct *st, int channel,
- unsigned int mode)
-{
- int chan = st->logic2phys[channel];
-
- st->mode[chan] = mode;
- return i8254_set_mode_low(st->iobase, chan, mode);
-}
-
-static unsigned int i8254_read_status_low(unsigned int base, int channel)
-{
- return i8254_status(base, 0, channel);
-}
-
-static unsigned int i8254_read_status(struct i8254_struct *st, int channel)
-{
- int chan = st->logic2phys[channel];
-
- return i8254_read_status_low(st->iobase, chan);
-}
-
static void i8254_initialize(struct i8254_struct *st)
{
int i;
+
for (i = 0; i < 3; ++i)
- i8254_set_mode_low(st->iobase, i, st->mode[i]);
+ i8254_set_mode(st->iobase, 0, i, st->mode[i]);
}
static int das08_counter_read(struct comedi_device *dev,
@@ -498,8 +446,10 @@
struct comedi_insn *insn, unsigned int *data)
{
struct das08_private_struct *devpriv = dev->private;
- int chan = insn->chanspec;
- data[0] = i8254_read_channel(&devpriv->i8254, chan);
+ struct i8254_struct *st = &devpriv->i8254;
+ int chan = st->logic2phys[insn->chanspec];
+
+ data[0] = i8254_read(st->iobase, 0, chan);
return 1;
}
@@ -508,8 +458,10 @@
struct comedi_insn *insn, unsigned int *data)
{
struct das08_private_struct *devpriv = dev->private;
- int chan = insn->chanspec;
- i8254_write_channel(&devpriv->i8254, chan, data[0]);
+ struct i8254_struct *st = &devpriv->i8254;
+ int chan = st->logic2phys[insn->chanspec];
+
+ i8254_write(st->iobase, 0, chan, data[0]);
return 1;
}
@@ -518,17 +470,19 @@
struct comedi_insn *insn, unsigned int *data)
{
struct das08_private_struct *devpriv = dev->private;
- int chan = insn->chanspec;
+ struct i8254_struct *st = &devpriv->i8254;
+ int chan = st->logic2phys[insn->chanspec];
if (insn->n != 2)
return -EINVAL;
switch (data[0]) {
case INSN_CONFIG_SET_COUNTER_MODE:
- __i8254_set_mode(&devpriv->i8254, chan, data[1]);
+ st->mode[chan] = data[1];
+ i8254_set_mode(st->iobase, 0, chan, data[1]);
break;
case INSN_CONFIG_8254_READ_STATUS:
- data[1] = i8254_read_status(&devpriv->i8254, chan);
+ data[1] = i8254_status(st->iobase, 0, chan);
break;
default:
return -EINVAL;