3 Anders Gnistrup <ex18@kalman.iau.dtu.dk>
9 Author: Anders Gnistrup <ex18@kalman.iau.dtu.dk>
10 Devices: [unknown] FL512 (fl512)
13 Digital I/O is not supported.
15 Configuration options:
16 [0] - I/O port base address
21 #include "../comedidev.h"
23 #include <linux/delay.h>
24 #include <linux/ioport.h>
26 #define FL512_SIZE 16 /* the size of the used memory */
28 sampl_t ao_readback[2];
30 #define devpriv ((fl512_private *) dev->private)
32 static const comedi_lrange range_fl512 = { 4, {
43 static int fl512_attach(comedi_device * dev, comedi_devconfig * it);
44 static int fl512_detach(comedi_device * dev);
46 static comedi_driver driver_fl512 = {
53 COMEDI_INITCLEANUP(driver_fl512);
55 static int fl512_ai_insn(comedi_device * dev,
56 comedi_subdevice * s, comedi_insn * insn, lsampl_t * data);
57 static int fl512_ao_insn(comedi_device * dev,
58 comedi_subdevice * s, comedi_insn * insn, lsampl_t * data);
59 static int fl512_ao_insn_readback(comedi_device * dev,
60 comedi_subdevice * s, comedi_insn * insn, lsampl_t * data);
63 * fl512_ai_insn : this is the analog input function
65 static int fl512_ai_insn(comedi_device * dev,
66 comedi_subdevice * s, comedi_insn * insn, lsampl_t * data)
69 unsigned int lo_byte, hi_byte;
70 char chan = CR_CHAN(insn->chanspec);
71 unsigned long iobase = dev->iobase;
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);
88 * fl512_ao_insn : used to write to a DA port n times
90 static int fl512_ao_insn(comedi_device * dev,
91 comedi_subdevice * s, comedi_insn * insn, lsampl_t * data)
94 int chan = CR_CHAN(insn->chanspec); /* get chan to write */
95 unsigned long iobase = dev->iobase; /* get base address */
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 */
102 devpriv->ao_readback[chan] = data[n];
108 * fl512_ao_insn_readback : used to read previous values written to
111 static int fl512_ao_insn_readback(comedi_device * dev,
112 comedi_subdevice * s, comedi_insn * insn, lsampl_t * data)
115 int chan = CR_CHAN(insn->chanspec);
117 for (n = 0; n < insn->n; n++) {
118 data[n] = devpriv->ao_readback[chan];
127 static int fl512_attach(comedi_device * dev, comedi_devconfig * it)
129 unsigned long iobase;
130 comedi_subdevice *s; /* pointer to the subdevice:
131 Analog in, Analog out, ( not made ->and Digital IO) */
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");
139 dev->iobase = iobase;
140 dev->board_name = "fl512";
141 if (alloc_private(dev, sizeof(fl512_private)) < 0)
145 printk("malloc ok\n");
148 if (alloc_subdevices(dev, 2) < 0)
152 * this if the definitions of the supdevices, 2 have been defined
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");
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");
178 static int fl512_detach(comedi_device * dev)
181 release_region(dev->iobase, FL512_SIZE);
182 printk("comedi%d: fl512: dummy i detach\n", dev->minor);