1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41#include <linux/module.h>
42#include <linux/kernel.h>
43#include <linux/init.h>
44#include <linux/etherdevice.h>
45
46#include "nfp_net_ctrl.h"
47#include "nfp_net.h"
48
49const char nfp_net_driver_name[] = "nfp_netvf";
50const char nfp_net_driver_version[] = "0.1";
51#define PCI_DEVICE_NFP6000VF 0x6003
52static const struct pci_device_id nfp_netvf_pci_device_ids[] = {
53 { PCI_VENDOR_ID_NETRONOME, PCI_DEVICE_NFP6000VF,
54 PCI_VENDOR_ID_NETRONOME, PCI_ANY_ID,
55 PCI_ANY_ID, 0,
56 },
57 { 0, }
58};
59MODULE_DEVICE_TABLE(pci, nfp_netvf_pci_device_ids);
60
61static void nfp_netvf_get_mac_addr(struct nfp_net *nn)
62{
63 u8 mac_addr[ETH_ALEN];
64
65 put_unaligned_be32(nn_readl(nn, NFP_NET_CFG_MACADDR + 0), &mac_addr[0]);
66
67 put_unaligned_be16(nn_readl(nn, NFP_NET_CFG_MACADDR + 4) >> 16,
68 &mac_addr[4]);
69
70 if (!is_valid_ether_addr(mac_addr)) {
71 eth_hw_addr_random(nn->netdev);
72 return;
73 }
74
75 ether_addr_copy(nn->netdev->dev_addr, mac_addr);
76 ether_addr_copy(nn->netdev->perm_addr, mac_addr);
77}
78
79static int nfp_netvf_pci_probe(struct pci_dev *pdev,
80 const struct pci_device_id *pci_id)
81{
82 struct nfp_net_fw_version fw_ver;
83 int max_tx_rings, max_rx_rings;
84 u32 tx_bar_off, rx_bar_off;
85 u32 tx_bar_sz, rx_bar_sz;
86 int tx_bar_no, rx_bar_no;
87 u8 __iomem *ctrl_bar;
88 struct nfp_net *nn;
89 int is_nfp3200;
90 u32 startq;
91 int stride;
92 int err;
93
94 err = pci_enable_device_mem(pdev);
95 if (err)
96 return err;
97
98 err = pci_request_regions(pdev, nfp_net_driver_name);
99 if (err) {
100 dev_err(&pdev->dev, "Unable to allocate device memory.\n");
101 goto err_pci_disable;
102 }
103
104 switch (pdev->device) {
105 case PCI_DEVICE_NFP6000VF:
106 is_nfp3200 = 0;
107 break;
108 default:
109 err = -ENODEV;
110 goto err_pci_regions;
111 }
112
113 pci_set_master(pdev);
114
115 err = dma_set_mask_and_coherent(&pdev->dev,
116 DMA_BIT_MASK(NFP_NET_MAX_DMA_BITS));
117 if (err)
118 goto err_pci_regions;
119
120
121
122
123
124
125
126 ctrl_bar = ioremap_nocache(pci_resource_start(pdev, NFP_NET_CTRL_BAR),
127 NFP_NET_CFG_BAR_SZ);
128 if (!ctrl_bar) {
129 dev_err(&pdev->dev,
130 "Failed to map resource %d\n", NFP_NET_CTRL_BAR);
131 err = -EIO;
132 goto err_pci_regions;
133 }
134
135 nfp_net_get_fw_version(&fw_ver, ctrl_bar);
136 if (fw_ver.resv || fw_ver.class != NFP_NET_CFG_VERSION_CLASS_GENERIC) {
137 dev_err(&pdev->dev, "Unknown Firmware ABI %d.%d.%d.%d\n",
138 fw_ver.resv, fw_ver.class, fw_ver.major, fw_ver.minor);
139 err = -EINVAL;
140 goto err_ctrl_unmap;
141 }
142
143
144 if (nfp_net_fw_ver_eq(&fw_ver, 0, 0, 0, 1)) {
145 stride = 2;
146 tx_bar_no = NFP_NET_Q0_BAR;
147 rx_bar_no = NFP_NET_Q1_BAR;
148 dev_warn(&pdev->dev, "OBSOLETE Firmware detected - VF isolation not available\n");
149 } else {
150 switch (fw_ver.major) {
151 case 1 ... 3:
152 if (is_nfp3200) {
153 stride = 2;
154 tx_bar_no = NFP_NET_Q0_BAR;
155 rx_bar_no = NFP_NET_Q1_BAR;
156 } else {
157 stride = 4;
158 tx_bar_no = NFP_NET_Q0_BAR;
159 rx_bar_no = tx_bar_no;
160 }
161 break;
162 default:
163 dev_err(&pdev->dev, "Unsupported Firmware ABI %d.%d.%d.%d\n",
164 fw_ver.resv, fw_ver.class,
165 fw_ver.major, fw_ver.minor);
166 err = -EINVAL;
167 goto err_ctrl_unmap;
168 }
169 }
170
171
172 max_tx_rings = readl(ctrl_bar + NFP_NET_CFG_MAX_TXRINGS);
173 max_rx_rings = readl(ctrl_bar + NFP_NET_CFG_MAX_RXRINGS);
174
175 tx_bar_sz = NFP_QCP_QUEUE_ADDR_SZ * max_tx_rings * stride;
176 rx_bar_sz = NFP_QCP_QUEUE_ADDR_SZ * max_rx_rings * stride;
177
178
179 if (tx_bar_sz > pci_resource_len(pdev, tx_bar_no)) {
180 dev_err(&pdev->dev,
181 "TX BAR too small for number of TX rings. Adjusting\n");
182 tx_bar_sz = pci_resource_len(pdev, tx_bar_no);
183 max_tx_rings = (tx_bar_sz / NFP_QCP_QUEUE_ADDR_SZ) / 2;
184 }
185 if (rx_bar_sz > pci_resource_len(pdev, rx_bar_no)) {
186 dev_err(&pdev->dev,
187 "RX BAR too small for number of RX rings. Adjusting\n");
188 rx_bar_sz = pci_resource_len(pdev, rx_bar_no);
189 max_rx_rings = (rx_bar_sz / NFP_QCP_QUEUE_ADDR_SZ) / 2;
190 }
191
192
193
194
195 switch (pdev->device) {
196 case PCI_DEVICE_NFP6000VF:
197 startq = readl(ctrl_bar + NFP_NET_CFG_START_TXQ);
198 tx_bar_off = NFP_PCIE_QUEUE(startq);
199 startq = readl(ctrl_bar + NFP_NET_CFG_START_RXQ);
200 rx_bar_off = NFP_PCIE_QUEUE(startq);
201 break;
202 default:
203 err = -ENODEV;
204 goto err_ctrl_unmap;
205 }
206
207
208 nn = nfp_net_netdev_alloc(pdev, max_tx_rings, max_rx_rings);
209 if (IS_ERR(nn)) {
210 err = PTR_ERR(nn);
211 goto err_ctrl_unmap;
212 }
213
214 nn->fw_ver = fw_ver;
215 nn->ctrl_bar = ctrl_bar;
216 nn->is_vf = 1;
217 nn->is_nfp3200 = is_nfp3200;
218 nn->stride_tx = stride;
219 nn->stride_rx = stride;
220
221 if (rx_bar_no == tx_bar_no) {
222 u32 bar_off, bar_sz;
223 resource_size_t map_addr;
224
225
226 if (tx_bar_off < rx_bar_off)
227 bar_off = tx_bar_off;
228 else
229 bar_off = rx_bar_off;
230
231 if ((tx_bar_off + tx_bar_sz) > (rx_bar_off + rx_bar_sz))
232 bar_sz = (tx_bar_off + tx_bar_sz) - bar_off;
233 else
234 bar_sz = (rx_bar_off + rx_bar_sz) - bar_off;
235
236 map_addr = pci_resource_start(pdev, tx_bar_no) + bar_off;
237 nn->q_bar = ioremap_nocache(map_addr, bar_sz);
238 if (!nn->q_bar) {
239 nn_err(nn, "Failed to map resource %d\n", tx_bar_no);
240 err = -EIO;
241 goto err_netdev_free;
242 }
243
244
245 nn->tx_bar = nn->q_bar + (tx_bar_off - bar_off);
246
247 nn->rx_bar = nn->q_bar + (rx_bar_off - bar_off);
248 } else {
249 resource_size_t map_addr;
250
251
252 map_addr = pci_resource_start(pdev, tx_bar_no) + tx_bar_off;
253 nn->tx_bar = ioremap_nocache(map_addr, tx_bar_sz);
254 if (!nn->tx_bar) {
255 nn_err(nn, "Failed to map resource %d\n", tx_bar_no);
256 err = -EIO;
257 goto err_netdev_free;
258 }
259
260
261 map_addr = pci_resource_start(pdev, rx_bar_no) + rx_bar_off;
262 nn->rx_bar = ioremap_nocache(map_addr, rx_bar_sz);
263 if (!nn->rx_bar) {
264 nn_err(nn, "Failed to map resource %d\n", rx_bar_no);
265 err = -EIO;
266 goto err_unmap_tx;
267 }
268 }
269
270 nfp_netvf_get_mac_addr(nn);
271
272 err = nfp_net_irqs_alloc(nn);
273 if (!err) {
274 nn_warn(nn, "Unable to allocate MSI-X Vectors. Exiting\n");
275 err = -EIO;
276 goto err_unmap_rx;
277 }
278
279
280
281
282
283 nn->me_freq_mhz = 1200;
284
285 err = nfp_net_netdev_init(nn->netdev);
286 if (err)
287 goto err_irqs_disable;
288
289 pci_set_drvdata(pdev, nn);
290
291 nfp_net_info(nn);
292 nfp_net_debugfs_adapter_add(nn);
293
294 return 0;
295
296err_irqs_disable:
297 nfp_net_irqs_disable(nn);
298err_unmap_rx:
299 if (!nn->q_bar)
300 iounmap(nn->rx_bar);
301err_unmap_tx:
302 if (!nn->q_bar)
303 iounmap(nn->tx_bar);
304 else
305 iounmap(nn->q_bar);
306err_netdev_free:
307 pci_set_drvdata(pdev, NULL);
308 nfp_net_netdev_free(nn);
309err_ctrl_unmap:
310 iounmap(ctrl_bar);
311err_pci_regions:
312 pci_release_regions(pdev);
313err_pci_disable:
314 pci_disable_device(pdev);
315 return err;
316}
317
318static void nfp_netvf_pci_remove(struct pci_dev *pdev)
319{
320 struct nfp_net *nn = pci_get_drvdata(pdev);
321
322
323
324
325 nfp_net_debugfs_adapter_del(nn);
326
327 nfp_net_netdev_clean(nn->netdev);
328
329 nfp_net_irqs_disable(nn);
330
331 if (!nn->q_bar) {
332 iounmap(nn->rx_bar);
333 iounmap(nn->tx_bar);
334 } else {
335 iounmap(nn->q_bar);
336 }
337 iounmap(nn->ctrl_bar);
338
339 pci_set_drvdata(pdev, NULL);
340
341 nfp_net_netdev_free(nn);
342
343 pci_release_regions(pdev);
344 pci_disable_device(pdev);
345}
346
347static struct pci_driver nfp_netvf_pci_driver = {
348 .name = nfp_net_driver_name,
349 .id_table = nfp_netvf_pci_device_ids,
350 .probe = nfp_netvf_pci_probe,
351 .remove = nfp_netvf_pci_remove,
352};
353
354static int __init nfp_netvf_init(void)
355{
356 int err;
357
358 pr_info("%s: NFP VF Network driver, Copyright (C) 2014-2015 Netronome Systems\n",
359 nfp_net_driver_name);
360
361 nfp_net_debugfs_create();
362 err = pci_register_driver(&nfp_netvf_pci_driver);
363 if (err) {
364 nfp_net_debugfs_destroy();
365 return err;
366 }
367
368 return 0;
369}
370
371static void __exit nfp_netvf_exit(void)
372{
373 pci_unregister_driver(&nfp_netvf_pci_driver);
374 nfp_net_debugfs_destroy();
375}
376
377module_init(nfp_netvf_init);
378module_exit(nfp_netvf_exit);
379
380MODULE_AUTHOR("Netronome Systems <oss-drivers@netronome.com>");
381MODULE_LICENSE("GPL");
382MODULE_DESCRIPTION("NFP VF network device driver");
383