1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3 * comedi/drivers/contec_pci_dio.c
4 *
5 * COMEDI - Linux Control and Measurement Device Interface
6 * Copyright (C) 2000 David A. Schleef <ds@schleef.org>
7 */
8
9 /*
10 * Driver: contec_pci_dio
11 * Description: Contec PIO1616L digital I/O board
12 * Devices: [Contec] PIO1616L (contec_pci_dio)
13 * Author: Stefano Rivoir <s.rivoir@gts.it>
14 * Updated: Wed, 27 Jun 2007 13:00:06 +0100
15 * Status: works
16 *
17 * Configuration Options: not applicable, uses comedi PCI auto config
18 */
19
20 #include <linux/module.h>
21 #include <linux/comedi/comedi_pci.h>
22
23 /*
24 * Register map
25 */
26 #define PIO1616L_DI_REG 0x00
27 #define PIO1616L_DO_REG 0x02
28
contec_do_insn_bits(struct comedi_device * dev,struct comedi_subdevice * s,struct comedi_insn * insn,unsigned int * data)29 static int contec_do_insn_bits(struct comedi_device *dev,
30 struct comedi_subdevice *s,
31 struct comedi_insn *insn,
32 unsigned int *data)
33 {
34 if (comedi_dio_update_state(s, data))
35 outw(s->state, dev->iobase + PIO1616L_DO_REG);
36
37 data[1] = s->state;
38
39 return insn->n;
40 }
41
contec_di_insn_bits(struct comedi_device * dev,struct comedi_subdevice * s,struct comedi_insn * insn,unsigned int * data)42 static int contec_di_insn_bits(struct comedi_device *dev,
43 struct comedi_subdevice *s,
44 struct comedi_insn *insn, unsigned int *data)
45 {
46 data[1] = inw(dev->iobase + PIO1616L_DI_REG);
47
48 return insn->n;
49 }
50
contec_auto_attach(struct comedi_device * dev,unsigned long context_unused)51 static int contec_auto_attach(struct comedi_device *dev,
52 unsigned long context_unused)
53 {
54 struct pci_dev *pcidev = comedi_to_pci_dev(dev);
55 struct comedi_subdevice *s;
56 int ret;
57
58 ret = comedi_pci_enable(dev);
59 if (ret)
60 return ret;
61 dev->iobase = pci_resource_start(pcidev, 0);
62
63 ret = comedi_alloc_subdevices(dev, 2);
64 if (ret)
65 return ret;
66
67 s = &dev->subdevices[0];
68 s->type = COMEDI_SUBD_DI;
69 s->subdev_flags = SDF_READABLE;
70 s->n_chan = 16;
71 s->maxdata = 1;
72 s->range_table = &range_digital;
73 s->insn_bits = contec_di_insn_bits;
74
75 s = &dev->subdevices[1];
76 s->type = COMEDI_SUBD_DO;
77 s->subdev_flags = SDF_WRITABLE;
78 s->n_chan = 16;
79 s->maxdata = 1;
80 s->range_table = &range_digital;
81 s->insn_bits = contec_do_insn_bits;
82
83 return 0;
84 }
85
86 static struct comedi_driver contec_pci_dio_driver = {
87 .driver_name = "contec_pci_dio",
88 .module = THIS_MODULE,
89 .auto_attach = contec_auto_attach,
90 .detach = comedi_pci_detach,
91 };
92
contec_pci_dio_pci_probe(struct pci_dev * dev,const struct pci_device_id * id)93 static int contec_pci_dio_pci_probe(struct pci_dev *dev,
94 const struct pci_device_id *id)
95 {
96 return comedi_pci_auto_config(dev, &contec_pci_dio_driver,
97 id->driver_data);
98 }
99
100 static const struct pci_device_id contec_pci_dio_pci_table[] = {
101 { PCI_DEVICE(PCI_VENDOR_ID_CONTEC, 0x8172) },
102 { 0 }
103 };
104 MODULE_DEVICE_TABLE(pci, contec_pci_dio_pci_table);
105
106 static struct pci_driver contec_pci_dio_pci_driver = {
107 .name = "contec_pci_dio",
108 .id_table = contec_pci_dio_pci_table,
109 .probe = contec_pci_dio_pci_probe,
110 .remove = comedi_pci_auto_unconfig,
111 };
112 module_comedi_pci_driver(contec_pci_dio_driver, contec_pci_dio_pci_driver);
113
114 MODULE_AUTHOR("Comedi https://www.comedi.org");
115 MODULE_DESCRIPTION("Comedi low-level driver");
116 MODULE_LICENSE("GPL");
117