staging: comedi: me_daq: fix me_ao_insn_read()

This function is supposed to return the analog output value for
a specified channel. The channel number is packed in insn->chanspec,
which is an unsigned int, and unpacked using the CR_CHAN() macro.

Currently this function is trying to use the chanspec as an array.
This works only if a single data value is read.

Fix the function so that the desired channel is determined and all
the data returned is from that channel.

Also, fix the return. The comedi core expects insn_read functions to
return the number of data values (insn->n).

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/me_daq.c b/drivers/staging/comedi/drivers/me_daq.c
index 1e4a980a63b7c5e1f1672499e731e84dbb3a73b1..1efad5967d942be9cb5cdcfa994441e2ef54bf35 100644 (file)
--- a/drivers/staging/comedi/drivers/me_daq.c
+++ b/drivers/staging/comedi/drivers/me_daq.c
@@ -469,20 +469,19 @@ static int me_ao_insn_write(struct comedi_device *dev,
        return i;
 }
 
-/* Analog output readback */
 static int me_ao_insn_read(struct comedi_device *dev,
-                          struct comedi_subdevice *s, struct comedi_insn *insn,
+                          struct comedi_subdevice *s,
+                          struct comedi_insn *insn,
                           unsigned int *data)
 {
        struct me_private_data *dev_private = dev->private;
+       unsigned int chan = CR_CHAN(insn->chanspec);
        int i;
 
-       for (i = 0; i < insn->n; i++) {
-               data[i] =
-                   dev_private->ao_readback[CR_CHAN((&insn->chanspec)[i])];
-       }
+       for (i = 0; i < insn->n; i++)
+               data[i] = dev_private->ao_readback[chan];
 
-       return 1;
+       return insn->n;
 }
 
 /*