staging: comedi: me_daq: fix bug in me_ao_insn_write()

The comedi core expects (*insn_write) functions to write insn->n values
to the hardware and return the number of values written.

Currently, this function only writes the first value. The core also
validates all the data values so the extra masking with s->maxdata is
not needed. Fix this function to work like the core expects.

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>

diff --git a/drivers/staging/comedi/drivers/me_daq.c b/drivers/staging/comedi/drivers/me_daq.c
index 37a6fa9..df1fceb 100644 (file)
--- a/drivers/staging/comedi/drivers/me_daq.c
+++ b/drivers/staging/comedi/drivers/me_daq.c
@@ -325,6 +325,7 @@ static int me_ao_insn_write(struct comedi_device *dev,
        struct me_private_data *dev_private = dev->private;
        unsigned int chan = CR_CHAN(insn->chanspec);
        unsigned int rang = CR_RANGE(insn->chanspec);
+       unsigned int val = dev_private->ao_readback[chan];
        int i;
 
        /* Enable all DAC */
@@ -353,10 +354,11 @@ static int me_ao_insn_write(struct comedi_device *dev,
 
        /* Set data register */
        for (i = 0; i < insn->n; i++) {
-               writew((data[0] & s->maxdata),
-                      dev->mmio + ME_DAC_DATA_A + (chan << 1));
-               dev_private->ao_readback[chan] = (data[0] & s->maxdata);
+               val = data[i];
+
+               writew(val, dev->mmio + ME_DAC_DATA_A + (chan << 1));
        }
+       dev_private->ao_readback[chan] = val;
 
        /* Update dac with data registers */
        readw(dev->mmio + ME_DAC_UPDATE);