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