staging: comedi: comedi_parport: fix parport_insn_config_a()
authorH Hartley Sweeten <hsweeten@visionengravers.com>
Fri, 30 Aug 2013 18:45:25 +0000 (11:45 -0700)
committerGreg Kroah-Hartman <gregkh@linuxfoundation.org>
Tue, 17 Sep 2013 14:47:42 +0000 (07:47 -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.

Also, rename the function to better describe it's use.

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/comedi_parport.c

index fc73434..0e0cc75 100644 (file)
@@ -109,22 +109,25 @@ static int parport_data_reg_insn_bits(struct comedi_device *dev,
        return insn->n;
 }
 
-static int parport_insn_config_a(struct comedi_device *dev,
-                                struct comedi_subdevice *s,
-                                struct comedi_insn *insn, unsigned int *data)
+static int parport_data_reg_insn_config(struct comedi_device *dev,
+                                       struct comedi_subdevice *s,
+                                       struct comedi_insn *insn,
+                                       unsigned int *data)
 {
        struct parport_private *devpriv = dev->private;
+       int ret;
 
-       if (data[0]) {
-               s->io_bits = 0xff;
+       ret = comedi_dio_insn_config(dev, s, insn, data, 0xff);
+       if (ret)
+               return ret;
+
+       if (s->io_bits)
                devpriv->c_data &= ~PARPORT_CTRL_BIDIR_ENA;
-       } else {
-               s->io_bits = 0;
+       else
                devpriv->c_data |= PARPORT_CTRL_BIDIR_ENA;
-       }
        outb(devpriv->c_data, dev->iobase + PARPORT_CTRL_REG);
 
-       return 1;
+       return insn->n;
 }
 
 static int parport_insn_b(struct comedi_device *dev, struct comedi_subdevice *s,
@@ -288,7 +291,7 @@ static int parport_attach(struct comedi_device *dev,
        s->maxdata = 1;
        s->range_table = &range_digital;
        s->insn_bits = parport_data_reg_insn_bits;
-       s->insn_config = parport_insn_config_a;
+       s->insn_config = parport_data_reg_insn_config;
 
        s = &dev->subdevices[1];
        s->type = COMEDI_SUBD_DI;