]>
Commit | Line | Data |
---|---|---|
3d396eb1 | 1 | /* |
5d242f1c | 2 | * Copyright (C) 2003 - 2009 NetXen, Inc. |
3d396eb1 | 3 | * All rights reserved. |
80922fbc | 4 | * |
3d396eb1 AK |
5 | * This program is free software; you can redistribute it and/or |
6 | * modify it under the terms of the GNU General Public License | |
7 | * as published by the Free Software Foundation; either version 2 | |
8 | * of the License, or (at your option) any later version. | |
80922fbc | 9 | * |
3d396eb1 AK |
10 | * This program is distributed in the hope that it will be useful, but |
11 | * WITHOUT ANY WARRANTY; without even the implied warranty of | |
12 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
13 | * GNU General Public License for more details. | |
80922fbc | 14 | * |
3d396eb1 AK |
15 | * You should have received a copy of the GNU General Public License |
16 | * along with this program; if not, write to the Free Software | |
17 | * Foundation, Inc., 59 Temple Place - Suite 330, Boston, | |
18 | * MA 02111-1307, USA. | |
80922fbc | 19 | * |
3d396eb1 AK |
20 | * The full GNU General Public License is included in this distribution |
21 | * in the file called LICENSE. | |
80922fbc | 22 | * |
3d396eb1 AK |
23 | * Contact Information: |
24 | * info@netxen.com | |
5d242f1c DP |
25 | * NetXen Inc, |
26 | * 18922 Forge Drive | |
27 | * Cupertino, CA 95014-0701 | |
3d396eb1 AK |
28 | * |
29 | */ | |
30 | ||
cb8011ad | 31 | #include <linux/vmalloc.h> |
e98e3350 | 32 | #include <linux/interrupt.h> |
3d396eb1 AK |
33 | #include "netxen_nic_hw.h" |
34 | ||
35 | #include "netxen_nic.h" | |
3d396eb1 | 36 | #include "netxen_nic_phan_reg.h" |
3d396eb1 | 37 | |
1494a814 | 38 | #include <linux/dma-mapping.h> |
391587c3 | 39 | #include <linux/if_vlan.h> |
c9bdd4b5 | 40 | #include <net/ip.h> |
00977784 | 41 | #include <linux/ipv6.h> |
6598b169 | 42 | #include <linux/inetdevice.h> |
1494a814 | 43 | |
3d396eb1 AK |
44 | MODULE_DESCRIPTION("NetXen Multi port (1/10) Gigabit Network Driver"); |
45 | MODULE_LICENSE("GPL"); | |
46 | MODULE_VERSION(NETXEN_NIC_LINUX_VERSIONID); | |
47 | ||
ceded32f | 48 | char netxen_nic_driver_name[] = "netxen_nic"; |
3d396eb1 | 49 | static char netxen_nic_driver_string[] = "NetXen Network Driver version " |
cb8011ad | 50 | NETXEN_NIC_LINUX_VERSIONID; |
3d396eb1 | 51 | |
2956640d DP |
52 | static int port_mode = NETXEN_PORT_MODE_AUTO_NEG; |
53 | ||
54 | /* Default to restricted 1G auto-neg mode */ | |
55 | static int wol_port_mode = 5; | |
56 | ||
57 | static int use_msi = 1; | |
58 | ||
59 | static int use_msi_x = 1; | |
60 | ||
3d396eb1 AK |
61 | /* Local functions to NetXen NIC driver */ |
62 | static int __devinit netxen_nic_probe(struct pci_dev *pdev, | |
2956640d | 63 | const struct pci_device_id *ent); |
3d396eb1 AK |
64 | static void __devexit netxen_nic_remove(struct pci_dev *pdev); |
65 | static int netxen_nic_open(struct net_device *netdev); | |
66 | static int netxen_nic_close(struct net_device *netdev); | |
67 | static int netxen_nic_xmit_frame(struct sk_buff *, struct net_device *); | |
68 | static void netxen_tx_timeout(struct net_device *netdev); | |
f17443f4 | 69 | static void netxen_reset_task(struct work_struct *work); |
3d396eb1 | 70 | static void netxen_watchdog(unsigned long); |
bea3348e | 71 | static int netxen_nic_poll(struct napi_struct *napi, int budget); |
3d396eb1 AK |
72 | #ifdef CONFIG_NET_POLL_CONTROLLER |
73 | static void netxen_nic_poll_controller(struct net_device *netdev); | |
74 | #endif | |
1494a814 | 75 | static irqreturn_t netxen_intr(int irq, void *data); |
05aaa02d | 76 | static irqreturn_t netxen_msi_intr(int irq, void *data); |
b3df68f8 | 77 | static irqreturn_t netxen_msix_intr(int irq, void *data); |
3d396eb1 AK |
78 | |
79 | /* PCI Device ID Table */ | |
70081ac5 | 80 | #define ENTRY(device) \ |
040dec3b | 81 | {PCI_DEVICE(PCI_VENDOR_ID_NETXEN, (device)), \ |
70081ac5 AV |
82 | .class = PCI_CLASS_NETWORK_ETHERNET << 8, .class_mask = ~0} |
83 | ||
3d396eb1 | 84 | static struct pci_device_id netxen_pci_tbl[] __devinitdata = { |
040dec3b DP |
85 | ENTRY(PCI_DEVICE_ID_NX2031_10GXSR), |
86 | ENTRY(PCI_DEVICE_ID_NX2031_10GCX4), | |
87 | ENTRY(PCI_DEVICE_ID_NX2031_4GCU), | |
88 | ENTRY(PCI_DEVICE_ID_NX2031_IMEZ), | |
89 | ENTRY(PCI_DEVICE_ID_NX2031_HMEZ), | |
90 | ENTRY(PCI_DEVICE_ID_NX2031_XG_MGMT), | |
91 | ENTRY(PCI_DEVICE_ID_NX2031_XG_MGMT2), | |
92 | ENTRY(PCI_DEVICE_ID_NX3031), | |
3d396eb1 AK |
93 | {0,} |
94 | }; | |
95 | ||
96 | MODULE_DEVICE_TABLE(pci, netxen_pci_tbl); | |
97 | ||
b1555130 AB |
98 | static struct workqueue_struct *netxen_workq; |
99 | #define SCHEDULE_WORK(tp) queue_work(netxen_workq, tp) | |
100 | #define FLUSH_SCHEDULED_WORK() flush_workqueue(netxen_workq) | |
101 | ||
ed25ffa1 AK |
102 | static void netxen_watchdog(unsigned long); |
103 | ||
7830b22c DP |
104 | static uint32_t crb_cmd_producer[4] = { |
105 | CRB_CMD_PRODUCER_OFFSET, CRB_CMD_PRODUCER_OFFSET_1, | |
106 | CRB_CMD_PRODUCER_OFFSET_2, CRB_CMD_PRODUCER_OFFSET_3 | |
107 | }; | |
108 | ||
c9fc891f | 109 | void |
3ce06a32 | 110 | netxen_nic_update_cmd_producer(struct netxen_adapter *adapter, |
cb2107be | 111 | struct nx_host_tx_ring *tx_ring) |
3176ff3e | 112 | { |
cb2107be DP |
113 | NXWR32(adapter, tx_ring->crb_cmd_producer, tx_ring->producer); |
114 | ||
115 | if (netxen_tx_avail(tx_ring) <= TX_STOP_THRESH) { | |
116 | netif_stop_queue(adapter->netdev); | |
117 | smp_mb(); | |
118 | } | |
3176ff3e MT |
119 | } |
120 | ||
7830b22c DP |
121 | static uint32_t crb_cmd_consumer[4] = { |
122 | CRB_CMD_CONSUMER_OFFSET, CRB_CMD_CONSUMER_OFFSET_1, | |
123 | CRB_CMD_CONSUMER_OFFSET_2, CRB_CMD_CONSUMER_OFFSET_3 | |
124 | }; | |
125 | ||
3ce06a32 DP |
126 | static inline void |
127 | netxen_nic_update_cmd_consumer(struct netxen_adapter *adapter, | |
cb2107be | 128 | struct nx_host_tx_ring *tx_ring) |
3176ff3e | 129 | { |
cb2107be | 130 | NXWR32(adapter, tx_ring->crb_cmd_consumer, tx_ring->sw_consumer); |
3176ff3e MT |
131 | } |
132 | ||
2956640d | 133 | static uint32_t msi_tgt_status[8] = { |
443be796 | 134 | ISR_INT_TARGET_STATUS, ISR_INT_TARGET_STATUS_F1, |
2956640d DP |
135 | ISR_INT_TARGET_STATUS_F2, ISR_INT_TARGET_STATUS_F3, |
136 | ISR_INT_TARGET_STATUS_F4, ISR_INT_TARGET_STATUS_F5, | |
137 | ISR_INT_TARGET_STATUS_F6, ISR_INT_TARGET_STATUS_F7 | |
443be796 DP |
138 | }; |
139 | ||
2956640d DP |
140 | static struct netxen_legacy_intr_set legacy_intr[] = NX_LEGACY_INTR_CONFIG; |
141 | ||
d8b100c5 | 142 | static inline void netxen_nic_disable_int(struct nx_host_sds_ring *sds_ring) |
4638aef1 | 143 | { |
d8b100c5 DP |
144 | struct netxen_adapter *adapter = sds_ring->adapter; |
145 | ||
f98a9f69 | 146 | NXWR32(adapter, sds_ring->crb_intr_mask, 0); |
4638aef1 SH |
147 | } |
148 | ||
d8b100c5 | 149 | static inline void netxen_nic_enable_int(struct nx_host_sds_ring *sds_ring) |
4638aef1 | 150 | { |
d8b100c5 DP |
151 | struct netxen_adapter *adapter = sds_ring->adapter; |
152 | ||
f98a9f69 | 153 | NXWR32(adapter, sds_ring->crb_intr_mask, 0x1); |
4638aef1 | 154 | |
092bc571 DP |
155 | if (!NETXEN_IS_MSI_FAMILY(adapter)) |
156 | adapter->pci_write_immediate(adapter, | |
157 | adapter->legacy_intr.tgt_mask_reg, 0xfbff); | |
4638aef1 SH |
158 | } |
159 | ||
71dcddbd DP |
160 | static int |
161 | netxen_alloc_sds_rings(struct netxen_recv_context *recv_ctx, int count) | |
162 | { | |
163 | int size = sizeof(struct nx_host_sds_ring) * count; | |
164 | ||
165 | recv_ctx->sds_rings = kzalloc(size, GFP_KERNEL); | |
166 | ||
167 | return (recv_ctx->sds_rings == NULL); | |
168 | } | |
169 | ||
d8b100c5 | 170 | static void |
71dcddbd DP |
171 | netxen_free_sds_rings(struct netxen_recv_context *recv_ctx) |
172 | { | |
173 | if (recv_ctx->sds_rings != NULL) | |
174 | kfree(recv_ctx->sds_rings); | |
175 | } | |
176 | ||
177 | static int | |
d8b100c5 DP |
178 | netxen_napi_add(struct netxen_adapter *adapter, struct net_device *netdev) |
179 | { | |
180 | int ring; | |
181 | struct nx_host_sds_ring *sds_ring; | |
182 | struct netxen_recv_context *recv_ctx = &adapter->recv_ctx; | |
183 | ||
71dcddbd | 184 | if (netxen_alloc_sds_rings(recv_ctx, adapter->max_sds_rings)) |
f17443f4 | 185 | return -ENOMEM; |
71dcddbd | 186 | |
d8b100c5 DP |
187 | for (ring = 0; ring < adapter->max_sds_rings; ring++) { |
188 | sds_ring = &recv_ctx->sds_rings[ring]; | |
189 | netif_napi_add(netdev, &sds_ring->napi, | |
190 | netxen_nic_poll, NETXEN_NETDEV_WEIGHT); | |
191 | } | |
71dcddbd DP |
192 | |
193 | return 0; | |
d8b100c5 DP |
194 | } |
195 | ||
196 | static void | |
197 | netxen_napi_enable(struct netxen_adapter *adapter) | |
198 | { | |
199 | int ring; | |
200 | struct nx_host_sds_ring *sds_ring; | |
201 | struct netxen_recv_context *recv_ctx = &adapter->recv_ctx; | |
202 | ||
203 | for (ring = 0; ring < adapter->max_sds_rings; ring++) { | |
204 | sds_ring = &recv_ctx->sds_rings[ring]; | |
205 | napi_enable(&sds_ring->napi); | |
206 | netxen_nic_enable_int(sds_ring); | |
207 | } | |
208 | } | |
209 | ||
210 | static void | |
211 | netxen_napi_disable(struct netxen_adapter *adapter) | |
212 | { | |
213 | int ring; | |
214 | struct nx_host_sds_ring *sds_ring; | |
215 | struct netxen_recv_context *recv_ctx = &adapter->recv_ctx; | |
216 | ||
217 | for (ring = 0; ring < adapter->max_sds_rings; ring++) { | |
218 | sds_ring = &recv_ctx->sds_rings[ring]; | |
be339aee | 219 | netxen_nic_disable_int(sds_ring); |
b2af9cb0 DP |
220 | napi_synchronize(&sds_ring->napi); |
221 | napi_disable(&sds_ring->napi); | |
d8b100c5 DP |
222 | } |
223 | } | |
224 | ||
2956640d DP |
225 | static int nx_set_dma_mask(struct netxen_adapter *adapter, uint8_t revision_id) |
226 | { | |
227 | struct pci_dev *pdev = adapter->pdev; | |
1f434f63 DP |
228 | uint64_t mask, cmask; |
229 | ||
230 | adapter->pci_using_dac = 0; | |
2956640d | 231 | |
6afd142f | 232 | mask = DMA_BIT_MASK(32); |
2956640d DP |
233 | /* |
234 | * Consistent DMA mask is set to 32 bit because it cannot be set to | |
235 | * 35 bits. For P3 also leave it at 32 bits for now. Only the rings | |
236 | * come off this pool. | |
237 | */ | |
6afd142f | 238 | cmask = DMA_BIT_MASK(32); |
1f434f63 DP |
239 | |
240 | #ifndef CONFIG_IA64 | |
241 | if (revision_id >= NX_P3_B0) | |
6afd142f | 242 | mask = DMA_BIT_MASK(39); |
1f434f63 | 243 | else if (revision_id == NX_P2_C1) |
6afd142f | 244 | mask = DMA_BIT_MASK(35); |
1f434f63 | 245 | #endif |
2956640d | 246 | if (pci_set_dma_mask(pdev, mask) == 0 && |
1f434f63 | 247 | pci_set_consistent_dma_mask(pdev, cmask) == 0) { |
2956640d DP |
248 | adapter->pci_using_dac = 1; |
249 | return 0; | |
250 | } | |
2956640d | 251 | |
1f434f63 DP |
252 | return -EIO; |
253 | } | |
254 | ||
255 | /* Update addressable range if firmware supports it */ | |
256 | static int | |
257 | nx_update_dma_mask(struct netxen_adapter *adapter) | |
258 | { | |
259 | int change, shift, err; | |
260 | uint64_t mask, old_mask; | |
261 | struct pci_dev *pdev = adapter->pdev; | |
262 | ||
263 | change = 0; | |
264 | ||
f98a9f69 | 265 | shift = NXRD32(adapter, CRB_DMA_SHIFT); |
1f434f63 DP |
266 | if (shift >= 32) |
267 | return 0; | |
268 | ||
269 | if (NX_IS_REVISION_P3(adapter->ahw.revision_id) && (shift > 9)) | |
270 | change = 1; | |
271 | else if ((adapter->ahw.revision_id == NX_P2_C1) && (shift <= 4)) | |
272 | change = 1; | |
273 | ||
274 | if (change) { | |
275 | old_mask = pdev->dma_mask; | |
276 | mask = (1ULL<<(32+shift)) - 1; | |
277 | ||
278 | err = pci_set_dma_mask(pdev, mask); | |
279 | if (err) | |
280 | return pci_set_dma_mask(pdev, old_mask); | |
2956640d DP |
281 | } |
282 | ||
2956640d DP |
283 | return 0; |
284 | } | |
285 | ||
24767ab1 DP |
286 | static void |
287 | netxen_check_options(struct netxen_adapter *adapter) | |
2956640d | 288 | { |
24767ab1 DP |
289 | if (adapter->ahw.port_type == NETXEN_NIC_XGBE) { |
290 | adapter->num_rxd = DEFAULT_RCV_DESCRIPTORS_10G; | |
291 | adapter->num_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_10G; | |
292 | } else if (adapter->ahw.port_type == NETXEN_NIC_GBE) { | |
293 | adapter->num_rxd = DEFAULT_RCV_DESCRIPTORS_1G; | |
294 | adapter->num_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_1G; | |
295 | } | |
2956640d | 296 | |
f6d21f44 DP |
297 | adapter->msix_supported = 0; |
298 | if (NX_IS_REVISION_P3(adapter->ahw.revision_id)) { | |
c7860a2a | 299 | adapter->msix_supported = !!use_msi_x; |
f6d21f44 DP |
300 | adapter->rss_supported = !!use_msi_x; |
301 | } else if (adapter->fw_version >= NETXEN_VERSION_CODE(3, 4, 336)) { | |
302 | switch (adapter->ahw.board_type) { | |
303 | case NETXEN_BRDTYPE_P2_SB31_10G: | |
304 | case NETXEN_BRDTYPE_P2_SB31_10G_CX4: | |
f6d21f44 DP |
305 | adapter->msix_supported = !!use_msi_x; |
306 | adapter->rss_supported = !!use_msi_x; | |
307 | break; | |
308 | default: | |
309 | break; | |
310 | } | |
311 | } | |
2956640d | 312 | |
24767ab1 | 313 | adapter->num_txd = MAX_CMD_DESCRIPTORS; |
2956640d | 314 | |
24767ab1 DP |
315 | if (NX_IS_REVISION_P2(adapter->ahw.revision_id)) { |
316 | adapter->num_lro_rxd = MAX_LRO_RCV_DESCRIPTORS; | |
317 | adapter->max_rds_rings = 3; | |
318 | } else { | |
319 | adapter->num_lro_rxd = 0; | |
320 | adapter->max_rds_rings = 2; | |
321 | } | |
2956640d DP |
322 | } |
323 | ||
324 | static int | |
325 | netxen_check_hw_init(struct netxen_adapter *adapter, int first_boot) | |
326 | { | |
27c915a4 | 327 | u32 val, timeout; |
2956640d DP |
328 | |
329 | if (first_boot == 0x55555555) { | |
330 | /* This is the first boot after power up */ | |
f98a9f69 | 331 | NXWR32(adapter, NETXEN_CAM_RAM(0x1fc), NETXEN_BDINFO_MAGIC); |
27c915a4 DP |
332 | |
333 | if (!NX_IS_REVISION_P2(adapter->ahw.revision_id)) | |
334 | return 0; | |
2956640d DP |
335 | |
336 | /* PCI bus master workaround */ | |
f98a9f69 | 337 | first_boot = NXRD32(adapter, NETXEN_PCIE_REG(0x4)); |
2956640d DP |
338 | if (!(first_boot & 0x4)) { |
339 | first_boot |= 0x4; | |
f98a9f69 DP |
340 | NXWR32(adapter, NETXEN_PCIE_REG(0x4), first_boot); |
341 | first_boot = NXRD32(adapter, NETXEN_PCIE_REG(0x4)); | |
2956640d DP |
342 | } |
343 | ||
344 | /* This is the first boot after power up */ | |
f98a9f69 | 345 | first_boot = NXRD32(adapter, NETXEN_ROMUSB_GLB_SW_RESET); |
2956640d DP |
346 | if (first_boot != 0x80000f) { |
347 | /* clear the register for future unloads/loads */ | |
f98a9f69 | 348 | NXWR32(adapter, NETXEN_CAM_RAM(0x1fc), 0); |
27c915a4 | 349 | return -EIO; |
2956640d DP |
350 | } |
351 | ||
27c915a4 | 352 | /* Start P2 boot loader */ |
f98a9f69 DP |
353 | val = NXRD32(adapter, NETXEN_ROMUSB_GLB_PEGTUNE_DONE); |
354 | NXWR32(adapter, NETXEN_ROMUSB_GLB_PEGTUNE_DONE, val | 0x1); | |
27c915a4 DP |
355 | timeout = 0; |
356 | do { | |
357 | msleep(1); | |
f98a9f69 | 358 | val = NXRD32(adapter, NETXEN_CAM_RAM(0x1fc)); |
27c915a4 DP |
359 | |
360 | if (++timeout > 5000) | |
361 | return -EIO; | |
362 | ||
363 | } while (val == NETXEN_BDINFO_MAGIC); | |
2956640d | 364 | } |
27c915a4 | 365 | return 0; |
2956640d DP |
366 | } |
367 | ||
368 | static void netxen_set_port_mode(struct netxen_adapter *adapter) | |
369 | { | |
370 | u32 val, data; | |
371 | ||
1e2d0059 | 372 | val = adapter->ahw.board_type; |
2956640d DP |
373 | if ((val == NETXEN_BRDTYPE_P3_HMEZ) || |
374 | (val == NETXEN_BRDTYPE_P3_XG_LOM)) { | |
375 | if (port_mode == NETXEN_PORT_MODE_802_3_AP) { | |
376 | data = NETXEN_PORT_MODE_802_3_AP; | |
f98a9f69 | 377 | NXWR32(adapter, NETXEN_PORT_MODE_ADDR, data); |
2956640d DP |
378 | } else if (port_mode == NETXEN_PORT_MODE_XG) { |
379 | data = NETXEN_PORT_MODE_XG; | |
f98a9f69 | 380 | NXWR32(adapter, NETXEN_PORT_MODE_ADDR, data); |
2956640d DP |
381 | } else if (port_mode == NETXEN_PORT_MODE_AUTO_NEG_1G) { |
382 | data = NETXEN_PORT_MODE_AUTO_NEG_1G; | |
f98a9f69 | 383 | NXWR32(adapter, NETXEN_PORT_MODE_ADDR, data); |
2956640d DP |
384 | } else if (port_mode == NETXEN_PORT_MODE_AUTO_NEG_XG) { |
385 | data = NETXEN_PORT_MODE_AUTO_NEG_XG; | |
f98a9f69 | 386 | NXWR32(adapter, NETXEN_PORT_MODE_ADDR, data); |
2956640d DP |
387 | } else { |
388 | data = NETXEN_PORT_MODE_AUTO_NEG; | |
f98a9f69 | 389 | NXWR32(adapter, NETXEN_PORT_MODE_ADDR, data); |
2956640d DP |
390 | } |
391 | ||
392 | if ((wol_port_mode != NETXEN_PORT_MODE_802_3_AP) && | |
393 | (wol_port_mode != NETXEN_PORT_MODE_XG) && | |
394 | (wol_port_mode != NETXEN_PORT_MODE_AUTO_NEG_1G) && | |
395 | (wol_port_mode != NETXEN_PORT_MODE_AUTO_NEG_XG)) { | |
396 | wol_port_mode = NETXEN_PORT_MODE_AUTO_NEG; | |
397 | } | |
f98a9f69 | 398 | NXWR32(adapter, NETXEN_WOL_PORT_MODE, wol_port_mode); |
2956640d DP |
399 | } |
400 | } | |
401 | ||
2956640d DP |
402 | static void netxen_set_msix_bit(struct pci_dev *pdev, int enable) |
403 | { | |
404 | u32 control; | |
405 | int pos; | |
406 | ||
407 | pos = pci_find_capability(pdev, PCI_CAP_ID_MSIX); | |
408 | if (pos) { | |
409 | pci_read_config_dword(pdev, pos, &control); | |
410 | if (enable) | |
411 | control |= PCI_MSIX_FLAGS_ENABLE; | |
412 | else | |
413 | control = 0; | |
414 | pci_write_config_dword(pdev, pos, control); | |
415 | } | |
416 | } | |
417 | ||
be339aee | 418 | static void netxen_init_msix_entries(struct netxen_adapter *adapter, int count) |
2956640d DP |
419 | { |
420 | int i; | |
421 | ||
be339aee | 422 | for (i = 0; i < count; i++) |
2956640d DP |
423 | adapter->msix_entries[i].entry = i; |
424 | } | |
425 | ||
9dc28efe DP |
426 | static int |
427 | netxen_read_mac_addr(struct netxen_adapter *adapter) | |
428 | { | |
429 | int i; | |
430 | unsigned char *p; | |
431 | __le64 mac_addr; | |
9dc28efe DP |
432 | struct net_device *netdev = adapter->netdev; |
433 | struct pci_dev *pdev = adapter->pdev; | |
434 | ||
9dc28efe DP |
435 | if (NX_IS_REVISION_P3(adapter->ahw.revision_id)) { |
436 | if (netxen_p3_get_mac_addr(adapter, &mac_addr) != 0) | |
437 | return -EIO; | |
438 | } else { | |
439 | if (netxen_get_flash_mac_addr(adapter, &mac_addr) != 0) | |
440 | return -EIO; | |
441 | } | |
442 | ||
443 | p = (unsigned char *)&mac_addr; | |
444 | for (i = 0; i < 6; i++) | |
445 | netdev->dev_addr[i] = *(p + 5 - i); | |
446 | ||
447 | memcpy(netdev->perm_addr, netdev->dev_addr, netdev->addr_len); | |
448 | ||
449 | /* set station address */ | |
450 | ||
e174961c JB |
451 | if (!is_valid_ether_addr(netdev->perm_addr)) |
452 | dev_warn(&pdev->dev, "Bad MAC address %pM.\n", netdev->dev_addr); | |
9dc28efe DP |
453 | |
454 | return 0; | |
455 | } | |
456 | ||
3d0a3cc9 DP |
457 | int netxen_nic_set_mac(struct net_device *netdev, void *p) |
458 | { | |
459 | struct netxen_adapter *adapter = netdev_priv(netdev); | |
460 | struct sockaddr *addr = p; | |
461 | ||
462 | if (!is_valid_ether_addr(addr->sa_data)) | |
463 | return -EINVAL; | |
464 | ||
465 | if (netif_running(netdev)) { | |
466 | netif_device_detach(netdev); | |
467 | netxen_napi_disable(adapter); | |
468 | } | |
469 | ||
470 | memcpy(netdev->dev_addr, addr->sa_data, netdev->addr_len); | |
471 | adapter->macaddr_set(adapter, addr->sa_data); | |
472 | ||
473 | if (netif_running(netdev)) { | |
474 | netif_device_attach(netdev); | |
475 | netxen_napi_enable(adapter); | |
476 | } | |
477 | return 0; | |
478 | } | |
479 | ||
1abd266f SH |
480 | static void netxen_set_multicast_list(struct net_device *dev) |
481 | { | |
482 | struct netxen_adapter *adapter = netdev_priv(dev); | |
483 | ||
3d0a3cc9 | 484 | adapter->set_multi(dev); |
1abd266f SH |
485 | } |
486 | ||
487 | static const struct net_device_ops netxen_netdev_ops = { | |
488 | .ndo_open = netxen_nic_open, | |
489 | .ndo_stop = netxen_nic_close, | |
490 | .ndo_start_xmit = netxen_nic_xmit_frame, | |
491 | .ndo_get_stats = netxen_nic_get_stats, | |
492 | .ndo_validate_addr = eth_validate_addr, | |
493 | .ndo_set_multicast_list = netxen_set_multicast_list, | |
494 | .ndo_set_mac_address = netxen_nic_set_mac, | |
495 | .ndo_change_mtu = netxen_nic_change_mtu, | |
496 | .ndo_tx_timeout = netxen_tx_timeout, | |
497 | #ifdef CONFIG_NET_POLL_CONTROLLER | |
498 | .ndo_poll_controller = netxen_nic_poll_controller, | |
499 | #endif | |
500 | }; | |
501 | ||
97daee83 DP |
502 | static void |
503 | netxen_setup_intr(struct netxen_adapter *adapter) | |
504 | { | |
505 | struct netxen_legacy_intr_set *legacy_intrp; | |
506 | struct pci_dev *pdev = adapter->pdev; | |
be339aee DP |
507 | int err, num_msix; |
508 | ||
509 | if (adapter->rss_supported) { | |
510 | num_msix = (num_online_cpus() >= MSIX_ENTRIES_PER_ADAPTER) ? | |
511 | MSIX_ENTRIES_PER_ADAPTER : 2; | |
512 | } else | |
513 | num_msix = 1; | |
514 | ||
515 | adapter->max_sds_rings = 1; | |
97daee83 DP |
516 | |
517 | adapter->flags &= ~(NETXEN_NIC_MSI_ENABLED | NETXEN_NIC_MSIX_ENABLED); | |
97daee83 DP |
518 | |
519 | if (adapter->ahw.revision_id >= NX_P3_B0) | |
520 | legacy_intrp = &legacy_intr[adapter->ahw.pci_func]; | |
521 | else | |
522 | legacy_intrp = &legacy_intr[0]; | |
523 | adapter->legacy_intr.int_vec_bit = legacy_intrp->int_vec_bit; | |
524 | adapter->legacy_intr.tgt_status_reg = legacy_intrp->tgt_status_reg; | |
525 | adapter->legacy_intr.tgt_mask_reg = legacy_intrp->tgt_mask_reg; | |
526 | adapter->legacy_intr.pci_int_reg = legacy_intrp->pci_int_reg; | |
527 | ||
528 | netxen_set_msix_bit(pdev, 0); | |
529 | ||
530 | if (adapter->msix_supported) { | |
531 | ||
be339aee DP |
532 | netxen_init_msix_entries(adapter, num_msix); |
533 | err = pci_enable_msix(pdev, adapter->msix_entries, num_msix); | |
534 | if (err == 0) { | |
535 | adapter->flags |= NETXEN_NIC_MSIX_ENABLED; | |
536 | netxen_set_msix_bit(pdev, 1); | |
97daee83 | 537 | |
be339aee DP |
538 | if (adapter->rss_supported) |
539 | adapter->max_sds_rings = num_msix; | |
97daee83 | 540 | |
be339aee DP |
541 | dev_info(&pdev->dev, "using msi-x interrupts\n"); |
542 | return; | |
543 | } | |
544 | ||
545 | if (err > 0) | |
546 | pci_disable_msix(pdev); | |
547 | ||
548 | /* fall through for msi */ | |
97daee83 | 549 | } |
be339aee DP |
550 | |
551 | if (use_msi && !pci_enable_msi(pdev)) { | |
552 | adapter->flags |= NETXEN_NIC_MSI_ENABLED; | |
553 | adapter->msi_tgt_status = | |
554 | msi_tgt_status[adapter->ahw.pci_func]; | |
555 | dev_info(&pdev->dev, "using msi interrupts\n"); | |
f67f3408 | 556 | adapter->msix_entries[0].vector = pdev->irq; |
be339aee DP |
557 | return; |
558 | } | |
559 | ||
560 | dev_info(&pdev->dev, "using legacy interrupts\n"); | |
561 | adapter->msix_entries[0].vector = pdev->irq; | |
97daee83 DP |
562 | } |
563 | ||
564 | static void | |
565 | netxen_teardown_intr(struct netxen_adapter *adapter) | |
566 | { | |
567 | if (adapter->flags & NETXEN_NIC_MSIX_ENABLED) | |
568 | pci_disable_msix(adapter->pdev); | |
569 | if (adapter->flags & NETXEN_NIC_MSI_ENABLED) | |
570 | pci_disable_msi(adapter->pdev); | |
571 | } | |
572 | ||
573 | static void | |
574 | netxen_cleanup_pci_map(struct netxen_adapter *adapter) | |
575 | { | |
576 | if (adapter->ahw.db_base != NULL) | |
577 | iounmap(adapter->ahw.db_base); | |
578 | if (adapter->ahw.pci_base0 != NULL) | |
579 | iounmap(adapter->ahw.pci_base0); | |
580 | if (adapter->ahw.pci_base1 != NULL) | |
581 | iounmap(adapter->ahw.pci_base1); | |
582 | if (adapter->ahw.pci_base2 != NULL) | |
583 | iounmap(adapter->ahw.pci_base2); | |
584 | } | |
585 | ||
586 | static int | |
587 | netxen_setup_pci_map(struct netxen_adapter *adapter) | |
588 | { | |
589 | void __iomem *mem_ptr0 = NULL; | |
590 | void __iomem *mem_ptr1 = NULL; | |
591 | void __iomem *mem_ptr2 = NULL; | |
592 | void __iomem *db_ptr = NULL; | |
593 | ||
97daee83 DP |
594 | unsigned long mem_base, mem_len, db_base, db_len = 0, pci_len0 = 0; |
595 | ||
596 | struct pci_dev *pdev = adapter->pdev; | |
597 | int pci_func = adapter->ahw.pci_func; | |
598 | ||
599 | int err = 0; | |
600 | ||
601 | /* | |
602 | * Set the CRB window to invalid. If any register in window 0 is | |
603 | * accessed it should set the window to 0 and then reset it to 1. | |
604 | */ | |
605 | adapter->curr_window = 255; | |
606 | adapter->ahw.qdr_sn_window = -1; | |
607 | adapter->ahw.ddr_mn_window = -1; | |
608 | ||
609 | /* remap phys address */ | |
610 | mem_base = pci_resource_start(pdev, 0); /* 0 is for BAR 0 */ | |
611 | mem_len = pci_resource_len(pdev, 0); | |
612 | pci_len0 = 0; | |
613 | ||
614 | adapter->hw_write_wx = netxen_nic_hw_write_wx_128M; | |
615 | adapter->hw_read_wx = netxen_nic_hw_read_wx_128M; | |
616 | adapter->pci_read_immediate = netxen_nic_pci_read_immediate_128M; | |
617 | adapter->pci_write_immediate = netxen_nic_pci_write_immediate_128M; | |
97daee83 DP |
618 | adapter->pci_set_window = netxen_nic_pci_set_window_128M; |
619 | adapter->pci_mem_read = netxen_nic_pci_mem_read_128M; | |
620 | adapter->pci_mem_write = netxen_nic_pci_mem_write_128M; | |
621 | ||
622 | /* 128 Meg of memory */ | |
623 | if (mem_len == NETXEN_PCI_128MB_SIZE) { | |
624 | mem_ptr0 = ioremap(mem_base, FIRST_PAGE_GROUP_SIZE); | |
625 | mem_ptr1 = ioremap(mem_base + SECOND_PAGE_GROUP_START, | |
626 | SECOND_PAGE_GROUP_SIZE); | |
627 | mem_ptr2 = ioremap(mem_base + THIRD_PAGE_GROUP_START, | |
628 | THIRD_PAGE_GROUP_SIZE); | |
97daee83 DP |
629 | } else if (mem_len == NETXEN_PCI_32MB_SIZE) { |
630 | mem_ptr1 = ioremap(mem_base, SECOND_PAGE_GROUP_SIZE); | |
631 | mem_ptr2 = ioremap(mem_base + THIRD_PAGE_GROUP_START - | |
632 | SECOND_PAGE_GROUP_START, THIRD_PAGE_GROUP_SIZE); | |
97daee83 DP |
633 | } else if (mem_len == NETXEN_PCI_2MB_SIZE) { |
634 | adapter->hw_write_wx = netxen_nic_hw_write_wx_2M; | |
635 | adapter->hw_read_wx = netxen_nic_hw_read_wx_2M; | |
636 | adapter->pci_read_immediate = netxen_nic_pci_read_immediate_2M; | |
637 | adapter->pci_write_immediate = | |
638 | netxen_nic_pci_write_immediate_2M; | |
97daee83 DP |
639 | adapter->pci_set_window = netxen_nic_pci_set_window_2M; |
640 | adapter->pci_mem_read = netxen_nic_pci_mem_read_2M; | |
641 | adapter->pci_mem_write = netxen_nic_pci_mem_write_2M; | |
642 | ||
643 | mem_ptr0 = pci_ioremap_bar(pdev, 0); | |
644 | if (mem_ptr0 == NULL) { | |
645 | dev_err(&pdev->dev, "failed to map PCI bar 0\n"); | |
646 | return -EIO; | |
647 | } | |
648 | pci_len0 = mem_len; | |
97daee83 DP |
649 | |
650 | adapter->ahw.ddr_mn_window = 0; | |
651 | adapter->ahw.qdr_sn_window = 0; | |
652 | ||
653 | adapter->ahw.mn_win_crb = 0x100000 + PCIX_MN_WINDOW + | |
654 | (pci_func * 0x20); | |
655 | adapter->ahw.ms_win_crb = 0x100000 + PCIX_SN_WINDOW; | |
656 | if (pci_func < 4) | |
657 | adapter->ahw.ms_win_crb += (pci_func * 0x20); | |
658 | else | |
659 | adapter->ahw.ms_win_crb += | |
660 | 0xA0 + ((pci_func - 4) * 0x10); | |
661 | } else { | |
662 | return -EIO; | |
663 | } | |
664 | ||
665 | dev_info(&pdev->dev, "%dMB memory map\n", (int)(mem_len>>20)); | |
666 | ||
667 | adapter->ahw.pci_base0 = mem_ptr0; | |
668 | adapter->ahw.pci_len0 = pci_len0; | |
97daee83 DP |
669 | adapter->ahw.pci_base1 = mem_ptr1; |
670 | adapter->ahw.pci_base2 = mem_ptr2; | |
671 | ||
672 | if (NX_IS_REVISION_P3(adapter->ahw.revision_id)) | |
673 | goto skip_doorbell; | |
674 | ||
675 | db_base = pci_resource_start(pdev, 4); /* doorbell is on bar 4 */ | |
676 | db_len = pci_resource_len(pdev, 4); | |
677 | ||
678 | if (db_len == 0) { | |
679 | printk(KERN_ERR "%s: doorbell is disabled\n", | |
680 | netxen_nic_driver_name); | |
681 | err = -EIO; | |
682 | goto err_out; | |
683 | } | |
684 | ||
685 | db_ptr = ioremap(db_base, NETXEN_DB_MAPSIZE_BYTES); | |
686 | if (!db_ptr) { | |
687 | printk(KERN_ERR "%s: Failed to allocate doorbell map.", | |
688 | netxen_nic_driver_name); | |
689 | err = -EIO; | |
690 | goto err_out; | |
691 | } | |
692 | ||
693 | skip_doorbell: | |
694 | adapter->ahw.db_base = db_ptr; | |
695 | adapter->ahw.db_len = db_len; | |
696 | return 0; | |
697 | ||
698 | err_out: | |
699 | netxen_cleanup_pci_map(adapter); | |
700 | return err; | |
701 | } | |
702 | ||
ba599d4f | 703 | static int |
f7185c71 | 704 | netxen_start_firmware(struct netxen_adapter *adapter, int request_fw) |
ba599d4f DP |
705 | { |
706 | int val, err, first_boot; | |
707 | struct pci_dev *pdev = adapter->pdev; | |
708 | ||
0b72e659 | 709 | int first_driver = 0; |
f7185c71 DP |
710 | |
711 | if (NX_IS_REVISION_P2(adapter->ahw.revision_id)) | |
712 | first_driver = (adapter->portnum == 0); | |
713 | else | |
714 | first_driver = (adapter->ahw.pci_func == 0); | |
0b72e659 DP |
715 | |
716 | if (!first_driver) | |
96f2ebd2 | 717 | goto wait_init; |
0b72e659 | 718 | |
f98a9f69 | 719 | first_boot = NXRD32(adapter, NETXEN_CAM_RAM(0x1fc)); |
ba599d4f DP |
720 | |
721 | err = netxen_check_hw_init(adapter, first_boot); | |
722 | if (err) { | |
723 | dev_err(&pdev->dev, "error in init HW init sequence\n"); | |
724 | return err; | |
725 | } | |
726 | ||
f7185c71 DP |
727 | if (request_fw) |
728 | netxen_request_firmware(adapter); | |
729 | ||
67c38fc6 DP |
730 | err = netxen_need_fw_reset(adapter); |
731 | if (err <= 0) | |
732 | return err; | |
733 | ||
ba599d4f | 734 | if (first_boot != 0x55555555) { |
f98a9f69 | 735 | NXWR32(adapter, CRB_CMDPEG_STATE, 0); |
ba599d4f DP |
736 | netxen_pinit_from_rom(adapter, 0); |
737 | msleep(1); | |
738 | } | |
567c6c4e | 739 | |
f98a9f69 | 740 | NXWR32(adapter, CRB_DMA_SHIFT, 0x55555555); |
567c6c4e DP |
741 | if (NX_IS_REVISION_P3(adapter->ahw.revision_id)) |
742 | netxen_set_port_mode(adapter); | |
743 | ||
ba599d4f DP |
744 | netxen_load_firmware(adapter); |
745 | ||
746 | if (NX_IS_REVISION_P2(adapter->ahw.revision_id)) { | |
747 | ||
748 | /* Initialize multicast addr pool owners */ | |
749 | val = 0x7654; | |
1e2d0059 | 750 | if (adapter->ahw.port_type == NETXEN_NIC_XGBE) |
ba599d4f | 751 | val |= 0x0f000000; |
f98a9f69 | 752 | NXWR32(adapter, NETXEN_MAC_ADDR_CNTL_REG, val); |
ba599d4f DP |
753 | |
754 | } | |
755 | ||
83ac51fa | 756 | err = netxen_init_dummy_dma(adapter); |
ba599d4f DP |
757 | if (err) |
758 | return err; | |
759 | ||
760 | /* | |
761 | * Tell the hardware our version number. | |
762 | */ | |
763 | val = (_NETXEN_NIC_LINUX_MAJOR << 16) | |
764 | | ((_NETXEN_NIC_LINUX_MINOR << 8)) | |
765 | | (_NETXEN_NIC_LINUX_SUBVERSION); | |
f98a9f69 | 766 | NXWR32(adapter, CRB_DRIVER_VERSION, val); |
ba599d4f | 767 | |
96f2ebd2 | 768 | wait_init: |
ba599d4f DP |
769 | /* Handshake with the card before we register the devices. */ |
770 | err = netxen_phantom_init(adapter, NETXEN_NIC_PEG_TUNE); | |
771 | if (err) { | |
83ac51fa | 772 | netxen_free_dummy_dma(adapter); |
ba599d4f DP |
773 | return err; |
774 | } | |
775 | ||
68b3cae0 DP |
776 | nx_update_dma_mask(adapter); |
777 | ||
778 | netxen_nic_get_firmware_info(adapter); | |
779 | ||
ba599d4f DP |
780 | return 0; |
781 | } | |
782 | ||
9f5bc7f1 DP |
783 | static int |
784 | netxen_nic_request_irq(struct netxen_adapter *adapter) | |
785 | { | |
786 | irq_handler_t handler; | |
d8b100c5 DP |
787 | struct nx_host_sds_ring *sds_ring; |
788 | int err, ring; | |
789 | ||
9f5bc7f1 DP |
790 | unsigned long flags = IRQF_SAMPLE_RANDOM; |
791 | struct net_device *netdev = adapter->netdev; | |
d8b100c5 | 792 | struct netxen_recv_context *recv_ctx = &adapter->recv_ctx; |
9f5bc7f1 | 793 | |
9f5bc7f1 DP |
794 | if (adapter->flags & NETXEN_NIC_MSIX_ENABLED) |
795 | handler = netxen_msix_intr; | |
796 | else if (adapter->flags & NETXEN_NIC_MSI_ENABLED) | |
797 | handler = netxen_msi_intr; | |
798 | else { | |
799 | flags |= IRQF_SHARED; | |
800 | handler = netxen_intr; | |
801 | } | |
802 | adapter->irq = netdev->irq; | |
803 | ||
d8b100c5 DP |
804 | for (ring = 0; ring < adapter->max_sds_rings; ring++) { |
805 | sds_ring = &recv_ctx->sds_rings[ring]; | |
be339aee | 806 | sprintf(sds_ring->name, "%s[%d]", netdev->name, ring); |
d8b100c5 DP |
807 | err = request_irq(sds_ring->irq, handler, |
808 | flags, sds_ring->name, sds_ring); | |
809 | if (err) | |
810 | return err; | |
811 | } | |
812 | ||
813 | return 0; | |
814 | } | |
815 | ||
816 | static void | |
817 | netxen_nic_free_irq(struct netxen_adapter *adapter) | |
818 | { | |
819 | int ring; | |
820 | struct nx_host_sds_ring *sds_ring; | |
821 | ||
822 | struct netxen_recv_context *recv_ctx = &adapter->recv_ctx; | |
823 | ||
824 | for (ring = 0; ring < adapter->max_sds_rings; ring++) { | |
825 | sds_ring = &recv_ctx->sds_rings[ring]; | |
826 | free_irq(sds_ring->irq, sds_ring); | |
827 | } | |
9f5bc7f1 DP |
828 | } |
829 | ||
ca2ef330 DP |
830 | static void |
831 | netxen_nic_init_coalesce_defaults(struct netxen_adapter *adapter) | |
832 | { | |
833 | adapter->coal.flags = NETXEN_NIC_INTR_DEFAULT; | |
834 | adapter->coal.normal.data.rx_time_us = | |
835 | NETXEN_DEFAULT_INTR_COALESCE_RX_TIME_US; | |
836 | adapter->coal.normal.data.rx_packets = | |
837 | NETXEN_DEFAULT_INTR_COALESCE_RX_PACKETS; | |
838 | adapter->coal.normal.data.tx_time_us = | |
839 | NETXEN_DEFAULT_INTR_COALESCE_TX_TIME_US; | |
840 | adapter->coal.normal.data.tx_packets = | |
841 | NETXEN_DEFAULT_INTR_COALESCE_TX_PACKETS; | |
842 | } | |
843 | ||
9f5bc7f1 DP |
844 | static int |
845 | netxen_nic_up(struct netxen_adapter *adapter, struct net_device *netdev) | |
846 | { | |
847 | int err; | |
848 | ||
849 | err = adapter->init_port(adapter, adapter->physical_port); | |
850 | if (err) { | |
851 | printk(KERN_ERR "%s: Failed to initialize port %d\n", | |
852 | netxen_nic_driver_name, adapter->portnum); | |
853 | return err; | |
854 | } | |
3d0a3cc9 DP |
855 | if (NX_IS_REVISION_P2(adapter->ahw.revision_id)) |
856 | adapter->macaddr_set(adapter, netdev->dev_addr); | |
9f5bc7f1 | 857 | |
3d0a3cc9 DP |
858 | adapter->set_multi(netdev); |
859 | adapter->set_mtu(adapter, netdev->mtu); | |
9f5bc7f1 DP |
860 | |
861 | adapter->ahw.linkup = 0; | |
9f5bc7f1 | 862 | |
d8b100c5 DP |
863 | if (adapter->max_sds_rings > 1) |
864 | netxen_config_rss(adapter, 1); | |
9f5bc7f1 | 865 | |
ca2ef330 DP |
866 | if (NX_IS_REVISION_P3(adapter->ahw.revision_id)) |
867 | netxen_config_intr_coalesce(adapter); | |
868 | ||
b2af9cb0 DP |
869 | netxen_napi_enable(adapter); |
870 | ||
5103c9f7 | 871 | if (adapter->capabilities & NX_FW_CAPABILITY_LINK_NOTIFICATION) |
3bf26ce3 | 872 | netxen_linkevent_request(adapter, 1); |
3d0a3cc9 DP |
873 | else |
874 | netxen_nic_set_link_parameters(adapter); | |
875 | ||
876 | mod_timer(&adapter->watchdog_timer, jiffies); | |
3bf26ce3 | 877 | |
9f5bc7f1 DP |
878 | return 0; |
879 | } | |
880 | ||
881 | static void | |
882 | netxen_nic_down(struct netxen_adapter *adapter, struct net_device *netdev) | |
883 | { | |
b2af9cb0 | 884 | spin_lock(&adapter->tx_clean_lock); |
9f5bc7f1 | 885 | netif_carrier_off(netdev); |
b2af9cb0 | 886 | netif_tx_disable(netdev); |
9f5bc7f1 DP |
887 | |
888 | if (adapter->stop_port) | |
889 | adapter->stop_port(adapter); | |
890 | ||
5cf4d323 DP |
891 | if (NX_IS_REVISION_P3(adapter->ahw.revision_id)) |
892 | netxen_p3_free_mac_list(adapter); | |
893 | ||
be339aee DP |
894 | netxen_napi_disable(adapter); |
895 | ||
9f5bc7f1 | 896 | netxen_release_tx_buffers(adapter); |
b2af9cb0 | 897 | spin_unlock(&adapter->tx_clean_lock); |
9f5bc7f1 | 898 | |
9f5bc7f1 | 899 | del_timer_sync(&adapter->watchdog_timer); |
b2af9cb0 | 900 | FLUSH_SCHEDULED_WORK(); |
9f5bc7f1 DP |
901 | } |
902 | ||
903 | ||
904 | static int | |
905 | netxen_nic_attach(struct netxen_adapter *adapter) | |
906 | { | |
907 | struct net_device *netdev = adapter->netdev; | |
908 | struct pci_dev *pdev = adapter->pdev; | |
becf46a0 | 909 | int err, ring; |
d8b100c5 | 910 | struct nx_host_rds_ring *rds_ring; |
d877f1e3 | 911 | struct nx_host_tx_ring *tx_ring; |
9f5bc7f1 DP |
912 | |
913 | err = netxen_init_firmware(adapter); | |
914 | if (err != 0) { | |
915 | printk(KERN_ERR "Failed to init firmware\n"); | |
916 | return -EIO; | |
917 | } | |
918 | ||
9f5bc7f1 DP |
919 | err = netxen_alloc_sw_resources(adapter); |
920 | if (err) { | |
921 | printk(KERN_ERR "%s: Error in setting sw resources\n", | |
922 | netdev->name); | |
923 | return err; | |
924 | } | |
925 | ||
926 | netxen_nic_clear_stats(adapter); | |
927 | ||
928 | err = netxen_alloc_hw_resources(adapter); | |
929 | if (err) { | |
930 | printk(KERN_ERR "%s: Error in setting hw resources\n", | |
931 | netdev->name); | |
932 | goto err_out_free_sw; | |
933 | } | |
934 | ||
4f96b988 | 935 | if (NX_IS_REVISION_P2(adapter->ahw.revision_id)) { |
4ea528a1 | 936 | tx_ring = adapter->tx_ring; |
d877f1e3 DP |
937 | tx_ring->crb_cmd_producer = crb_cmd_producer[adapter->portnum]; |
938 | tx_ring->crb_cmd_consumer = crb_cmd_consumer[adapter->portnum]; | |
9f5bc7f1 | 939 | |
cb2107be DP |
940 | tx_ring->producer = 0; |
941 | tx_ring->sw_consumer = 0; | |
942 | ||
943 | netxen_nic_update_cmd_producer(adapter, tx_ring); | |
944 | netxen_nic_update_cmd_consumer(adapter, tx_ring); | |
9f5bc7f1 DP |
945 | } |
946 | ||
d8b100c5 DP |
947 | for (ring = 0; ring < adapter->max_rds_rings; ring++) { |
948 | rds_ring = &adapter->recv_ctx.rds_rings[ring]; | |
949 | netxen_post_rx_buffers(adapter, ring, rds_ring); | |
950 | } | |
9f5bc7f1 DP |
951 | |
952 | err = netxen_nic_request_irq(adapter); | |
953 | if (err) { | |
954 | dev_err(&pdev->dev, "%s: failed to setup interrupt\n", | |
955 | netdev->name); | |
956 | goto err_out_free_rxbuf; | |
957 | } | |
958 | ||
ca2ef330 DP |
959 | if (NX_IS_REVISION_P3(adapter->ahw.revision_id)) |
960 | netxen_nic_init_coalesce_defaults(adapter); | |
961 | ||
9f5bc7f1 DP |
962 | adapter->is_up = NETXEN_ADAPTER_UP_MAGIC; |
963 | return 0; | |
964 | ||
965 | err_out_free_rxbuf: | |
966 | netxen_release_rx_buffers(adapter); | |
967 | netxen_free_hw_resources(adapter); | |
968 | err_out_free_sw: | |
969 | netxen_free_sw_resources(adapter); | |
970 | return err; | |
971 | } | |
972 | ||
973 | static void | |
974 | netxen_nic_detach(struct netxen_adapter *adapter) | |
975 | { | |
9f5bc7f1 | 976 | netxen_free_hw_resources(adapter); |
cf981ffb | 977 | netxen_release_rx_buffers(adapter); |
be339aee | 978 | netxen_nic_free_irq(adapter); |
9f5bc7f1 DP |
979 | netxen_free_sw_resources(adapter); |
980 | ||
981 | adapter->is_up = 0; | |
982 | } | |
983 | ||
f17443f4 DP |
984 | static int |
985 | netxen_setup_netdev(struct netxen_adapter *adapter, | |
986 | struct net_device *netdev) | |
987 | { | |
988 | int err = 0; | |
989 | struct pci_dev *pdev = adapter->pdev; | |
990 | ||
991 | adapter->rx_csum = 1; | |
992 | adapter->mc_enabled = 0; | |
993 | if (NX_IS_REVISION_P3(adapter->ahw.revision_id)) | |
994 | adapter->max_mc_count = 38; | |
995 | else | |
996 | adapter->max_mc_count = 16; | |
997 | ||
998 | netdev->netdev_ops = &netxen_netdev_ops; | |
999 | netdev->watchdog_timeo = 2*HZ; | |
1000 | ||
1001 | netxen_nic_change_mtu(netdev, netdev->mtu); | |
1002 | ||
1003 | SET_ETHTOOL_OPS(netdev, &netxen_nic_ethtool_ops); | |
1004 | ||
1005 | netdev->features |= (NETIF_F_SG | NETIF_F_IP_CSUM | NETIF_F_TSO); | |
1006 | netdev->features |= (NETIF_F_GRO); | |
1007 | netdev->vlan_features |= (NETIF_F_SG | NETIF_F_IP_CSUM | NETIF_F_TSO); | |
1008 | ||
1009 | if (NX_IS_REVISION_P3(adapter->ahw.revision_id)) { | |
1010 | netdev->features |= (NETIF_F_IPV6_CSUM | NETIF_F_TSO6); | |
1011 | netdev->vlan_features |= (NETIF_F_IPV6_CSUM | NETIF_F_TSO6); | |
1012 | } | |
1013 | ||
1014 | if (adapter->pci_using_dac) { | |
1015 | netdev->features |= NETIF_F_HIGHDMA; | |
1016 | netdev->vlan_features |= NETIF_F_HIGHDMA; | |
1017 | } | |
1018 | ||
028afe71 DP |
1019 | if (adapter->capabilities & NX_FW_CAPABILITY_FVLANTX) |
1020 | netdev->features |= (NETIF_F_HW_VLAN_TX); | |
1021 | ||
f17443f4 DP |
1022 | netdev->irq = adapter->msix_entries[0].vector; |
1023 | ||
1024 | err = netxen_napi_add(adapter, netdev); | |
1025 | if (err) | |
1026 | return err; | |
1027 | ||
1028 | init_timer(&adapter->watchdog_timer); | |
1029 | adapter->watchdog_timer.function = &netxen_watchdog; | |
1030 | adapter->watchdog_timer.data = (unsigned long)adapter; | |
1031 | INIT_WORK(&adapter->watchdog_task, netxen_watchdog_task); | |
1032 | INIT_WORK(&adapter->tx_timeout_task, netxen_reset_task); | |
1033 | ||
1034 | if (netxen_read_mac_addr(adapter)) | |
1035 | dev_warn(&pdev->dev, "failed to read mac addr\n"); | |
1036 | ||
1037 | netif_carrier_off(netdev); | |
1038 | netif_stop_queue(netdev); | |
1039 | ||
1040 | err = register_netdev(netdev); | |
1041 | if (err) { | |
1042 | dev_err(&pdev->dev, "failed to register net device\n"); | |
1043 | return err; | |
1044 | } | |
1045 | ||
1046 | return 0; | |
1047 | } | |
1048 | ||
3d396eb1 AK |
1049 | static int __devinit |
1050 | netxen_nic_probe(struct pci_dev *pdev, const struct pci_device_id *ent) | |
1051 | { | |
1052 | struct net_device *netdev = NULL; | |
1053 | struct netxen_adapter *adapter = NULL; | |
2956640d | 1054 | int i = 0, err; |
3176ff3e | 1055 | int pci_func_id = PCI_FUNC(pdev->devfn); |
2956640d | 1056 | uint8_t revision_id; |
3d396eb1 | 1057 | |
3176ff3e | 1058 | if (pdev->class != 0x020000) { |
dcd56fdb | 1059 | printk(KERN_DEBUG "NetXen function %d, class %x will not " |
3176ff3e | 1060 | "be enabled.\n",pci_func_id, pdev->class); |
ed25ffa1 AK |
1061 | return -ENODEV; |
1062 | } | |
2956640d | 1063 | |
11d89d63 DP |
1064 | if (pdev->revision >= NX_P3_A0 && pdev->revision < NX_P3_B1) { |
1065 | printk(KERN_WARNING "NetXen chip revisions between 0x%x-0x%x" | |
1066 | "will not be enabled.\n", | |
1067 | NX_P3_A0, NX_P3_B1); | |
1068 | return -ENODEV; | |
1069 | } | |
1070 | ||
3d396eb1 AK |
1071 | if ((err = pci_enable_device(pdev))) |
1072 | return err; | |
2956640d | 1073 | |
3d396eb1 AK |
1074 | if (!(pci_resource_flags(pdev, 0) & IORESOURCE_MEM)) { |
1075 | err = -ENODEV; | |
1076 | goto err_out_disable_pdev; | |
1077 | } | |
1078 | ||
1079 | if ((err = pci_request_regions(pdev, netxen_nic_driver_name))) | |
1080 | goto err_out_disable_pdev; | |
1081 | ||
1082 | pci_set_master(pdev); | |
3176ff3e MT |
1083 | |
1084 | netdev = alloc_etherdev(sizeof(struct netxen_adapter)); | |
1085 | if(!netdev) { | |
f17443f4 DP |
1086 | dev_err(&pdev->dev, "failed to allocate net_device\n"); |
1087 | err = -ENOMEM; | |
3176ff3e MT |
1088 | goto err_out_free_res; |
1089 | } | |
1090 | ||
3176ff3e MT |
1091 | SET_NETDEV_DEV(netdev, &pdev->dev); |
1092 | ||
4cf1653a | 1093 | adapter = netdev_priv(netdev); |
2956640d DP |
1094 | adapter->netdev = netdev; |
1095 | adapter->pdev = pdev; | |
13ba9c77 | 1096 | adapter->ahw.pci_func = pci_func_id; |
2956640d DP |
1097 | |
1098 | revision_id = pdev->revision; | |
1099 | adapter->ahw.revision_id = revision_id; | |
1100 | ||
1101 | err = nx_set_dma_mask(adapter, revision_id); | |
1102 | if (err) | |
1103 | goto err_out_free_netdev; | |
1104 | ||
3ce06a32 | 1105 | rwlock_init(&adapter->adapter_lock); |
d8b100c5 | 1106 | spin_lock_init(&adapter->tx_clean_lock); |
5cf4d323 | 1107 | INIT_LIST_HEAD(&adapter->mac_list); |
3ce06a32 | 1108 | |
97daee83 DP |
1109 | err = netxen_setup_pci_map(adapter); |
1110 | if (err) | |
6c80b18d | 1111 | goto err_out_free_netdev; |
3d396eb1 | 1112 | |
2d1a3bbd | 1113 | /* This will be reset for mezz cards */ |
3176ff3e | 1114 | adapter->portnum = pci_func_id; |
3176ff3e | 1115 | |
f17443f4 DP |
1116 | err = netxen_nic_get_board_info(adapter); |
1117 | if (err) { | |
1118 | dev_err(&pdev->dev, "Error getting board config info.\n"); | |
dcd56fdb DP |
1119 | goto err_out_iounmap; |
1120 | } | |
6c80b18d | 1121 | |
6c80b18d MT |
1122 | netxen_initialize_adapter_ops(adapter); |
1123 | ||
13ba9c77 | 1124 | /* Mezz cards have PCI function 0,2,3 enabled */ |
1e2d0059 | 1125 | switch (adapter->ahw.board_type) { |
dc515f2e DP |
1126 | case NETXEN_BRDTYPE_P2_SB31_10G_IMEZ: |
1127 | case NETXEN_BRDTYPE_P2_SB31_10G_HMEZ: | |
1128 | if (pci_func_id >= 2) | |
13ba9c77 | 1129 | adapter->portnum = pci_func_id - 2; |
dc515f2e DP |
1130 | break; |
1131 | default: | |
1132 | break; | |
1133 | } | |
13ba9c77 | 1134 | |
f7185c71 | 1135 | err = netxen_start_firmware(adapter, 1); |
0b72e659 DP |
1136 | if (err) |
1137 | goto err_out_iounmap; | |
f17443f4 | 1138 | |
3d396eb1 | 1139 | /* |
6c80b18d | 1140 | * See if the firmware gave us a virtual-physical port mapping. |
3d396eb1 | 1141 | */ |
dcd56fdb | 1142 | adapter->physical_port = adapter->portnum; |
4f96b988 | 1143 | if (NX_IS_REVISION_P2(adapter->ahw.revision_id)) { |
f98a9f69 | 1144 | i = NXRD32(adapter, CRB_V2P(adapter->portnum)); |
044fad0d DP |
1145 | if (i != 0x55555555) |
1146 | adapter->physical_port = i; | |
1147 | } | |
6c80b18d | 1148 | |
438627c7 | 1149 | netxen_check_options(adapter); |
2956640d | 1150 | |
97daee83 | 1151 | netxen_setup_intr(adapter); |
2956640d | 1152 | |
f17443f4 | 1153 | err = netxen_setup_netdev(adapter, netdev); |
9dc28efe | 1154 | if (err) |
2956640d | 1155 | goto err_out_disable_msi; |
6c80b18d MT |
1156 | |
1157 | pci_set_drvdata(pdev, adapter); | |
3d396eb1 | 1158 | |
1e2d0059 | 1159 | switch (adapter->ahw.port_type) { |
2956640d DP |
1160 | case NETXEN_NIC_GBE: |
1161 | dev_info(&adapter->pdev->dev, "%s: GbE port initialized\n", | |
1162 | adapter->netdev->name); | |
1163 | break; | |
1164 | case NETXEN_NIC_XGBE: | |
1165 | dev_info(&adapter->pdev->dev, "%s: XGbE port initialized\n", | |
1166 | adapter->netdev->name); | |
1167 | break; | |
3d396eb1 | 1168 | } |
3d396eb1 | 1169 | |
2956640d DP |
1170 | return 0; |
1171 | ||
1172 | err_out_disable_msi: | |
97daee83 | 1173 | netxen_teardown_intr(adapter); |
6c80b18d | 1174 | |
83ac51fa | 1175 | netxen_free_dummy_dma(adapter); |
3d396eb1 | 1176 | |
2956640d | 1177 | err_out_iounmap: |
97daee83 | 1178 | netxen_cleanup_pci_map(adapter); |
cb8011ad | 1179 | |
6c80b18d MT |
1180 | err_out_free_netdev: |
1181 | free_netdev(netdev); | |
1182 | ||
1183 | err_out_free_res: | |
3d396eb1 | 1184 | pci_release_regions(pdev); |
6c80b18d MT |
1185 | |
1186 | err_out_disable_pdev: | |
2956640d | 1187 | pci_set_drvdata(pdev, NULL); |
3d396eb1 AK |
1188 | pci_disable_device(pdev); |
1189 | return err; | |
1190 | } | |
1191 | ||
1192 | static void __devexit netxen_nic_remove(struct pci_dev *pdev) | |
1193 | { | |
1194 | struct netxen_adapter *adapter; | |
3176ff3e | 1195 | struct net_device *netdev; |
3d396eb1 | 1196 | |
6c80b18d | 1197 | adapter = pci_get_drvdata(pdev); |
3d396eb1 AK |
1198 | if (adapter == NULL) |
1199 | return; | |
1200 | ||
6c80b18d MT |
1201 | netdev = adapter->netdev; |
1202 | ||
96acb6eb DP |
1203 | unregister_netdev(netdev); |
1204 | ||
96acb6eb | 1205 | if (adapter->is_up == NETXEN_ADAPTER_UP_MAGIC) { |
9f5bc7f1 | 1206 | netxen_nic_detach(adapter); |
96acb6eb | 1207 | } |
3d396eb1 | 1208 | |
439b454e | 1209 | if (adapter->portnum == 0) |
83ac51fa | 1210 | netxen_free_dummy_dma(adapter); |
96acb6eb | 1211 | |
97daee83 | 1212 | netxen_teardown_intr(adapter); |
71dcddbd | 1213 | netxen_free_sds_rings(&adapter->recv_ctx); |
3052246c | 1214 | |
97daee83 | 1215 | netxen_cleanup_pci_map(adapter); |
595e3fb8 | 1216 | |
f7185c71 DP |
1217 | netxen_release_firmware(adapter); |
1218 | ||
595e3fb8 | 1219 | pci_release_regions(pdev); |
3052246c | 1220 | pci_disable_device(pdev); |
595e3fb8 MT |
1221 | pci_set_drvdata(pdev, NULL); |
1222 | ||
6c80b18d | 1223 | free_netdev(netdev); |
3d396eb1 AK |
1224 | } |
1225 | ||
01542cd1 | 1226 | #ifdef CONFIG_PM |
0b72e659 DP |
1227 | static int |
1228 | netxen_nic_suspend(struct pci_dev *pdev, pm_message_t state) | |
1229 | { | |
1230 | ||
1231 | struct netxen_adapter *adapter = pci_get_drvdata(pdev); | |
1232 | struct net_device *netdev = adapter->netdev; | |
1233 | ||
1234 | netif_device_detach(netdev); | |
1235 | ||
1236 | if (netif_running(netdev)) | |
1237 | netxen_nic_down(adapter, netdev); | |
1238 | ||
1239 | if (adapter->is_up == NETXEN_ADAPTER_UP_MAGIC) | |
1240 | netxen_nic_detach(adapter); | |
1241 | ||
1242 | pci_save_state(pdev); | |
1243 | ||
1244 | if (netxen_nic_wol_supported(adapter)) { | |
1245 | pci_enable_wake(pdev, PCI_D3cold, 1); | |
1246 | pci_enable_wake(pdev, PCI_D3hot, 1); | |
1247 | } | |
1248 | ||
1249 | pci_disable_device(pdev); | |
1250 | pci_set_power_state(pdev, pci_choose_state(pdev, state)); | |
1251 | ||
1252 | return 0; | |
1253 | } | |
1254 | ||
1255 | static int | |
1256 | netxen_nic_resume(struct pci_dev *pdev) | |
1257 | { | |
1258 | struct netxen_adapter *adapter = pci_get_drvdata(pdev); | |
1259 | struct net_device *netdev = adapter->netdev; | |
1260 | int err; | |
1261 | ||
1262 | pci_set_power_state(pdev, PCI_D0); | |
1263 | pci_restore_state(pdev); | |
1264 | ||
1265 | err = pci_enable_device(pdev); | |
1266 | if (err) | |
1267 | return err; | |
1268 | ||
1269 | adapter->curr_window = 255; | |
1270 | ||
f7185c71 | 1271 | err = netxen_start_firmware(adapter, 0); |
0b72e659 DP |
1272 | if (err) { |
1273 | dev_err(&pdev->dev, "failed to start firmware\n"); | |
1274 | return err; | |
1275 | } | |
1276 | ||
1277 | if (netif_running(netdev)) { | |
1278 | err = netxen_nic_attach(adapter); | |
1279 | if (err) | |
1280 | return err; | |
1281 | ||
1282 | err = netxen_nic_up(adapter, netdev); | |
1283 | if (err) | |
1284 | return err; | |
1285 | ||
1286 | netif_device_attach(netdev); | |
1287 | } | |
1288 | ||
1289 | return 0; | |
1290 | } | |
01542cd1 | 1291 | #endif |
0b72e659 | 1292 | |
3d396eb1 AK |
1293 | static int netxen_nic_open(struct net_device *netdev) |
1294 | { | |
4cf1653a | 1295 | struct netxen_adapter *adapter = netdev_priv(netdev); |
3d396eb1 | 1296 | int err = 0; |
3d396eb1 | 1297 | |
dcd56fdb DP |
1298 | if (adapter->driver_mismatch) |
1299 | return -EIO; | |
1300 | ||
3d396eb1 | 1301 | if (adapter->is_up != NETXEN_ADAPTER_UP_MAGIC) { |
9f5bc7f1 DP |
1302 | err = netxen_nic_attach(adapter); |
1303 | if (err) | |
3d396eb1 | 1304 | return err; |
ed25ffa1 | 1305 | } |
2956640d | 1306 | |
9f5bc7f1 DP |
1307 | err = netxen_nic_up(adapter, netdev); |
1308 | if (err) | |
1309 | goto err_out; | |
05aaa02d | 1310 | |
dcd56fdb | 1311 | netif_start_queue(netdev); |
3d396eb1 AK |
1312 | |
1313 | return 0; | |
2956640d | 1314 | |
9f5bc7f1 DP |
1315 | err_out: |
1316 | netxen_nic_detach(adapter); | |
2956640d | 1317 | return err; |
3d396eb1 AK |
1318 | } |
1319 | ||
1320 | /* | |
1321 | * netxen_nic_close - Disables a network interface entry point | |
1322 | */ | |
1323 | static int netxen_nic_close(struct net_device *netdev) | |
1324 | { | |
3176ff3e | 1325 | struct netxen_adapter *adapter = netdev_priv(netdev); |
3d396eb1 | 1326 | |
9f5bc7f1 | 1327 | netxen_nic_down(adapter, netdev); |
3d396eb1 AK |
1328 | return 0; |
1329 | } | |
1330 | ||
1bcfd790 DP |
1331 | static void |
1332 | netxen_tso_check(struct net_device *netdev, | |
1333 | struct nx_host_tx_ring *tx_ring, | |
1334 | struct cmd_desc_type0 *first_desc, | |
1335 | struct sk_buff *skb) | |
cd1f8160 | 1336 | { |
391587c3 | 1337 | u8 opcode = TX_ETHER_PKT; |
cdff1036 | 1338 | __be16 protocol = skb->protocol; |
028afe71 | 1339 | u16 flags = 0, vid = 0; |
1bcfd790 | 1340 | u32 producer; |
028afe71 | 1341 | int copied, offset, copy_len, hdr_len = 0, tso = 0, vlan_oob = 0; |
1bcfd790 | 1342 | struct cmd_desc_type0 *hwdesc; |
028afe71 | 1343 | struct vlan_ethhdr *vh; |
cdff1036 | 1344 | |
09640e63 | 1345 | if (protocol == cpu_to_be16(ETH_P_8021Q)) { |
028afe71 DP |
1346 | |
1347 | vh = (struct vlan_ethhdr *)skb->data; | |
cdff1036 DP |
1348 | protocol = vh->h_vlan_encapsulated_proto; |
1349 | flags = FLAGS_VLAN_TAGGED; | |
028afe71 DP |
1350 | |
1351 | } else if (vlan_tx_tag_present(skb)) { | |
1352 | ||
1353 | flags = FLAGS_VLAN_OOB; | |
1354 | vid = vlan_tx_tag_get(skb); | |
1355 | netxen_set_tx_vlan_tci(first_desc, vid); | |
1356 | vlan_oob = 1; | |
cdff1036 | 1357 | } |
cd1f8160 | 1358 | |
391587c3 DP |
1359 | if ((netdev->features & (NETIF_F_TSO | NETIF_F_TSO6)) && |
1360 | skb_shinfo(skb)->gso_size > 0) { | |
1361 | ||
1bcfd790 DP |
1362 | hdr_len = skb_transport_offset(skb) + tcp_hdrlen(skb); |
1363 | ||
1364 | first_desc->mss = cpu_to_le16(skb_shinfo(skb)->gso_size); | |
1365 | first_desc->total_hdr_length = hdr_len; | |
028afe71 DP |
1366 | if (vlan_oob) { |
1367 | first_desc->total_hdr_length += VLAN_HLEN; | |
1368 | first_desc->tcp_hdr_offset = VLAN_HLEN; | |
1369 | first_desc->ip_hdr_offset = VLAN_HLEN; | |
1370 | /* Only in case of TSO on vlan device */ | |
1371 | flags |= FLAGS_VLAN_TAGGED; | |
1372 | } | |
391587c3 | 1373 | |
09640e63 | 1374 | opcode = (protocol == cpu_to_be16(ETH_P_IPV6)) ? |
391587c3 | 1375 | TX_TCP_LSO6 : TX_TCP_LSO; |
1bcfd790 | 1376 | tso = 1; |
cd1f8160 DP |
1377 | |
1378 | } else if (skb->ip_summed == CHECKSUM_PARTIAL) { | |
391587c3 DP |
1379 | u8 l4proto; |
1380 | ||
09640e63 | 1381 | if (protocol == cpu_to_be16(ETH_P_IP)) { |
391587c3 DP |
1382 | l4proto = ip_hdr(skb)->protocol; |
1383 | ||
1384 | if (l4proto == IPPROTO_TCP) | |
1385 | opcode = TX_TCP_PKT; | |
1386 | else if(l4proto == IPPROTO_UDP) | |
1387 | opcode = TX_UDP_PKT; | |
09640e63 | 1388 | } else if (protocol == cpu_to_be16(ETH_P_IPV6)) { |
391587c3 DP |
1389 | l4proto = ipv6_hdr(skb)->nexthdr; |
1390 | ||
1391 | if (l4proto == IPPROTO_TCP) | |
1392 | opcode = TX_TCPV6_PKT; | |
1393 | else if(l4proto == IPPROTO_UDP) | |
1394 | opcode = TX_UDPV6_PKT; | |
1395 | } | |
cd1f8160 | 1396 | } |
028afe71 DP |
1397 | |
1398 | first_desc->tcp_hdr_offset += skb_transport_offset(skb); | |
1399 | first_desc->ip_hdr_offset += skb_network_offset(skb); | |
1bcfd790 DP |
1400 | netxen_set_tx_flags_opcode(first_desc, flags, opcode); |
1401 | ||
1402 | if (!tso) | |
1403 | return; | |
1404 | ||
1405 | /* For LSO, we need to copy the MAC/IP/TCP headers into | |
1406 | * the descriptor ring | |
1407 | */ | |
1408 | producer = tx_ring->producer; | |
1409 | copied = 0; | |
1410 | offset = 2; | |
1411 | ||
028afe71 DP |
1412 | if (vlan_oob) { |
1413 | /* Create a TSO vlan header template for firmware */ | |
1414 | ||
1415 | hwdesc = &tx_ring->desc_head[producer]; | |
1416 | tx_ring->cmd_buf_arr[producer].skb = NULL; | |
1417 | ||
1418 | copy_len = min((int)sizeof(struct cmd_desc_type0) - offset, | |
1419 | hdr_len + VLAN_HLEN); | |
1420 | ||
1421 | vh = (struct vlan_ethhdr *)((char *)hwdesc + 2); | |
1422 | skb_copy_from_linear_data(skb, vh, 12); | |
1423 | vh->h_vlan_proto = htons(ETH_P_8021Q); | |
1424 | vh->h_vlan_TCI = htons(vid); | |
1425 | skb_copy_from_linear_data_offset(skb, 12, | |
1426 | (char *)vh + 16, copy_len - 16); | |
1427 | ||
1428 | copied = copy_len; | |
1429 | offset = 0; | |
1430 | ||
1431 | producer = get_next_index(producer, tx_ring->num_desc); | |
1432 | } | |
1433 | ||
1bcfd790 DP |
1434 | while (copied < hdr_len) { |
1435 | ||
1436 | copy_len = min((int)sizeof(struct cmd_desc_type0) - offset, | |
1437 | (hdr_len - copied)); | |
1438 | ||
1439 | hwdesc = &tx_ring->desc_head[producer]; | |
1440 | tx_ring->cmd_buf_arr[producer].skb = NULL; | |
1441 | ||
1442 | skb_copy_from_linear_data_offset(skb, copied, | |
1443 | (char *)hwdesc + offset, copy_len); | |
1444 | ||
1445 | copied += copy_len; | |
1446 | offset = 0; | |
1447 | ||
1448 | producer = get_next_index(producer, tx_ring->num_desc); | |
1449 | } | |
1450 | ||
1451 | tx_ring->producer = producer; | |
1452 | barrier(); | |
cd1f8160 DP |
1453 | } |
1454 | ||
6f703406 DP |
1455 | static void |
1456 | netxen_clean_tx_dma_mapping(struct pci_dev *pdev, | |
1457 | struct netxen_cmd_buffer *pbuf, int last) | |
1458 | { | |
1459 | int k; | |
1460 | struct netxen_skb_frag *buffrag; | |
1461 | ||
1462 | buffrag = &pbuf->frag_array[0]; | |
1463 | pci_unmap_single(pdev, buffrag->dma, | |
1464 | buffrag->length, PCI_DMA_TODEVICE); | |
1465 | ||
1466 | for (k = 1; k < last; k++) { | |
1467 | buffrag = &pbuf->frag_array[k]; | |
1468 | pci_unmap_page(pdev, buffrag->dma, | |
1469 | buffrag->length, PCI_DMA_TODEVICE); | |
1470 | } | |
1471 | } | |
1472 | ||
d32cc3d2 DP |
1473 | static inline void |
1474 | netxen_clear_cmddesc(u64 *desc) | |
1475 | { | |
1bcfd790 DP |
1476 | desc[0] = 0ULL; |
1477 | desc[2] = 0ULL; | |
d32cc3d2 DP |
1478 | } |
1479 | ||
1480 | static int | |
1481 | netxen_nic_xmit_frame(struct sk_buff *skb, struct net_device *netdev) | |
3d396eb1 | 1482 | { |
3176ff3e | 1483 | struct netxen_adapter *adapter = netdev_priv(netdev); |
4ea528a1 | 1484 | struct nx_host_tx_ring *tx_ring = adapter->tx_ring; |
1bcfd790 | 1485 | struct skb_frag_struct *frag; |
391587c3 | 1486 | struct netxen_cmd_buffer *pbuf; |
3d396eb1 | 1487 | struct netxen_skb_frag *buffrag; |
1bcfd790 DP |
1488 | struct cmd_desc_type0 *hwdesc, *first_desc; |
1489 | struct pci_dev *pdev; | |
6f703406 | 1490 | dma_addr_t temp_dma; |
391587c3 | 1491 | int i, k; |
1bcfd790 | 1492 | unsigned long offset; |
3d396eb1 | 1493 | |
cb2107be | 1494 | u32 producer; |
1bcfd790 | 1495 | int len, frag_count, no_of_desc; |
d877f1e3 | 1496 | u32 num_txd = tx_ring->num_desc; |
3d396eb1 | 1497 | |
3d396eb1 AK |
1498 | frag_count = skb_shinfo(skb)->nr_frags + 1; |
1499 | ||
d877f1e3 | 1500 | /* 4 fragments per cmd des */ |
3d396eb1 | 1501 | no_of_desc = (frag_count + 3) >> 2; |
53a01e00 | 1502 | |
cb2107be | 1503 | if (unlikely(no_of_desc + 2) > netxen_tx_avail(tx_ring)) { |
ba53e6b4 | 1504 | netif_stop_queue(netdev); |
ba53e6b4 | 1505 | return NETDEV_TX_BUSY; |
53a01e00 | 1506 | } |
3d396eb1 | 1507 | |
cb2107be DP |
1508 | producer = tx_ring->producer; |
1509 | ||
1bcfd790 DP |
1510 | pdev = adapter->pdev; |
1511 | len = skb->len - skb->data_len; | |
391587c3 | 1512 | |
1bcfd790 DP |
1513 | temp_dma = pci_map_single(pdev, skb->data, len, PCI_DMA_TODEVICE); |
1514 | if (pci_dma_mapping_error(pdev, temp_dma)) | |
1515 | goto drop_packet; | |
391587c3 | 1516 | |
1bcfd790 | 1517 | pbuf = &tx_ring->cmd_buf_arr[producer]; |
3d396eb1 | 1518 | pbuf->skb = skb; |
3d396eb1 | 1519 | pbuf->frag_count = frag_count; |
6f703406 | 1520 | |
1bcfd790 | 1521 | buffrag = &pbuf->frag_array[0]; |
6f703406 | 1522 | buffrag->dma = temp_dma; |
1bcfd790 DP |
1523 | buffrag->length = len; |
1524 | ||
1525 | first_desc = hwdesc = &tx_ring->desc_head[producer]; | |
1526 | netxen_clear_cmddesc((u64 *)hwdesc); | |
391587c3 DP |
1527 | netxen_set_tx_frags_len(hwdesc, frag_count, skb->len); |
1528 | netxen_set_tx_port(hwdesc, adapter->portnum); | |
3d396eb1 | 1529 | |
1bcfd790 DP |
1530 | hwdesc->buffer_length[0] = cpu_to_le16(len); |
1531 | hwdesc->addr_buffer1 = cpu_to_le64(temp_dma); | |
3d396eb1 AK |
1532 | |
1533 | for (i = 1, k = 1; i < frag_count; i++, k++) { | |
3d396eb1 AK |
1534 | |
1535 | /* move to next desc. if there is a need */ | |
1536 | if ((i & 0x3) == 0) { | |
1537 | k = 0; | |
ba53e6b4 | 1538 | producer = get_next_index(producer, num_txd); |
d877f1e3 | 1539 | hwdesc = &tx_ring->desc_head[producer]; |
d32cc3d2 | 1540 | netxen_clear_cmddesc((u64 *)hwdesc); |
d877f1e3 | 1541 | pbuf = &tx_ring->cmd_buf_arr[producer]; |
53a01e00 | 1542 | pbuf->skb = NULL; |
3d396eb1 | 1543 | } |
1bcfd790 | 1544 | buffrag = &pbuf->frag_array[i]; |
3d396eb1 AK |
1545 | frag = &skb_shinfo(skb)->frags[i - 1]; |
1546 | len = frag->size; | |
1547 | offset = frag->page_offset; | |
1548 | ||
6f703406 | 1549 | temp_dma = pci_map_page(pdev, frag->page, offset, |
3d396eb1 | 1550 | len, PCI_DMA_TODEVICE); |
6f703406 DP |
1551 | if (pci_dma_mapping_error(pdev, temp_dma)) { |
1552 | netxen_clean_tx_dma_mapping(pdev, pbuf, i); | |
1553 | goto drop_packet; | |
1554 | } | |
3d396eb1 | 1555 | |
3d396eb1 | 1556 | buffrag->dma = temp_dma; |
1bcfd790 | 1557 | buffrag->length = len; |
3d396eb1 | 1558 | |
1bcfd790 | 1559 | hwdesc->buffer_length[k] = cpu_to_le16(len); |
3d396eb1 AK |
1560 | switch (k) { |
1561 | case 0: | |
3d396eb1 AK |
1562 | hwdesc->addr_buffer1 = cpu_to_le64(temp_dma); |
1563 | break; | |
1564 | case 1: | |
3d396eb1 AK |
1565 | hwdesc->addr_buffer2 = cpu_to_le64(temp_dma); |
1566 | break; | |
1567 | case 2: | |
3d396eb1 AK |
1568 | hwdesc->addr_buffer3 = cpu_to_le64(temp_dma); |
1569 | break; | |
1570 | case 3: | |
3d396eb1 AK |
1571 | hwdesc->addr_buffer4 = cpu_to_le64(temp_dma); |
1572 | break; | |
1573 | } | |
3d396eb1 | 1574 | } |
1bcfd790 | 1575 | tx_ring->producer = get_next_index(producer, num_txd); |
3d396eb1 | 1576 | |
1bcfd790 | 1577 | netxen_tso_check(netdev, tx_ring, first_desc, skb); |
6c80b18d | 1578 | |
cb2107be | 1579 | netxen_nic_update_cmd_producer(adapter, tx_ring); |
3d396eb1 | 1580 | |
1bcfd790 | 1581 | adapter->stats.txbytes += skb->len; |
ba53e6b4 | 1582 | adapter->stats.xmitcalled++; |
3d396eb1 | 1583 | |
3d396eb1 | 1584 | return NETDEV_TX_OK; |
6f703406 DP |
1585 | |
1586 | drop_packet: | |
1587 | adapter->stats.txdropped++; | |
1588 | dev_kfree_skb_any(skb); | |
1589 | return NETDEV_TX_OK; | |
3d396eb1 AK |
1590 | } |
1591 | ||
a97342f9 DP |
1592 | static int netxen_nic_check_temp(struct netxen_adapter *adapter) |
1593 | { | |
1594 | struct net_device *netdev = adapter->netdev; | |
1595 | uint32_t temp, temp_state, temp_val; | |
1596 | int rv = 0; | |
1597 | ||
f98a9f69 | 1598 | temp = NXRD32(adapter, CRB_TEMP_STATE); |
a97342f9 DP |
1599 | |
1600 | temp_state = nx_get_temp_state(temp); | |
1601 | temp_val = nx_get_temp_val(temp); | |
1602 | ||
1603 | if (temp_state == NX_TEMP_PANIC) { | |
1604 | printk(KERN_ALERT | |
1605 | "%s: Device temperature %d degrees C exceeds" | |
1606 | " maximum allowed. Hardware has been shut down.\n", | |
e4135c2d DP |
1607 | netdev->name, temp_val); |
1608 | ||
1609 | netif_device_detach(netdev); | |
1610 | netxen_nic_down(adapter, netdev); | |
1611 | netxen_nic_detach(adapter); | |
a97342f9 | 1612 | |
a97342f9 DP |
1613 | rv = 1; |
1614 | } else if (temp_state == NX_TEMP_WARN) { | |
1615 | if (adapter->temp == NX_TEMP_NORMAL) { | |
1616 | printk(KERN_ALERT | |
1617 | "%s: Device temperature %d degrees C " | |
1618 | "exceeds operating range." | |
1619 | " Immediate action needed.\n", | |
e4135c2d | 1620 | netdev->name, temp_val); |
a97342f9 DP |
1621 | } |
1622 | } else { | |
1623 | if (adapter->temp == NX_TEMP_WARN) { | |
1624 | printk(KERN_INFO | |
1625 | "%s: Device temperature is now %d degrees C" | |
e4135c2d | 1626 | " in normal range.\n", netdev->name, |
a97342f9 DP |
1627 | temp_val); |
1628 | } | |
1629 | } | |
1630 | adapter->temp = temp_state; | |
1631 | return rv; | |
1632 | } | |
1633 | ||
3bf26ce3 | 1634 | void netxen_advert_link_change(struct netxen_adapter *adapter, int linkup) |
a97342f9 DP |
1635 | { |
1636 | struct net_device *netdev = adapter->netdev; | |
a97342f9 DP |
1637 | |
1638 | if (adapter->ahw.linkup && !linkup) { | |
1639 | printk(KERN_INFO "%s: %s NIC Link is down\n", | |
1640 | netxen_nic_driver_name, netdev->name); | |
1641 | adapter->ahw.linkup = 0; | |
1642 | if (netif_running(netdev)) { | |
1643 | netif_carrier_off(netdev); | |
1644 | netif_stop_queue(netdev); | |
1645 | } | |
c7860a2a | 1646 | |
3bf26ce3 DP |
1647 | if (!adapter->has_link_events) |
1648 | netxen_nic_set_link_parameters(adapter); | |
1649 | ||
a97342f9 DP |
1650 | } else if (!adapter->ahw.linkup && linkup) { |
1651 | printk(KERN_INFO "%s: %s NIC Link is up\n", | |
1652 | netxen_nic_driver_name, netdev->name); | |
1653 | adapter->ahw.linkup = 1; | |
1654 | if (netif_running(netdev)) { | |
1655 | netif_carrier_on(netdev); | |
1656 | netif_wake_queue(netdev); | |
1657 | } | |
c7860a2a | 1658 | |
3bf26ce3 DP |
1659 | if (!adapter->has_link_events) |
1660 | netxen_nic_set_link_parameters(adapter); | |
a97342f9 DP |
1661 | } |
1662 | } | |
1663 | ||
3bf26ce3 DP |
1664 | static void netxen_nic_handle_phy_intr(struct netxen_adapter *adapter) |
1665 | { | |
1666 | u32 val, port, linkup; | |
1667 | ||
1668 | port = adapter->physical_port; | |
1669 | ||
1670 | if (NX_IS_REVISION_P3(adapter->ahw.revision_id)) { | |
f98a9f69 | 1671 | val = NXRD32(adapter, CRB_XG_STATE_P3); |
3bf26ce3 DP |
1672 | val = XG_LINK_STATE_P3(adapter->ahw.pci_func, val); |
1673 | linkup = (val == XG_LINK_UP_P3); | |
1674 | } else { | |
f98a9f69 | 1675 | val = NXRD32(adapter, CRB_XG_STATE); |
3bf26ce3 DP |
1676 | if (adapter->ahw.port_type == NETXEN_NIC_GBE) |
1677 | linkup = (val >> port) & 1; | |
1678 | else { | |
1679 | val = (val >> port*8) & 0xff; | |
1680 | linkup = (val == XG_LINK_UP); | |
1681 | } | |
1682 | } | |
1683 | ||
1684 | netxen_advert_link_change(adapter, linkup); | |
1685 | } | |
1686 | ||
3d396eb1 AK |
1687 | static void netxen_watchdog(unsigned long v) |
1688 | { | |
1689 | struct netxen_adapter *adapter = (struct netxen_adapter *)v; | |
ed25ffa1 AK |
1690 | |
1691 | SCHEDULE_WORK(&adapter->watchdog_task); | |
3d396eb1 AK |
1692 | } |
1693 | ||
a97342f9 DP |
1694 | void netxen_watchdog_task(struct work_struct *work) |
1695 | { | |
1696 | struct netxen_adapter *adapter = | |
1697 | container_of(work, struct netxen_adapter, watchdog_task); | |
1698 | ||
e4135c2d | 1699 | if (netxen_nic_check_temp(adapter)) |
a97342f9 DP |
1700 | return; |
1701 | ||
3bf26ce3 DP |
1702 | if (!adapter->has_link_events) |
1703 | netxen_nic_handle_phy_intr(adapter); | |
a97342f9 | 1704 | |
922c4f2c DP |
1705 | if (netif_running(adapter->netdev)) |
1706 | mod_timer(&adapter->watchdog_timer, jiffies + 2 * HZ); | |
a97342f9 DP |
1707 | } |
1708 | ||
3d396eb1 AK |
1709 | static void netxen_tx_timeout(struct net_device *netdev) |
1710 | { | |
3176ff3e MT |
1711 | struct netxen_adapter *adapter = (struct netxen_adapter *) |
1712 | netdev_priv(netdev); | |
f17443f4 DP |
1713 | |
1714 | dev_err(&netdev->dev, "transmit timeout, resetting.\n"); | |
1715 | ||
3176ff3e | 1716 | SCHEDULE_WORK(&adapter->tx_timeout_task); |
3d396eb1 AK |
1717 | } |
1718 | ||
f17443f4 | 1719 | static void netxen_reset_task(struct work_struct *work) |
3d396eb1 | 1720 | { |
4790654c | 1721 | struct netxen_adapter *adapter = |
3176ff3e | 1722 | container_of(work, struct netxen_adapter, tx_timeout_task); |
3d396eb1 | 1723 | |
b2af9cb0 DP |
1724 | if (!netif_running(adapter->netdev)) |
1725 | return; | |
1726 | ||
d8b100c5 | 1727 | netxen_napi_disable(adapter); |
ba53e6b4 | 1728 | |
6c80b18d | 1729 | adapter->netdev->trans_start = jiffies; |
ba53e6b4 | 1730 | |
d8b100c5 | 1731 | netxen_napi_enable(adapter); |
6c80b18d | 1732 | netif_wake_queue(adapter->netdev); |
3d396eb1 AK |
1733 | } |
1734 | ||
a97342f9 DP |
1735 | struct net_device_stats *netxen_nic_get_stats(struct net_device *netdev) |
1736 | { | |
1737 | struct netxen_adapter *adapter = netdev_priv(netdev); | |
1738 | struct net_device_stats *stats = &adapter->net_stats; | |
1739 | ||
1740 | memset(stats, 0, sizeof(*stats)); | |
1741 | ||
a97342f9 | 1742 | stats->rx_packets = adapter->stats.no_rcv; |
e98e3350 | 1743 | stats->tx_packets = adapter->stats.xmitfinished; |
a97342f9 | 1744 | stats->rx_bytes = adapter->stats.rxbytes; |
a97342f9 | 1745 | stats->tx_bytes = adapter->stats.txbytes; |
a97342f9 | 1746 | stats->rx_dropped = adapter->stats.rxdropped; |
a97342f9 DP |
1747 | stats->tx_dropped = adapter->stats.txdropped; |
1748 | ||
1749 | return stats; | |
1750 | } | |
1751 | ||
e4c93c81 | 1752 | static irqreturn_t netxen_intr(int irq, void *data) |
3d396eb1 | 1753 | { |
d8b100c5 DP |
1754 | struct nx_host_sds_ring *sds_ring = data; |
1755 | struct netxen_adapter *adapter = sds_ring->adapter; | |
d71e1be8 DP |
1756 | u32 status = 0; |
1757 | ||
1758 | status = adapter->pci_read_immediate(adapter, ISR_INT_VECTOR); | |
1759 | ||
1760 | if (!(status & adapter->legacy_intr.int_vec_bit)) | |
05aaa02d | 1761 | return IRQ_NONE; |
e01872af | 1762 | |
d71e1be8 DP |
1763 | if (adapter->ahw.revision_id >= NX_P3_B1) { |
1764 | /* check interrupt state machine, to be sure */ | |
1765 | status = adapter->pci_read_immediate(adapter, | |
1766 | ISR_INT_STATE_REG); | |
1767 | if (!ISR_LEGACY_INT_TRIGGERED(status)) | |
1768 | return IRQ_NONE; | |
1769 | ||
092bc571 DP |
1770 | } else { |
1771 | unsigned long our_int = 0; | |
d71e1be8 | 1772 | |
f98a9f69 | 1773 | our_int = NXRD32(adapter, CRB_INT_VECTOR); |
092bc571 | 1774 | |
d71e1be8 | 1775 | /* not our interrupt */ |
092bc571 | 1776 | if (!test_and_clear_bit((7 + adapter->portnum), &our_int)) |
d71e1be8 DP |
1777 | return IRQ_NONE; |
1778 | ||
092bc571 | 1779 | /* claim interrupt */ |
f98a9f69 | 1780 | NXWR32(adapter, CRB_INT_VECTOR, (our_int & 0xffffffff)); |
e01872af | 1781 | } |
1782 | ||
092bc571 | 1783 | /* clear interrupt */ |
4f96b988 | 1784 | if (NX_IS_REVISION_P2(adapter->ahw.revision_id)) |
d8b100c5 | 1785 | netxen_nic_disable_int(sds_ring); |
092bc571 DP |
1786 | |
1787 | adapter->pci_write_immediate(adapter, | |
1788 | adapter->legacy_intr.tgt_status_reg, | |
1789 | 0xffffffff); | |
1790 | /* read twice to ensure write is flushed */ | |
1791 | adapter->pci_read_immediate(adapter, ISR_INT_VECTOR); | |
1792 | adapter->pci_read_immediate(adapter, ISR_INT_VECTOR); | |
1793 | ||
d8b100c5 | 1794 | napi_schedule(&sds_ring->napi); |
3d396eb1 AK |
1795 | |
1796 | return IRQ_HANDLED; | |
1797 | } | |
1798 | ||
e4c93c81 | 1799 | static irqreturn_t netxen_msi_intr(int irq, void *data) |
05aaa02d | 1800 | { |
d8b100c5 DP |
1801 | struct nx_host_sds_ring *sds_ring = data; |
1802 | struct netxen_adapter *adapter = sds_ring->adapter; | |
05aaa02d | 1803 | |
092bc571 DP |
1804 | /* clear interrupt */ |
1805 | adapter->pci_write_immediate(adapter, | |
7a2469ce | 1806 | adapter->msi_tgt_status, 0xffffffff); |
092bc571 | 1807 | |
d8b100c5 | 1808 | napi_schedule(&sds_ring->napi); |
05aaa02d DP |
1809 | return IRQ_HANDLED; |
1810 | } | |
1811 | ||
b3df68f8 DP |
1812 | static irqreturn_t netxen_msix_intr(int irq, void *data) |
1813 | { | |
d8b100c5 | 1814 | struct nx_host_sds_ring *sds_ring = data; |
b3df68f8 | 1815 | |
d8b100c5 | 1816 | napi_schedule(&sds_ring->napi); |
b3df68f8 DP |
1817 | return IRQ_HANDLED; |
1818 | } | |
1819 | ||
bea3348e | 1820 | static int netxen_nic_poll(struct napi_struct *napi, int budget) |
3d396eb1 | 1821 | { |
d8b100c5 DP |
1822 | struct nx_host_sds_ring *sds_ring = |
1823 | container_of(napi, struct nx_host_sds_ring, napi); | |
1824 | ||
1825 | struct netxen_adapter *adapter = sds_ring->adapter; | |
1826 | ||
05aaa02d | 1827 | int tx_complete; |
bea3348e | 1828 | int work_done; |
3d396eb1 | 1829 | |
05aaa02d | 1830 | tx_complete = netxen_process_cmd_ring(adapter); |
3d396eb1 | 1831 | |
d8b100c5 | 1832 | work_done = netxen_process_rcv_ring(sds_ring, budget); |
3d396eb1 | 1833 | |
05aaa02d | 1834 | if ((work_done < budget) && tx_complete) { |
d8b100c5 | 1835 | napi_complete(&sds_ring->napi); |
b2af9cb0 DP |
1836 | if (netif_running(adapter->netdev)) |
1837 | netxen_nic_enable_int(sds_ring); | |
3d396eb1 AK |
1838 | } |
1839 | ||
bea3348e | 1840 | return work_done; |
3d396eb1 AK |
1841 | } |
1842 | ||
1843 | #ifdef CONFIG_NET_POLL_CONTROLLER | |
1844 | static void netxen_nic_poll_controller(struct net_device *netdev) | |
1845 | { | |
3176ff3e | 1846 | struct netxen_adapter *adapter = netdev_priv(netdev); |
3d396eb1 | 1847 | disable_irq(adapter->irq); |
1494a814 | 1848 | netxen_intr(adapter->irq, adapter); |
3d396eb1 AK |
1849 | enable_irq(adapter->irq); |
1850 | } | |
1851 | #endif | |
3d396eb1 | 1852 | |
6598b169 DP |
1853 | #define is_netxen_netdev(dev) (dev->netdev_ops == &netxen_netdev_ops) |
1854 | ||
1855 | static int | |
1856 | netxen_destip_supported(struct netxen_adapter *adapter) | |
1857 | { | |
1858 | if (NX_IS_REVISION_P2(adapter->ahw.revision_id)) | |
1859 | return 0; | |
1860 | ||
1861 | if (adapter->ahw.cut_through) | |
1862 | return 0; | |
1863 | ||
1864 | return 1; | |
1865 | } | |
1866 | ||
1867 | static int netxen_netdev_event(struct notifier_block *this, | |
1868 | unsigned long event, void *ptr) | |
1869 | { | |
1870 | struct netxen_adapter *adapter; | |
1871 | struct net_device *dev = (struct net_device *)ptr; | |
1872 | struct in_device *indev; | |
1873 | ||
1874 | recheck: | |
1875 | if (dev == NULL) | |
1876 | goto done; | |
1877 | ||
1878 | if (dev->priv_flags & IFF_802_1Q_VLAN) { | |
1879 | dev = vlan_dev_real_dev(dev); | |
1880 | goto recheck; | |
1881 | } | |
1882 | ||
1883 | if (!is_netxen_netdev(dev)) | |
1884 | goto done; | |
1885 | ||
1886 | adapter = netdev_priv(dev); | |
1887 | ||
1888 | if (!adapter || !netxen_destip_supported(adapter)) | |
1889 | goto done; | |
1890 | ||
1891 | if (adapter->is_up != NETXEN_ADAPTER_UP_MAGIC) | |
1892 | goto done; | |
1893 | ||
1894 | indev = in_dev_get(dev); | |
1895 | if (!indev) | |
1896 | goto done; | |
1897 | ||
1898 | for_ifa(indev) { | |
1899 | switch (event) { | |
1900 | case NETDEV_UP: | |
1901 | netxen_config_ipaddr(adapter, | |
1902 | ifa->ifa_address, NX_IP_UP); | |
1903 | break; | |
1904 | case NETDEV_DOWN: | |
1905 | netxen_config_ipaddr(adapter, | |
1906 | ifa->ifa_address, NX_IP_DOWN); | |
1907 | break; | |
1908 | default: | |
1909 | break; | |
1910 | } | |
1911 | } endfor_ifa(indev); | |
1912 | ||
1913 | in_dev_put(indev); | |
1914 | done: | |
1915 | return NOTIFY_DONE; | |
1916 | } | |
1917 | ||
1918 | static int | |
1919 | netxen_inetaddr_event(struct notifier_block *this, | |
1920 | unsigned long event, void *ptr) | |
1921 | { | |
1922 | struct netxen_adapter *adapter; | |
1923 | struct net_device *dev; | |
1924 | ||
1925 | struct in_ifaddr *ifa = (struct in_ifaddr *)ptr; | |
1926 | ||
1927 | dev = ifa->ifa_dev ? ifa->ifa_dev->dev : NULL; | |
1928 | ||
1929 | recheck: | |
1930 | if (dev == NULL || !netif_running(dev)) | |
1931 | goto done; | |
1932 | ||
1933 | if (dev->priv_flags & IFF_802_1Q_VLAN) { | |
1934 | dev = vlan_dev_real_dev(dev); | |
1935 | goto recheck; | |
1936 | } | |
1937 | ||
1938 | if (!is_netxen_netdev(dev)) | |
1939 | goto done; | |
1940 | ||
1941 | adapter = netdev_priv(dev); | |
1942 | ||
1943 | if (!adapter || !netxen_destip_supported(adapter)) | |
1944 | goto done; | |
1945 | ||
1946 | if (adapter->is_up != NETXEN_ADAPTER_UP_MAGIC) | |
1947 | goto done; | |
1948 | ||
1949 | switch (event) { | |
1950 | case NETDEV_UP: | |
1951 | netxen_config_ipaddr(adapter, ifa->ifa_address, NX_IP_UP); | |
1952 | break; | |
1953 | case NETDEV_DOWN: | |
1954 | netxen_config_ipaddr(adapter, ifa->ifa_address, NX_IP_DOWN); | |
1955 | break; | |
1956 | default: | |
1957 | break; | |
1958 | } | |
1959 | ||
1960 | done: | |
1961 | return NOTIFY_DONE; | |
1962 | } | |
1963 | ||
1964 | static struct notifier_block netxen_netdev_cb = { | |
1965 | .notifier_call = netxen_netdev_event, | |
1966 | }; | |
1967 | ||
1968 | static struct notifier_block netxen_inetaddr_cb = { | |
1969 | .notifier_call = netxen_inetaddr_event, | |
1970 | }; | |
1971 | ||
3d396eb1 AK |
1972 | static struct pci_driver netxen_driver = { |
1973 | .name = netxen_nic_driver_name, | |
1974 | .id_table = netxen_pci_tbl, | |
1975 | .probe = netxen_nic_probe, | |
0b72e659 | 1976 | .remove = __devexit_p(netxen_nic_remove), |
01542cd1 | 1977 | #ifdef CONFIG_PM |
0b72e659 DP |
1978 | .suspend = netxen_nic_suspend, |
1979 | .resume = netxen_nic_resume | |
01542cd1 | 1980 | #endif |
3d396eb1 AK |
1981 | }; |
1982 | ||
3d396eb1 AK |
1983 | static int __init netxen_init_module(void) |
1984 | { | |
ff4fbd43 DP |
1985 | printk(KERN_INFO "%s\n", netxen_nic_driver_string); |
1986 | ||
79ea13ce | 1987 | if ((netxen_workq = create_singlethread_workqueue("netxen")) == NULL) |
ed25ffa1 AK |
1988 | return -ENOMEM; |
1989 | ||
6598b169 DP |
1990 | register_netdevice_notifier(&netxen_netdev_cb); |
1991 | register_inetaddr_notifier(&netxen_inetaddr_cb); | |
1992 | ||
184231bd | 1993 | return pci_register_driver(&netxen_driver); |
3d396eb1 AK |
1994 | } |
1995 | ||
1996 | module_init(netxen_init_module); | |
1997 | ||
1998 | static void __exit netxen_exit_module(void) | |
1999 | { | |
3d396eb1 | 2000 | pci_unregister_driver(&netxen_driver); |
6598b169 DP |
2001 | |
2002 | unregister_inetaddr_notifier(&netxen_inetaddr_cb); | |
2003 | unregister_netdevice_notifier(&netxen_netdev_cb); | |
9de06610 | 2004 | destroy_workqueue(netxen_workq); |
3d396eb1 AK |
2005 | } |
2006 | ||
2007 | module_exit(netxen_exit_module); |