From: H Hartley Sweeten <hsweeten@visionengravers.com>
Date: Fri, 20 Jun 2014 20:12:39 +0000 (-0700)
Subject: staging: comedi: dt282x: fix dt282x_ao_insn_write()
X-Git-Url: https://git.stricted.de/?a=commitdiff_plain;h=804ee9ac04c01946c5ba158b5e350b40ee515fed;p=GitHub%2FLineageOS%2FG12%2Fandroid_kernel_amlogic_linux-4.9.git

staging: comedi: dt282x: fix dt282x_ao_insn_write()

The (*insn_write) functions are expected to write 'insn->n' samples to the
hardware. Fix this function so it works like the comedi core expects.

The comedi core sanity checks that the samples are within the 'maxdata' range
of the subdevice before calling the (*insn_write) so this function does not
need to mask each sample by 's->maxdata'.

Also, the wrong '*2scomp' flag in the private data was being checked to see
if the sample needs to be munged before being written. Fix this.

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/dt282x.c b/drivers/staging/comedi/drivers/dt282x.c
index 3eaf26cb2218..dcc4055bee71 100644
--- a/drivers/staging/comedi/drivers/dt282x.c
+++ b/drivers/staging/comedi/drivers/dt282x.c
@@ -882,37 +882,42 @@ static int dt282x_ao_insn_read(struct comedi_device *dev,
 
 static int dt282x_ao_insn_write(struct comedi_device *dev,
 				struct comedi_subdevice *s,
-				struct comedi_insn *insn, unsigned int *data)
+				struct comedi_insn *insn,
+				unsigned int *data)
 {
 	struct dt282x_private *devpriv = dev->private;
-	unsigned int d;
-	unsigned int chan;
-
-	chan = CR_CHAN(insn->chanspec);
-	d = data[0];
-	d &= s->maxdata;
-	devpriv->ao[chan] = d;
+	unsigned int chan = CR_CHAN(insn->chanspec);
+	bool munge = false;
+	unsigned int val;
+	int i;
 
 	devpriv->dacsr |= DT2821_SSEL;
-
 	if (chan) {
-		/* select channel */
 		devpriv->dacsr |= DT2821_YSEL;
-		if (devpriv->da0_2scomp)
-			d = comedi_offset_munge(s, d);
+		if (devpriv->da1_2scomp)
+			munge = true;
 	} else {
 		devpriv->dacsr &= ~DT2821_YSEL;
-		if (devpriv->da1_2scomp)
-			d = comedi_offset_munge(s, d);
+		if (devpriv->da0_2scomp)
+			munge = true;
 	}
 
-	outw(devpriv->dacsr, dev->iobase + DT2821_DACSR);
+	for (i = 0; i < insn->n; i++) {
+		val = data[i];
+		devpriv->ao[chan] = val;
 
-	outw(d, dev->iobase + DT2821_DADAT);
+		if (munge)
+			val = comedi_offset_munge(s, val);
 
-	outw(devpriv->supcsr | DT2821_DACON, dev->iobase + DT2821_SUPCSR);
+		outw(devpriv->dacsr, dev->iobase + DT2821_DACSR);
 
-	return 1;
+		outw(val, dev->iobase + DT2821_DADAT);
+
+		outw(devpriv->supcsr | DT2821_DACON,
+		     dev->iobase + DT2821_SUPCSR);
+	}
+
+	return insn->n;
 }
 
 static int dt282x_ao_cmdtest(struct comedi_device *dev,