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#include <linux/module.h>
40#include <linux/pci.h>
41#include <linux/interrupt.h>
42
43#include "../comedidev.h"
44
45#include "mite.h"
46
47#define AO_VALUE_OFFSET 0x00
48#define AO_CHAN_OFFSET 0x0c
49#define AO_STATUS_OFFSET 0x10
50#define AO_CONTROL_OFFSET 0x10
51#define DIO_PORT0_DIR_OFFSET 0x20
52#define DIO_PORT0_DATA_OFFSET 0x24
53#define DIO_PORT1_DIR_OFFSET 0x28
54#define DIO_PORT1_DATA_OFFSET 0x2c
55#define MISC_STATUS_OFFSET 0x14
56#define MISC_CONTROL_OFFSET 0x14
57
58enum ni_670x_boardid {
59 BOARD_PCI6703,
60 BOARD_PXI6704,
61 BOARD_PCI6704,
62};
63
64struct ni_670x_board {
65 const char *name;
66 unsigned short ao_chans;
67};
68
69static const struct ni_670x_board ni_670x_boards[] = {
70 [BOARD_PCI6703] = {
71 .name = "PCI-6703",
72 .ao_chans = 16,
73 },
74 [BOARD_PXI6704] = {
75 .name = "PXI-6704",
76 .ao_chans = 32,
77 },
78 [BOARD_PCI6704] = {
79 .name = "PCI-6704",
80 .ao_chans = 32,
81 },
82};
83
84struct ni_670x_private {
85
86 struct mite_struct *mite;
87 int boardtype;
88 int dio;
89 unsigned int ao_readback[32];
90};
91
92static int ni_670x_ao_winsn(struct comedi_device *dev,
93 struct comedi_subdevice *s,
94 struct comedi_insn *insn, unsigned int *data)
95{
96 struct ni_670x_private *devpriv = dev->private;
97 int i;
98 int chan = CR_CHAN(insn->chanspec);
99
100
101
102
103
104
105
106
107
108
109
110
111 for (i = 0; i < insn->n; i++) {
112
113 writel(((chan & 15) << 1) | ((chan & 16) >> 4),
114 devpriv->mite->daq_io_addr + AO_CHAN_OFFSET);
115
116 writel(data[i], devpriv->mite->daq_io_addr + AO_VALUE_OFFSET);
117 devpriv->ao_readback[chan] = data[i];
118 }
119
120 return i;
121}
122
123static int ni_670x_ao_rinsn(struct comedi_device *dev,
124 struct comedi_subdevice *s,
125 struct comedi_insn *insn, unsigned int *data)
126{
127 struct ni_670x_private *devpriv = dev->private;
128 int i;
129 int chan = CR_CHAN(insn->chanspec);
130
131 for (i = 0; i < insn->n; i++)
132 data[i] = devpriv->ao_readback[chan];
133
134 return i;
135}
136
137static int ni_670x_dio_insn_bits(struct comedi_device *dev,
138 struct comedi_subdevice *s,
139 struct comedi_insn *insn,
140 unsigned int *data)
141{
142 struct ni_670x_private *devpriv = dev->private;
143 void __iomem *io_addr = devpriv->mite->daq_io_addr +
144 DIO_PORT0_DATA_OFFSET;
145
146 if (comedi_dio_update_state(s, data))
147 writel(s->state, io_addr);
148
149 data[1] = readl(io_addr);
150
151 return insn->n;
152}
153
154static int ni_670x_dio_insn_config(struct comedi_device *dev,
155 struct comedi_subdevice *s,
156 struct comedi_insn *insn,
157 unsigned int *data)
158{
159 struct ni_670x_private *devpriv = dev->private;
160 int ret;
161
162 ret = comedi_dio_insn_config(dev, s, insn, data, 0);
163 if (ret)
164 return ret;
165
166 writel(s->io_bits, devpriv->mite->daq_io_addr + DIO_PORT0_DIR_OFFSET);
167
168 return insn->n;
169}
170
171static int ni_670x_auto_attach(struct comedi_device *dev,
172 unsigned long context)
173{
174 struct pci_dev *pcidev = comedi_to_pci_dev(dev);
175 const struct ni_670x_board *thisboard = NULL;
176 struct ni_670x_private *devpriv;
177 struct comedi_subdevice *s;
178 int ret;
179 int i;
180
181 if (context < ARRAY_SIZE(ni_670x_boards))
182 thisboard = &ni_670x_boards[context];
183 if (!thisboard)
184 return -ENODEV;
185 dev->board_ptr = thisboard;
186 dev->board_name = thisboard->name;
187
188 ret = comedi_pci_enable(dev);
189 if (ret)
190 return ret;
191
192 devpriv = comedi_alloc_devpriv(dev, sizeof(*devpriv));
193 if (!devpriv)
194 return -ENOMEM;
195
196 devpriv->mite = mite_alloc(pcidev);
197 if (!devpriv->mite)
198 return -ENOMEM;
199
200 ret = mite_setup(devpriv->mite);
201 if (ret < 0) {
202 dev_warn(dev->class_dev, "error setting up mite\n");
203 return ret;
204 }
205
206 ret = comedi_alloc_subdevices(dev, 2);
207 if (ret)
208 return ret;
209
210 s = &dev->subdevices[0];
211
212 s->type = COMEDI_SUBD_AO;
213 s->subdev_flags = SDF_WRITABLE;
214 s->n_chan = thisboard->ao_chans;
215 s->maxdata = 0xffff;
216 if (s->n_chan == 32) {
217 const struct comedi_lrange **range_table_list;
218
219 range_table_list = kmalloc(sizeof(struct comedi_lrange *) * 32,
220 GFP_KERNEL);
221 if (!range_table_list)
222 return -ENOMEM;
223 s->range_table_list = range_table_list;
224 for (i = 0; i < 16; i++) {
225 range_table_list[i] = &range_bipolar10;
226 range_table_list[16 + i] = &range_0_20mA;
227 }
228 } else {
229 s->range_table = &range_bipolar10;
230 }
231 s->insn_write = &ni_670x_ao_winsn;
232 s->insn_read = &ni_670x_ao_rinsn;
233
234 s = &dev->subdevices[1];
235
236 s->type = COMEDI_SUBD_DIO;
237 s->subdev_flags = SDF_READABLE | SDF_WRITABLE;
238 s->n_chan = 8;
239 s->maxdata = 1;
240 s->range_table = &range_digital;
241 s->insn_bits = ni_670x_dio_insn_bits;
242 s->insn_config = ni_670x_dio_insn_config;
243
244
245 writel(0x10, devpriv->mite->daq_io_addr + MISC_CONTROL_OFFSET);
246
247 writel(0x00, devpriv->mite->daq_io_addr + AO_CONTROL_OFFSET);
248
249 dev_info(dev->class_dev, "%s: %s attached\n",
250 dev->driver->driver_name, dev->board_name);
251
252 return 0;
253}
254
255static void ni_670x_detach(struct comedi_device *dev)
256{
257 struct ni_670x_private *devpriv = dev->private;
258 struct comedi_subdevice *s;
259
260 if (dev->n_subdevices) {
261 s = &dev->subdevices[0];
262 if (s)
263 kfree(s->range_table_list);
264 }
265 if (devpriv && devpriv->mite) {
266 mite_unsetup(devpriv->mite);
267 mite_free(devpriv->mite);
268 }
269 comedi_pci_disable(dev);
270}
271
272static struct comedi_driver ni_670x_driver = {
273 .driver_name = "ni_670x",
274 .module = THIS_MODULE,
275 .auto_attach = ni_670x_auto_attach,
276 .detach = ni_670x_detach,
277};
278
279static int ni_670x_pci_probe(struct pci_dev *dev,
280 const struct pci_device_id *id)
281{
282 return comedi_pci_auto_config(dev, &ni_670x_driver, id->driver_data);
283}
284
285static const struct pci_device_id ni_670x_pci_table[] = {
286 { PCI_VDEVICE(NI, 0x1290), BOARD_PCI6704 },
287 { PCI_VDEVICE(NI, 0x1920), BOARD_PXI6704 },
288 { PCI_VDEVICE(NI, 0x2c90), BOARD_PCI6703 },
289 { 0 }
290};
291MODULE_DEVICE_TABLE(pci, ni_670x_pci_table);
292
293static struct pci_driver ni_670x_pci_driver = {
294 .name = "ni_670x",
295 .id_table = ni_670x_pci_table,
296 .probe = ni_670x_pci_probe,
297 .remove = comedi_pci_auto_unconfig,
298};
299module_comedi_pci_driver(ni_670x_driver, ni_670x_pci_driver);
300
301MODULE_AUTHOR("Comedi http://www.comedi.org");
302MODULE_DESCRIPTION("Comedi low-level driver");
303MODULE_LICENSE("GPL");
304