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

staging: comedi: s526: cleanup s526_gpct_winsn()

Use a local variable for the iobase of the channel being written.
This makes the outw() calls a bit cleaner.

Rearrange the switch () so that the actual write to the device
can be common regardless of the gpct configuration.
Signed-off-by: default avatarH Hartley Sweeten <hsweeten@visionengravers.com>
Cc: Ian Abbott <abbotti@mev.co.uk>
Signed-off-by: default avatarGreg Kroah-Hartman <gregkh@linuxfoundation.org>
parent 5a5614cb
...@@ -381,27 +381,18 @@ static int s526_gpct_insn_config(struct comedi_device *dev, ...@@ -381,27 +381,18 @@ static int s526_gpct_insn_config(struct comedi_device *dev,
} }
static int s526_gpct_winsn(struct comedi_device *dev, static int s526_gpct_winsn(struct comedi_device *dev,
struct comedi_subdevice *s, struct comedi_insn *insn, struct comedi_subdevice *s,
struct comedi_insn *insn,
unsigned int *data) unsigned int *data)
{ {
struct s526_private *devpriv = dev->private; struct s526_private *devpriv = dev->private;
unsigned int chan = CR_CHAN(insn->chanspec); unsigned int chan = CR_CHAN(insn->chanspec);
short value; unsigned long chan_iobase = dev->iobase + chan * 8;
union cmReg cmReg;
inw(chan_iobase + REG_C0M); /* Is this read required? */
cmReg.value = inw(dev->iobase + REG_C0M + chan * 8);
/* Check what Application of Counter this channel is configured for */ /* Check what Application of Counter this channel is configured for */
switch (devpriv->s526_gpct_config[chan].app) { switch (devpriv->s526_gpct_config[chan].app) {
case PositionMeasurement:
outw(0xFFFF & ((*data) >> 16), dev->iobase + REG_C0H + chan * 8);
outw(0xFFFF & (*data), dev->iobase + REG_C0L + chan * 8);
break;
case SinglePulseGeneration:
outw(0xFFFF & ((*data) >> 16), dev->iobase + REG_C0H + chan * 8);
outw(0xFFFF & (*data), dev->iobase + REG_C0L + chan * 8);
break;
case PulseTrainGeneration: case PulseTrainGeneration:
/* data[0] contains the PULSE_WIDTH /* data[0] contains the PULSE_WIDTH
data[1] contains the PULSE_PERIOD data[1] contains the PULSE_PERIOD
...@@ -410,22 +401,24 @@ static int s526_gpct_winsn(struct comedi_device *dev, ...@@ -410,22 +401,24 @@ static int s526_gpct_winsn(struct comedi_device *dev,
pulse frequency on the selected source pulse frequency on the selected source
*/ */
if ((data[1] > data[0]) && (data[0] > 0)) { if ((data[1] > data[0]) && (data[0] > 0)) {
(devpriv->s526_gpct_config[chan]).data[0] = data[0]; devpriv->s526_gpct_config[chan].data[0] = data[0];
(devpriv->s526_gpct_config[chan]).data[1] = data[1]; devpriv->s526_gpct_config[chan].data[1] = data[1];
} else { } else {
return -EINVAL; return -EINVAL;
} }
value = (short)((*data >> 16) & 0xFFFF); /* Fall thru to write the PULSE_WIDTH */
outw(value, dev->iobase + REG_C0H + chan * 8);
value = (short)(*data & 0xFFFF); case PositionMeasurement:
outw(value, dev->iobase + REG_C0L + chan * 8); case SinglePulseGeneration:
outw((data[0] >> 16) & 0xffff, chan_iobase + REG_C0H);
outw(data[0] & 0xffff, chan_iobase + REG_C0L);
break; break;
default: /* Impossible */
default:
return -EINVAL; return -EINVAL;
break;
} }
/* return the number of samples written */
return insn->n; return insn->n;
} }
......
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