Skip to content

Commit

Permalink
staging: comedi: usbdux: tidy up usbdux_dio_insn_bits()
Browse files Browse the repository at this point in the history
Rename the local variable used for the private data pointer to the
comedi "norm".

Remove the unnecessary sanity check of the private data pointer. This
function can only be called is the private data was allocated during
the attach.

Tidy up the exit path using goto to ensure that the semaphore is
released.

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>
  • Loading branch information
H Hartley Sweeten authored and Greg Kroah-Hartman committed Jul 26, 2013
1 parent fc110df commit 81a9bda
Showing 1 changed file with 27 additions and 27 deletions.
54 changes: 27 additions & 27 deletions drivers/staging/comedi/drivers/usbdux.c
Original file line number Diff line number Diff line change
Expand Up @@ -1302,40 +1302,40 @@ static int usbdux_dio_insn_config(struct comedi_device *dev,

static int usbdux_dio_insn_bits(struct comedi_device *dev,
struct comedi_subdevice *s,
struct comedi_insn *insn, unsigned int *data)
struct comedi_insn *insn,
unsigned int *data)
{

struct usbdux_private *this_usbduxsub = dev->private;
int err;
struct usbdux_private *devpriv = dev->private;
unsigned int mask = data[0];
unsigned int bits = data[1];
int ret;

if (!this_usbduxsub)
return -EFAULT;
down(&devpriv->sem);

down(&this_usbduxsub->sem);
s->state &= ~mask;
s->state |= (bits & mask);

/* The insn data is a mask in data[0] and the new data
* in data[1], each channel cooresponding to a bit. */
s->state &= ~data[0];
s->state |= data[0] & data[1];
this_usbduxsub->dux_commands[1] = s->io_bits;
this_usbduxsub->dux_commands[2] = s->state;
devpriv->dux_commands[1] = s->io_bits;
devpriv->dux_commands[2] = s->state;

/* This command also tells the firmware to return */
/* the digital input lines */
err = send_dux_commands(dev, SENDDIOBITSCOMMAND);
if (err < 0) {
up(&this_usbduxsub->sem);
return err;
}
err = receive_dux_commands(dev, SENDDIOBITSCOMMAND);
if (err < 0) {
up(&this_usbduxsub->sem);
return err;
}
/*
* This command also tells the firmware to return
* the digital input lines.
*/
ret = send_dux_commands(dev, SENDDIOBITSCOMMAND);
if (ret < 0)
goto dio_exit;
ret = receive_dux_commands(dev, SENDDIOBITSCOMMAND);
if (ret < 0)
goto dio_exit;

data[1] = le16_to_cpu(this_usbduxsub->insn_buffer[1]);
up(&this_usbduxsub->sem);
return insn->n;
data[1] = le16_to_cpu(devpriv->insn_buffer[1]);

dio_exit:
up(&devpriv->sem);

return ret ? ret : insn->n;
}

/* reads the 4 counters, only two are used just now */
Expand Down

0 comments on commit 81a9bda

Please sign in to comment.