Commit bcc01b4d authored by H Hartley Sweeten's avatar H Hartley Sweeten Committed by Greg Kroah-Hartman

staging: comedi: pcmad: return errno if AI conversion times out

Instead of returning invalid data, return -ETIME if the analog input
conversion times out.
Signed-off-by: default avatarH Hartley Sweeten <hsweeten@visionengravers.com>
Cc: Ian Abbott <abbotti@mev.co.uk>
Signed-off-by: default avatarGreg Kroah-Hartman <gregkh@linuxfoundation.org>
parent 2a09cba6
...@@ -72,25 +72,37 @@ struct pcmad_priv_struct { ...@@ -72,25 +72,37 @@ struct pcmad_priv_struct {
#define TIMEOUT 100 #define TIMEOUT 100
static int pcmad_ai_wait_for_eoc(struct comedi_device *dev,
int timeout)
{
int i;
for (i = 0; i < timeout; i++) {
if ((inb(dev->iobase + PCMAD_STATUS) & 0x3) == 0x3)
return 0;
}
return -ETIME;
}
static int pcmad_ai_insn_read(struct comedi_device *dev, static int pcmad_ai_insn_read(struct comedi_device *dev,
struct comedi_subdevice *s, struct comedi_subdevice *s,
struct comedi_insn *insn, unsigned int *data) struct comedi_insn *insn, unsigned int *data)
{ {
const struct pcmad_board_struct *board = comedi_board(dev); const struct pcmad_board_struct *board = comedi_board(dev);
struct pcmad_priv_struct *devpriv = dev->private; struct pcmad_priv_struct *devpriv = dev->private;
int i;
int chan; int chan;
int n; int n;
int ret;
chan = CR_CHAN(insn->chanspec); chan = CR_CHAN(insn->chanspec);
for (n = 0; n < insn->n; n++) { for (n = 0; n < insn->n; n++) {
outb(chan, dev->iobase + PCMAD_CONVERT); outb(chan, dev->iobase + PCMAD_CONVERT);
for (i = 0; i < TIMEOUT; i++) { ret = pcmad_ai_wait_for_eoc(dev, TIMEOUT);
if ((inb(dev->iobase + PCMAD_STATUS) & 0x3) == 0x3) if (ret)
break; return ret;
}
data[n] = inb(dev->iobase + PCMAD_LSB); data[n] = inb(dev->iobase + PCMAD_LSB);
data[n] |= (inb(dev->iobase + PCMAD_MSB) << 8); data[n] |= (inb(dev->iobase + PCMAD_MSB) << 8);
......
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