Commit 9dc99895 authored by J. Ali Harlow's avatar J. Ali Harlow Committed by Greg Kroah-Hartman

comedi vmk80xx: simplify rinsn output calculation

vmk80xx_di_rinsn() and vmk80xx_do_rinsn() extract the required channel
data by inconsistent and overly-complex algorithms. Simplify them both.
Signed-off-by: default avatarJ. Ali Harlow <ali@avrc.city.ac.uk>
Signed-off-by: default avatarGreg Kroah-Hartman <gregkh@suse.de>
parent 85a2f34f
...@@ -747,7 +747,7 @@ static int vmk80xx_di_rinsn(struct comedi_device *cdev, ...@@ -747,7 +747,7 @@ static int vmk80xx_di_rinsn(struct comedi_device *cdev,
else else
inp = rx_buf[reg]; inp = rx_buf[reg];
data[n] = ((inp & (1 << chan)) > 0); data[n] = (inp >> chan) & 1;
} }
up(&dev->limit_sem); up(&dev->limit_sem);
...@@ -812,7 +812,6 @@ static int vmk80xx_do_rinsn(struct comedi_device *cdev, ...@@ -812,7 +812,6 @@ static int vmk80xx_do_rinsn(struct comedi_device *cdev,
struct vmk80xx_usb *dev = cdev->private; struct vmk80xx_usb *dev = cdev->private;
int chan; int chan;
int reg; int reg;
int mask;
int n; int n;
dbgvm("vmk80xx: %s\n", __func__); dbgvm("vmk80xx: %s\n", __func__);
...@@ -825,7 +824,6 @@ static int vmk80xx_do_rinsn(struct comedi_device *cdev, ...@@ -825,7 +824,6 @@ static int vmk80xx_do_rinsn(struct comedi_device *cdev,
chan = CR_CHAN(insn->chanspec); chan = CR_CHAN(insn->chanspec);
reg = VMK8061_DO_REG; reg = VMK8061_DO_REG;
mask = 1 << chan;
dev->usb_tx_buf[0] = VMK8061_CMD_RD_DO; dev->usb_tx_buf[0] = VMK8061_CMD_RD_DO;
...@@ -833,7 +831,7 @@ static int vmk80xx_do_rinsn(struct comedi_device *cdev, ...@@ -833,7 +831,7 @@ static int vmk80xx_do_rinsn(struct comedi_device *cdev,
if (vmk80xx_read_packet(dev)) if (vmk80xx_read_packet(dev))
break; break;
data[n] = (dev->usb_rx_buf[reg] & mask) >> chan; data[n] = (dev->usb_rx_buf[reg] >> chan) & 1;
} }
up(&dev->limit_sem); up(&dev->limit_sem);
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment