Skip to content

Commit

Permalink
staging: comedi: usbdux: tidy up usbdux_ao_insn_write()
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.

Return -EBUSY instead of 0 if the (*insn_write) cannot be done because
a command is running.

Tidy up the for() loop that writes the data. The dux_commands[1] and [4]
can be set outside the loop since they are constant. Use a local pointer
for dux_commands[2] to load the value to write. Only the last value needs
to be cached in the private data for read back.

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 818782c commit 37c1d1e
Showing 1 changed file with 28 additions and 25 deletions.
53 changes: 28 additions & 25 deletions drivers/staging/comedi/drivers/usbdux.c
Original file line number Diff line number Diff line change
Expand Up @@ -1035,39 +1035,42 @@ static int usbdux_ao_insn_read(struct comedi_device *dev,

static int usbdux_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)
{
int i, err;
int chan = CR_CHAN(insn->chanspec);
struct usbdux_private *this_usbduxsub = dev->private;
struct usbdux_private *devpriv = dev->private;
unsigned int chan = CR_CHAN(insn->chanspec);
unsigned int val = devpriv->out_buffer[chan];
int16_t *p = (int16_t *)&devpriv->dux_commands[2];
int ret = -EBUSY;
int i;

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

down(&this_usbduxsub->sem);
if (this_usbduxsub->ao_cmd_running) {
up(&this_usbduxsub->sem);
return 0;
}
if (devpriv->ao_cmd_running)
goto ao_write_exit;

/* number of channels: 1 */
devpriv->dux_commands[1] = 1;
/* channel number */
devpriv->dux_commands[4] = chan << 6;

for (i = 0; i < insn->n; i++) {
/* number of channels: 1 */
this_usbduxsub->dux_commands[1] = 1;
val = data[i];

/* one 16 bit value */
*((int16_t *) (this_usbduxsub->dux_commands + 2)) =
cpu_to_le16(data[i]);
this_usbduxsub->out_buffer[chan] = data[i];
/* channel number */
this_usbduxsub->dux_commands[4] = (chan << 6);
err = send_dux_commands(dev, SENDDACOMMANDS);
if (err < 0) {
up(&this_usbduxsub->sem);
return err;
}
*p = cpu_to_le16(val);

ret = send_dux_commands(dev, SENDDACOMMANDS);
if (ret < 0)
goto ao_write_exit;
}
up(&this_usbduxsub->sem);
devpriv->out_buffer[chan] = val;

return i;
ao_write_exit:
up(&devpriv->sem);

return ret ? ret : insn->n;
}

static int usbdux_ao_inttrig(struct comedi_device *dev,
Expand Down

0 comments on commit 37c1d1e

Please sign in to comment.