Commit e72f7ad4 authored by H Hartley Sweeten's avatar H Hartley Sweeten Committed by Greg Kroah-Hartman

staging: comedi: me4000: fix 8254 timer programming

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.

Also, use the CR_CHAN() macro to make sure the only the channel is
used in the insh->chanspec to specify the counter number.
Signed-off-by: default avatarH Hartley Sweeten <hsweeten@visionengravers.com>
Reviewed-by: default avatarIan Abbott <abbotti@mev.co.uk>
Signed-off-by: default avatarGreg Kroah-Hartman <gregkh@linuxfoundation.org>
parent 4f161fc7
...@@ -1352,6 +1352,7 @@ static int me4000_cnt_insn_config(struct comedi_device *dev, ...@@ -1352,6 +1352,7 @@ static int me4000_cnt_insn_config(struct comedi_device *dev,
unsigned int *data) unsigned int *data)
{ {
struct me4000_info *info = dev->private; struct me4000_info *info = dev->private;
unsigned int chan = CR_CHAN(insn->chanspec);
int err; int err;
switch (data[0]) { switch (data[0]) {
...@@ -1359,16 +1360,17 @@ static int me4000_cnt_insn_config(struct comedi_device *dev, ...@@ -1359,16 +1360,17 @@ static int me4000_cnt_insn_config(struct comedi_device *dev,
if (insn->n != 1) if (insn->n != 1)
return -EINVAL; return -EINVAL;
err = i8254_load(info->timer_regbase, 0, insn->chanspec, 0, err = i8254_set_mode(info->timer_regbase, 0, chan,
I8254_MODE0 | I8254_BINARY); I8254_MODE0 | I8254_BINARY);
if (err) if (err)
return err; return err;
i8254_write(info->timer_regbase, 0, chan, 0);
break; break;
case GPCT_SET_OPERATION: case GPCT_SET_OPERATION:
if (insn->n != 2) if (insn->n != 2)
return -EINVAL; return -EINVAL;
err = i8254_set_mode(info->timer_regbase, 0, insn->chanspec, err = i8254_set_mode(info->timer_regbase, 0, chan,
(data[1] << 1) | I8254_BINARY); (data[1] << 1) | I8254_BINARY);
if (err) if (err)
return err; return err;
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment