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#include <linux/module.h>
50
51#include "../comedi_pci.h"
52
53
54
55
56#define PCI1724_DAC_CTRL_REG 0x00
57#define PCI1724_DAC_CTRL_GX(x) BIT(20 + ((x) / 8))
58#define PCI1724_DAC_CTRL_CX(x) (((x) % 8) << 16)
59#define PCI1724_DAC_CTRL_MODE(x) (((x) & 0x3) << 14)
60#define PCI1724_DAC_CTRL_MODE_GAIN PCI1724_DAC_CTRL_MODE(1)
61#define PCI1724_DAC_CTRL_MODE_OFFSET PCI1724_DAC_CTRL_MODE(2)
62#define PCI1724_DAC_CTRL_MODE_NORMAL PCI1724_DAC_CTRL_MODE(3)
63#define PCI1724_DAC_CTRL_MODE_MASK PCI1724_DAC_CTRL_MODE(3)
64#define PCI1724_DAC_CTRL_DATA(x) (((x) & 0x3fff) << 0)
65#define PCI1724_SYNC_CTRL_REG 0x04
66#define PCI1724_SYNC_CTRL_DACSTAT BIT(1)
67#define PCI1724_SYNC_CTRL_SYN BIT(0)
68#define PCI1724_EEPROM_CTRL_REG 0x08
69#define PCI1724_SYNC_TRIG_REG 0x0c
70#define PCI1724_BOARD_ID_REG 0x10
71#define PCI1724_BOARD_ID_MASK (0xf << 0)
72
73static const struct comedi_lrange adv_pci1724_ao_ranges = {
74 4, {
75 BIP_RANGE(10),
76 RANGE_mA(0, 20),
77 RANGE_mA(4, 20),
78 RANGE_unitless(0, 1)
79 }
80};
81
82static int adv_pci1724_dac_idle(struct comedi_device *dev,
83 struct comedi_subdevice *s,
84 struct comedi_insn *insn,
85 unsigned long context)
86{
87 unsigned int status;
88
89 status = inl(dev->iobase + PCI1724_SYNC_CTRL_REG);
90 if ((status & PCI1724_SYNC_CTRL_DACSTAT) == 0)
91 return 0;
92 return -EBUSY;
93}
94
95static int adv_pci1724_insn_write(struct comedi_device *dev,
96 struct comedi_subdevice *s,
97 struct comedi_insn *insn,
98 unsigned int *data)
99{
100 unsigned long mode = (unsigned long)s->private;
101 unsigned int chan = CR_CHAN(insn->chanspec);
102 unsigned int ctrl;
103 int ret;
104 int i;
105
106 ctrl = PCI1724_DAC_CTRL_GX(chan) | PCI1724_DAC_CTRL_CX(chan) | mode;
107
108
109 outl(0, dev->iobase + PCI1724_SYNC_CTRL_REG);
110
111 for (i = 0; i < insn->n; ++i) {
112 unsigned int val = data[i];
113
114 ret = comedi_timeout(dev, s, insn, adv_pci1724_dac_idle, 0);
115 if (ret)
116 return ret;
117
118 outl(ctrl | PCI1724_DAC_CTRL_DATA(val),
119 dev->iobase + PCI1724_DAC_CTRL_REG);
120
121 s->readback[chan] = val;
122 }
123
124 return insn->n;
125}
126
127static int adv_pci1724_auto_attach(struct comedi_device *dev,
128 unsigned long context_unused)
129{
130 struct pci_dev *pcidev = comedi_to_pci_dev(dev);
131 struct comedi_subdevice *s;
132 unsigned int board_id;
133 int ret;
134
135 ret = comedi_pci_enable(dev);
136 if (ret)
137 return ret;
138
139 dev->iobase = pci_resource_start(pcidev, 2);
140 board_id = inl(dev->iobase + PCI1724_BOARD_ID_REG);
141 dev_info(dev->class_dev, "board id: %d\n",
142 board_id & PCI1724_BOARD_ID_MASK);
143
144 ret = comedi_alloc_subdevices(dev, 3);
145 if (ret)
146 return ret;
147
148
149 s = &dev->subdevices[0];
150 s->type = COMEDI_SUBD_AO;
151 s->subdev_flags = SDF_READABLE | SDF_WRITABLE | SDF_GROUND;
152 s->n_chan = 32;
153 s->maxdata = 0x3fff;
154 s->range_table = &adv_pci1724_ao_ranges;
155 s->insn_write = adv_pci1724_insn_write;
156 s->private = (void *)PCI1724_DAC_CTRL_MODE_NORMAL;
157
158 ret = comedi_alloc_subdev_readback(s);
159 if (ret)
160 return ret;
161
162
163 s = &dev->subdevices[1];
164 s->type = COMEDI_SUBD_CALIB;
165 s->subdev_flags = SDF_READABLE | SDF_WRITABLE | SDF_INTERNAL;
166 s->n_chan = 32;
167 s->maxdata = 0x3fff;
168 s->insn_write = adv_pci1724_insn_write;
169 s->private = (void *)PCI1724_DAC_CTRL_MODE_OFFSET;
170
171 ret = comedi_alloc_subdev_readback(s);
172 if (ret)
173 return ret;
174
175
176 s = &dev->subdevices[2];
177 s->type = COMEDI_SUBD_CALIB;
178 s->subdev_flags = SDF_READABLE | SDF_WRITABLE | SDF_INTERNAL;
179 s->n_chan = 32;
180 s->maxdata = 0x3fff;
181 s->insn_write = adv_pci1724_insn_write;
182 s->private = (void *)PCI1724_DAC_CTRL_MODE_GAIN;
183
184 return comedi_alloc_subdev_readback(s);
185}
186
187static struct comedi_driver adv_pci1724_driver = {
188 .driver_name = "adv_pci1724",
189 .module = THIS_MODULE,
190 .auto_attach = adv_pci1724_auto_attach,
191 .detach = comedi_pci_detach,
192};
193
194static int adv_pci1724_pci_probe(struct pci_dev *dev,
195 const struct pci_device_id *id)
196{
197 return comedi_pci_auto_config(dev, &adv_pci1724_driver,
198 id->driver_data);
199}
200
201static const struct pci_device_id adv_pci1724_pci_table[] = {
202 { PCI_DEVICE(PCI_VENDOR_ID_ADVANTECH, 0x1724) },
203 { 0 }
204};
205MODULE_DEVICE_TABLE(pci, adv_pci1724_pci_table);
206
207static struct pci_driver adv_pci1724_pci_driver = {
208 .name = "adv_pci1724",
209 .id_table = adv_pci1724_pci_table,
210 .probe = adv_pci1724_pci_probe,
211 .remove = comedi_pci_auto_unconfig,
212};
213module_comedi_pci_driver(adv_pci1724_driver, adv_pci1724_pci_driver);
214
215MODULE_AUTHOR("Frank Mori Hess <fmh6jj@gmail.com>");
216MODULE_DESCRIPTION("Advantech PCI-1724U Comedi driver");
217MODULE_LICENSE("GPL");
218