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