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#include <linux/pci.h>
33
34#include "../comedidev.h"
35#include "addi_watchdog.h"
36
37
38
39
40#define APCI2200_DI_REG 0x00
41#define APCI2200_DO_REG 0x04
42#define APCI2200_WDOG_REG 0x08
43
44static int apci2200_di_insn_bits(struct comedi_device *dev,
45 struct comedi_subdevice *s,
46 struct comedi_insn *insn,
47 unsigned int *data)
48{
49 data[1] = inw(dev->iobase + APCI2200_DI_REG);
50
51 return insn->n;
52}
53
54static int apci2200_do_insn_bits(struct comedi_device *dev,
55 struct comedi_subdevice *s,
56 struct comedi_insn *insn,
57 unsigned int *data)
58{
59 unsigned int mask = data[0];
60 unsigned int bits = data[1];
61
62 s->state = inw(dev->iobase + APCI2200_DO_REG);
63 if (mask) {
64 s->state &= ~mask;
65 s->state |= (bits & mask);
66
67 outw(s->state, dev->iobase + APCI2200_DO_REG);
68 }
69
70 data[1] = s->state;
71
72 return insn->n;
73}
74
75static int apci2200_reset(struct comedi_device *dev)
76{
77 outw(0x0, dev->iobase + APCI2200_DO_REG);
78
79 addi_watchdog_reset(dev->iobase + APCI2200_WDOG_REG);
80
81 return 0;
82}
83
84static int apci2200_auto_attach(struct comedi_device *dev,
85 unsigned long context_unused)
86{
87 struct pci_dev *pcidev = comedi_to_pci_dev(dev);
88 struct comedi_subdevice *s;
89 int ret;
90
91 ret = comedi_pci_enable(dev);
92 if (ret)
93 return ret;
94
95 dev->iobase = pci_resource_start(pcidev, 1);
96
97 ret = comedi_alloc_subdevices(dev, 3);
98 if (ret)
99 return ret;
100
101
102 s = &dev->subdevices[0];
103 s->type = COMEDI_SUBD_DI;
104 s->subdev_flags = SDF_READABLE;
105 s->n_chan = 8;
106 s->maxdata = 1;
107 s->range_table = &range_digital;
108 s->insn_bits = apci2200_di_insn_bits;
109
110
111 s = &dev->subdevices[1];
112 s->type = COMEDI_SUBD_DO;
113 s->subdev_flags = SDF_WRITEABLE;
114 s->n_chan = 16;
115 s->maxdata = 1;
116 s->range_table = &range_digital;
117 s->insn_bits = apci2200_do_insn_bits;
118
119
120 s = &dev->subdevices[2];
121 ret = addi_watchdog_init(s, dev->iobase + APCI2200_WDOG_REG);
122 if (ret)
123 return ret;
124
125 apci2200_reset(dev);
126 return 0;
127}
128
129static void apci2200_detach(struct comedi_device *dev)
130{
131 if (dev->iobase)
132 apci2200_reset(dev);
133 comedi_spriv_free(dev, 2);
134 comedi_pci_disable(dev);
135}
136
137static struct comedi_driver apci2200_driver = {
138 .driver_name = "addi_apci_2200",
139 .module = THIS_MODULE,
140 .auto_attach = apci2200_auto_attach,
141 .detach = apci2200_detach,
142};
143
144static int apci2200_pci_probe(struct pci_dev *dev,
145 const struct pci_device_id *id)
146{
147 return comedi_pci_auto_config(dev, &apci2200_driver, id->driver_data);
148}
149
150static DEFINE_PCI_DEVICE_TABLE(apci2200_pci_table) = {
151 { PCI_DEVICE(PCI_VENDOR_ID_ADDIDATA, 0x1005) },
152 { 0 }
153};
154MODULE_DEVICE_TABLE(pci, apci2200_pci_table);
155
156static struct pci_driver apci2200_pci_driver = {
157 .name = "addi_apci_2200",
158 .id_table = apci2200_pci_table,
159 .probe = apci2200_pci_probe,
160 .remove = comedi_pci_auto_unconfig,
161};
162module_comedi_pci_driver(apci2200_driver, apci2200_pci_driver);
163
164MODULE_DESCRIPTION("ADDI-DATA APCI-2200 Relay board, optically isolated");
165MODULE_AUTHOR("Comedi http://www.comedi.org");
166MODULE_LICENSE("GPL");
167