Use a local variable to hold the base register, 'reg', that is used
to write to the relays.
Add local variables for the 'mask' and 'bits' values used to update
the relays.
The relays only need to be updated if the 'mask' is set. Move the outb()
calls into the if (mask) to make this clearer.
Signed-off-by: H Hartley Sweeten <hsweeten@visionengravers.com>
Cc: Ian Abbott <abbotti@mev.co.uk>
Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
struct comedi_insn *insn,
unsigned int *data)
{
- if (data[0]) {
- s->state &= ~data[0];
- s->state |= (data[0] & data[1]);
+ unsigned long reg = (unsigned long)s->private;
+ unsigned int mask = data[0];
+ unsigned int bits = data[1];
+
+ if (mask) {
+ s->state &= ~mask;
+ s->state |= (bits & mask);
+
+ if (mask & 0x00ff)
+ outb(s->state & 0xff, dev->iobase + reg);
+ if (mask & 0xff00)
+ outb((s->state >> 8), dev->iobase + reg + 1);
}
- if (data[0] & 0x00ff)
- outb(s->state & 0xff, dev->iobase + (unsigned long)s->private);
- if (data[0] & 0xff00)
- outb((s->state >> 8),
- dev->iobase + (unsigned long)s->private + 1);
data[1] = s->state;