staging: comedi: dmm32at: fix dmm32at_dio_insn_config()
authorH Hartley Sweeten <hsweeten@visionengravers.com>
Mon, 26 Aug 2013 22:29:10 +0000 (15:29 -0700)
committerGreg Kroah-Hartman <gregkh@linuxfoundation.org>
Tue, 27 Aug 2013 23:59:08 +0000 (16:59 -0700)
This is the (*insn_config) function for a DIO subdevice. It should be
using the data[0] value as the "instruction" to perform on the subdevice.

Use the comedi_dio_insn_config() helper to properly handle instructions.

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>
drivers/staging/comedi/drivers/dmm32at.c

index 5237f47d39ae908f66b8645e5878e7da25e5d895..118a4fd129f903ee3481c392644e115a8ef56188 100644 (file)
@@ -648,31 +648,34 @@ static int dmm32at_dio_insn_bits(struct comedi_device *dev,
 
 static int dmm32at_dio_insn_config(struct comedi_device *dev,
                                   struct comedi_subdevice *s,
-                                  struct comedi_insn *insn, unsigned int *data)
+                                  struct comedi_insn *insn,
+                                  unsigned int *data)
 {
        struct dmm32at_private *devpriv = dev->private;
+       unsigned int chan = CR_CHAN(insn->chanspec);
+       unsigned int mask;
        unsigned char chanbit;
-       int chan = CR_CHAN(insn->chanspec);
-
-       if (insn->n != 1)
-               return -EINVAL;
+       int ret;
 
-       if (chan < 8)
+       if (chan < 8) {
+               mask = 0x0000ff;
                chanbit = DMM32AT_DIRA;
-       else if (chan < 16)
+       } else if (chan < 16) {
+               mask = 0x00ff00;
                chanbit = DMM32AT_DIRB;
-       else if (chan < 20)
+       } else if (chan < 20) {
+               mask = 0x0f0000;
                chanbit = DMM32AT_DIRCL;
-       else
+       } else {
+               mask = 0xf00000;
                chanbit = DMM32AT_DIRCH;
+       }
 
-       /* The input or output configuration of each digital line is
-        * configured by a special insn_config instruction.  chanspec
-        * contains the channel to be changed, and data[0] contains the
-        * value COMEDI_INPUT or COMEDI_OUTPUT. */
+       ret = comedi_dio_insn_config(dev, s, insn, data, mask);
+       if (ret)
+               return ret;
 
-       /* if output clear the bit, otherwise set it */
-       if (data[0] == COMEDI_OUTPUT)
+       if (data[0] == INSN_CONFIG_DIO_OUTPUT)
                devpriv->dio_config &= ~chanbit;
        else
                devpriv->dio_config |= chanbit;
@@ -681,7 +684,7 @@ static int dmm32at_dio_insn_config(struct comedi_device *dev,
        /* set the DIO's to the new configuration setting */
        outb(devpriv->dio_config, dev->iobase + DMM32AT_DIOCONF);
 
-       return 1;
+       return insn->n;
 }
 
 static int dmm32at_attach(struct comedi_device *dev,