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 
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 
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 
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 
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