int have_irq;
};
-#define CALLBACK_ARG (((struct subdev_8255_private *)s->private)->cb_arg)
-#define CALLBACK_FUNC (((struct subdev_8255_private *)s->private)->cb_func)
-#define subdevpriv ((struct subdev_8255_private *)s->private)
-
void subdev_8255_interrupt(struct comedi_device *dev,
struct comedi_subdevice *s)
{
+ struct subdev_8255_private *spriv = s->private;
short d;
- d = CALLBACK_FUNC(0, _8255_DATA, 0, CALLBACK_ARG);
- d |= (CALLBACK_FUNC(0, _8255_DATA + 1, 0, CALLBACK_ARG) << 8);
+ d = spriv->cb_func(0, _8255_DATA, 0, spriv->cb_arg);
+ d |= (spriv->cb_func(0, _8255_DATA + 1, 0, spriv->cb_arg) << 8);
comedi_buf_put(s->async, d);
s->async->events |= COMEDI_CB_EOS;
struct comedi_subdevice *s,
struct comedi_insn *insn, unsigned int *data)
{
+ struct subdev_8255_private *spriv = s->private;
+
if (data[0]) {
s->state &= ~data[0];
s->state |= (data[0] & data[1]);
if (data[0] & 0xff)
- CALLBACK_FUNC(1, _8255_DATA, s->state & 0xff,
- CALLBACK_ARG);
+ spriv->cb_func(1, _8255_DATA, s->state & 0xff,
+ spriv->cb_arg);
if (data[0] & 0xff00)
- CALLBACK_FUNC(1, _8255_DATA + 1, (s->state >> 8) & 0xff,
- CALLBACK_ARG);
+ spriv->cb_func(1, _8255_DATA + 1,
+ (s->state >> 8) & 0xff, spriv->cb_arg);
if (data[0] & 0xff0000)
- CALLBACK_FUNC(1, _8255_DATA + 2,
- (s->state >> 16) & 0xff, CALLBACK_ARG);
+ spriv->cb_func(1, _8255_DATA + 2,
+ (s->state >> 16) & 0xff, spriv->cb_arg);
}
- data[1] = CALLBACK_FUNC(0, _8255_DATA, 0, CALLBACK_ARG);
- data[1] |= (CALLBACK_FUNC(0, _8255_DATA + 1, 0, CALLBACK_ARG) << 8);
- data[1] |= (CALLBACK_FUNC(0, _8255_DATA + 2, 0, CALLBACK_ARG) << 16);
+ data[1] = spriv->cb_func(0, _8255_DATA, 0, spriv->cb_arg);
+ data[1] |= (spriv->cb_func(0, _8255_DATA + 1, 0, spriv->cb_arg) << 8);
+ data[1] |= (spriv->cb_func(0, _8255_DATA + 2, 0, spriv->cb_arg) << 16);
return 2;
}
static void do_config(struct comedi_device *dev, struct comedi_subdevice *s)
{
+ struct subdev_8255_private *spriv = s->private;
int config;
config = CR_CW;
config |= CR_C_LO_IO;
if (!(s->io_bits & 0xf00000))
config |= CR_C_HI_IO;
- CALLBACK_FUNC(1, _8255_CR, config, CALLBACK_ARG);
+ spriv->cb_func(1, _8255_CR, config, spriv->cb_arg);
}
static int subdev_8255_insn_config(struct comedi_device *dev,
int (*cb) (int, int, int, unsigned long),
unsigned long arg)
{
+ struct subdev_8255_private *spriv;
+
s->type = COMEDI_SUBD_DIO;
s->subdev_flags = SDF_READABLE | SDF_WRITABLE;
s->n_chan = 24;
s->range_table = &range_digital;
s->maxdata = 1;
- s->private = kmalloc(sizeof(struct subdev_8255_private), GFP_KERNEL);
- if (!s->private)
+ spriv = kmalloc(sizeof(*spriv), GFP_KERNEL);
+ if (!spriv)
return -ENOMEM;
+ s->private = spriv;
- CALLBACK_ARG = arg;
+ spriv->cb_arg = arg;
if (cb == NULL)
- CALLBACK_FUNC = subdev_8255_cb;
+ spriv->cb_func = subdev_8255_cb;
else
- CALLBACK_FUNC = cb;
+ spriv->cb_func = cb;
s->insn_bits = subdev_8255_insn;
s->insn_config = subdev_8255_insn_config;
int (*cb) (int, int, int, unsigned long),
unsigned long arg)
{
+ struct subdev_8255_private *spriv;
int ret;
ret = subdev_8255_init(dev, s, cb, arg);
if (ret < 0)
return ret;
+ spriv = s->private;
+
+ spriv->have_irq = 1;
s->do_cmdtest = subdev_8255_cmdtest;
s->do_cmd = subdev_8255_cmd;
s->cancel = subdev_8255_cancel;
- subdevpriv->have_irq = 1;
-
return 0;
}
EXPORT_SYMBOL(subdev_8255_init_irq);
static void dev_8255_detach(struct comedi_device *dev)
{
- int i;
- unsigned long iobase;
struct comedi_subdevice *s;
+ struct subdev_8255_private *spriv;
+ int i;
for (i = 0; i < dev->n_subdevices; i++) {
s = dev->subdevices + i;
if (s->type != COMEDI_SUBD_UNUSED) {
- iobase = CALLBACK_ARG;
- release_region(iobase, _8255_SIZE);
+ spriv = s->private;
+ release_region(spriv->cb_arg, _8255_SIZE);
}
subdev_8255_cleanup(dev, s);
}