diff options
author | H Hartley Sweeten <hsweeten@visionengravers.com> | 2014-03-10 21:07:39 (GMT) |
---|---|---|
committer | Greg Kroah-Hartman <gregkh@linuxfoundation.org> | 2014-03-17 21:04:00 (GMT) |
commit | a7b31d3996a866408ebd6d16992d166b0207c7c1 (patch) | |
tree | 31ef60df0aa422d945dcf25a26d3bee4a3e2f81b /drivers | |
parent | c034f1f6774d47bcc3ab1e17f5c892e94674d38a (diff) | |
download | linux-a7b31d3996a866408ebd6d16992d166b0207c7c1.tar.xz |
staging: comedi: c6xdigio: use comedi_offset_munge()
The value read from the encoders is in two's complement format. Use
the comedi_offset_munge() helper to convert the value to offset binary.
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>
Diffstat (limited to 'drivers')
-rw-r--r-- | drivers/staging/comedi/drivers/c6xdigio.c | 15 |
1 files changed, 10 insertions, 5 deletions
diff --git a/drivers/staging/comedi/drivers/c6xdigio.c b/drivers/staging/comedi/drivers/c6xdigio.c index 3937e64..20a5dfe 100644 --- a/drivers/staging/comedi/drivers/c6xdigio.c +++ b/drivers/staging/comedi/drivers/c6xdigio.c @@ -153,7 +153,7 @@ static int c6xdigio_encoder_read(struct comedi_device *dev, c6xdigio_write_data(dev, 0x00, 0x80); - return val ^ 0x800000; + return val; } static int c6xdigio_pwm_insn_write(struct comedi_device *dev, @@ -177,12 +177,17 @@ static int c6xdigio_encoder_insn_read(struct comedi_device *dev, unsigned int *data) { unsigned int chan = CR_CHAN(insn->chanspec); - int n; + unsigned int val; + int i; - for (n = 0; n < insn->n; n++) - data[n] = (c6xdigio_encoder_read(dev, chan) & 0xffffff); + for (i = 0; i < insn->n; i++) { + val = c6xdigio_encoder_read(dev, chan); + + /* munge two's complement value to offset binary */ + data[i] = comedi_offset_munge(s, val); + } - return n; + return insn->n; } static void c6xdigio_init(struct comedi_device *dev) |