2 * Copyright 2008-2010 Cisco Systems, Inc. All rights reserved.
3 * Copyright 2007 Nuova Systems, Inc. All rights reserved.
5 * This program is free software; you may redistribute it and/or modify
6 * it under the terms of the GNU General Public License as published by
7 * the Free Software Foundation; version 2 of the License.
9 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
10 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
11 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
12 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
13 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
14 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
15 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
20 #include <linux/module.h>
21 #include <linux/kernel.h>
22 #include <linux/string.h>
23 #include <linux/errno.h>
24 #include <linux/types.h>
25 #include <linux/init.h>
26 #include <linux/workqueue.h>
27 #include <linux/pci.h>
28 #include <linux/netdevice.h>
29 #include <linux/etherdevice.h>
30 #include <linux/if_ether.h>
31 #include <linux/if_vlan.h>
32 #include <linux/ethtool.h>
35 #include <linux/ipv6.h>
36 #include <linux/tcp.h>
37 #include <linux/rtnetlink.h>
38 #include <net/ip6_checksum.h>
40 #include "cq_enet_desc.h"
42 #include "vnic_intr.h"
43 #include "vnic_stats.h"
48 #define ENIC_NOTIFY_TIMER_PERIOD (2 * HZ)
49 #define WQ_ENET_MAX_DESC_LEN (1 << WQ_ENET_LEN_BITS)
50 #define MAX_TSO (1 << 16)
51 #define ENIC_DESC_MAX_SPLITS (MAX_TSO / WQ_ENET_MAX_DESC_LEN + 1)
53 #define PCI_DEVICE_ID_CISCO_VIC_ENET 0x0043 /* ethernet vnic */
54 #define PCI_DEVICE_ID_CISCO_VIC_ENET_DYN 0x0044 /* enet dynamic vnic */
56 /* Supported devices */
57 static DEFINE_PCI_DEVICE_TABLE(enic_id_table
) = {
58 { PCI_VDEVICE(CISCO
, PCI_DEVICE_ID_CISCO_VIC_ENET
) },
59 { PCI_VDEVICE(CISCO
, PCI_DEVICE_ID_CISCO_VIC_ENET_DYN
) },
60 { 0, } /* end of table */
63 MODULE_DESCRIPTION(DRV_DESCRIPTION
);
64 MODULE_AUTHOR("Scott Feldman <scofeldm@cisco.com>");
65 MODULE_LICENSE("GPL");
66 MODULE_VERSION(DRV_VERSION
);
67 MODULE_DEVICE_TABLE(pci
, enic_id_table
);
70 char name
[ETH_GSTRING_LEN
];
74 #define ENIC_TX_STAT(stat) \
75 { .name = #stat, .offset = offsetof(struct vnic_tx_stats, stat) / 8 }
76 #define ENIC_RX_STAT(stat) \
77 { .name = #stat, .offset = offsetof(struct vnic_rx_stats, stat) / 8 }
79 static const struct enic_stat enic_tx_stats
[] = {
80 ENIC_TX_STAT(tx_frames_ok
),
81 ENIC_TX_STAT(tx_unicast_frames_ok
),
82 ENIC_TX_STAT(tx_multicast_frames_ok
),
83 ENIC_TX_STAT(tx_broadcast_frames_ok
),
84 ENIC_TX_STAT(tx_bytes_ok
),
85 ENIC_TX_STAT(tx_unicast_bytes_ok
),
86 ENIC_TX_STAT(tx_multicast_bytes_ok
),
87 ENIC_TX_STAT(tx_broadcast_bytes_ok
),
88 ENIC_TX_STAT(tx_drops
),
89 ENIC_TX_STAT(tx_errors
),
93 static const struct enic_stat enic_rx_stats
[] = {
94 ENIC_RX_STAT(rx_frames_ok
),
95 ENIC_RX_STAT(rx_frames_total
),
96 ENIC_RX_STAT(rx_unicast_frames_ok
),
97 ENIC_RX_STAT(rx_multicast_frames_ok
),
98 ENIC_RX_STAT(rx_broadcast_frames_ok
),
99 ENIC_RX_STAT(rx_bytes_ok
),
100 ENIC_RX_STAT(rx_unicast_bytes_ok
),
101 ENIC_RX_STAT(rx_multicast_bytes_ok
),
102 ENIC_RX_STAT(rx_broadcast_bytes_ok
),
103 ENIC_RX_STAT(rx_drop
),
104 ENIC_RX_STAT(rx_no_bufs
),
105 ENIC_RX_STAT(rx_errors
),
106 ENIC_RX_STAT(rx_rss
),
107 ENIC_RX_STAT(rx_crc_errors
),
108 ENIC_RX_STAT(rx_frames_64
),
109 ENIC_RX_STAT(rx_frames_127
),
110 ENIC_RX_STAT(rx_frames_255
),
111 ENIC_RX_STAT(rx_frames_511
),
112 ENIC_RX_STAT(rx_frames_1023
),
113 ENIC_RX_STAT(rx_frames_1518
),
114 ENIC_RX_STAT(rx_frames_to_max
),
117 static const unsigned int enic_n_tx_stats
= ARRAY_SIZE(enic_tx_stats
);
118 static const unsigned int enic_n_rx_stats
= ARRAY_SIZE(enic_rx_stats
);
120 static int enic_is_dynamic(struct enic
*enic
)
122 return enic
->pdev
->device
== PCI_DEVICE_ID_CISCO_VIC_ENET_DYN
;
125 static inline unsigned int enic_cq_rq(struct enic
*enic
, unsigned int rq
)
130 static inline unsigned int enic_cq_wq(struct enic
*enic
, unsigned int wq
)
132 return enic
->rq_count
+ wq
;
135 static inline unsigned int enic_legacy_io_intr(void)
140 static inline unsigned int enic_legacy_err_intr(void)
145 static inline unsigned int enic_legacy_notify_intr(void)
150 static inline unsigned int enic_msix_rq_intr(struct enic
*enic
, unsigned int rq
)
155 static inline unsigned int enic_msix_wq_intr(struct enic
*enic
, unsigned int wq
)
157 return enic
->rq_count
+ wq
;
160 static inline unsigned int enic_msix_err_intr(struct enic
*enic
)
162 return enic
->rq_count
+ enic
->wq_count
;
165 static inline unsigned int enic_msix_notify_intr(struct enic
*enic
)
167 return enic
->rq_count
+ enic
->wq_count
+ 1;
170 static int enic_get_settings(struct net_device
*netdev
,
171 struct ethtool_cmd
*ecmd
)
173 struct enic
*enic
= netdev_priv(netdev
);
175 ecmd
->supported
= (SUPPORTED_10000baseT_Full
| SUPPORTED_FIBRE
);
176 ecmd
->advertising
= (ADVERTISED_10000baseT_Full
| ADVERTISED_FIBRE
);
177 ecmd
->port
= PORT_FIBRE
;
178 ecmd
->transceiver
= XCVR_EXTERNAL
;
180 if (netif_carrier_ok(netdev
)) {
181 ecmd
->speed
= vnic_dev_port_speed(enic
->vdev
);
182 ecmd
->duplex
= DUPLEX_FULL
;
188 ecmd
->autoneg
= AUTONEG_DISABLE
;
193 static int enic_dev_fw_info(struct enic
*enic
,
194 struct vnic_devcmd_fw_info
**fw_info
)
198 spin_lock(&enic
->devcmd_lock
);
199 err
= vnic_dev_fw_info(enic
->vdev
, fw_info
);
200 spin_unlock(&enic
->devcmd_lock
);
205 static void enic_get_drvinfo(struct net_device
*netdev
,
206 struct ethtool_drvinfo
*drvinfo
)
208 struct enic
*enic
= netdev_priv(netdev
);
209 struct vnic_devcmd_fw_info
*fw_info
;
211 enic_dev_fw_info(enic
, &fw_info
);
213 strncpy(drvinfo
->driver
, DRV_NAME
, sizeof(drvinfo
->driver
));
214 strncpy(drvinfo
->version
, DRV_VERSION
, sizeof(drvinfo
->version
));
215 strncpy(drvinfo
->fw_version
, fw_info
->fw_version
,
216 sizeof(drvinfo
->fw_version
));
217 strncpy(drvinfo
->bus_info
, pci_name(enic
->pdev
),
218 sizeof(drvinfo
->bus_info
));
221 static void enic_get_strings(struct net_device
*netdev
, u32 stringset
, u8
*data
)
227 for (i
= 0; i
< enic_n_tx_stats
; i
++) {
228 memcpy(data
, enic_tx_stats
[i
].name
, ETH_GSTRING_LEN
);
229 data
+= ETH_GSTRING_LEN
;
231 for (i
= 0; i
< enic_n_rx_stats
; i
++) {
232 memcpy(data
, enic_rx_stats
[i
].name
, ETH_GSTRING_LEN
);
233 data
+= ETH_GSTRING_LEN
;
239 static int enic_get_sset_count(struct net_device
*netdev
, int sset
)
243 return enic_n_tx_stats
+ enic_n_rx_stats
;
249 static int enic_dev_stats_dump(struct enic
*enic
, struct vnic_stats
**vstats
)
253 spin_lock(&enic
->devcmd_lock
);
254 err
= vnic_dev_stats_dump(enic
->vdev
, vstats
);
255 spin_unlock(&enic
->devcmd_lock
);
260 static void enic_get_ethtool_stats(struct net_device
*netdev
,
261 struct ethtool_stats
*stats
, u64
*data
)
263 struct enic
*enic
= netdev_priv(netdev
);
264 struct vnic_stats
*vstats
;
267 enic_dev_stats_dump(enic
, &vstats
);
269 for (i
= 0; i
< enic_n_tx_stats
; i
++)
270 *(data
++) = ((u64
*)&vstats
->tx
)[enic_tx_stats
[i
].offset
];
271 for (i
= 0; i
< enic_n_rx_stats
; i
++)
272 *(data
++) = ((u64
*)&vstats
->rx
)[enic_rx_stats
[i
].offset
];
275 static u32
enic_get_rx_csum(struct net_device
*netdev
)
277 struct enic
*enic
= netdev_priv(netdev
);
278 return enic
->csum_rx_enabled
;
281 static int enic_set_rx_csum(struct net_device
*netdev
, u32 data
)
283 struct enic
*enic
= netdev_priv(netdev
);
285 if (data
&& !ENIC_SETTING(enic
, RXCSUM
))
288 enic
->csum_rx_enabled
= !!data
;
293 static int enic_set_tx_csum(struct net_device
*netdev
, u32 data
)
295 struct enic
*enic
= netdev_priv(netdev
);
297 if (data
&& !ENIC_SETTING(enic
, TXCSUM
))
301 netdev
->features
|= NETIF_F_HW_CSUM
;
303 netdev
->features
&= ~NETIF_F_HW_CSUM
;
308 static int enic_set_tso(struct net_device
*netdev
, u32 data
)
310 struct enic
*enic
= netdev_priv(netdev
);
312 if (data
&& !ENIC_SETTING(enic
, TSO
))
317 NETIF_F_TSO
| NETIF_F_TSO6
| NETIF_F_TSO_ECN
;
320 ~(NETIF_F_TSO
| NETIF_F_TSO6
| NETIF_F_TSO_ECN
);
325 static u32
enic_get_msglevel(struct net_device
*netdev
)
327 struct enic
*enic
= netdev_priv(netdev
);
328 return enic
->msg_enable
;
331 static void enic_set_msglevel(struct net_device
*netdev
, u32 value
)
333 struct enic
*enic
= netdev_priv(netdev
);
334 enic
->msg_enable
= value
;
337 static int enic_get_coalesce(struct net_device
*netdev
,
338 struct ethtool_coalesce
*ecmd
)
340 struct enic
*enic
= netdev_priv(netdev
);
342 ecmd
->tx_coalesce_usecs
= enic
->tx_coalesce_usecs
;
343 ecmd
->rx_coalesce_usecs
= enic
->rx_coalesce_usecs
;
348 static int enic_set_coalesce(struct net_device
*netdev
,
349 struct ethtool_coalesce
*ecmd
)
351 struct enic
*enic
= netdev_priv(netdev
);
352 u32 tx_coalesce_usecs
;
353 u32 rx_coalesce_usecs
;
354 unsigned int i
, intr
;
356 tx_coalesce_usecs
= min_t(u32
,
357 INTR_COALESCE_HW_TO_USEC(VNIC_INTR_TIMER_MAX
),
358 ecmd
->tx_coalesce_usecs
);
359 rx_coalesce_usecs
= min_t(u32
,
360 INTR_COALESCE_HW_TO_USEC(VNIC_INTR_TIMER_MAX
),
361 ecmd
->rx_coalesce_usecs
);
363 switch (vnic_dev_get_intr_mode(enic
->vdev
)) {
364 case VNIC_DEV_INTR_MODE_INTX
:
365 if (tx_coalesce_usecs
!= rx_coalesce_usecs
)
368 intr
= enic_legacy_io_intr();
369 vnic_intr_coalescing_timer_set(&enic
->intr
[intr
],
370 INTR_COALESCE_USEC_TO_HW(tx_coalesce_usecs
));
372 case VNIC_DEV_INTR_MODE_MSI
:
373 if (tx_coalesce_usecs
!= rx_coalesce_usecs
)
376 vnic_intr_coalescing_timer_set(&enic
->intr
[0],
377 INTR_COALESCE_USEC_TO_HW(tx_coalesce_usecs
));
379 case VNIC_DEV_INTR_MODE_MSIX
:
380 for (i
= 0; i
< enic
->wq_count
; i
++) {
381 intr
= enic_msix_wq_intr(enic
, i
);
382 vnic_intr_coalescing_timer_set(&enic
->intr
[intr
],
383 INTR_COALESCE_USEC_TO_HW(tx_coalesce_usecs
));
386 for (i
= 0; i
< enic
->rq_count
; i
++) {
387 intr
= enic_msix_rq_intr(enic
, i
);
388 vnic_intr_coalescing_timer_set(&enic
->intr
[intr
],
389 INTR_COALESCE_USEC_TO_HW(rx_coalesce_usecs
));
397 enic
->tx_coalesce_usecs
= tx_coalesce_usecs
;
398 enic
->rx_coalesce_usecs
= rx_coalesce_usecs
;
403 static const struct ethtool_ops enic_ethtool_ops
= {
404 .get_settings
= enic_get_settings
,
405 .get_drvinfo
= enic_get_drvinfo
,
406 .get_msglevel
= enic_get_msglevel
,
407 .set_msglevel
= enic_set_msglevel
,
408 .get_link
= ethtool_op_get_link
,
409 .get_strings
= enic_get_strings
,
410 .get_sset_count
= enic_get_sset_count
,
411 .get_ethtool_stats
= enic_get_ethtool_stats
,
412 .get_rx_csum
= enic_get_rx_csum
,
413 .set_rx_csum
= enic_set_rx_csum
,
414 .get_tx_csum
= ethtool_op_get_tx_csum
,
415 .set_tx_csum
= enic_set_tx_csum
,
416 .get_sg
= ethtool_op_get_sg
,
417 .set_sg
= ethtool_op_set_sg
,
418 .get_tso
= ethtool_op_get_tso
,
419 .set_tso
= enic_set_tso
,
420 .get_coalesce
= enic_get_coalesce
,
421 .set_coalesce
= enic_set_coalesce
,
422 .get_flags
= ethtool_op_get_flags
,
425 static void enic_free_wq_buf(struct vnic_wq
*wq
, struct vnic_wq_buf
*buf
)
427 struct enic
*enic
= vnic_dev_priv(wq
->vdev
);
430 pci_unmap_single(enic
->pdev
, buf
->dma_addr
,
431 buf
->len
, PCI_DMA_TODEVICE
);
433 pci_unmap_page(enic
->pdev
, buf
->dma_addr
,
434 buf
->len
, PCI_DMA_TODEVICE
);
437 dev_kfree_skb_any(buf
->os_buf
);
440 static void enic_wq_free_buf(struct vnic_wq
*wq
,
441 struct cq_desc
*cq_desc
, struct vnic_wq_buf
*buf
, void *opaque
)
443 enic_free_wq_buf(wq
, buf
);
446 static int enic_wq_service(struct vnic_dev
*vdev
, struct cq_desc
*cq_desc
,
447 u8 type
, u16 q_number
, u16 completed_index
, void *opaque
)
449 struct enic
*enic
= vnic_dev_priv(vdev
);
451 spin_lock(&enic
->wq_lock
[q_number
]);
453 vnic_wq_service(&enic
->wq
[q_number
], cq_desc
,
454 completed_index
, enic_wq_free_buf
,
457 if (netif_queue_stopped(enic
->netdev
) &&
458 vnic_wq_desc_avail(&enic
->wq
[q_number
]) >=
459 (MAX_SKB_FRAGS
+ ENIC_DESC_MAX_SPLITS
))
460 netif_wake_queue(enic
->netdev
);
462 spin_unlock(&enic
->wq_lock
[q_number
]);
467 static void enic_log_q_error(struct enic
*enic
)
472 for (i
= 0; i
< enic
->wq_count
; i
++) {
473 error_status
= vnic_wq_error_status(&enic
->wq
[i
]);
475 netdev_err(enic
->netdev
, "WQ[%d] error_status %d\n",
479 for (i
= 0; i
< enic
->rq_count
; i
++) {
480 error_status
= vnic_rq_error_status(&enic
->rq
[i
]);
482 netdev_err(enic
->netdev
, "RQ[%d] error_status %d\n",
487 static void enic_msglvl_check(struct enic
*enic
)
489 u32 msg_enable
= vnic_dev_msg_lvl(enic
->vdev
);
491 if (msg_enable
!= enic
->msg_enable
) {
492 netdev_info(enic
->netdev
, "msg lvl changed from 0x%x to 0x%x\n",
493 enic
->msg_enable
, msg_enable
);
494 enic
->msg_enable
= msg_enable
;
498 static void enic_mtu_check(struct enic
*enic
)
500 u32 mtu
= vnic_dev_mtu(enic
->vdev
);
501 struct net_device
*netdev
= enic
->netdev
;
503 if (mtu
&& mtu
!= enic
->port_mtu
) {
504 enic
->port_mtu
= mtu
;
505 if (mtu
< netdev
->mtu
)
507 "interface MTU (%d) set higher "
508 "than switch port MTU (%d)\n",
513 static void enic_link_check(struct enic
*enic
)
515 int link_status
= vnic_dev_link_status(enic
->vdev
);
516 int carrier_ok
= netif_carrier_ok(enic
->netdev
);
518 if (link_status
&& !carrier_ok
) {
519 netdev_info(enic
->netdev
, "Link UP\n");
520 netif_carrier_on(enic
->netdev
);
521 } else if (!link_status
&& carrier_ok
) {
522 netdev_info(enic
->netdev
, "Link DOWN\n");
523 netif_carrier_off(enic
->netdev
);
527 static void enic_notify_check(struct enic
*enic
)
529 enic_msglvl_check(enic
);
530 enic_mtu_check(enic
);
531 enic_link_check(enic
);
534 #define ENIC_TEST_INTR(pba, i) (pba & (1 << i))
536 static irqreturn_t
enic_isr_legacy(int irq
, void *data
)
538 struct net_device
*netdev
= data
;
539 struct enic
*enic
= netdev_priv(netdev
);
540 unsigned int io_intr
= enic_legacy_io_intr();
541 unsigned int err_intr
= enic_legacy_err_intr();
542 unsigned int notify_intr
= enic_legacy_notify_intr();
545 vnic_intr_mask(&enic
->intr
[io_intr
]);
547 pba
= vnic_intr_legacy_pba(enic
->legacy_pba
);
549 vnic_intr_unmask(&enic
->intr
[io_intr
]);
550 return IRQ_NONE
; /* not our interrupt */
553 if (ENIC_TEST_INTR(pba
, notify_intr
)) {
554 vnic_intr_return_all_credits(&enic
->intr
[notify_intr
]);
555 enic_notify_check(enic
);
558 if (ENIC_TEST_INTR(pba
, err_intr
)) {
559 vnic_intr_return_all_credits(&enic
->intr
[err_intr
]);
560 enic_log_q_error(enic
);
561 /* schedule recovery from WQ/RQ error */
562 schedule_work(&enic
->reset
);
566 if (ENIC_TEST_INTR(pba
, io_intr
)) {
567 if (napi_schedule_prep(&enic
->napi
[0]))
568 __napi_schedule(&enic
->napi
[0]);
570 vnic_intr_unmask(&enic
->intr
[io_intr
]);
576 static irqreturn_t
enic_isr_msi(int irq
, void *data
)
578 struct enic
*enic
= data
;
580 /* With MSI, there is no sharing of interrupts, so this is
581 * our interrupt and there is no need to ack it. The device
582 * is not providing per-vector masking, so the OS will not
583 * write to PCI config space to mask/unmask the interrupt.
584 * We're using mask_on_assertion for MSI, so the device
585 * automatically masks the interrupt when the interrupt is
586 * generated. Later, when exiting polling, the interrupt
587 * will be unmasked (see enic_poll).
589 * Also, the device uses the same PCIe Traffic Class (TC)
590 * for Memory Write data and MSI, so there are no ordering
591 * issues; the MSI will always arrive at the Root Complex
592 * _after_ corresponding Memory Writes (i.e. descriptor
596 napi_schedule(&enic
->napi
[0]);
601 static irqreturn_t
enic_isr_msix_rq(int irq
, void *data
)
603 struct napi_struct
*napi
= data
;
605 /* schedule NAPI polling for RQ cleanup */
611 static irqreturn_t
enic_isr_msix_wq(int irq
, void *data
)
613 struct enic
*enic
= data
;
614 unsigned int cq
= enic_cq_wq(enic
, 0);
615 unsigned int intr
= enic_msix_wq_intr(enic
, 0);
616 unsigned int wq_work_to_do
= -1; /* no limit */
617 unsigned int wq_work_done
;
619 wq_work_done
= vnic_cq_service(&enic
->cq
[cq
],
620 wq_work_to_do
, enic_wq_service
, NULL
);
622 vnic_intr_return_credits(&enic
->intr
[intr
],
625 1 /* reset intr timer */);
630 static irqreturn_t
enic_isr_msix_err(int irq
, void *data
)
632 struct enic
*enic
= data
;
633 unsigned int intr
= enic_msix_err_intr(enic
);
635 vnic_intr_return_all_credits(&enic
->intr
[intr
]);
637 enic_log_q_error(enic
);
639 /* schedule recovery from WQ/RQ error */
640 schedule_work(&enic
->reset
);
645 static irqreturn_t
enic_isr_msix_notify(int irq
, void *data
)
647 struct enic
*enic
= data
;
648 unsigned int intr
= enic_msix_notify_intr(enic
);
650 vnic_intr_return_all_credits(&enic
->intr
[intr
]);
651 enic_notify_check(enic
);
656 static inline void enic_queue_wq_skb_cont(struct enic
*enic
,
657 struct vnic_wq
*wq
, struct sk_buff
*skb
,
658 unsigned int len_left
, int loopback
)
662 /* Queue additional data fragments */
663 for (frag
= skb_shinfo(skb
)->frags
; len_left
; frag
++) {
664 len_left
-= frag
->size
;
665 enic_queue_wq_desc_cont(wq
, skb
,
666 pci_map_page(enic
->pdev
, frag
->page
,
667 frag
->page_offset
, frag
->size
,
670 (len_left
== 0), /* EOP? */
675 static inline void enic_queue_wq_skb_vlan(struct enic
*enic
,
676 struct vnic_wq
*wq
, struct sk_buff
*skb
,
677 int vlan_tag_insert
, unsigned int vlan_tag
, int loopback
)
679 unsigned int head_len
= skb_headlen(skb
);
680 unsigned int len_left
= skb
->len
- head_len
;
681 int eop
= (len_left
== 0);
683 /* Queue the main skb fragment. The fragments are no larger
684 * than max MTU(9000)+ETH_HDR_LEN(14) bytes, which is less
685 * than WQ_ENET_MAX_DESC_LEN length. So only one descriptor
686 * per fragment is queued.
688 enic_queue_wq_desc(wq
, skb
,
689 pci_map_single(enic
->pdev
, skb
->data
,
690 head_len
, PCI_DMA_TODEVICE
),
692 vlan_tag_insert
, vlan_tag
,
696 enic_queue_wq_skb_cont(enic
, wq
, skb
, len_left
, loopback
);
699 static inline void enic_queue_wq_skb_csum_l4(struct enic
*enic
,
700 struct vnic_wq
*wq
, struct sk_buff
*skb
,
701 int vlan_tag_insert
, unsigned int vlan_tag
, int loopback
)
703 unsigned int head_len
= skb_headlen(skb
);
704 unsigned int len_left
= skb
->len
- head_len
;
705 unsigned int hdr_len
= skb_transport_offset(skb
);
706 unsigned int csum_offset
= hdr_len
+ skb
->csum_offset
;
707 int eop
= (len_left
== 0);
709 /* Queue the main skb fragment. The fragments are no larger
710 * than max MTU(9000)+ETH_HDR_LEN(14) bytes, which is less
711 * than WQ_ENET_MAX_DESC_LEN length. So only one descriptor
712 * per fragment is queued.
714 enic_queue_wq_desc_csum_l4(wq
, skb
,
715 pci_map_single(enic
->pdev
, skb
->data
,
716 head_len
, PCI_DMA_TODEVICE
),
720 vlan_tag_insert
, vlan_tag
,
724 enic_queue_wq_skb_cont(enic
, wq
, skb
, len_left
, loopback
);
727 static inline void enic_queue_wq_skb_tso(struct enic
*enic
,
728 struct vnic_wq
*wq
, struct sk_buff
*skb
, unsigned int mss
,
729 int vlan_tag_insert
, unsigned int vlan_tag
, int loopback
)
731 unsigned int frag_len_left
= skb_headlen(skb
);
732 unsigned int len_left
= skb
->len
- frag_len_left
;
733 unsigned int hdr_len
= skb_transport_offset(skb
) + tcp_hdrlen(skb
);
734 int eop
= (len_left
== 0);
737 unsigned int offset
= 0;
740 /* Preload TCP csum field with IP pseudo hdr calculated
741 * with IP length set to zero. HW will later add in length
742 * to each TCP segment resulting from the TSO.
745 if (skb
->protocol
== cpu_to_be16(ETH_P_IP
)) {
746 ip_hdr(skb
)->check
= 0;
747 tcp_hdr(skb
)->check
= ~csum_tcpudp_magic(ip_hdr(skb
)->saddr
,
748 ip_hdr(skb
)->daddr
, 0, IPPROTO_TCP
, 0);
749 } else if (skb
->protocol
== cpu_to_be16(ETH_P_IPV6
)) {
750 tcp_hdr(skb
)->check
= ~csum_ipv6_magic(&ipv6_hdr(skb
)->saddr
,
751 &ipv6_hdr(skb
)->daddr
, 0, IPPROTO_TCP
, 0);
754 /* Queue WQ_ENET_MAX_DESC_LEN length descriptors
755 * for the main skb fragment
757 while (frag_len_left
) {
758 len
= min(frag_len_left
, (unsigned int)WQ_ENET_MAX_DESC_LEN
);
759 dma_addr
= pci_map_single(enic
->pdev
, skb
->data
+ offset
,
760 len
, PCI_DMA_TODEVICE
);
761 enic_queue_wq_desc_tso(wq
, skb
,
765 vlan_tag_insert
, vlan_tag
,
766 eop
&& (len
== frag_len_left
), loopback
);
767 frag_len_left
-= len
;
774 /* Queue WQ_ENET_MAX_DESC_LEN length descriptors
775 * for additional data fragments
777 for (frag
= skb_shinfo(skb
)->frags
; len_left
; frag
++) {
778 len_left
-= frag
->size
;
779 frag_len_left
= frag
->size
;
780 offset
= frag
->page_offset
;
782 while (frag_len_left
) {
783 len
= min(frag_len_left
,
784 (unsigned int)WQ_ENET_MAX_DESC_LEN
);
785 dma_addr
= pci_map_page(enic
->pdev
, frag
->page
,
788 enic_queue_wq_desc_cont(wq
, skb
,
792 (len
== frag_len_left
), /* EOP? */
794 frag_len_left
-= len
;
800 static inline void enic_queue_wq_skb(struct enic
*enic
,
801 struct vnic_wq
*wq
, struct sk_buff
*skb
)
803 unsigned int mss
= skb_shinfo(skb
)->gso_size
;
804 unsigned int vlan_tag
= 0;
805 int vlan_tag_insert
= 0;
808 if (enic
->vlan_group
&& vlan_tx_tag_present(skb
)) {
809 /* VLAN tag from trunking driver */
811 vlan_tag
= vlan_tx_tag_get(skb
);
812 } else if (enic
->loop_enable
) {
813 vlan_tag
= enic
->loop_tag
;
818 enic_queue_wq_skb_tso(enic
, wq
, skb
, mss
,
819 vlan_tag_insert
, vlan_tag
, loopback
);
820 else if (skb
->ip_summed
== CHECKSUM_PARTIAL
)
821 enic_queue_wq_skb_csum_l4(enic
, wq
, skb
,
822 vlan_tag_insert
, vlan_tag
, loopback
);
824 enic_queue_wq_skb_vlan(enic
, wq
, skb
,
825 vlan_tag_insert
, vlan_tag
, loopback
);
828 /* netif_tx_lock held, process context with BHs disabled, or BH */
829 static netdev_tx_t
enic_hard_start_xmit(struct sk_buff
*skb
,
830 struct net_device
*netdev
)
832 struct enic
*enic
= netdev_priv(netdev
);
833 struct vnic_wq
*wq
= &enic
->wq
[0];
841 /* Non-TSO sends must fit within ENIC_NON_TSO_MAX_DESC descs,
842 * which is very likely. In the off chance it's going to take
843 * more than * ENIC_NON_TSO_MAX_DESC, linearize the skb.
846 if (skb_shinfo(skb
)->gso_size
== 0 &&
847 skb_shinfo(skb
)->nr_frags
+ 1 > ENIC_NON_TSO_MAX_DESC
&&
848 skb_linearize(skb
)) {
853 spin_lock_irqsave(&enic
->wq_lock
[0], flags
);
855 if (vnic_wq_desc_avail(wq
) <
856 skb_shinfo(skb
)->nr_frags
+ ENIC_DESC_MAX_SPLITS
) {
857 netif_stop_queue(netdev
);
858 /* This is a hard error, log it */
859 netdev_err(netdev
, "BUG! Tx ring full when queue awake!\n");
860 spin_unlock_irqrestore(&enic
->wq_lock
[0], flags
);
861 return NETDEV_TX_BUSY
;
864 enic_queue_wq_skb(enic
, wq
, skb
);
866 if (vnic_wq_desc_avail(wq
) < MAX_SKB_FRAGS
+ ENIC_DESC_MAX_SPLITS
)
867 netif_stop_queue(netdev
);
869 spin_unlock_irqrestore(&enic
->wq_lock
[0], flags
);
874 /* dev_base_lock rwlock held, nominally process context */
875 static struct net_device_stats
*enic_get_stats(struct net_device
*netdev
)
877 struct enic
*enic
= netdev_priv(netdev
);
878 struct net_device_stats
*net_stats
= &netdev
->stats
;
879 struct vnic_stats
*stats
;
881 enic_dev_stats_dump(enic
, &stats
);
883 net_stats
->tx_packets
= stats
->tx
.tx_frames_ok
;
884 net_stats
->tx_bytes
= stats
->tx
.tx_bytes_ok
;
885 net_stats
->tx_errors
= stats
->tx
.tx_errors
;
886 net_stats
->tx_dropped
= stats
->tx
.tx_drops
;
888 net_stats
->rx_packets
= stats
->rx
.rx_frames_ok
;
889 net_stats
->rx_bytes
= stats
->rx
.rx_bytes_ok
;
890 net_stats
->rx_errors
= stats
->rx
.rx_errors
;
891 net_stats
->multicast
= stats
->rx
.rx_multicast_frames_ok
;
892 net_stats
->rx_over_errors
= enic
->rq_truncated_pkts
;
893 net_stats
->rx_crc_errors
= enic
->rq_bad_fcs
;
894 net_stats
->rx_dropped
= stats
->rx
.rx_no_bufs
+ stats
->rx
.rx_drop
;
899 static void enic_reset_multicast_list(struct enic
*enic
)
905 static int enic_set_mac_addr(struct net_device
*netdev
, char *addr
)
907 struct enic
*enic
= netdev_priv(netdev
);
909 if (enic_is_dynamic(enic
)) {
910 if (!is_valid_ether_addr(addr
) && !is_zero_ether_addr(addr
))
911 return -EADDRNOTAVAIL
;
913 if (!is_valid_ether_addr(addr
))
914 return -EADDRNOTAVAIL
;
917 memcpy(netdev
->dev_addr
, addr
, netdev
->addr_len
);
922 static int enic_dev_add_station_addr(struct enic
*enic
)
926 if (is_valid_ether_addr(enic
->netdev
->dev_addr
)) {
927 spin_lock(&enic
->devcmd_lock
);
928 err
= vnic_dev_add_addr(enic
->vdev
, enic
->netdev
->dev_addr
);
929 spin_unlock(&enic
->devcmd_lock
);
935 static int enic_dev_del_station_addr(struct enic
*enic
)
939 if (is_valid_ether_addr(enic
->netdev
->dev_addr
)) {
940 spin_lock(&enic
->devcmd_lock
);
941 err
= vnic_dev_del_addr(enic
->vdev
, enic
->netdev
->dev_addr
);
942 spin_unlock(&enic
->devcmd_lock
);
948 static int enic_set_mac_address_dynamic(struct net_device
*netdev
, void *p
)
950 struct enic
*enic
= netdev_priv(netdev
);
951 struct sockaddr
*saddr
= p
;
952 char *addr
= saddr
->sa_data
;
955 if (netif_running(enic
->netdev
)) {
956 err
= enic_dev_del_station_addr(enic
);
961 err
= enic_set_mac_addr(netdev
, addr
);
965 if (netif_running(enic
->netdev
)) {
966 err
= enic_dev_add_station_addr(enic
);
974 static int enic_set_mac_address(struct net_device
*netdev
, void *p
)
976 struct sockaddr
*saddr
= p
;
977 char *addr
= saddr
->sa_data
;
978 struct enic
*enic
= netdev_priv(netdev
);
981 err
= enic_dev_del_station_addr(enic
);
985 err
= enic_set_mac_addr(netdev
, addr
);
989 return enic_dev_add_station_addr(enic
);
992 static int enic_dev_packet_filter(struct enic
*enic
, int directed
,
993 int multicast
, int broadcast
, int promisc
, int allmulti
)
997 spin_lock(&enic
->devcmd_lock
);
998 err
= vnic_dev_packet_filter(enic
->vdev
, directed
,
999 multicast
, broadcast
, promisc
, allmulti
);
1000 spin_unlock(&enic
->devcmd_lock
);
1005 static int enic_dev_add_multicast_addr(struct enic
*enic
, u8
*addr
)
1009 spin_lock(&enic
->devcmd_lock
);
1010 err
= vnic_dev_add_addr(enic
->vdev
, addr
);
1011 spin_unlock(&enic
->devcmd_lock
);
1016 static int enic_dev_del_multicast_addr(struct enic
*enic
, u8
*addr
)
1020 spin_lock(&enic
->devcmd_lock
);
1021 err
= vnic_dev_del_addr(enic
->vdev
, addr
);
1022 spin_unlock(&enic
->devcmd_lock
);
1027 /* netif_tx_lock held, BHs disabled */
1028 static void enic_set_multicast_list(struct net_device
*netdev
)
1030 struct enic
*enic
= netdev_priv(netdev
);
1031 struct netdev_hw_addr
*ha
;
1033 int multicast
= (netdev
->flags
& IFF_MULTICAST
) ? 1 : 0;
1034 int broadcast
= (netdev
->flags
& IFF_BROADCAST
) ? 1 : 0;
1035 int promisc
= (netdev
->flags
& IFF_PROMISC
) ? 1 : 0;
1036 unsigned int mc_count
= netdev_mc_count(netdev
);
1037 int allmulti
= (netdev
->flags
& IFF_ALLMULTI
) ||
1038 mc_count
> ENIC_MULTICAST_PERFECT_FILTERS
;
1039 unsigned int flags
= netdev
->flags
| (allmulti
? IFF_ALLMULTI
: 0);
1040 u8 mc_addr
[ENIC_MULTICAST_PERFECT_FILTERS
][ETH_ALEN
];
1043 if (mc_count
> ENIC_MULTICAST_PERFECT_FILTERS
)
1044 mc_count
= ENIC_MULTICAST_PERFECT_FILTERS
;
1046 if (enic
->flags
!= flags
) {
1047 enic
->flags
= flags
;
1048 enic_dev_packet_filter(enic
, directed
,
1049 multicast
, broadcast
, promisc
, allmulti
);
1052 /* Is there an easier way? Trying to minimize to
1053 * calls to add/del multicast addrs. We keep the
1054 * addrs from the last call in enic->mc_addr and
1055 * look for changes to add/del.
1059 netdev_for_each_mc_addr(ha
, netdev
) {
1062 memcpy(mc_addr
[i
++], ha
->addr
, ETH_ALEN
);
1065 for (i
= 0; i
< enic
->mc_count
; i
++) {
1066 for (j
= 0; j
< mc_count
; j
++)
1067 if (compare_ether_addr(enic
->mc_addr
[i
],
1071 enic_dev_del_multicast_addr(enic
, enic
->mc_addr
[i
]);
1074 for (i
= 0; i
< mc_count
; i
++) {
1075 for (j
= 0; j
< enic
->mc_count
; j
++)
1076 if (compare_ether_addr(mc_addr
[i
],
1077 enic
->mc_addr
[j
]) == 0)
1079 if (j
== enic
->mc_count
)
1080 enic_dev_add_multicast_addr(enic
, mc_addr
[i
]);
1083 /* Save the list to compare against next time
1086 for (i
= 0; i
< mc_count
; i
++)
1087 memcpy(enic
->mc_addr
[i
], mc_addr
[i
], ETH_ALEN
);
1089 enic
->mc_count
= mc_count
;
1092 /* rtnl lock is held */
1093 static void enic_vlan_rx_register(struct net_device
*netdev
,
1094 struct vlan_group
*vlan_group
)
1096 struct enic
*enic
= netdev_priv(netdev
);
1097 enic
->vlan_group
= vlan_group
;
1100 /* rtnl lock is held */
1101 static void enic_vlan_rx_add_vid(struct net_device
*netdev
, u16 vid
)
1103 struct enic
*enic
= netdev_priv(netdev
);
1105 spin_lock(&enic
->devcmd_lock
);
1106 enic_add_vlan(enic
, vid
);
1107 spin_unlock(&enic
->devcmd_lock
);
1110 /* rtnl lock is held */
1111 static void enic_vlan_rx_kill_vid(struct net_device
*netdev
, u16 vid
)
1113 struct enic
*enic
= netdev_priv(netdev
);
1115 spin_lock(&enic
->devcmd_lock
);
1116 enic_del_vlan(enic
, vid
);
1117 spin_unlock(&enic
->devcmd_lock
);
1120 /* netif_tx_lock held, BHs disabled */
1121 static void enic_tx_timeout(struct net_device
*netdev
)
1123 struct enic
*enic
= netdev_priv(netdev
);
1124 schedule_work(&enic
->reset
);
1127 static int enic_vnic_dev_deinit(struct enic
*enic
)
1131 spin_lock(&enic
->devcmd_lock
);
1132 err
= vnic_dev_deinit(enic
->vdev
);
1133 spin_unlock(&enic
->devcmd_lock
);
1138 static int enic_dev_init_prov(struct enic
*enic
, struct vic_provinfo
*vp
)
1142 spin_lock(&enic
->devcmd_lock
);
1143 err
= vnic_dev_init_prov(enic
->vdev
,
1144 (u8
*)vp
, vic_provinfo_size(vp
));
1145 spin_unlock(&enic
->devcmd_lock
);
1150 static int enic_dev_init_done(struct enic
*enic
, int *done
, int *error
)
1154 spin_lock(&enic
->devcmd_lock
);
1155 err
= vnic_dev_init_done(enic
->vdev
, done
, error
);
1156 spin_unlock(&enic
->devcmd_lock
);
1161 static int enic_set_port_profile(struct enic
*enic
, u8
*mac
)
1163 struct vic_provinfo
*vp
;
1164 u8 oui
[3] = VIC_PROVINFO_CISCO_OUI
;
1168 err
= enic_vnic_dev_deinit(enic
);
1172 switch (enic
->pp
.request
) {
1174 case PORT_REQUEST_ASSOCIATE
:
1176 if (!(enic
->pp
.set
& ENIC_SET_NAME
) || !strlen(enic
->pp
.name
))
1179 if (!is_valid_ether_addr(mac
))
1180 return -EADDRNOTAVAIL
;
1182 vp
= vic_provinfo_alloc(GFP_KERNEL
, oui
,
1183 VIC_PROVINFO_LINUX_TYPE
);
1187 vic_provinfo_add_tlv(vp
,
1188 VIC_LINUX_PROV_TLV_PORT_PROFILE_NAME_STR
,
1189 strlen(enic
->pp
.name
) + 1, enic
->pp
.name
);
1191 vic_provinfo_add_tlv(vp
,
1192 VIC_LINUX_PROV_TLV_CLIENT_MAC_ADDR
,
1195 if (enic
->pp
.set
& ENIC_SET_INSTANCE
) {
1196 sprintf(uuid_str
, "%pUB", enic
->pp
.instance_uuid
);
1197 vic_provinfo_add_tlv(vp
,
1198 VIC_LINUX_PROV_TLV_CLIENT_UUID_STR
,
1199 sizeof(uuid_str
), uuid_str
);
1202 if (enic
->pp
.set
& ENIC_SET_HOST
) {
1203 sprintf(uuid_str
, "%pUB", enic
->pp
.host_uuid
);
1204 vic_provinfo_add_tlv(vp
,
1205 VIC_LINUX_PROV_TLV_HOST_UUID_STR
,
1206 sizeof(uuid_str
), uuid_str
);
1209 err
= enic_dev_init_prov(enic
, vp
);
1210 vic_provinfo_free(vp
);
1215 case PORT_REQUEST_DISASSOCIATE
:
1222 enic
->pp
.set
|= ENIC_SET_APPLIED
;
1226 static int enic_set_vf_port(struct net_device
*netdev
, int vf
,
1227 struct nlattr
*port
[])
1229 struct enic
*enic
= netdev_priv(netdev
);
1231 memset(&enic
->pp
, 0, sizeof(enic
->pp
));
1233 if (port
[IFLA_PORT_REQUEST
]) {
1234 enic
->pp
.set
|= ENIC_SET_REQUEST
;
1235 enic
->pp
.request
= nla_get_u8(port
[IFLA_PORT_REQUEST
]);
1238 if (port
[IFLA_PORT_PROFILE
]) {
1239 enic
->pp
.set
|= ENIC_SET_NAME
;
1240 memcpy(enic
->pp
.name
, nla_data(port
[IFLA_PORT_PROFILE
]),
1244 if (port
[IFLA_PORT_INSTANCE_UUID
]) {
1245 enic
->pp
.set
|= ENIC_SET_INSTANCE
;
1246 memcpy(enic
->pp
.instance_uuid
,
1247 nla_data(port
[IFLA_PORT_INSTANCE_UUID
]), PORT_UUID_MAX
);
1250 if (port
[IFLA_PORT_HOST_UUID
]) {
1251 enic
->pp
.set
|= ENIC_SET_HOST
;
1252 memcpy(enic
->pp
.host_uuid
,
1253 nla_data(port
[IFLA_PORT_HOST_UUID
]), PORT_UUID_MAX
);
1256 /* don't support VFs, yet */
1257 if (vf
!= PORT_SELF_VF
)
1260 if (!(enic
->pp
.set
& ENIC_SET_REQUEST
))
1263 if (enic
->pp
.request
== PORT_REQUEST_ASSOCIATE
) {
1265 /* If the interface mac addr hasn't been assigned,
1266 * assign a random mac addr before setting port-
1270 if (is_zero_ether_addr(netdev
->dev_addr
))
1271 random_ether_addr(netdev
->dev_addr
);
1274 return enic_set_port_profile(enic
, netdev
->dev_addr
);
1277 static int enic_get_vf_port(struct net_device
*netdev
, int vf
,
1278 struct sk_buff
*skb
)
1280 struct enic
*enic
= netdev_priv(netdev
);
1281 int err
, error
, done
;
1282 u16 response
= PORT_PROFILE_RESPONSE_SUCCESS
;
1284 if (!(enic
->pp
.set
& ENIC_SET_APPLIED
))
1287 err
= enic_dev_init_done(enic
, &done
, &error
);
1294 response
= PORT_PROFILE_RESPONSE_INPROGRESS
;
1297 response
= PORT_PROFILE_RESPONSE_INVALID
;
1300 response
= PORT_PROFILE_RESPONSE_BADSTATE
;
1303 response
= PORT_PROFILE_RESPONSE_INSUFFICIENT_RESOURCES
;
1306 response
= PORT_PROFILE_RESPONSE_ERROR
;
1310 NLA_PUT_U16(skb
, IFLA_PORT_REQUEST
, enic
->pp
.request
);
1311 NLA_PUT_U16(skb
, IFLA_PORT_RESPONSE
, response
);
1312 if (enic
->pp
.set
& ENIC_SET_NAME
)
1313 NLA_PUT(skb
, IFLA_PORT_PROFILE
, PORT_PROFILE_MAX
,
1315 if (enic
->pp
.set
& ENIC_SET_INSTANCE
)
1316 NLA_PUT(skb
, IFLA_PORT_INSTANCE_UUID
, PORT_UUID_MAX
,
1317 enic
->pp
.instance_uuid
);
1318 if (enic
->pp
.set
& ENIC_SET_HOST
)
1319 NLA_PUT(skb
, IFLA_PORT_HOST_UUID
, PORT_UUID_MAX
,
1320 enic
->pp
.host_uuid
);
1328 static void enic_free_rq_buf(struct vnic_rq
*rq
, struct vnic_rq_buf
*buf
)
1330 struct enic
*enic
= vnic_dev_priv(rq
->vdev
);
1335 pci_unmap_single(enic
->pdev
, buf
->dma_addr
,
1336 buf
->len
, PCI_DMA_FROMDEVICE
);
1337 dev_kfree_skb_any(buf
->os_buf
);
1340 static int enic_rq_alloc_buf(struct vnic_rq
*rq
)
1342 struct enic
*enic
= vnic_dev_priv(rq
->vdev
);
1343 struct net_device
*netdev
= enic
->netdev
;
1344 struct sk_buff
*skb
;
1345 unsigned int len
= netdev
->mtu
+ VLAN_ETH_HLEN
;
1346 unsigned int os_buf_index
= 0;
1347 dma_addr_t dma_addr
;
1349 skb
= netdev_alloc_skb_ip_align(netdev
, len
);
1353 dma_addr
= pci_map_single(enic
->pdev
, skb
->data
,
1354 len
, PCI_DMA_FROMDEVICE
);
1356 enic_queue_rq_desc(rq
, skb
, os_buf_index
,
1362 static int enic_rq_alloc_buf_a1(struct vnic_rq
*rq
)
1364 struct rq_enet_desc
*desc
= vnic_rq_next_desc(rq
);
1366 if (vnic_rq_posting_soon(rq
)) {
1368 /* SW workaround for A0 HW erratum: if we're just about
1369 * to write posted_index, insert a dummy desc
1373 rq_enet_desc_enc(desc
, 0, RQ_ENET_TYPE_RESV2
, 0);
1374 vnic_rq_post(rq
, 0, 0, 0, 0);
1376 return enic_rq_alloc_buf(rq
);
1382 static int enic_dev_hw_version(struct enic
*enic
,
1383 enum vnic_dev_hw_version
*hw_ver
)
1387 spin_lock(&enic
->devcmd_lock
);
1388 err
= vnic_dev_hw_version(enic
->vdev
, hw_ver
);
1389 spin_unlock(&enic
->devcmd_lock
);
1394 static int enic_set_rq_alloc_buf(struct enic
*enic
)
1396 enum vnic_dev_hw_version hw_ver
;
1399 err
= enic_dev_hw_version(enic
, &hw_ver
);
1404 case VNIC_DEV_HW_VER_A1
:
1405 enic
->rq_alloc_buf
= enic_rq_alloc_buf_a1
;
1407 case VNIC_DEV_HW_VER_A2
:
1408 case VNIC_DEV_HW_VER_UNKNOWN
:
1409 enic
->rq_alloc_buf
= enic_rq_alloc_buf
;
1418 static void enic_rq_indicate_buf(struct vnic_rq
*rq
,
1419 struct cq_desc
*cq_desc
, struct vnic_rq_buf
*buf
,
1420 int skipped
, void *opaque
)
1422 struct enic
*enic
= vnic_dev_priv(rq
->vdev
);
1423 struct net_device
*netdev
= enic
->netdev
;
1424 struct sk_buff
*skb
;
1426 u8 type
, color
, eop
, sop
, ingress_port
, vlan_stripped
;
1427 u8 fcoe
, fcoe_sof
, fcoe_fc_crc_ok
, fcoe_enc_error
, fcoe_eof
;
1428 u8 tcp_udp_csum_ok
, udp
, tcp
, ipv4_csum_ok
;
1429 u8 ipv6
, ipv4
, ipv4_fragment
, fcs_ok
, rss_type
, csum_not_calc
;
1431 u16 q_number
, completed_index
, bytes_written
, vlan_tci
, checksum
;
1438 prefetch(skb
->data
- NET_IP_ALIGN
);
1439 pci_unmap_single(enic
->pdev
, buf
->dma_addr
,
1440 buf
->len
, PCI_DMA_FROMDEVICE
);
1442 cq_enet_rq_desc_dec((struct cq_enet_rq_desc
*)cq_desc
,
1443 &type
, &color
, &q_number
, &completed_index
,
1444 &ingress_port
, &fcoe
, &eop
, &sop
, &rss_type
,
1445 &csum_not_calc
, &rss_hash
, &bytes_written
,
1446 &packet_error
, &vlan_stripped
, &vlan_tci
, &checksum
,
1447 &fcoe_sof
, &fcoe_fc_crc_ok
, &fcoe_enc_error
,
1448 &fcoe_eof
, &tcp_udp_csum_ok
, &udp
, &tcp
,
1449 &ipv4_csum_ok
, &ipv6
, &ipv4
, &ipv4_fragment
,
1455 if (bytes_written
> 0)
1457 else if (bytes_written
== 0)
1458 enic
->rq_truncated_pkts
++;
1461 dev_kfree_skb_any(skb
);
1466 if (eop
&& bytes_written
> 0) {
1471 skb_put(skb
, bytes_written
);
1472 skb
->protocol
= eth_type_trans(skb
, netdev
);
1474 if (enic
->csum_rx_enabled
&& !csum_not_calc
) {
1475 skb
->csum
= htons(checksum
);
1476 skb
->ip_summed
= CHECKSUM_COMPLETE
;
1481 if (enic
->vlan_group
&& vlan_stripped
&&
1482 (vlan_tci
& CQ_ENET_RQ_DESC_VLAN_TCI_VLAN_MASK
)) {
1484 if (netdev
->features
& NETIF_F_GRO
)
1485 vlan_gro_receive(&enic
->napi
[q_number
],
1486 enic
->vlan_group
, vlan_tci
, skb
);
1488 vlan_hwaccel_receive_skb(skb
,
1489 enic
->vlan_group
, vlan_tci
);
1493 if (netdev
->features
& NETIF_F_GRO
)
1494 napi_gro_receive(&enic
->napi
[q_number
], skb
);
1496 netif_receive_skb(skb
);
1504 dev_kfree_skb_any(skb
);
1508 static int enic_rq_service(struct vnic_dev
*vdev
, struct cq_desc
*cq_desc
,
1509 u8 type
, u16 q_number
, u16 completed_index
, void *opaque
)
1511 struct enic
*enic
= vnic_dev_priv(vdev
);
1513 vnic_rq_service(&enic
->rq
[q_number
], cq_desc
,
1514 completed_index
, VNIC_RQ_RETURN_DESC
,
1515 enic_rq_indicate_buf
, opaque
);
1520 static int enic_poll(struct napi_struct
*napi
, int budget
)
1522 struct net_device
*netdev
= napi
->dev
;
1523 struct enic
*enic
= netdev_priv(netdev
);
1524 unsigned int cq_rq
= enic_cq_rq(enic
, 0);
1525 unsigned int cq_wq
= enic_cq_wq(enic
, 0);
1526 unsigned int intr
= enic_legacy_io_intr();
1527 unsigned int rq_work_to_do
= budget
;
1528 unsigned int wq_work_to_do
= -1; /* no limit */
1529 unsigned int work_done
, rq_work_done
, wq_work_done
;
1532 /* Service RQ (first) and WQ
1535 rq_work_done
= vnic_cq_service(&enic
->cq
[cq_rq
],
1536 rq_work_to_do
, enic_rq_service
, NULL
);
1538 wq_work_done
= vnic_cq_service(&enic
->cq
[cq_wq
],
1539 wq_work_to_do
, enic_wq_service
, NULL
);
1541 /* Accumulate intr event credits for this polling
1542 * cycle. An intr event is the completion of a
1543 * a WQ or RQ packet.
1546 work_done
= rq_work_done
+ wq_work_done
;
1549 vnic_intr_return_credits(&enic
->intr
[intr
],
1551 0 /* don't unmask intr */,
1552 0 /* don't reset intr timer */);
1554 err
= vnic_rq_fill(&enic
->rq
[0], enic
->rq_alloc_buf
);
1556 /* Buffer allocation failed. Stay in polling
1557 * mode so we can try to fill the ring again.
1561 rq_work_done
= rq_work_to_do
;
1563 if (rq_work_done
< rq_work_to_do
) {
1565 /* Some work done, but not enough to stay in polling,
1569 napi_complete(napi
);
1570 vnic_intr_unmask(&enic
->intr
[intr
]);
1573 return rq_work_done
;
1576 static int enic_poll_msix(struct napi_struct
*napi
, int budget
)
1578 struct net_device
*netdev
= napi
->dev
;
1579 struct enic
*enic
= netdev_priv(netdev
);
1580 unsigned int rq
= (napi
- &enic
->napi
[0]);
1581 unsigned int cq
= enic_cq_rq(enic
, rq
);
1582 unsigned int intr
= enic_msix_rq_intr(enic
, rq
);
1583 unsigned int work_to_do
= budget
;
1584 unsigned int work_done
;
1590 work_done
= vnic_cq_service(&enic
->cq
[cq
],
1591 work_to_do
, enic_rq_service
, NULL
);
1593 /* Return intr event credits for this polling
1594 * cycle. An intr event is the completion of a
1599 vnic_intr_return_credits(&enic
->intr
[intr
],
1601 0 /* don't unmask intr */,
1602 0 /* don't reset intr timer */);
1604 err
= vnic_rq_fill(&enic
->rq
[rq
], enic
->rq_alloc_buf
);
1606 /* Buffer allocation failed. Stay in polling mode
1607 * so we can try to fill the ring again.
1611 work_done
= work_to_do
;
1613 if (work_done
< work_to_do
) {
1615 /* Some work done, but not enough to stay in polling,
1619 napi_complete(napi
);
1620 vnic_intr_unmask(&enic
->intr
[intr
]);
1626 static void enic_notify_timer(unsigned long data
)
1628 struct enic
*enic
= (struct enic
*)data
;
1630 enic_notify_check(enic
);
1632 mod_timer(&enic
->notify_timer
,
1633 round_jiffies(jiffies
+ ENIC_NOTIFY_TIMER_PERIOD
));
1636 static void enic_free_intr(struct enic
*enic
)
1638 struct net_device
*netdev
= enic
->netdev
;
1641 switch (vnic_dev_get_intr_mode(enic
->vdev
)) {
1642 case VNIC_DEV_INTR_MODE_INTX
:
1643 free_irq(enic
->pdev
->irq
, netdev
);
1645 case VNIC_DEV_INTR_MODE_MSI
:
1646 free_irq(enic
->pdev
->irq
, enic
);
1648 case VNIC_DEV_INTR_MODE_MSIX
:
1649 for (i
= 0; i
< ARRAY_SIZE(enic
->msix
); i
++)
1650 if (enic
->msix
[i
].requested
)
1651 free_irq(enic
->msix_entry
[i
].vector
,
1652 enic
->msix
[i
].devid
);
1659 static int enic_request_intr(struct enic
*enic
)
1661 struct net_device
*netdev
= enic
->netdev
;
1662 unsigned int i
, intr
;
1665 switch (vnic_dev_get_intr_mode(enic
->vdev
)) {
1667 case VNIC_DEV_INTR_MODE_INTX
:
1669 err
= request_irq(enic
->pdev
->irq
, enic_isr_legacy
,
1670 IRQF_SHARED
, netdev
->name
, netdev
);
1673 case VNIC_DEV_INTR_MODE_MSI
:
1675 err
= request_irq(enic
->pdev
->irq
, enic_isr_msi
,
1676 0, netdev
->name
, enic
);
1679 case VNIC_DEV_INTR_MODE_MSIX
:
1681 for (i
= 0; i
< enic
->rq_count
; i
++) {
1682 intr
= enic_msix_rq_intr(enic
, i
);
1683 sprintf(enic
->msix
[intr
].devname
,
1684 "%.11s-rx-%d", netdev
->name
, i
);
1685 enic
->msix
[intr
].isr
= enic_isr_msix_rq
;
1686 enic
->msix
[intr
].devid
= &enic
->napi
[i
];
1689 for (i
= 0; i
< enic
->wq_count
; i
++) {
1690 intr
= enic_msix_wq_intr(enic
, i
);
1691 sprintf(enic
->msix
[intr
].devname
,
1692 "%.11s-tx-%d", netdev
->name
, i
);
1693 enic
->msix
[intr
].isr
= enic_isr_msix_wq
;
1694 enic
->msix
[intr
].devid
= enic
;
1697 intr
= enic_msix_err_intr(enic
);
1698 sprintf(enic
->msix
[intr
].devname
,
1699 "%.11s-err", netdev
->name
);
1700 enic
->msix
[intr
].isr
= enic_isr_msix_err
;
1701 enic
->msix
[intr
].devid
= enic
;
1703 intr
= enic_msix_notify_intr(enic
);
1704 sprintf(enic
->msix
[intr
].devname
,
1705 "%.11s-notify", netdev
->name
);
1706 enic
->msix
[intr
].isr
= enic_isr_msix_notify
;
1707 enic
->msix
[intr
].devid
= enic
;
1709 for (i
= 0; i
< ARRAY_SIZE(enic
->msix
); i
++)
1710 enic
->msix
[i
].requested
= 0;
1712 for (i
= 0; i
< enic
->intr_count
; i
++) {
1713 err
= request_irq(enic
->msix_entry
[i
].vector
,
1714 enic
->msix
[i
].isr
, 0,
1715 enic
->msix
[i
].devname
,
1716 enic
->msix
[i
].devid
);
1718 enic_free_intr(enic
);
1721 enic
->msix
[i
].requested
= 1;
1733 static void enic_synchronize_irqs(struct enic
*enic
)
1737 switch (vnic_dev_get_intr_mode(enic
->vdev
)) {
1738 case VNIC_DEV_INTR_MODE_INTX
:
1739 case VNIC_DEV_INTR_MODE_MSI
:
1740 synchronize_irq(enic
->pdev
->irq
);
1742 case VNIC_DEV_INTR_MODE_MSIX
:
1743 for (i
= 0; i
< enic
->intr_count
; i
++)
1744 synchronize_irq(enic
->msix_entry
[i
].vector
);
1751 static int enic_dev_notify_set(struct enic
*enic
)
1755 spin_lock(&enic
->devcmd_lock
);
1756 switch (vnic_dev_get_intr_mode(enic
->vdev
)) {
1757 case VNIC_DEV_INTR_MODE_INTX
:
1758 err
= vnic_dev_notify_set(enic
->vdev
,
1759 enic_legacy_notify_intr());
1761 case VNIC_DEV_INTR_MODE_MSIX
:
1762 err
= vnic_dev_notify_set(enic
->vdev
,
1763 enic_msix_notify_intr(enic
));
1766 err
= vnic_dev_notify_set(enic
->vdev
, -1 /* no intr */);
1769 spin_unlock(&enic
->devcmd_lock
);
1774 static int enic_dev_notify_unset(struct enic
*enic
)
1778 spin_lock(&enic
->devcmd_lock
);
1779 err
= vnic_dev_notify_unset(enic
->vdev
);
1780 spin_unlock(&enic
->devcmd_lock
);
1785 static int enic_dev_enable(struct enic
*enic
)
1789 spin_lock(&enic
->devcmd_lock
);
1790 err
= vnic_dev_enable_wait(enic
->vdev
);
1791 spin_unlock(&enic
->devcmd_lock
);
1796 static int enic_dev_disable(struct enic
*enic
)
1800 spin_lock(&enic
->devcmd_lock
);
1801 err
= vnic_dev_disable(enic
->vdev
);
1802 spin_unlock(&enic
->devcmd_lock
);
1807 static void enic_notify_timer_start(struct enic
*enic
)
1809 switch (vnic_dev_get_intr_mode(enic
->vdev
)) {
1810 case VNIC_DEV_INTR_MODE_MSI
:
1811 mod_timer(&enic
->notify_timer
, jiffies
);
1814 /* Using intr for notification for INTx/MSI-X */
1819 /* rtnl lock is held, process context */
1820 static int enic_open(struct net_device
*netdev
)
1822 struct enic
*enic
= netdev_priv(netdev
);
1826 err
= enic_request_intr(enic
);
1828 netdev_err(netdev
, "Unable to request irq.\n");
1832 err
= enic_dev_notify_set(enic
);
1835 "Failed to alloc notify buffer, aborting.\n");
1836 goto err_out_free_intr
;
1839 for (i
= 0; i
< enic
->rq_count
; i
++) {
1840 vnic_rq_fill(&enic
->rq
[i
], enic
->rq_alloc_buf
);
1841 /* Need at least one buffer on ring to get going */
1842 if (vnic_rq_desc_used(&enic
->rq
[i
]) == 0) {
1843 netdev_err(netdev
, "Unable to alloc receive buffers\n");
1845 goto err_out_notify_unset
;
1849 for (i
= 0; i
< enic
->wq_count
; i
++)
1850 vnic_wq_enable(&enic
->wq
[i
]);
1851 for (i
= 0; i
< enic
->rq_count
; i
++)
1852 vnic_rq_enable(&enic
->rq
[i
]);
1854 enic_dev_add_station_addr(enic
);
1855 enic_set_multicast_list(netdev
);
1857 netif_wake_queue(netdev
);
1859 for (i
= 0; i
< enic
->rq_count
; i
++)
1860 napi_enable(&enic
->napi
[i
]);
1862 enic_dev_enable(enic
);
1864 for (i
= 0; i
< enic
->intr_count
; i
++)
1865 vnic_intr_unmask(&enic
->intr
[i
]);
1867 enic_notify_timer_start(enic
);
1871 err_out_notify_unset
:
1872 enic_dev_notify_unset(enic
);
1874 enic_free_intr(enic
);
1879 /* rtnl lock is held, process context */
1880 static int enic_stop(struct net_device
*netdev
)
1882 struct enic
*enic
= netdev_priv(netdev
);
1886 for (i
= 0; i
< enic
->intr_count
; i
++) {
1887 vnic_intr_mask(&enic
->intr
[i
]);
1888 (void)vnic_intr_masked(&enic
->intr
[i
]); /* flush write */
1891 enic_synchronize_irqs(enic
);
1893 del_timer_sync(&enic
->notify_timer
);
1895 enic_dev_disable(enic
);
1897 for (i
= 0; i
< enic
->rq_count
; i
++)
1898 napi_disable(&enic
->napi
[i
]);
1900 netif_carrier_off(netdev
);
1901 netif_tx_disable(netdev
);
1902 enic_dev_del_station_addr(enic
);
1904 for (i
= 0; i
< enic
->wq_count
; i
++) {
1905 err
= vnic_wq_disable(&enic
->wq
[i
]);
1909 for (i
= 0; i
< enic
->rq_count
; i
++) {
1910 err
= vnic_rq_disable(&enic
->rq
[i
]);
1915 enic_dev_notify_unset(enic
);
1916 enic_free_intr(enic
);
1918 for (i
= 0; i
< enic
->wq_count
; i
++)
1919 vnic_wq_clean(&enic
->wq
[i
], enic_free_wq_buf
);
1920 for (i
= 0; i
< enic
->rq_count
; i
++)
1921 vnic_rq_clean(&enic
->rq
[i
], enic_free_rq_buf
);
1922 for (i
= 0; i
< enic
->cq_count
; i
++)
1923 vnic_cq_clean(&enic
->cq
[i
]);
1924 for (i
= 0; i
< enic
->intr_count
; i
++)
1925 vnic_intr_clean(&enic
->intr
[i
]);
1930 static int enic_change_mtu(struct net_device
*netdev
, int new_mtu
)
1932 struct enic
*enic
= netdev_priv(netdev
);
1933 int running
= netif_running(netdev
);
1935 if (new_mtu
< ENIC_MIN_MTU
|| new_mtu
> ENIC_MAX_MTU
)
1941 netdev
->mtu
= new_mtu
;
1943 if (netdev
->mtu
> enic
->port_mtu
)
1945 "interface MTU (%d) set higher than port MTU (%d)\n",
1946 netdev
->mtu
, enic
->port_mtu
);
1954 #ifdef CONFIG_NET_POLL_CONTROLLER
1955 static void enic_poll_controller(struct net_device
*netdev
)
1957 struct enic
*enic
= netdev_priv(netdev
);
1958 struct vnic_dev
*vdev
= enic
->vdev
;
1959 unsigned int i
, intr
;
1961 switch (vnic_dev_get_intr_mode(vdev
)) {
1962 case VNIC_DEV_INTR_MODE_MSIX
:
1963 for (i
= 0; i
< enic
->rq_count
; i
++) {
1964 intr
= enic_msix_rq_intr(enic
, i
);
1965 enic_isr_msix_rq(enic
->msix_entry
[intr
].vector
, enic
);
1967 intr
= enic_msix_wq_intr(enic
, i
);
1968 enic_isr_msix_wq(enic
->msix_entry
[intr
].vector
, enic
);
1970 case VNIC_DEV_INTR_MODE_MSI
:
1971 enic_isr_msi(enic
->pdev
->irq
, enic
);
1973 case VNIC_DEV_INTR_MODE_INTX
:
1974 enic_isr_legacy(enic
->pdev
->irq
, netdev
);
1982 static int enic_dev_wait(struct vnic_dev
*vdev
,
1983 int (*start
)(struct vnic_dev
*, int),
1984 int (*finished
)(struct vnic_dev
*, int *),
1991 BUG_ON(in_interrupt());
1993 err
= start(vdev
, arg
);
1997 /* Wait for func to complete...2 seconds max
2000 time
= jiffies
+ (HZ
* 2);
2003 err
= finished(vdev
, &done
);
2010 schedule_timeout_uninterruptible(HZ
/ 10);
2012 } while (time_after(time
, jiffies
));
2017 static int enic_dev_open(struct enic
*enic
)
2021 err
= enic_dev_wait(enic
->vdev
, vnic_dev_open
,
2022 vnic_dev_open_done
, 0);
2024 dev_err(enic_get_dev(enic
), "vNIC device open failed, err %d\n",
2030 static int enic_dev_hang_reset(struct enic
*enic
)
2034 err
= enic_dev_wait(enic
->vdev
, vnic_dev_hang_reset
,
2035 vnic_dev_hang_reset_done
, 0);
2037 netdev_err(enic
->netdev
, "vNIC hang reset failed, err %d\n",
2043 static int enic_set_rsskey(struct enic
*enic
)
2046 union vnic_rss_key
*rss_key_buf_va
= NULL
;
2047 union vnic_rss_key rss_key
= {
2048 .key
[0].b
= {85, 67, 83, 97, 119, 101, 115, 111, 109, 101},
2049 .key
[1].b
= {80, 65, 76, 79, 117, 110, 105, 113, 117, 101},
2050 .key
[2].b
= {76, 73, 78, 85, 88, 114, 111, 99, 107, 115},
2051 .key
[3].b
= {69, 78, 73, 67, 105, 115, 99, 111, 111, 108},
2055 rss_key_buf_va
= pci_alloc_consistent(enic
->pdev
,
2056 sizeof(union vnic_rss_key
), &rss_key_buf_pa
);
2057 if (!rss_key_buf_va
)
2060 memcpy(rss_key_buf_va
, &rss_key
, sizeof(union vnic_rss_key
));
2062 spin_lock(&enic
->devcmd_lock
);
2063 err
= enic_set_rss_key(enic
,
2065 sizeof(union vnic_rss_key
));
2066 spin_unlock(&enic
->devcmd_lock
);
2068 pci_free_consistent(enic
->pdev
, sizeof(union vnic_rss_key
),
2069 rss_key_buf_va
, rss_key_buf_pa
);
2074 static int enic_set_rsscpu(struct enic
*enic
, u8 rss_hash_bits
)
2077 union vnic_rss_cpu
*rss_cpu_buf_va
= NULL
;
2081 rss_cpu_buf_va
= pci_alloc_consistent(enic
->pdev
,
2082 sizeof(union vnic_rss_cpu
), &rss_cpu_buf_pa
);
2083 if (!rss_cpu_buf_va
)
2086 for (i
= 0; i
< (1 << rss_hash_bits
); i
++)
2087 (*rss_cpu_buf_va
).cpu
[i
/4].b
[i
%4] = i
% enic
->rq_count
;
2089 spin_lock(&enic
->devcmd_lock
);
2090 err
= enic_set_rss_cpu(enic
,
2092 sizeof(union vnic_rss_cpu
));
2093 spin_unlock(&enic
->devcmd_lock
);
2095 pci_free_consistent(enic
->pdev
, sizeof(union vnic_rss_cpu
),
2096 rss_cpu_buf_va
, rss_cpu_buf_pa
);
2101 static int enic_set_niccfg(struct enic
*enic
, u8 rss_default_cpu
,
2102 u8 rss_hash_type
, u8 rss_hash_bits
, u8 rss_base_cpu
, u8 rss_enable
)
2104 const u8 tso_ipid_split_en
= 0;
2105 const u8 ig_vlan_strip_en
= 1;
2108 /* Enable VLAN tag stripping.
2111 spin_lock(&enic
->devcmd_lock
);
2112 err
= enic_set_nic_cfg(enic
,
2113 rss_default_cpu
, rss_hash_type
,
2114 rss_hash_bits
, rss_base_cpu
,
2115 rss_enable
, tso_ipid_split_en
,
2117 spin_unlock(&enic
->devcmd_lock
);
2122 static int enic_set_rss_nic_cfg(struct enic
*enic
)
2124 struct device
*dev
= enic_get_dev(enic
);
2125 const u8 rss_default_cpu
= 0;
2126 const u8 rss_hash_type
= NIC_CFG_RSS_HASH_TYPE_IPV4
|
2127 NIC_CFG_RSS_HASH_TYPE_TCP_IPV4
|
2128 NIC_CFG_RSS_HASH_TYPE_IPV6
|
2129 NIC_CFG_RSS_HASH_TYPE_TCP_IPV6
;
2130 const u8 rss_hash_bits
= 7;
2131 const u8 rss_base_cpu
= 0;
2132 u8 rss_enable
= ENIC_SETTING(enic
, RSS
) && (enic
->rq_count
> 1);
2135 if (!enic_set_rsskey(enic
)) {
2136 if (enic_set_rsscpu(enic
, rss_hash_bits
)) {
2138 dev_warn(dev
, "RSS disabled, "
2139 "Failed to set RSS cpu indirection table.");
2143 dev_warn(dev
, "RSS disabled, Failed to set RSS key.\n");
2147 return enic_set_niccfg(enic
, rss_default_cpu
, rss_hash_type
,
2148 rss_hash_bits
, rss_base_cpu
, rss_enable
);
2151 static int enic_dev_hang_notify(struct enic
*enic
)
2155 spin_lock(&enic
->devcmd_lock
);
2156 err
= vnic_dev_hang_notify(enic
->vdev
);
2157 spin_unlock(&enic
->devcmd_lock
);
2162 static int enic_dev_set_ig_vlan_rewrite_mode(struct enic
*enic
)
2166 spin_lock(&enic
->devcmd_lock
);
2167 err
= vnic_dev_set_ig_vlan_rewrite_mode(enic
->vdev
,
2168 IG_VLAN_REWRITE_MODE_PRIORITY_TAG_DEFAULT_VLAN
);
2169 spin_unlock(&enic
->devcmd_lock
);
2174 static void enic_reset(struct work_struct
*work
)
2176 struct enic
*enic
= container_of(work
, struct enic
, reset
);
2178 if (!netif_running(enic
->netdev
))
2183 enic_dev_hang_notify(enic
);
2184 enic_stop(enic
->netdev
);
2185 enic_dev_hang_reset(enic
);
2186 enic_reset_multicast_list(enic
);
2187 enic_init_vnic_resources(enic
);
2188 enic_set_rss_nic_cfg(enic
);
2189 enic_dev_set_ig_vlan_rewrite_mode(enic
);
2190 enic_open(enic
->netdev
);
2195 static int enic_set_intr_mode(struct enic
*enic
)
2197 unsigned int n
= min_t(unsigned int, enic
->rq_count
, ENIC_RQ_MAX
);
2201 /* Set interrupt mode (INTx, MSI, MSI-X) depending
2202 * on system capabilities.
2206 * We need n RQs, m WQs, n+m CQs, and n+m+2 INTRs
2207 * (the second to last INTR is used for WQ/RQ errors)
2208 * (the last INTR is used for notifications)
2211 BUG_ON(ARRAY_SIZE(enic
->msix_entry
) < n
+ m
+ 2);
2212 for (i
= 0; i
< n
+ m
+ 2; i
++)
2213 enic
->msix_entry
[i
].entry
= i
;
2215 /* Use multiple RQs if RSS is enabled
2218 if (ENIC_SETTING(enic
, RSS
) &&
2219 enic
->config
.intr_mode
< 1 &&
2220 enic
->rq_count
>= n
&&
2221 enic
->wq_count
>= m
&&
2222 enic
->cq_count
>= n
+ m
&&
2223 enic
->intr_count
>= n
+ m
+ 2) {
2225 if (!pci_enable_msix(enic
->pdev
, enic
->msix_entry
, n
+ m
+ 2)) {
2229 enic
->cq_count
= n
+ m
;
2230 enic
->intr_count
= n
+ m
+ 2;
2232 vnic_dev_set_intr_mode(enic
->vdev
,
2233 VNIC_DEV_INTR_MODE_MSIX
);
2239 if (enic
->config
.intr_mode
< 1 &&
2240 enic
->rq_count
>= 1 &&
2241 enic
->wq_count
>= m
&&
2242 enic
->cq_count
>= 1 + m
&&
2243 enic
->intr_count
>= 1 + m
+ 2) {
2244 if (!pci_enable_msix(enic
->pdev
, enic
->msix_entry
, 1 + m
+ 2)) {
2248 enic
->cq_count
= 1 + m
;
2249 enic
->intr_count
= 1 + m
+ 2;
2251 vnic_dev_set_intr_mode(enic
->vdev
,
2252 VNIC_DEV_INTR_MODE_MSIX
);
2260 * We need 1 RQ, 1 WQ, 2 CQs, and 1 INTR
2263 if (enic
->config
.intr_mode
< 2 &&
2264 enic
->rq_count
>= 1 &&
2265 enic
->wq_count
>= 1 &&
2266 enic
->cq_count
>= 2 &&
2267 enic
->intr_count
>= 1 &&
2268 !pci_enable_msi(enic
->pdev
)) {
2273 enic
->intr_count
= 1;
2275 vnic_dev_set_intr_mode(enic
->vdev
, VNIC_DEV_INTR_MODE_MSI
);
2282 * We need 1 RQ, 1 WQ, 2 CQs, and 3 INTRs
2283 * (the first INTR is used for WQ/RQ)
2284 * (the second INTR is used for WQ/RQ errors)
2285 * (the last INTR is used for notifications)
2288 if (enic
->config
.intr_mode
< 3 &&
2289 enic
->rq_count
>= 1 &&
2290 enic
->wq_count
>= 1 &&
2291 enic
->cq_count
>= 2 &&
2292 enic
->intr_count
>= 3) {
2297 enic
->intr_count
= 3;
2299 vnic_dev_set_intr_mode(enic
->vdev
, VNIC_DEV_INTR_MODE_INTX
);
2304 vnic_dev_set_intr_mode(enic
->vdev
, VNIC_DEV_INTR_MODE_UNKNOWN
);
2309 static void enic_clear_intr_mode(struct enic
*enic
)
2311 switch (vnic_dev_get_intr_mode(enic
->vdev
)) {
2312 case VNIC_DEV_INTR_MODE_MSIX
:
2313 pci_disable_msix(enic
->pdev
);
2315 case VNIC_DEV_INTR_MODE_MSI
:
2316 pci_disable_msi(enic
->pdev
);
2322 vnic_dev_set_intr_mode(enic
->vdev
, VNIC_DEV_INTR_MODE_UNKNOWN
);
2325 static const struct net_device_ops enic_netdev_dynamic_ops
= {
2326 .ndo_open
= enic_open
,
2327 .ndo_stop
= enic_stop
,
2328 .ndo_start_xmit
= enic_hard_start_xmit
,
2329 .ndo_get_stats
= enic_get_stats
,
2330 .ndo_validate_addr
= eth_validate_addr
,
2331 .ndo_set_multicast_list
= enic_set_multicast_list
,
2332 .ndo_set_mac_address
= enic_set_mac_address_dynamic
,
2333 .ndo_change_mtu
= enic_change_mtu
,
2334 .ndo_vlan_rx_register
= enic_vlan_rx_register
,
2335 .ndo_vlan_rx_add_vid
= enic_vlan_rx_add_vid
,
2336 .ndo_vlan_rx_kill_vid
= enic_vlan_rx_kill_vid
,
2337 .ndo_tx_timeout
= enic_tx_timeout
,
2338 .ndo_set_vf_port
= enic_set_vf_port
,
2339 .ndo_get_vf_port
= enic_get_vf_port
,
2340 #ifdef CONFIG_NET_POLL_CONTROLLER
2341 .ndo_poll_controller
= enic_poll_controller
,
2345 static const struct net_device_ops enic_netdev_ops
= {
2346 .ndo_open
= enic_open
,
2347 .ndo_stop
= enic_stop
,
2348 .ndo_start_xmit
= enic_hard_start_xmit
,
2349 .ndo_get_stats
= enic_get_stats
,
2350 .ndo_validate_addr
= eth_validate_addr
,
2351 .ndo_set_mac_address
= enic_set_mac_address
,
2352 .ndo_set_multicast_list
= enic_set_multicast_list
,
2353 .ndo_change_mtu
= enic_change_mtu
,
2354 .ndo_vlan_rx_register
= enic_vlan_rx_register
,
2355 .ndo_vlan_rx_add_vid
= enic_vlan_rx_add_vid
,
2356 .ndo_vlan_rx_kill_vid
= enic_vlan_rx_kill_vid
,
2357 .ndo_tx_timeout
= enic_tx_timeout
,
2358 #ifdef CONFIG_NET_POLL_CONTROLLER
2359 .ndo_poll_controller
= enic_poll_controller
,
2363 static void enic_dev_deinit(struct enic
*enic
)
2367 for (i
= 0; i
< enic
->rq_count
; i
++)
2368 netif_napi_del(&enic
->napi
[i
]);
2370 enic_free_vnic_resources(enic
);
2371 enic_clear_intr_mode(enic
);
2374 static int enic_dev_init(struct enic
*enic
)
2376 struct device
*dev
= enic_get_dev(enic
);
2377 struct net_device
*netdev
= enic
->netdev
;
2381 /* Get vNIC configuration
2384 err
= enic_get_vnic_config(enic
);
2386 dev_err(dev
, "Get vNIC configuration failed, aborting\n");
2390 /* Get available resource counts
2393 enic_get_res_counts(enic
);
2395 /* Set interrupt mode based on resource counts and system
2399 err
= enic_set_intr_mode(enic
);
2401 dev_err(dev
, "Failed to set intr mode based on resource "
2402 "counts and system capabilities, aborting\n");
2406 /* Allocate and configure vNIC resources
2409 err
= enic_alloc_vnic_resources(enic
);
2411 dev_err(dev
, "Failed to alloc vNIC resources, aborting\n");
2412 goto err_out_free_vnic_resources
;
2415 enic_init_vnic_resources(enic
);
2417 err
= enic_set_rq_alloc_buf(enic
);
2419 dev_err(dev
, "Failed to set RQ buffer allocator, aborting\n");
2420 goto err_out_free_vnic_resources
;
2423 err
= enic_set_rss_nic_cfg(enic
);
2425 dev_err(dev
, "Failed to config nic, aborting\n");
2426 goto err_out_free_vnic_resources
;
2429 err
= enic_dev_set_ig_vlan_rewrite_mode(enic
);
2432 "Failed to set ingress vlan rewrite mode, aborting.\n");
2433 goto err_out_free_vnic_resources
;
2436 switch (vnic_dev_get_intr_mode(enic
->vdev
)) {
2438 netif_napi_add(netdev
, &enic
->napi
[0], enic_poll
, 64);
2440 case VNIC_DEV_INTR_MODE_MSIX
:
2441 for (i
= 0; i
< enic
->rq_count
; i
++)
2442 netif_napi_add(netdev
, &enic
->napi
[i
],
2443 enic_poll_msix
, 64);
2449 err_out_free_vnic_resources
:
2450 enic_clear_intr_mode(enic
);
2451 enic_free_vnic_resources(enic
);
2456 static void enic_iounmap(struct enic
*enic
)
2460 for (i
= 0; i
< ARRAY_SIZE(enic
->bar
); i
++)
2461 if (enic
->bar
[i
].vaddr
)
2462 iounmap(enic
->bar
[i
].vaddr
);
2465 static int __devinit
enic_probe(struct pci_dev
*pdev
,
2466 const struct pci_device_id
*ent
)
2468 struct device
*dev
= &pdev
->dev
;
2469 struct net_device
*netdev
;
2475 /* Allocate net device structure and initialize. Private
2476 * instance data is initialized to zero.
2479 netdev
= alloc_etherdev(sizeof(struct enic
));
2481 pr_err("Etherdev alloc failed, aborting\n");
2485 pci_set_drvdata(pdev
, netdev
);
2487 SET_NETDEV_DEV(netdev
, &pdev
->dev
);
2489 enic
= netdev_priv(netdev
);
2490 enic
->netdev
= netdev
;
2493 /* Setup PCI resources
2496 err
= pci_enable_device_mem(pdev
);
2498 dev_err(dev
, "Cannot enable PCI device, aborting\n");
2499 goto err_out_free_netdev
;
2502 err
= pci_request_regions(pdev
, DRV_NAME
);
2504 dev_err(dev
, "Cannot request PCI regions, aborting\n");
2505 goto err_out_disable_device
;
2508 pci_set_master(pdev
);
2510 /* Query PCI controller on system for DMA addressing
2511 * limitation for the device. Try 40-bit first, and
2515 err
= pci_set_dma_mask(pdev
, DMA_BIT_MASK(40));
2517 err
= pci_set_dma_mask(pdev
, DMA_BIT_MASK(32));
2519 dev_err(dev
, "No usable DMA configuration, aborting\n");
2520 goto err_out_release_regions
;
2522 err
= pci_set_consistent_dma_mask(pdev
, DMA_BIT_MASK(32));
2524 dev_err(dev
, "Unable to obtain %u-bit DMA "
2525 "for consistent allocations, aborting\n", 32);
2526 goto err_out_release_regions
;
2529 err
= pci_set_consistent_dma_mask(pdev
, DMA_BIT_MASK(40));
2531 dev_err(dev
, "Unable to obtain %u-bit DMA "
2532 "for consistent allocations, aborting\n", 40);
2533 goto err_out_release_regions
;
2538 /* Map vNIC resources from BAR0-5
2541 for (i
= 0; i
< ARRAY_SIZE(enic
->bar
); i
++) {
2542 if (!(pci_resource_flags(pdev
, i
) & IORESOURCE_MEM
))
2544 enic
->bar
[i
].len
= pci_resource_len(pdev
, i
);
2545 enic
->bar
[i
].vaddr
= pci_iomap(pdev
, i
, enic
->bar
[i
].len
);
2546 if (!enic
->bar
[i
].vaddr
) {
2547 dev_err(dev
, "Cannot memory-map BAR %d, aborting\n", i
);
2549 goto err_out_iounmap
;
2551 enic
->bar
[i
].bus_addr
= pci_resource_start(pdev
, i
);
2554 /* Register vNIC device
2557 enic
->vdev
= vnic_dev_register(NULL
, enic
, pdev
, enic
->bar
,
2558 ARRAY_SIZE(enic
->bar
));
2560 dev_err(dev
, "vNIC registration failed, aborting\n");
2562 goto err_out_iounmap
;
2565 /* Issue device open to get device in known state
2568 err
= enic_dev_open(enic
);
2570 dev_err(dev
, "vNIC dev open failed, aborting\n");
2571 goto err_out_vnic_unregister
;
2574 /* Issue device init to initialize the vnic-to-switch link.
2575 * We'll start with carrier off and wait for link UP
2576 * notification later to turn on carrier. We don't need
2577 * to wait here for the vnic-to-switch link initialization
2578 * to complete; link UP notification is the indication that
2579 * the process is complete.
2582 netif_carrier_off(netdev
);
2584 /* Do not call dev_init for a dynamic vnic.
2585 * For a dynamic vnic, init_prov_info will be
2586 * called later by an upper layer.
2589 if (!enic_is_dynamic(enic
)) {
2590 err
= vnic_dev_init(enic
->vdev
, 0);
2592 dev_err(dev
, "vNIC dev init failed, aborting\n");
2593 goto err_out_dev_close
;
2597 /* Setup devcmd lock
2600 spin_lock_init(&enic
->devcmd_lock
);
2602 err
= enic_dev_init(enic
);
2604 dev_err(dev
, "Device initialization failed, aborting\n");
2605 goto err_out_dev_close
;
2608 /* Setup notification timer, HW reset task, and wq locks
2611 init_timer(&enic
->notify_timer
);
2612 enic
->notify_timer
.function
= enic_notify_timer
;
2613 enic
->notify_timer
.data
= (unsigned long)enic
;
2615 INIT_WORK(&enic
->reset
, enic_reset
);
2617 for (i
= 0; i
< enic
->wq_count
; i
++)
2618 spin_lock_init(&enic
->wq_lock
[i
]);
2620 /* Register net device
2623 enic
->port_mtu
= enic
->config
.mtu
;
2624 (void)enic_change_mtu(netdev
, enic
->port_mtu
);
2626 err
= enic_set_mac_addr(netdev
, enic
->mac_addr
);
2628 dev_err(dev
, "Invalid MAC address, aborting\n");
2629 goto err_out_dev_deinit
;
2632 enic
->tx_coalesce_usecs
= enic
->config
.intr_timer_usec
;
2633 enic
->rx_coalesce_usecs
= enic
->tx_coalesce_usecs
;
2635 if (enic_is_dynamic(enic
))
2636 netdev
->netdev_ops
= &enic_netdev_dynamic_ops
;
2638 netdev
->netdev_ops
= &enic_netdev_ops
;
2640 netdev
->watchdog_timeo
= 2 * HZ
;
2641 netdev
->ethtool_ops
= &enic_ethtool_ops
;
2643 netdev
->features
|= NETIF_F_HW_VLAN_TX
| NETIF_F_HW_VLAN_RX
;
2644 if (ENIC_SETTING(enic
, LOOP
)) {
2645 netdev
->features
&= ~NETIF_F_HW_VLAN_TX
;
2646 enic
->loop_enable
= 1;
2647 enic
->loop_tag
= enic
->config
.loop_tag
;
2648 dev_info(dev
, "loopback tag=0x%04x\n", enic
->loop_tag
);
2650 if (ENIC_SETTING(enic
, TXCSUM
))
2651 netdev
->features
|= NETIF_F_SG
| NETIF_F_HW_CSUM
;
2652 if (ENIC_SETTING(enic
, TSO
))
2653 netdev
->features
|= NETIF_F_TSO
|
2654 NETIF_F_TSO6
| NETIF_F_TSO_ECN
;
2655 if (ENIC_SETTING(enic
, LRO
))
2656 netdev
->features
|= NETIF_F_GRO
;
2658 netdev
->features
|= NETIF_F_HIGHDMA
;
2660 enic
->csum_rx_enabled
= ENIC_SETTING(enic
, RXCSUM
);
2662 err
= register_netdev(netdev
);
2664 dev_err(dev
, "Cannot register net device, aborting\n");
2665 goto err_out_dev_deinit
;
2671 enic_dev_deinit(enic
);
2673 vnic_dev_close(enic
->vdev
);
2674 err_out_vnic_unregister
:
2675 vnic_dev_unregister(enic
->vdev
);
2678 err_out_release_regions
:
2679 pci_release_regions(pdev
);
2680 err_out_disable_device
:
2681 pci_disable_device(pdev
);
2682 err_out_free_netdev
:
2683 pci_set_drvdata(pdev
, NULL
);
2684 free_netdev(netdev
);
2689 static void __devexit
enic_remove(struct pci_dev
*pdev
)
2691 struct net_device
*netdev
= pci_get_drvdata(pdev
);
2694 struct enic
*enic
= netdev_priv(netdev
);
2696 flush_scheduled_work();
2697 unregister_netdev(netdev
);
2698 enic_dev_deinit(enic
);
2699 vnic_dev_close(enic
->vdev
);
2700 vnic_dev_unregister(enic
->vdev
);
2702 pci_release_regions(pdev
);
2703 pci_disable_device(pdev
);
2704 pci_set_drvdata(pdev
, NULL
);
2705 free_netdev(netdev
);
2709 static struct pci_driver enic_driver
= {
2711 .id_table
= enic_id_table
,
2712 .probe
= enic_probe
,
2713 .remove
= __devexit_p(enic_remove
),
2716 static int __init
enic_init_module(void)
2718 pr_info("%s, ver %s\n", DRV_DESCRIPTION
, DRV_VERSION
);
2720 return pci_register_driver(&enic_driver
);
2723 static void __exit
enic_cleanup_module(void)
2725 pci_unregister_driver(&enic_driver
);
2728 module_init(enic_init_module
);
2729 module_exit(enic_cleanup_module
);