1
2
3
4
5
6
7
8
9
10
11
12
13#include <linux/module.h>
14#include <linux/pci.h>
15#include <linux/pci-aspm.h>
16#include <linux/slab.h>
17#include "xillybus.h"
18
19MODULE_DESCRIPTION("Xillybus driver for PCIe");
20MODULE_AUTHOR("Eli Billauer, Xillybus Ltd.");
21MODULE_VERSION("1.06");
22MODULE_ALIAS("xillybus_pcie");
23MODULE_LICENSE("GPL v2");
24
25#define PCI_DEVICE_ID_XILLYBUS 0xebeb
26
27#define PCI_VENDOR_ID_ALTERA 0x1172
28#define PCI_VENDOR_ID_ACTEL 0x11aa
29#define PCI_VENDOR_ID_LATTICE 0x1204
30
31static const char xillyname[] = "xillybus_pcie";
32
33static const struct pci_device_id xillyids[] = {
34 {PCI_DEVICE(PCI_VENDOR_ID_XILINX, PCI_DEVICE_ID_XILLYBUS)},
35 {PCI_DEVICE(PCI_VENDOR_ID_ALTERA, PCI_DEVICE_ID_XILLYBUS)},
36 {PCI_DEVICE(PCI_VENDOR_ID_ACTEL, PCI_DEVICE_ID_XILLYBUS)},
37 {PCI_DEVICE(PCI_VENDOR_ID_LATTICE, PCI_DEVICE_ID_XILLYBUS)},
38 { }
39};
40
41static int xilly_pci_direction(int direction)
42{
43 switch (direction) {
44 case DMA_TO_DEVICE:
45 return PCI_DMA_TODEVICE;
46 case DMA_FROM_DEVICE:
47 return PCI_DMA_FROMDEVICE;
48 default:
49 return PCI_DMA_BIDIRECTIONAL;
50 }
51}
52
53static void xilly_dma_sync_single_for_cpu_pci(struct xilly_endpoint *ep,
54 dma_addr_t dma_handle,
55 size_t size,
56 int direction)
57{
58 pci_dma_sync_single_for_cpu(ep->pdev,
59 dma_handle,
60 size,
61 xilly_pci_direction(direction));
62}
63
64static void xilly_dma_sync_single_for_device_pci(struct xilly_endpoint *ep,
65 dma_addr_t dma_handle,
66 size_t size,
67 int direction)
68{
69 pci_dma_sync_single_for_device(ep->pdev,
70 dma_handle,
71 size,
72 xilly_pci_direction(direction));
73}
74
75static void xilly_pci_unmap(void *ptr)
76{
77 struct xilly_mapping *data = ptr;
78
79 pci_unmap_single(data->device, data->dma_addr,
80 data->size, data->direction);
81
82 kfree(ptr);
83}
84
85
86
87
88
89
90
91static int xilly_map_single_pci(struct xilly_endpoint *ep,
92 void *ptr,
93 size_t size,
94 int direction,
95 dma_addr_t *ret_dma_handle
96 )
97{
98 int pci_direction;
99 dma_addr_t addr;
100 struct xilly_mapping *this;
101
102 this = kzalloc(sizeof(*this), GFP_KERNEL);
103 if (!this)
104 return -ENOMEM;
105
106 pci_direction = xilly_pci_direction(direction);
107
108 addr = pci_map_single(ep->pdev, ptr, size, pci_direction);
109
110 if (pci_dma_mapping_error(ep->pdev, addr)) {
111 kfree(this);
112 return -ENODEV;
113 }
114
115 this->device = ep->pdev;
116 this->dma_addr = addr;
117 this->size = size;
118 this->direction = pci_direction;
119
120 *ret_dma_handle = addr;
121
122 return devm_add_action_or_reset(ep->dev, xilly_pci_unmap, this);
123}
124
125static struct xilly_endpoint_hardware pci_hw = {
126 .owner = THIS_MODULE,
127 .hw_sync_sgl_for_cpu = xilly_dma_sync_single_for_cpu_pci,
128 .hw_sync_sgl_for_device = xilly_dma_sync_single_for_device_pci,
129 .map_single = xilly_map_single_pci,
130};
131
132static int xilly_probe(struct pci_dev *pdev,
133 const struct pci_device_id *ent)
134{
135 struct xilly_endpoint *endpoint;
136 int rc;
137
138 endpoint = xillybus_init_endpoint(pdev, &pdev->dev, &pci_hw);
139
140 if (!endpoint)
141 return -ENOMEM;
142
143 pci_set_drvdata(pdev, endpoint);
144
145 rc = pcim_enable_device(pdev);
146 if (rc) {
147 dev_err(endpoint->dev,
148 "pcim_enable_device() failed. Aborting.\n");
149 return rc;
150 }
151
152
153
154 pci_disable_link_state(pdev, PCIE_LINK_STATE_L0S);
155
156 if (!(pci_resource_flags(pdev, 0) & IORESOURCE_MEM)) {
157 dev_err(endpoint->dev,
158 "Incorrect BAR configuration. Aborting.\n");
159 return -ENODEV;
160 }
161
162 rc = pcim_iomap_regions(pdev, 0x01, xillyname);
163 if (rc) {
164 dev_err(endpoint->dev,
165 "pcim_iomap_regions() failed. Aborting.\n");
166 return rc;
167 }
168
169 endpoint->registers = pcim_iomap_table(pdev)[0];
170
171 pci_set_master(pdev);
172
173
174 if (pci_enable_msi(pdev)) {
175 dev_err(endpoint->dev,
176 "Failed to enable MSI interrupts. Aborting.\n");
177 return -ENODEV;
178 }
179 rc = devm_request_irq(&pdev->dev, pdev->irq, xillybus_isr, 0,
180 xillyname, endpoint);
181 if (rc) {
182 dev_err(endpoint->dev,
183 "Failed to register MSI handler. Aborting.\n");
184 return -ENODEV;
185 }
186
187
188
189
190
191
192
193
194 if (!pci_set_dma_mask(pdev, DMA_BIT_MASK(32))) {
195 endpoint->dma_using_dac = 0;
196 } else if (!pci_set_dma_mask(pdev, DMA_BIT_MASK(64))) {
197 endpoint->dma_using_dac = 1;
198 } else {
199 dev_err(endpoint->dev, "Failed to set DMA mask. Aborting.\n");
200 return -ENODEV;
201 }
202
203 return xillybus_endpoint_discovery(endpoint);
204}
205
206static void xilly_remove(struct pci_dev *pdev)
207{
208 struct xilly_endpoint *endpoint = pci_get_drvdata(pdev);
209
210 xillybus_endpoint_remove(endpoint);
211}
212
213MODULE_DEVICE_TABLE(pci, xillyids);
214
215static struct pci_driver xillybus_driver = {
216 .name = xillyname,
217 .id_table = xillyids,
218 .probe = xilly_probe,
219 .remove = xilly_remove,
220};
221
222module_pci_driver(xillybus_driver);
223