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