release/src-rt-6.x.4708/linux/linux-2.6.36/drivers/staging/comedi/drivers/acl7225b.c

   1 /*
   2  * comedi/drivers/acl7225b.c
   3  * Driver for Adlink NuDAQ ACL-7225b and clones
   4  * José Luis Sánchez
   5  */
   6 /*
   7 Driver: acl7225b
   8 Description: Adlink NuDAQ ACL-7225b & compatibles
   9 Author: José Luis Sánchez (jsanchezv@teleline.es)
  10 Status: testing
  11 Devices: [Adlink] ACL-7225b (acl7225b), [ICP] P16R16DIO (p16r16dio)
  12 */
  13
  14 #include "../comedidev.h"
  15
  16 #include <linux/ioport.h>
  17
  18 #define ACL7225_SIZE   8        /* Requires 8 ioports, but only 4 are used */
  19 #define P16R16DIO_SIZE 4
  20 #define ACL7225_RIO_LO 0        /* Relays input/output low byte (R0-R7) */
  21 #define ACL7225_RIO_HI 1        /* Relays input/output high byte (R8-R15) */
  22 #define ACL7225_DI_LO  2        /* Digital input low byte (DI0-DI7) */
  23 #define ACL7225_DI_HI  3        /* Digital input high byte (DI8-DI15) */
  24
  25 static int acl7225b_attach(struct comedi_device *dev,
  26                            struct comedi_devconfig *it);
  27 static int acl7225b_detach(struct comedi_device *dev);
  28
  29 struct boardtype {
  30         const char *name;       /*  driver name */
  31         int io_range;           /*  len of I/O space */
  32 };
  33
  34 static const struct boardtype boardtypes[] = {
  35         {"acl7225b", ACL7225_SIZE,},
  36         {"p16r16dio", P16R16DIO_SIZE,},
  37 };
  38
  39 #define n_boardtypes (sizeof(boardtypes)/sizeof(struct boardtype))
  40 #define this_board ((const struct boardtype *)dev->board_ptr)
  41
  42 static struct comedi_driver driver_acl7225b = {
  43         .driver_name = "acl7225b",
  44         .module = THIS_MODULE,
  45         .attach = acl7225b_attach,
  46         .detach = acl7225b_detach,
  47         .board_name = &boardtypes[0].name,
  48         .num_names = n_boardtypes,
  49         .offset = sizeof(struct boardtype),
  50 };
  51
  52 static int __init driver_acl7225b_init_module(void)
  53 {
  54         return comedi_driver_register(&driver_acl7225b);
  55 }
  56
  57 static void __exit driver_acl7225b_cleanup_module(void)
  58 {
  59         comedi_driver_unregister(&driver_acl7225b);
  60 }
  61
  62 module_init(driver_acl7225b_init_module);
  63 module_exit(driver_acl7225b_cleanup_module);
  64
  65 static int acl7225b_do_insn(struct comedi_device *dev,
  66                             struct comedi_subdevice *s,
  67                             struct comedi_insn *insn, unsigned int *data)
  68 {
  69         if (insn->n != 2)
  70                 return -EINVAL;
  71
  72         if (data[0]) {
  73                 s->state &= ~data[0];
  74                 s->state |= (data[0] & data[1]);
  75         }
  76         if (data[0] & 0x00ff)
  77                 outb(s->state & 0xff, dev->iobase + (unsigned long)s->private);
  78         if (data[0] & 0xff00)
  79                 outb((s->state >> 8),
  80                      dev->iobase + (unsigned long)s->private + 1);
  81
  82         data[1] = s->state;
  83
  84         return 2;
  85 }
  86
  87 static int acl7225b_di_insn(struct comedi_device *dev,
  88                             struct comedi_subdevice *s,
  89                             struct comedi_insn *insn, unsigned int *data)
  90 {
  91         if (insn->n != 2)
  92                 return -EINVAL;
  93
  94         data[1] = inb(dev->iobase + (unsigned long)s->private) |
  95             (inb(dev->iobase + (unsigned long)s->private + 1) << 8);
  96
  97         return 2;
  98 }
  99
 100 static int acl7225b_attach(struct comedi_device *dev,
 101                            struct comedi_devconfig *it)
 102 {
 103         struct comedi_subdevice *s;
 104         int iobase, iorange;
 105
 106         iobase = it->options[0];
 107         iorange = this_board->io_range;
 108         printk(KERN_INFO "comedi%d: acl7225b: board=%s 0x%04x\n", dev->minor,
 109                this_board->name, iobase);
 110         if (!request_region(iobase, iorange, "acl7225b")) {
 111                 printk(KERN_ERR "comedi%d: request_region failed - I/O port conflict\n",
 112                         dev->minor);
 113                 return -EIO;
 114         }
 115         dev->board_name = this_board->name;
 116         dev->iobase = iobase;
 117         dev->irq = 0;
 118
 119         if (alloc_subdevices(dev, 3) < 0)
 120                 return -ENOMEM;
 121
 122         s = dev->subdevices + 0;
 123         /* Relays outputs */
 124         s->type = COMEDI_SUBD_DO;
 125         s->subdev_flags = SDF_WRITABLE;
 126         s->maxdata = 1;
 127         s->n_chan = 16;
 128         s->insn_bits = acl7225b_do_insn;
 129         s->range_table = &range_digital;
 130         s->private = (void *)ACL7225_RIO_LO;
 131
 132         s = dev->subdevices + 1;
 133         /* Relays status */
 134         s->type = COMEDI_SUBD_DI;
 135         s->subdev_flags = SDF_READABLE;
 136         s->maxdata = 1;
 137         s->n_chan = 16;
 138         s->insn_bits = acl7225b_di_insn;
 139         s->range_table = &range_digital;
 140         s->private = (void *)ACL7225_RIO_LO;
 141
 142         s = dev->subdevices + 2;
 143         /* Isolated digital inputs */
 144         s->type = COMEDI_SUBD_DI;
 145         s->subdev_flags = SDF_READABLE;
 146         s->maxdata = 1;
 147         s->n_chan = 16;
 148         s->insn_bits = acl7225b_di_insn;
 149         s->range_table = &range_digital;
 150         s->private = (void *)ACL7225_DI_LO;
 151
 152         return 0;
 153 }
 154
 155 static int acl7225b_detach(struct comedi_device *dev)
 156 {
 157         printk(KERN_INFO "comedi%d: acl7225b: remove\n", dev->minor);
 158
 159         if (dev->iobase)
 160                 release_region(dev->iobase, this_board->io_range);
 161
 162         return 0;
 163 }
 164
 165 MODULE_AUTHOR("Comedi http://www.comedi.org");
 166 MODULE_DESCRIPTION("Comedi low-level driver");
 167 MODULE_LICENSE("GPL");