Add the rt linux 4.1.3-rt3 as base
[kvmfornfv.git] / kernel / drivers / staging / comedi / drivers / dt2815.c
1 /*
2    comedi/drivers/dt2815.c
3    Hardware driver for Data Translation DT2815
4
5    COMEDI - Linux Control and Measurement Device Interface
6    Copyright (C) 1999 Anders Blomdell <anders.blomdell@control.lth.se>
7
8    This program is free software; you can redistribute it and/or modify
9    it under the terms of the GNU General Public License as published by
10    the Free Software Foundation; either version 2 of the License, or
11    (at your option) any later version.
12
13    This program is distributed in the hope that it will be useful,
14    but WITHOUT ANY WARRANTY; without even the implied warranty of
15    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
16    GNU General Public License for more details.
17  */
18 /*
19 Driver: dt2815
20 Description: Data Translation DT2815
21 Author: ds
22 Status: mostly complete, untested
23 Devices: [Data Translation] DT2815 (dt2815)
24
25 I'm not sure anyone has ever tested this board.  If you have information
26 contrary, please update.
27
28 Configuration options:
29   [0] - I/O port base base address
30   [1] - IRQ (unused)
31   [2] - Voltage unipolar/bipolar configuration
32         0 == unipolar 5V  (0V -- +5V)
33         1 == bipolar 5V  (-5V -- +5V)
34   [3] - Current offset configuration
35         0 == disabled  (0mA -- +32mAV)
36         1 == enabled  (+4mA -- +20mAV)
37   [4] - Firmware program configuration
38         0 == program 1 (see manual table 5-4)
39         1 == program 2 (see manual table 5-4)
40         2 == program 3 (see manual table 5-4)
41         3 == program 4 (see manual table 5-4)
42   [5] - Analog output 0 range configuration
43         0 == voltage
44         1 == current
45   [6] - Analog output 1 range configuration (same options)
46   [7] - Analog output 2 range configuration (same options)
47   [8] - Analog output 3 range configuration (same options)
48   [9] - Analog output 4 range configuration (same options)
49   [10] - Analog output 5 range configuration (same options)
50   [11] - Analog output 6 range configuration (same options)
51   [12] - Analog output 7 range configuration (same options)
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
62 struct dt2815_private {
63         const struct comedi_lrange *range_type_list[8];
64         unsigned int ao_readback[8];
65 };
66
67 static 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
80 static 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
94 static 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   options[0]   Board base address
124   options[1]   IRQ (not applicable)
125   options[2]   Voltage unipolar/bipolar configuration
126                 0 == unipolar 5V  (0V -- +5V)
127                 1 == bipolar 5V  (-5V -- +5V)
128   options[3]   Current offset configuration
129                 0 == disabled  (0mA -- +32mAV)
130                 1 == enabled  (+4mA -- +20mAV)
131   options[4]   Firmware program configuration
132                 0 == program 1 (see manual table 5-4)
133                 1 == program 2 (see manual table 5-4)
134                 2 == program 3 (see manual table 5-4)
135                 3 == program 4 (see manual table 5-4)
136   options[5]   Analog output 0 range configuration
137                 0 == voltage
138                 1 == current
139   options[6]   Analog output 1 range configuration
140   ...
141   options[12]   Analog output 7 range configuration
142                 0 == voltage
143                 1 == current
144  */
145
146 static 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         /* ao subdevice */
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         /* Init the 2815 */
186         outb(0x00, dev->iobase + DT2815_STATUS);
187         for (i = 0; i < 100; i++) {
188                 /* This is incredibly slow (approx 20 ms) */
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
213 static struct comedi_driver dt2815_driver = {
214         .driver_name    = "dt2815",
215         .module         = THIS_MODULE,
216         .attach         = dt2815_attach,
217         .detach         = comedi_legacy_detach,
218 };
219 module_comedi_driver(dt2815_driver);
220
221 MODULE_AUTHOR("Comedi http://www.comedi.org");
222 MODULE_DESCRIPTION("Comedi low-level driver");
223 MODULE_LICENSE("GPL");