1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23#include <linux/module.h>
24#include <linux/interrupt.h>
25
26#include "../comedi_pci.h"
27
28#include "ni_labpc.h"
29
30enum labpc_pci_boardid {
31 BOARD_NI_PCI1200,
32};
33
34static const struct labpc_boardinfo labpc_pci_boards[] = {
35 [BOARD_NI_PCI1200] = {
36 .name = "ni_pci-1200",
37 .ai_speed = 10000,
38 .ai_scan_up = 1,
39 .has_ao = 1,
40 .is_labpc1200 = 1,
41 },
42};
43
44
45#define MITE_IODWBSR 0xc0
46#define WENAB BIT(7)
47
48static int labpc_pci_mite_init(struct pci_dev *pcidev)
49{
50 void __iomem *mite_base;
51 u32 main_phys_addr;
52
53
54 mite_base = pci_ioremap_bar(pcidev, 0);
55 if (!mite_base)
56 return -ENOMEM;
57
58
59 main_phys_addr = pci_resource_start(pcidev, 1);
60 writel(main_phys_addr | WENAB, mite_base + MITE_IODWBSR);
61
62
63 iounmap(mite_base);
64 return 0;
65}
66
67static int labpc_pci_auto_attach(struct comedi_device *dev,
68 unsigned long context)
69{
70 struct pci_dev *pcidev = comedi_to_pci_dev(dev);
71 const struct labpc_boardinfo *board = NULL;
72 int ret;
73
74 if (context < ARRAY_SIZE(labpc_pci_boards))
75 board = &labpc_pci_boards[context];
76 if (!board)
77 return -ENODEV;
78 dev->board_ptr = board;
79 dev->board_name = board->name;
80
81 ret = comedi_pci_enable(dev);
82 if (ret)
83 return ret;
84
85 ret = labpc_pci_mite_init(pcidev);
86 if (ret)
87 return ret;
88
89 dev->mmio = pci_ioremap_bar(pcidev, 1);
90 if (!dev->mmio)
91 return -ENOMEM;
92
93 return labpc_common_attach(dev, pcidev->irq, IRQF_SHARED);
94}
95
96static void labpc_pci_detach(struct comedi_device *dev)
97{
98 labpc_common_detach(dev);
99 comedi_pci_detach(dev);
100}
101
102static struct comedi_driver labpc_pci_comedi_driver = {
103 .driver_name = "labpc_pci",
104 .module = THIS_MODULE,
105 .auto_attach = labpc_pci_auto_attach,
106 .detach = labpc_pci_detach,
107};
108
109static const struct pci_device_id labpc_pci_table[] = {
110 { PCI_VDEVICE(NI, 0x161), BOARD_NI_PCI1200 },
111 { 0 }
112};
113MODULE_DEVICE_TABLE(pci, labpc_pci_table);
114
115static int labpc_pci_probe(struct pci_dev *dev,
116 const struct pci_device_id *id)
117{
118 return comedi_pci_auto_config(dev, &labpc_pci_comedi_driver,
119 id->driver_data);
120}
121
122static struct pci_driver labpc_pci_driver = {
123 .name = "labpc_pci",
124 .id_table = labpc_pci_table,
125 .probe = labpc_pci_probe,
126 .remove = comedi_pci_auto_unconfig,
127};
128module_comedi_pci_driver(labpc_pci_comedi_driver, labpc_pci_driver);
129
130MODULE_DESCRIPTION("Comedi: National Instruments Lab-PC PCI-1200 driver");
131MODULE_AUTHOR("Comedi https://www.comedi.org");
132MODULE_LICENSE("GPL");
133