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