drivers/staging/comedi/drivers/fl512.c

   1 /*
   2     comedi/drivers/fl512.c
   3     Anders Gnistrup <ex18@kalman.iau.dtu.dk>
   4 */
   5
   6 /*
   7 Driver: fl512
   8 Description: unknown
   9 Author: Anders Gnistrup <ex18@kalman.iau.dtu.dk>
  10 Devices: [unknown] FL512 (fl512)
  11 Status: unknown
  12
  13 Digital I/O is not supported.
  14
  15 Configuration options:
  16   [0] - I/O port base address
  17 */
  18
  19 #define DEBUG 0
  20
  21 #include "../comedidev.h"
  22
  23 #include <linux/delay.h>
  24 #include <linux/ioport.h>
  25
  26 #define FL512_SIZE 16           /* the size of the used memory */
  27 typedef struct {
  28         short ao_readback[2];
  29 } fl512_private;
  30 #define devpriv ((fl512_private *) dev->private)
  31
  32 static const comedi_lrange range_fl512 = { 4, {
  33                         BIP_RANGE(0.5),
  34                         BIP_RANGE(1),
  35                         BIP_RANGE(5),
  36                         BIP_RANGE(10),
  37                         UNI_RANGE(1),
  38                         UNI_RANGE(5),
  39                         UNI_RANGE(10),
  40         }
  41 };
  42
  43 static int fl512_attach(struct comedi_device * dev, comedi_devconfig * it);
  44 static int fl512_detach(struct comedi_device * dev);
  45
  46 static comedi_driver driver_fl512 = {
  47       driver_name:"fl512",
  48       module:THIS_MODULE,
  49       attach:fl512_attach,
  50       detach:fl512_detach,
  51 };
  52
  53 COMEDI_INITCLEANUP(driver_fl512);
  54
  55 static int fl512_ai_insn(struct comedi_device * dev,
  56         struct comedi_subdevice * s, comedi_insn * insn, unsigned int * data);
  57 static int fl512_ao_insn(struct comedi_device * dev,
  58         struct comedi_subdevice * s, comedi_insn * insn, unsigned int * data);
  59 static int fl512_ao_insn_readback(struct comedi_device * dev,
  60         struct comedi_subdevice * s, comedi_insn * insn, unsigned int * data);
  61
  62 /*
  63  * fl512_ai_insn : this is the analog input function
  64  */
  65 static int fl512_ai_insn(struct comedi_device * dev,
  66         struct comedi_subdevice * s, comedi_insn * insn, unsigned int * data)
  67 {
  68         int n;
  69         unsigned int lo_byte, hi_byte;
  70         char chan = CR_CHAN(insn->chanspec);
  71         unsigned long iobase = dev->iobase;
  72
  73         for (n = 0; n < insn->n; n++) { /* sample n times on selected channel */
  74                 /* XXX probably can move next step out of for() loop -- will make
  75                  * AI a little bit faster. */
  76                 outb(chan, iobase + 2); /* select chan */
  77                 outb(0, iobase + 3);    /* start conversion */
  78                 /* XXX should test "done" flag instead of delay */
  79                 comedi_udelay(30);      /* sleep 30 usec */
  80                 lo_byte = inb(iobase + 2);      /* low 8 byte */
  81                 hi_byte = inb(iobase + 3) & 0xf;        /* high 4 bit and mask */
  82                 data[n] = lo_byte + (hi_byte << 8);
  83         }
  84         return n;
  85 }
  86
  87 /*
  88  * fl512_ao_insn : used to write to a DA port n times
  89  */
  90 static int fl512_ao_insn(struct comedi_device * dev,
  91         struct comedi_subdevice * s, comedi_insn * insn, unsigned int * data)
  92 {
  93         int n;
  94         int chan = CR_CHAN(insn->chanspec);     /* get chan to write */
  95         unsigned long iobase = dev->iobase;     /* get base address  */
  96
  97         for (n = 0; n < insn->n; n++) { /* write n data set */
  98                 outb(data[n] & 0x0ff, iobase + 4 + 2 * chan);   /* write low byte   */
  99                 outb((data[n] & 0xf00) >> 8, iobase + 4 + 2 * chan);    /* write high byte  */
 100                 inb(iobase + 4 + 2 * chan);     /* trig */
 101
 102                 devpriv->ao_readback[chan] = data[n];
 103         }
 104         return n;
 105 }
 106
 107 /*
 108  * fl512_ao_insn_readback : used to read previous values written to
 109  * DA port
 110  */
 111 static int fl512_ao_insn_readback(struct comedi_device * dev,
 112         struct comedi_subdevice * s, comedi_insn * insn, unsigned int * data)
 113 {
 114         int n;
 115         int chan = CR_CHAN(insn->chanspec);
 116
 117         for (n = 0; n < insn->n; n++) {
 118                 data[n] = devpriv->ao_readback[chan];
 119         }
 120
 121         return n;
 122 }
 123
 124 /*
 125  * start attach
 126  */
 127 static int fl512_attach(struct comedi_device * dev, comedi_devconfig * it)
 128 {
 129         unsigned long iobase;
 130         struct comedi_subdevice *s;     /* pointer to the subdevice:
 131                                    Analog in, Analog out, ( not made ->and Digital IO) */
 132
 133         iobase = it->options[0];
 134         printk("comedi:%d fl512: 0x%04lx", dev->minor, iobase);
 135         if (!request_region(iobase, FL512_SIZE, "fl512")) {
 136                 printk(" I/O port conflict\n");
 137                 return -EIO;
 138         }
 139         dev->iobase = iobase;
 140         dev->board_name = "fl512";
 141         if (alloc_private(dev, sizeof(fl512_private)) < 0)
 142                 return -ENOMEM;
 143
 144 #if DEBUG
 145         printk("malloc ok\n");
 146 #endif
 147
 148         if (alloc_subdevices(dev, 2) < 0)
 149                 return -ENOMEM;
 150
 151         /*
 152          * this if the definitions of the supdevices, 2 have been defined
 153          */
 154         /* Analog indput */
 155         s = dev->subdevices + 0;
 156         s->type = COMEDI_SUBD_AI;       /* define subdevice as Analog In   */
 157         s->subdev_flags = SDF_READABLE | SDF_GROUND;    /* you can read it from userspace  */
 158         s->n_chan = 16;         /* Number of Analog input channels */
 159         s->maxdata = 0x0fff;    /* accept only 12 bits of data     */
 160         s->range_table = &range_fl512;  /* device use one of the ranges    */
 161         s->insn_read = fl512_ai_insn;   /* function to call when read AD   */
 162         printk("comedi: fl512: subdevice 0 initialized\n");
 163
 164         /* Analog output */
 165         s = dev->subdevices + 1;
 166         s->type = COMEDI_SUBD_AO;       /* define subdevice as Analog OUT   */
 167         s->subdev_flags = SDF_WRITABLE; /* you can write it from userspace  */
 168         s->n_chan = 2;          /* Number of Analog output channels */
 169         s->maxdata = 0x0fff;    /* accept only 12 bits of data      */
 170         s->range_table = &range_fl512;  /* device use one of the ranges     */
 171         s->insn_write = fl512_ao_insn;  /* function to call when write DA   */
 172         s->insn_read = fl512_ao_insn_readback;  /* function to call when reading DA   */
 173         printk("comedi: fl512: subdevice 1 initialized\n");
 174
 175         return 1;
 176 }
 177
 178 static int fl512_detach(struct comedi_device * dev)
 179 {
 180         if (dev->iobase)
 181                 release_region(dev->iobase, FL512_SIZE);
 182         printk("comedi%d: fl512: dummy i detach\n", dev->minor);
 183         return 0;
 184 }