Commit | Line | Data |
---|---|---|
a6136145 SR |
1 | /* |
2 | comedi/drivers/contec_pci_dio.c | |
3 | ||
4 | COMEDI - Linux Control and Measurement Device Interface | |
5 | Copyright (C) 2000 David A. Schleef <ds@schleef.org> | |
6 | ||
7 | This program is free software; you can redistribute it and/or modify | |
8 | it under the terms of the GNU General Public License as published by | |
9 | the Free Software Foundation; either version 2 of the License, or | |
10 | (at your option) any later version. | |
11 | ||
12 | This program is distributed in the hope that it will be useful, | |
13 | but WITHOUT ANY WARRANTY; without even the implied warranty of | |
14 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
15 | GNU General Public License for more details. | |
16 | ||
17 | You should have received a copy of the GNU General Public License | |
18 | along with this program; if not, write to the Free Software | |
19 | Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | |
20 | ||
21 | */ | |
22 | /* | |
23 | Driver: contec_pci_dio | |
24 | Description: Contec PIO1616L digital I/O board | |
25 | Devices: [Contec] PIO1616L (contec_pci_dio) | |
26 | Author: Stefano Rivoir <s.rivoir@gts.it> | |
27 | Updated: Wed, 27 Jun 2007 13:00:06 +0100 | |
28 | Status: works | |
29 | ||
30 | Configuration Options: | |
31 | [0] - PCI bus of device (optional) | |
32 | [1] - PCI slot of device (optional) | |
33 | If bus/slot is not specified, the first supported | |
34 | PCI device found will be used. | |
35 | */ | |
36 | ||
37 | #include "../comedidev.h" | |
38 | ||
39 | #include "comedi_pci.h" | |
40 | ||
216ed755 | 41 | enum contec_model { |
a6136145 | 42 | PIO1616L = 0, |
216ed755 | 43 | }; |
a6136145 | 44 | |
72e7b74d | 45 | struct contec_board { |
a6136145 SR |
46 | const char *name; |
47 | int model; | |
48 | int in_ports; | |
49 | int out_ports; | |
50 | int in_offs; | |
51 | int out_offs; | |
52 | int out_boffs; | |
72e7b74d BP |
53 | }; |
54 | static const struct contec_board contec_boards[] = { | |
a6136145 SR |
55 | {"PIO1616L", PIO1616L, 16, 16, 0, 2, 10}, |
56 | }; | |
57 | ||
58 | #define PCI_DEVICE_ID_PIO1616L 0x8172 | |
59 | static DEFINE_PCI_DEVICE_TABLE(contec_pci_table) = { | |
60 | {PCI_VENDOR_ID_CONTEC, PCI_DEVICE_ID_PIO1616L, PCI_ANY_ID, PCI_ANY_ID, | |
61 | 0, 0, PIO1616L}, | |
62 | {0} | |
63 | }; | |
64 | ||
65 | MODULE_DEVICE_TABLE(pci, contec_pci_table); | |
66 | ||
72e7b74d | 67 | #define thisboard ((const struct contec_board *)dev->board_ptr) |
a6136145 | 68 | |
4f4123ba | 69 | struct contec_private { |
a6136145 SR |
70 | int data; |
71 | ||
72 | struct pci_dev *pci_dev; | |
73 | ||
4f4123ba | 74 | }; |
a6136145 | 75 | |
4f4123ba | 76 | #define devpriv ((struct contec_private *)dev->private) |
a6136145 | 77 | |
da91b269 BP |
78 | static int contec_attach(struct comedi_device *dev, struct comedi_devconfig *it); |
79 | static int contec_detach(struct comedi_device *dev); | |
139dfbdf | 80 | static struct comedi_driver driver_contec = { |
68c3dbff BP |
81 | .driver_name = "contec_pci_dio", |
82 | .module = THIS_MODULE, | |
83 | .attach = contec_attach, | |
84 | .detach = contec_detach, | |
a6136145 SR |
85 | }; |
86 | ||
87 | /* Classic digital IO */ | |
da91b269 BP |
88 | static int contec_di_insn_bits(struct comedi_device *dev, struct comedi_subdevice *s, |
89 | struct comedi_insn *insn, unsigned int *data); | |
90 | static int contec_do_insn_bits(struct comedi_device *dev, struct comedi_subdevice *s, | |
91 | struct comedi_insn *insn, unsigned int *data); | |
a6136145 SR |
92 | |
93 | #if 0 | |
da91b269 BP |
94 | static int contec_cmdtest(struct comedi_device *dev, struct comedi_subdevice *s, |
95 | struct comedi_cmd *cmd); | |
a6136145 SR |
96 | |
97 | static int contec_ns_to_timer(unsigned int *ns, int round); | |
98 | #endif | |
99 | ||
da91b269 | 100 | static int contec_attach(struct comedi_device *dev, struct comedi_devconfig *it) |
a6136145 SR |
101 | { |
102 | struct pci_dev *pcidev; | |
34c43922 | 103 | struct comedi_subdevice *s; |
a6136145 SR |
104 | |
105 | printk("comedi%d: contec: ", dev->minor); | |
106 | ||
107 | dev->board_name = thisboard->name; | |
108 | ||
4f4123ba | 109 | if (alloc_private(dev, sizeof(struct contec_private)) < 0) |
a6136145 SR |
110 | return -ENOMEM; |
111 | ||
112 | if (alloc_subdevices(dev, 2) < 0) | |
113 | return -ENOMEM; | |
114 | ||
115 | for (pcidev = pci_get_device(PCI_ANY_ID, PCI_ANY_ID, NULL); | |
116 | pcidev != NULL; | |
117 | pcidev = pci_get_device(PCI_ANY_ID, PCI_ANY_ID, pcidev)) { | |
118 | ||
119 | if (pcidev->vendor == PCI_VENDOR_ID_CONTEC && | |
120 | pcidev->device == PCI_DEVICE_ID_PIO1616L) { | |
121 | if (it->options[0] || it->options[1]) { | |
122 | /* Check bus and slot. */ | |
123 | if (it->options[0] != pcidev->bus->number || | |
124 | it->options[1] != | |
125 | PCI_SLOT(pcidev->devfn)) { | |
126 | continue; | |
127 | } | |
128 | } | |
129 | devpriv->pci_dev = pcidev; | |
130 | if (comedi_pci_enable(pcidev, "contec_pci_dio")) { | |
131 | printk("error enabling PCI device and request regions!\n"); | |
132 | return -EIO; | |
133 | } | |
134 | dev->iobase = pci_resource_start(pcidev, 0); | |
135 | printk(" base addr %lx ", dev->iobase); | |
136 | ||
137 | dev->board_ptr = contec_boards + 0; | |
138 | ||
139 | s = dev->subdevices + 0; | |
140 | ||
141 | s->type = COMEDI_SUBD_DI; | |
142 | s->subdev_flags = SDF_READABLE; | |
143 | s->n_chan = 16; | |
144 | s->maxdata = 1; | |
145 | s->range_table = &range_digital; | |
146 | s->insn_bits = contec_di_insn_bits; | |
147 | ||
148 | s = dev->subdevices + 1; | |
149 | s->type = COMEDI_SUBD_DO; | |
150 | s->subdev_flags = SDF_WRITABLE; | |
151 | s->n_chan = 16; | |
152 | s->maxdata = 1; | |
153 | s->range_table = &range_digital; | |
154 | s->insn_bits = contec_do_insn_bits; | |
155 | ||
156 | printk("attached\n"); | |
157 | ||
158 | return 1; | |
159 | } | |
160 | } | |
161 | ||
162 | printk("card not present!\n"); | |
163 | ||
164 | return -EIO; | |
165 | } | |
166 | ||
da91b269 | 167 | static int contec_detach(struct comedi_device *dev) |
a6136145 SR |
168 | { |
169 | printk("comedi%d: contec: remove\n", dev->minor); | |
170 | ||
171 | if (devpriv && devpriv->pci_dev) { | |
172 | if (dev->iobase) { | |
173 | comedi_pci_disable(devpriv->pci_dev); | |
174 | } | |
175 | pci_dev_put(devpriv->pci_dev); | |
176 | } | |
177 | ||
178 | return 0; | |
179 | } | |
180 | ||
181 | #if 0 | |
da91b269 BP |
182 | static int contec_cmdtest(struct comedi_device *dev, struct comedi_subdevice *s, |
183 | struct comedi_cmd *cmd) | |
a6136145 SR |
184 | { |
185 | printk("contec_cmdtest called\n"); | |
186 | return 0; | |
187 | } | |
188 | ||
189 | static int contec_ns_to_timer(unsigned int *ns, int round) | |
190 | { | |
191 | return *ns; | |
192 | } | |
193 | #endif | |
194 | ||
da91b269 BP |
195 | static int contec_do_insn_bits(struct comedi_device *dev, struct comedi_subdevice *s, |
196 | struct comedi_insn *insn, unsigned int *data) | |
a6136145 SR |
197 | { |
198 | ||
199 | printk("contec_do_insn_bits called\n"); | |
200 | printk(" data: %d %d\n", data[0], data[1]); | |
201 | ||
202 | if (insn->n != 2) | |
203 | return -EINVAL; | |
204 | ||
205 | if (data[0]) { | |
206 | s->state &= ~data[0]; | |
207 | s->state |= data[0] & data[1]; | |
208 | rt_printk(" out: %d on %lx\n", s->state, | |
209 | dev->iobase + thisboard->out_offs); | |
210 | outw(s->state, dev->iobase + thisboard->out_offs); | |
211 | } | |
212 | return 2; | |
213 | } | |
214 | ||
da91b269 BP |
215 | static int contec_di_insn_bits(struct comedi_device *dev, struct comedi_subdevice *s, |
216 | struct comedi_insn *insn, unsigned int *data) | |
a6136145 SR |
217 | { |
218 | ||
219 | rt_printk("contec_di_insn_bits called\n"); | |
220 | rt_printk(" data: %d %d\n", data[0], data[1]); | |
221 | ||
222 | if (insn->n != 2) | |
223 | return -EINVAL; | |
224 | ||
225 | data[1] = inw(dev->iobase + thisboard->in_offs); | |
226 | ||
227 | return 2; | |
228 | } | |
229 | ||
230 | COMEDI_PCI_INITCLEANUP(driver_contec, contec_pci_table); |