1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42#include "../comedidev.h"
43#include <linux/ioport.h>
44#include "8255.h"
45
46
47
48
49#define AIO12_8_STATUS_REG 0x00
50#define AIO12_8_STATUS_ADC_EOC (1 << 7)
51#define AIO12_8_STATUS_PORT_C_COS (1 << 6)
52#define AIO12_8_STATUS_IRQ_ENA (1 << 2)
53#define AIO12_8_INTERRUPT_REG 0x01
54#define AIO12_8_INTERRUPT_ADC (1 << 7)
55#define AIO12_8_INTERRUPT_COS (1 << 6)
56#define AIO12_8_INTERRUPT_COUNTER1 (1 << 5)
57#define AIO12_8_INTERRUPT_PORT_C3 (1 << 4)
58#define AIO12_8_INTERRUPT_PORT_C0 (1 << 3)
59#define AIO12_8_INTERRUPT_ENA (1 << 2)
60#define AIO12_8_ADC_REG 0x02
61#define AIO12_8_ADC_MODE_NORMAL (0 << 6)
62#define AIO12_8_ADC_MODE_INT_CLK (1 << 6)
63#define AIO12_8_ADC_MODE_STANDBY (2 << 6)
64#define AIO12_8_ADC_MODE_POWERDOWN (3 << 6)
65#define AIO12_8_ADC_ACQ_3USEC (0 << 5)
66#define AIO12_8_ADC_ACQ_PROGRAM (1 << 5)
67#define AIO12_8_ADC_RANGE(x) ((x) << 3)
68#define AIO12_8_ADC_CHAN(x) ((x) << 0)
69#define AIO12_8_DAC_REG(x) (0x04 + (x) * 2)
70#define AIO12_8_8254_BASE_REG 0x0c
71#define AIO12_8_8255_BASE_REG 0x10
72#define AIO12_8_DIO_CONTROL_REG 0x14
73#define AIO12_8_DIO_CONTROL_TST (1 << 0)
74#define AIO12_8_ADC_TRIGGER_REG 0x15
75#define AIO12_8_ADC_TRIGGER_RANGE(x) ((x) << 3)
76#define AIO12_8_ADC_TRIGGER_CHAN(x) ((x) << 0)
77#define AIO12_8_TRIGGER_REG 0x16
78#define AIO12_8_TRIGGER_ADTRIG (1 << 1)
79#define AIO12_8_TRIGGER_DACTRIG (1 << 0)
80#define AIO12_8_COS_REG 0x17
81#define AIO12_8_DAC_ENABLE_REG 0x18
82#define AIO12_8_DAC_ENABLE_REF_ENA (1 << 0)
83
84struct aio12_8_boardtype {
85 const char *name;
86 int ai_nchan;
87 int ao_nchan;
88};
89
90static const struct aio12_8_boardtype board_types[] = {
91 {
92 .name = "aio_aio12_8",
93 .ai_nchan = 8,
94 .ao_nchan = 4,
95 }, {
96 .name = "aio_ai12_8",
97 .ai_nchan = 8,
98 }, {
99 .name = "aio_ao12_8",
100 .ao_nchan = 4,
101 },
102};
103
104struct aio12_8_private {
105 unsigned int ao_readback[4];
106};
107
108static int aio_aio12_8_ai_read(struct comedi_device *dev,
109 struct comedi_subdevice *s,
110 struct comedi_insn *insn, unsigned int *data)
111{
112 unsigned int chan = CR_CHAN(insn->chanspec);
113 unsigned int range = CR_RANGE(insn->chanspec);
114 unsigned int val;
115 unsigned char control;
116 int n;
117
118
119
120
121
122 control = AIO12_8_ADC_MODE_NORMAL | AIO12_8_ADC_ACQ_3USEC |
123 AIO12_8_ADC_RANGE(range) | AIO12_8_ADC_CHAN(chan);
124
125
126 inb(dev->iobase + AIO12_8_STATUS_REG);
127
128 for (n = 0; n < insn->n; n++) {
129 int timeout = 5;
130
131
132 outb(control, dev->iobase + AIO12_8_ADC_REG);
133
134
135 do {
136 val = inb(dev->iobase + AIO12_8_STATUS_REG);
137 timeout--;
138 if (timeout == 0) {
139 dev_err(dev->class_dev, "ADC timeout\n");
140 return -ETIMEDOUT;
141 }
142 } while (!(val & AIO12_8_STATUS_ADC_EOC));
143
144 data[n] = inw(dev->iobase + AIO12_8_ADC_REG) & s->maxdata;
145 }
146
147 return insn->n;
148}
149
150static int aio_aio12_8_ao_read(struct comedi_device *dev,
151 struct comedi_subdevice *s,
152 struct comedi_insn *insn, unsigned int *data)
153{
154 struct aio12_8_private *devpriv = dev->private;
155 unsigned int chan = CR_CHAN(insn->chanspec);
156 int val = devpriv->ao_readback[chan];
157 int i;
158
159 for (i = 0; i < insn->n; i++)
160 data[i] = val;
161 return insn->n;
162}
163
164static int aio_aio12_8_ao_write(struct comedi_device *dev,
165 struct comedi_subdevice *s,
166 struct comedi_insn *insn, unsigned int *data)
167{
168 struct aio12_8_private *devpriv = dev->private;
169 unsigned int chan = CR_CHAN(insn->chanspec);
170 unsigned long port = dev->iobase + AIO12_8_DAC_REG(chan);
171 unsigned int val = 0;
172 int i;
173
174
175 outb(AIO12_8_DAC_ENABLE_REF_ENA, dev->iobase + AIO12_8_DAC_ENABLE_REG);
176
177 for (i = 0; i < insn->n; i++) {
178 val = data[i];
179 outw(val, port);
180 }
181
182 devpriv->ao_readback[chan] = val;
183
184 return insn->n;
185}
186
187static const struct comedi_lrange range_aio_aio12_8 = {
188 4,
189 {
190 UNI_RANGE(5),
191 BIP_RANGE(5),
192 UNI_RANGE(10),
193 BIP_RANGE(10),
194 }
195};
196
197static int aio_aio12_8_attach(struct comedi_device *dev,
198 struct comedi_devconfig *it)
199{
200 const struct aio12_8_boardtype *board = comedi_board(dev);
201 struct aio12_8_private *devpriv;
202 struct comedi_subdevice *s;
203 int ret;
204
205 ret = comedi_request_region(dev, it->options[0], 32);
206 if (ret)
207 return ret;
208
209 devpriv = kzalloc(sizeof(*devpriv), GFP_KERNEL);
210 if (!devpriv)
211 return -ENOMEM;
212 dev->private = devpriv;
213
214 ret = comedi_alloc_subdevices(dev, 4);
215 if (ret)
216 return ret;
217
218 s = &dev->subdevices[0];
219 if (board->ai_nchan) {
220
221 s->type = COMEDI_SUBD_AI;
222 s->subdev_flags = SDF_READABLE | SDF_GROUND | SDF_DIFF;
223 s->n_chan = board->ai_nchan;
224 s->maxdata = 0x0fff;
225 s->range_table = &range_aio_aio12_8;
226 s->insn_read = aio_aio12_8_ai_read;
227 } else {
228 s->type = COMEDI_SUBD_UNUSED;
229 }
230
231 s = &dev->subdevices[1];
232 if (board->ao_nchan) {
233
234 s->type = COMEDI_SUBD_AO;
235 s->subdev_flags = SDF_WRITABLE | SDF_GROUND | SDF_DIFF;
236 s->n_chan = 4;
237 s->maxdata = 0x0fff;
238 s->range_table = &range_aio_aio12_8;
239 s->insn_read = aio_aio12_8_ao_read;
240 s->insn_write = aio_aio12_8_ao_write;
241 } else {
242 s->type = COMEDI_SUBD_UNUSED;
243 }
244
245 s = &dev->subdevices[2];
246
247 ret = subdev_8255_init(dev, s, NULL,
248 dev->iobase + AIO12_8_8255_BASE_REG);
249 if (ret)
250 return ret;
251
252 s = &dev->subdevices[3];
253
254 s->type = COMEDI_SUBD_UNUSED;
255
256 dev_info(dev->class_dev, "%s: %s attached\n",
257 dev->driver->driver_name, dev->board_name);
258
259 return 0;
260}
261
262static void aio_aio12_8_detach(struct comedi_device *dev)
263{
264 comedi_spriv_free(dev, 2);
265 comedi_legacy_detach(dev);
266}
267
268static struct comedi_driver aio_aio12_8_driver = {
269 .driver_name = "aio_aio12_8",
270 .module = THIS_MODULE,
271 .attach = aio_aio12_8_attach,
272 .detach = aio_aio12_8_detach,
273 .board_name = &board_types[0].name,
274 .num_names = ARRAY_SIZE(board_types),
275 .offset = sizeof(struct aio12_8_boardtype),
276};
277module_comedi_driver(aio_aio12_8_driver);
278
279MODULE_AUTHOR("Comedi http://www.comedi.org");
280MODULE_DESCRIPTION("Comedi low-level driver");
281MODULE_LICENSE("GPL");
282