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
43
44
45
46
47
48
49
50
51
52
53
54#include <linux/module.h>
55#include "../comedidev.h"
56
57#include <linux/delay.h>
58
59#define DT2815_DATA 0
60#define DT2815_STATUS 1
61
62struct dt2815_private {
63 const struct comedi_lrange *range_type_list[8];
64 unsigned int ao_readback[8];
65};
66
67static int dt2815_ao_status(struct comedi_device *dev,
68 struct comedi_subdevice *s,
69 struct comedi_insn *insn,
70 unsigned long context)
71{
72 unsigned int status;
73
74 status = inb(dev->iobase + DT2815_STATUS);
75 if (status == context)
76 return 0;
77 return -EBUSY;
78}
79
80static int dt2815_ao_insn_read(struct comedi_device *dev,
81 struct comedi_subdevice *s,
82 struct comedi_insn *insn, unsigned int *data)
83{
84 struct dt2815_private *devpriv = dev->private;
85 int i;
86 int chan = CR_CHAN(insn->chanspec);
87
88 for (i = 0; i < insn->n; i++)
89 data[i] = devpriv->ao_readback[chan];
90
91 return i;
92}
93
94static int dt2815_ao_insn(struct comedi_device *dev, struct comedi_subdevice *s,
95 struct comedi_insn *insn, unsigned int *data)
96{
97 struct dt2815_private *devpriv = dev->private;
98 int i;
99 int chan = CR_CHAN(insn->chanspec);
100 unsigned int lo, hi;
101 int ret;
102
103 for (i = 0; i < insn->n; i++) {
104 lo = ((data[i] & 0x0f) << 4) | (chan << 1) | 0x01;
105 hi = (data[i] & 0xff0) >> 4;
106
107 ret = comedi_timeout(dev, s, insn, dt2815_ao_status, 0x00);
108 if (ret)
109 return ret;
110
111 outb(lo, dev->iobase + DT2815_DATA);
112
113 ret = comedi_timeout(dev, s, insn, dt2815_ao_status, 0x10);
114 if (ret)
115 return ret;
116
117 devpriv->ao_readback[chan] = data[i];
118 }
119 return i;
120}
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146static int dt2815_attach(struct comedi_device *dev, struct comedi_devconfig *it)
147{
148 struct dt2815_private *devpriv;
149 struct comedi_subdevice *s;
150 int i;
151 const struct comedi_lrange *current_range_type, *voltage_range_type;
152 int ret;
153
154 ret = comedi_request_region(dev, it->options[0], 0x2);
155 if (ret)
156 return ret;
157
158 ret = comedi_alloc_subdevices(dev, 1);
159 if (ret)
160 return ret;
161
162 devpriv = comedi_alloc_devpriv(dev, sizeof(*devpriv));
163 if (!devpriv)
164 return -ENOMEM;
165
166 s = &dev->subdevices[0];
167
168 s->type = COMEDI_SUBD_AO;
169 s->subdev_flags = SDF_WRITABLE;
170 s->maxdata = 0xfff;
171 s->n_chan = 8;
172 s->insn_write = dt2815_ao_insn;
173 s->insn_read = dt2815_ao_insn_read;
174 s->range_table_list = devpriv->range_type_list;
175
176 current_range_type = (it->options[3])
177 ? &range_4_20mA : &range_0_32mA;
178 voltage_range_type = (it->options[2])
179 ? &range_bipolar5 : &range_unipolar5;
180 for (i = 0; i < 8; i++) {
181 devpriv->range_type_list[i] = (it->options[5 + i])
182 ? current_range_type : voltage_range_type;
183 }
184
185
186 outb(0x00, dev->iobase + DT2815_STATUS);
187 for (i = 0; i < 100; i++) {
188
189 unsigned int status;
190
191 udelay(1000);
192 status = inb(dev->iobase + DT2815_STATUS);
193 if (status == 4) {
194 unsigned int program;
195
196 program = (it->options[4] & 0x3) << 3 | 0x7;
197 outb(program, dev->iobase + DT2815_DATA);
198 dev_dbg(dev->class_dev, "program: 0x%x (@t=%d)\n",
199 program, i);
200 break;
201 } else if (status != 0x00) {
202 dev_dbg(dev->class_dev,
203 "unexpected status 0x%x (@t=%d)\n",
204 status, i);
205 if (status & 0x60)
206 outb(0x00, dev->iobase + DT2815_STATUS);
207 }
208 }
209
210 return 0;
211}
212
213static struct comedi_driver dt2815_driver = {
214 .driver_name = "dt2815",
215 .module = THIS_MODULE,
216 .attach = dt2815_attach,
217 .detach = comedi_legacy_detach,
218};
219module_comedi_driver(dt2815_driver);
220
221MODULE_AUTHOR("Comedi http://www.comedi.org");
222MODULE_DESCRIPTION("Comedi low-level driver");
223MODULE_LICENSE("GPL");
224