fl512.c revision 34c43922e62708d45e9660eee4b4f1fb7b4bf2c7
1/* 2 comedi/drivers/fl512.c 3 Anders Gnistrup <ex18@kalman.iau.dtu.dk> 4*/ 5 6/* 7Driver: fl512 8Description: unknown 9Author: Anders Gnistrup <ex18@kalman.iau.dtu.dk> 10Devices: [unknown] FL512 (fl512) 11Status: unknown 12 13Digital I/O is not supported. 14 15Configuration 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 */ 27typedef struct { 28 short ao_readback[2]; 29} fl512_private; 30#define devpriv ((fl512_private *) dev->private) 31 32static 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 43static int fl512_attach(struct comedi_device * dev, comedi_devconfig * it); 44static int fl512_detach(struct comedi_device * dev); 45 46static comedi_driver driver_fl512 = { 47 driver_name:"fl512", 48 module:THIS_MODULE, 49 attach:fl512_attach, 50 detach:fl512_detach, 51}; 52 53COMEDI_INITCLEANUP(driver_fl512); 54 55static int fl512_ai_insn(struct comedi_device * dev, 56 struct comedi_subdevice * s, comedi_insn * insn, unsigned int * data); 57static int fl512_ao_insn(struct comedi_device * dev, 58 struct comedi_subdevice * s, comedi_insn * insn, unsigned int * data); 59static 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 */ 65static 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 */ 90static 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 */ 111static 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 */ 127static 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 178static 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} 185