diff options
Diffstat (limited to 'drivers/staging/comedi/drivers/pcmmio.c')
-rw-r--r-- | drivers/staging/comedi/drivers/pcmmio.c | 72 |
1 files changed, 15 insertions, 57 deletions
diff --git a/drivers/staging/comedi/drivers/pcmmio.c b/drivers/staging/comedi/drivers/pcmmio.c index fed7e77e0305..fc40ee2b34e9 100644 --- a/drivers/staging/comedi/drivers/pcmmio.c +++ b/drivers/staging/comedi/drivers/pcmmio.c @@ -192,8 +192,6 @@ struct pcmmio_private { unsigned int enabled_mask; unsigned int stop_count; unsigned int active:1; - - unsigned int ao_readback[8]; }; static void pcmmio_dio_write(struct comedi_device *dev, unsigned int val, @@ -408,8 +406,8 @@ static irqreturn_t interrupt_pcmmio(int irq, void *d) } /* devpriv->spinlock is already locked */ -static int pcmmio_start_intr(struct comedi_device *dev, - struct comedi_subdevice *s) +static void pcmmio_start_intr(struct comedi_device *dev, + struct comedi_subdevice *s) { struct pcmmio_private *devpriv = dev->private; struct comedi_cmd *cmd = &s->async->cmd; @@ -417,13 +415,6 @@ static int pcmmio_start_intr(struct comedi_device *dev, unsigned int pol_bits = 0; int i; - if (cmd->stop_src == TRIG_COUNT && devpriv->stop_count == 0) { - /* An empty acquisition! */ - s->async->events |= COMEDI_CB_EOA; - devpriv->active = 0; - return 1; - } - devpriv->enabled_mask = 0; devpriv->active = 1; if (cmd->chanlist) { @@ -443,8 +434,6 @@ static int pcmmio_start_intr(struct comedi_device *dev, /* set polarity and enable interrupts */ pcmmio_dio_write(dev, pol_bits, PCMMIO_PAGE_POL, 0); pcmmio_dio_write(dev, bits, PCMMIO_PAGE_ENAB, 0); - - return 0; } static int pcmmio_cancel(struct comedi_device *dev, struct comedi_subdevice *s) @@ -467,7 +456,6 @@ static int pcmmio_inttrig_start_intr(struct comedi_device *dev, struct pcmmio_private *devpriv = dev->private; struct comedi_cmd *cmd = &s->async->cmd; unsigned long flags; - int event = 0; if (trig_num != cmd->start_arg) return -EINVAL; @@ -475,12 +463,9 @@ static int pcmmio_inttrig_start_intr(struct comedi_device *dev, spin_lock_irqsave(&devpriv->spinlock, flags); s->async->inttrig = NULL; if (devpriv->active) - event = pcmmio_start_intr(dev, s); + pcmmio_start_intr(dev, s); spin_unlock_irqrestore(&devpriv->spinlock, flags); - if (event) - comedi_event(dev, s); - return 1; } @@ -492,28 +477,20 @@ static int pcmmio_cmd(struct comedi_device *dev, struct comedi_subdevice *s) struct pcmmio_private *devpriv = dev->private; struct comedi_cmd *cmd = &s->async->cmd; unsigned long flags; - int event = 0; spin_lock_irqsave(&devpriv->spinlock, flags); devpriv->active = 1; - /* Set up end of acquisition. */ - if (cmd->stop_src == TRIG_COUNT) - devpriv->stop_count = cmd->stop_arg; - else /* TRIG_NONE */ - devpriv->stop_count = 0; + devpriv->stop_count = cmd->stop_arg; /* Set up start of acquisition. */ if (cmd->start_src == TRIG_INT) s->async->inttrig = pcmmio_inttrig_start_intr; else /* TRIG_NOW */ - event = pcmmio_start_intr(dev, s); + pcmmio_start_intr(dev, s); spin_unlock_irqrestore(&devpriv->spinlock, flags); - if (event) - comedi_event(dev, s); - return 0; } @@ -551,16 +528,10 @@ static int pcmmio_cmdtest(struct comedi_device *dev, err |= cfc_check_trigger_arg_is(&cmd->convert_arg, 0); err |= cfc_check_trigger_arg_is(&cmd->scan_end_arg, cmd->chanlist_len); - switch (cmd->stop_src) { - case TRIG_COUNT: - /* any count allowed */ - break; - case TRIG_NONE: + if (cmd->stop_src == TRIG_COUNT) + err |= cfc_check_trigger_arg_min(&cmd->stop_arg, 1); + else /* TRIG_NONE */ err |= cfc_check_trigger_arg_is(&cmd->stop_arg, 0); - break; - default: - break; - } if (err) return 3; @@ -655,21 +626,6 @@ static int pcmmio_ai_insn_read(struct comedi_device *dev, return insn->n; } -static int pcmmio_ao_insn_read(struct comedi_device *dev, - struct comedi_subdevice *s, - struct comedi_insn *insn, - unsigned int *data) -{ - struct pcmmio_private *devpriv = dev->private; - unsigned int chan = CR_CHAN(insn->chanspec); - int i; - - for (i = 0; i < insn->n; i++) - data[i] = devpriv->ao_readback[chan]; - - return insn->n; -} - static int pcmmio_ao_eoc(struct comedi_device *dev, struct comedi_subdevice *s, struct comedi_insn *insn, @@ -688,11 +644,9 @@ static int pcmmio_ao_insn_write(struct comedi_device *dev, struct comedi_insn *insn, unsigned int *data) { - struct pcmmio_private *devpriv = dev->private; unsigned long iobase = dev->iobase; unsigned int chan = CR_CHAN(insn->chanspec); unsigned int range = CR_RANGE(insn->chanspec); - unsigned int val = devpriv->ao_readback[chan]; unsigned char cmd = 0; int ret; int i; @@ -719,7 +673,7 @@ static int pcmmio_ao_insn_write(struct comedi_device *dev, return ret; for (i = 0; i < insn->n; i++) { - val = data[i]; + unsigned int val = data[i]; /* write the data to the channel */ outb(val & 0xff, iobase + PCMMIO_AO_LSB_REG); @@ -731,7 +685,7 @@ static int pcmmio_ao_insn_write(struct comedi_device *dev, if (ret) return ret; - devpriv->ao_readback[chan] = val; + s->readback[chan] = val; } return insn->n; @@ -796,8 +750,12 @@ static int pcmmio_attach(struct comedi_device *dev, struct comedi_devconfig *it) s->n_chan = 8; s->maxdata = 0xffff; s->range_table = &pcmmio_ao_ranges; - s->insn_read = pcmmio_ao_insn_read; s->insn_write = pcmmio_ao_insn_write; + s->insn_read = comedi_readback_insn_read; + + ret = comedi_alloc_subdev_readback(s); + if (ret) + return ret; /* initialize the resource enable register by clearing it */ outb(0, dev->iobase + PCMMIO_AO_RESOURCE_ENA_REG); |