blob: 7cb7f292dfd142861dbd0ec3a4f5dd3810eae2c7 [file] [log] [blame]
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001/*
Chien Tungfa6c87d2009-12-09 15:21:56 -08002 * Copyright (c) 2006 - 2009 Intel Corporation. All rights reserved.
Glenn Streiff3c2d7742008-02-04 20:20:45 -08003 *
4 * This software is available to you under a choice of one of two
5 * licenses. You may choose to be licensed under the terms of the GNU
6 * General Public License (GPL) Version 2, available from the file
7 * COPYING in the main directory of this source tree, or the
8 * OpenIB.org BSD license below:
9 *
10 * Redistribution and use in source and binary forms, with or
11 * without modification, are permitted provided that the following
12 * conditions are met:
13 *
14 * - Redistributions of source code must retain the above
15 * copyright notice, this list of conditions and the following
16 * disclaimer.
17 *
18 * - Redistributions in binary form must reproduce the above
19 * copyright notice, this list of conditions and the following
20 * disclaimer in the documentation and/or other materials
21 * provided with the distribution.
22 *
23 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
24 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
25 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
26 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
27 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
28 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
29 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
30 * SOFTWARE.
31 *
32 */
33
34#include <linux/module.h>
35#include <linux/moduleparam.h>
36#include <linux/netdevice.h>
37#include <linux/etherdevice.h>
38#include <linux/ip.h>
39#include <linux/tcp.h>
40#include <linux/if_arp.h>
41#include <linux/if_vlan.h>
42#include <linux/ethtool.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090043#include <linux/slab.h>
Glenn Streiff3c2d7742008-02-04 20:20:45 -080044#include <net/tcp.h>
45
46#include <net/inet_common.h>
47#include <linux/inet.h>
48
49#include "nes.h"
50
51static struct nic_qp_map nic_qp_mapping_0[] = {
52 {16,0,0,1},{24,4,0,0},{28,8,0,0},{32,12,0,0},
53 {20,2,2,1},{26,6,2,0},{30,10,2,0},{34,14,2,0},
54 {18,1,1,1},{25,5,1,0},{29,9,1,0},{33,13,1,0},
55 {22,3,3,1},{27,7,3,0},{31,11,3,0},{35,15,3,0}
56};
57
58static struct nic_qp_map nic_qp_mapping_1[] = {
59 {18,1,1,1},{25,5,1,0},{29,9,1,0},{33,13,1,0},
60 {22,3,3,1},{27,7,3,0},{31,11,3,0},{35,15,3,0}
61};
62
63static struct nic_qp_map nic_qp_mapping_2[] = {
64 {20,2,2,1},{26,6,2,0},{30,10,2,0},{34,14,2,0}
65};
66
67static struct nic_qp_map nic_qp_mapping_3[] = {
68 {22,3,3,1},{27,7,3,0},{31,11,3,0},{35,15,3,0}
69};
70
71static struct nic_qp_map nic_qp_mapping_4[] = {
72 {28,8,0,0},{32,12,0,0}
73};
74
75static struct nic_qp_map nic_qp_mapping_5[] = {
76 {29,9,1,0},{33,13,1,0}
77};
78
79static struct nic_qp_map nic_qp_mapping_6[] = {
80 {30,10,2,0},{34,14,2,0}
81};
82
83static struct nic_qp_map nic_qp_mapping_7[] = {
84 {31,11,3,0},{35,15,3,0}
85};
86
87static struct nic_qp_map *nic_qp_mapping_per_function[] = {
88 nic_qp_mapping_0, nic_qp_mapping_1, nic_qp_mapping_2, nic_qp_mapping_3,
89 nic_qp_mapping_4, nic_qp_mapping_5, nic_qp_mapping_6, nic_qp_mapping_7
90};
91
92static const u32 default_msg = NETIF_MSG_DRV | NETIF_MSG_PROBE | NETIF_MSG_LINK
93 | NETIF_MSG_IFUP | NETIF_MSG_IFDOWN;
94static int debug = -1;
Vadim Makhervaks7e36d3d2008-10-03 12:21:18 -070095static int nics_per_function = 1;
Glenn Streiff3c2d7742008-02-04 20:20:45 -080096
Glenn Streiff3c2d7742008-02-04 20:20:45 -080097/**
98 * nes_netdev_poll
99 */
100static int nes_netdev_poll(struct napi_struct *napi, int budget)
101{
102 struct nes_vnic *nesvnic = container_of(napi, struct nes_vnic, napi);
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800103 struct nes_device *nesdev = nesvnic->nesdev;
104 struct nes_hw_nic_cq *nescq = &nesvnic->nic_cq;
105
106 nesvnic->budget = budget;
107 nescq->cqes_pending = 0;
108 nescq->rx_cqes_completed = 0;
109 nescq->cqe_allocs_pending = 0;
110 nescq->rx_pkts_indicated = 0;
111
112 nes_nic_ce_handler(nesdev, nescq);
113
114 if (nescq->cqes_pending == 0) {
Ben Hutchings288379f2009-01-19 16:43:59 -0800115 napi_complete(napi);
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800116 /* clear out completed cqes and arm */
117 nes_write32(nesdev->regs+NES_CQE_ALLOC, NES_CQE_ALLOC_NOTIFY_NEXT |
118 nescq->cq_number | (nescq->cqe_allocs_pending << 16));
119 nes_read32(nesdev->regs+NES_CQE_ALLOC);
120 } else {
121 /* clear out completed cqes but don't arm */
122 nes_write32(nesdev->regs+NES_CQE_ALLOC,
123 nescq->cq_number | (nescq->cqe_allocs_pending << 16));
124 nes_debug(NES_DBG_NETDEV, "%s: exiting with work pending\n",
125 nesvnic->netdev->name);
126 }
127 return nescq->rx_pkts_indicated;
128}
129
130
131/**
132 * nes_netdev_open - Activate the network interface; ifconfig
133 * ethx up.
134 */
135static int nes_netdev_open(struct net_device *netdev)
136{
137 u32 macaddr_low;
138 u16 macaddr_high;
139 struct nes_vnic *nesvnic = netdev_priv(netdev);
140 struct nes_device *nesdev = nesvnic->nesdev;
141 int ret;
142 int i;
Glenn Streiff11e07042008-02-15 11:41:27 -0600143 struct nes_vnic *first_nesvnic = NULL;
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800144 u32 nic_active_bit;
145 u32 nic_active;
Glenn Streiff11e07042008-02-15 11:41:27 -0600146 struct list_head *list_pos, *list_temp;
Maciej Sosnowskiea623452010-11-24 17:29:38 +0000147 unsigned long flags;
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800148
149 assert(nesdev != NULL);
150
Glenn Streiff11e07042008-02-15 11:41:27 -0600151 if (nesvnic->netdev_open == 1)
152 return 0;
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800153
154 if (netif_msg_ifup(nesvnic))
155 printk(KERN_INFO PFX "%s: enabling interface\n", netdev->name);
156
157 ret = nes_init_nic_qp(nesdev, netdev);
158 if (ret) {
159 return ret;
160 }
161
162 netif_carrier_off(netdev);
163 netif_stop_queue(netdev);
164
165 if ((!nesvnic->of_device_registered) && (nesvnic->rdma_enabled)) {
166 nesvnic->nesibdev = nes_init_ofa_device(netdev);
167 if (nesvnic->nesibdev == NULL) {
168 printk(KERN_ERR PFX "%s: nesvnic->nesibdev alloc failed", netdev->name);
169 } else {
170 nesvnic->nesibdev->nesvnic = nesvnic;
171 ret = nes_register_ofa_device(nesvnic->nesibdev);
172 if (ret) {
173 printk(KERN_ERR PFX "%s: Unable to register RDMA device, ret = %d\n",
174 netdev->name, ret);
175 }
176 }
177 }
178 /* Set packet filters */
179 nic_active_bit = 1 << nesvnic->nic_index;
180 nic_active = nes_read_indexed(nesdev, NES_IDX_NIC_ACTIVE);
181 nic_active |= nic_active_bit;
182 nes_write_indexed(nesdev, NES_IDX_NIC_ACTIVE, nic_active);
183 nic_active = nes_read_indexed(nesdev, NES_IDX_NIC_MULTICAST_ENABLE);
184 nic_active |= nic_active_bit;
185 nes_write_indexed(nesdev, NES_IDX_NIC_MULTICAST_ENABLE, nic_active);
186 nic_active = nes_read_indexed(nesdev, NES_IDX_NIC_BROADCAST_ON);
187 nic_active |= nic_active_bit;
188 nes_write_indexed(nesdev, NES_IDX_NIC_BROADCAST_ON, nic_active);
189
Glenn Streiff7495ab62008-04-29 13:46:54 -0700190 macaddr_high = ((u16)netdev->dev_addr[0]) << 8;
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800191 macaddr_high += (u16)netdev->dev_addr[1];
Glenn Streiff7495ab62008-04-29 13:46:54 -0700192
193 macaddr_low = ((u32)netdev->dev_addr[2]) << 24;
194 macaddr_low += ((u32)netdev->dev_addr[3]) << 16;
195 macaddr_low += ((u32)netdev->dev_addr[4]) << 8;
196 macaddr_low += (u32)netdev->dev_addr[5];
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800197
198 /* Program the various MAC regs */
199 for (i = 0; i < NES_MAX_PORT_COUNT; i++) {
200 if (nesvnic->qp_nic_index[i] == 0xf) {
201 break;
202 }
203 nes_debug(NES_DBG_NETDEV, "i=%d, perfect filter table index= %d, PERF FILTER LOW"
204 " (Addr:%08X) = %08X, HIGH = %08X.\n",
205 i, nesvnic->qp_nic_index[i],
Vadim Makhervaks7e36d3d2008-10-03 12:21:18 -0700206 NES_IDX_PERFECT_FILTER_LOW+
207 (nesvnic->qp_nic_index[i] * 8),
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800208 macaddr_low,
209 (u32)macaddr_high | NES_MAC_ADDR_VALID |
210 ((((u32)nesvnic->nic_index) << 16)));
211 nes_write_indexed(nesdev,
212 NES_IDX_PERFECT_FILTER_LOW + (nesvnic->qp_nic_index[i] * 8),
213 macaddr_low);
214 nes_write_indexed(nesdev,
215 NES_IDX_PERFECT_FILTER_HIGH + (nesvnic->qp_nic_index[i] * 8),
216 (u32)macaddr_high | NES_MAC_ADDR_VALID |
217 ((((u32)nesvnic->nic_index) << 16)));
218 }
219
220
221 nes_write32(nesdev->regs+NES_CQE_ALLOC, NES_CQE_ALLOC_NOTIFY_NEXT |
222 nesvnic->nic_cq.cq_number);
223 nes_read32(nesdev->regs+NES_CQE_ALLOC);
Glenn Streiff11e07042008-02-15 11:41:27 -0600224 list_for_each_safe(list_pos, list_temp, &nesdev->nesadapter->nesvnic_list[nesdev->mac_index]) {
225 first_nesvnic = container_of(list_pos, struct nes_vnic, list);
226 if (first_nesvnic->netdev_open == 1)
227 break;
228 }
229 if (first_nesvnic->netdev_open == 0) {
230 nes_debug(NES_DBG_INIT, "Setting up MAC interrupt mask.\n");
231 nes_write_indexed(nesdev, NES_IDX_MAC_INT_MASK + (0x200 * nesdev->mac_index),
232 ~(NES_MAC_INT_LINK_STAT_CHG | NES_MAC_INT_XGMII_EXT |
233 NES_MAC_INT_TX_UNDERFLOW | NES_MAC_INT_TX_ERROR));
234 first_nesvnic = nesvnic;
235 }
Faisal Latifcd6860e2010-07-04 00:17:59 +0000236
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800237 if (first_nesvnic->linkup) {
238 /* Enable network packets */
239 nesvnic->linkup = 1;
240 netif_start_queue(netdev);
241 netif_carrier_on(netdev);
242 }
Maciej Sosnowskiea623452010-11-24 17:29:38 +0000243
Maciej Sosnowski843276a2010-11-24 17:29:54 +0000244 spin_lock_irqsave(&nesdev->nesadapter->phy_lock, flags);
245 if (nesdev->nesadapter->phy_type[nesdev->mac_index] == NES_PHY_TYPE_SFP_D) {
246 if (nesdev->link_recheck)
247 cancel_delayed_work(&nesdev->work);
248 nesdev->link_recheck = 1;
249 schedule_delayed_work(&nesdev->work, NES_LINK_RECHECK_DELAY);
250 }
251 spin_unlock_irqrestore(&nesdev->nesadapter->phy_lock, flags);
252
Maciej Sosnowskiea623452010-11-24 17:29:38 +0000253 spin_lock_irqsave(&nesvnic->port_ibevent_lock, flags);
254 if (nesvnic->of_device_registered) {
255 nesdev->nesadapter->send_term_ok = 1;
256 if (nesvnic->linkup == 1) {
257 if (nesdev->iw_status == 0) {
258 nesdev->iw_status = 1;
259 nes_port_ibevent(nesvnic);
260 }
261 } else {
262 nesdev->iw_status = 0;
263 }
264 }
265 spin_unlock_irqrestore(&nesvnic->port_ibevent_lock, flags);
266
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800267 napi_enable(&nesvnic->napi);
268 nesvnic->netdev_open = 1;
269
270 return 0;
271}
272
273
274/**
275 * nes_netdev_stop
276 */
277static int nes_netdev_stop(struct net_device *netdev)
278{
279 struct nes_vnic *nesvnic = netdev_priv(netdev);
280 struct nes_device *nesdev = nesvnic->nesdev;
281 u32 nic_active_mask;
282 u32 nic_active;
Glenn Streiff11e07042008-02-15 11:41:27 -0600283 struct nes_vnic *first_nesvnic = NULL;
284 struct list_head *list_pos, *list_temp;
Maciej Sosnowskiea623452010-11-24 17:29:38 +0000285 unsigned long flags;
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800286
287 nes_debug(NES_DBG_SHUTDOWN, "nesvnic=%p, nesdev=%p, netdev=%p %s\n",
288 nesvnic, nesdev, netdev, netdev->name);
289 if (nesvnic->netdev_open == 0)
290 return 0;
291
292 if (netif_msg_ifdown(nesvnic))
293 printk(KERN_INFO PFX "%s: disabling interface\n", netdev->name);
Maciej Sosnowski52106bd2010-09-01 13:35:35 +0000294 netif_carrier_off(netdev);
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800295
296 /* Disable network packets */
297 napi_disable(&nesvnic->napi);
298 netif_stop_queue(netdev);
Glenn Streiff11e07042008-02-15 11:41:27 -0600299 list_for_each_safe(list_pos, list_temp, &nesdev->nesadapter->nesvnic_list[nesdev->mac_index]) {
300 first_nesvnic = container_of(list_pos, struct nes_vnic, list);
301 if ((first_nesvnic->netdev_open == 1) && (first_nesvnic != nesvnic))
302 break;
303 }
304
Chien Tung068e80d2008-09-26 15:08:10 -0500305 if ((first_nesvnic->netdev_open == 1) && (first_nesvnic != nesvnic) &&
306 (PCI_FUNC(first_nesvnic->nesdev->pcidev->devfn) !=
307 PCI_FUNC(nesvnic->nesdev->pcidev->devfn))) {
308 nes_write_indexed(nesdev, NES_IDX_MAC_INT_MASK+
309 (0x200*nesdev->mac_index), 0xffffffff);
310 nes_write_indexed(first_nesvnic->nesdev,
311 NES_IDX_MAC_INT_MASK+
312 (0x200*first_nesvnic->nesdev->mac_index),
313 ~(NES_MAC_INT_LINK_STAT_CHG | NES_MAC_INT_XGMII_EXT |
314 NES_MAC_INT_TX_UNDERFLOW | NES_MAC_INT_TX_ERROR));
315 } else {
Glenn Streiff11e07042008-02-15 11:41:27 -0600316 nes_write_indexed(nesdev, NES_IDX_MAC_INT_MASK+(0x200*nesdev->mac_index), 0xffffffff);
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800317 }
318
319 nic_active_mask = ~((u32)(1 << nesvnic->nic_index));
320 nes_write_indexed(nesdev, NES_IDX_PERFECT_FILTER_HIGH+
321 (nesvnic->perfect_filter_index*8), 0);
322 nic_active = nes_read_indexed(nesdev, NES_IDX_NIC_ACTIVE);
323 nic_active &= nic_active_mask;
324 nes_write_indexed(nesdev, NES_IDX_NIC_ACTIVE, nic_active);
325 nic_active = nes_read_indexed(nesdev, NES_IDX_NIC_MULTICAST_ALL);
326 nic_active &= nic_active_mask;
327 nes_write_indexed(nesdev, NES_IDX_NIC_MULTICAST_ALL, nic_active);
328 nic_active = nes_read_indexed(nesdev, NES_IDX_NIC_MULTICAST_ENABLE);
329 nic_active &= nic_active_mask;
330 nes_write_indexed(nesdev, NES_IDX_NIC_MULTICAST_ENABLE, nic_active);
331 nic_active = nes_read_indexed(nesdev, NES_IDX_NIC_UNICAST_ALL);
332 nic_active &= nic_active_mask;
333 nes_write_indexed(nesdev, NES_IDX_NIC_UNICAST_ALL, nic_active);
334 nic_active = nes_read_indexed(nesdev, NES_IDX_NIC_BROADCAST_ON);
335 nic_active &= nic_active_mask;
336 nes_write_indexed(nesdev, NES_IDX_NIC_BROADCAST_ON, nic_active);
337
Maciej Sosnowskiea623452010-11-24 17:29:38 +0000338 spin_lock_irqsave(&nesvnic->port_ibevent_lock, flags);
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800339 if (nesvnic->of_device_registered) {
Faisal Latifcd6860e2010-07-04 00:17:59 +0000340 nesdev->nesadapter->send_term_ok = 0;
341 nesdev->iw_status = 0;
Maciej Sosnowskiea623452010-11-24 17:29:38 +0000342 if (nesvnic->linkup == 1)
343 nes_port_ibevent(nesvnic);
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800344 }
Maciej Sosnowskiea623452010-11-24 17:29:38 +0000345 del_timer_sync(&nesvnic->event_timer);
346 nesvnic->event_timer.function = NULL;
347 spin_unlock_irqrestore(&nesvnic->port_ibevent_lock, flags);
348
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800349 nes_destroy_nic_qp(nesvnic);
350
351 nesvnic->netdev_open = 0;
352
353 return 0;
354}
355
356
357/**
358 * nes_nic_send
359 */
360static int nes_nic_send(struct sk_buff *skb, struct net_device *netdev)
361{
362 struct nes_vnic *nesvnic = netdev_priv(netdev);
363 struct nes_device *nesdev = nesvnic->nesdev;
364 struct nes_hw_nic *nesnic = &nesvnic->nic;
365 struct nes_hw_nic_sq_wqe *nic_sqe;
366 struct tcphdr *tcph;
367 __le16 *wqe_fragment_length;
368 u32 wqe_misc;
369 u16 wqe_fragment_index = 1; /* first fragment (0) is used by copy buffer */
370 u16 skb_fragment_index;
371 dma_addr_t bus_address;
372
373 nic_sqe = &nesnic->sq_vbase[nesnic->sq_head];
374 wqe_fragment_length = (__le16 *)&nic_sqe->wqe_words[NES_NIC_SQ_WQE_LENGTH_0_TAG_IDX];
375
376 /* setup the VLAN tag if present */
377 if (vlan_tx_tag_present(skb)) {
378 nes_debug(NES_DBG_NIC_TX, "%s: VLAN packet to send... VLAN = %08X\n",
379 netdev->name, vlan_tx_tag_get(skb));
380 wqe_misc = NES_NIC_SQ_WQE_TAGVALUE_ENABLE;
381 wqe_fragment_length[0] = (__force __le16) vlan_tx_tag_get(skb);
382 } else
383 wqe_misc = 0;
384
385 /* bump past the vlan tag */
386 wqe_fragment_length++;
387 /* wqe_fragment_address = (u64 *)&nic_sqe->wqe_words[NES_NIC_SQ_WQE_FRAG0_LOW_IDX]; */
388
389 if (skb->ip_summed == CHECKSUM_PARTIAL) {
390 tcph = tcp_hdr(skb);
391 if (1) {
392 if (skb_is_gso(skb)) {
393 /* nes_debug(NES_DBG_NIC_TX, "%s: TSO request... seg size = %u\n",
394 netdev->name, skb_is_gso(skb)); */
395 wqe_misc |= NES_NIC_SQ_WQE_LSO_ENABLE |
396 NES_NIC_SQ_WQE_COMPLETION | (u16)skb_is_gso(skb);
397 set_wqe_32bit_value(nic_sqe->wqe_words, NES_NIC_SQ_WQE_LSO_INFO_IDX,
398 ((u32)tcph->doff) |
399 (((u32)(((unsigned char *)tcph) - skb->data)) << 4));
400 } else {
401 wqe_misc |= NES_NIC_SQ_WQE_COMPLETION;
402 }
403 }
404 } else { /* CHECKSUM_HW */
405 wqe_misc |= NES_NIC_SQ_WQE_DISABLE_CHKSUM | NES_NIC_SQ_WQE_COMPLETION;
406 }
407
408 set_wqe_32bit_value(nic_sqe->wqe_words, NES_NIC_SQ_WQE_TOTAL_LENGTH_IDX,
409 skb->len);
410 memcpy(&nesnic->first_frag_vbase[nesnic->sq_head].buffer,
411 skb->data, min(((unsigned int)NES_FIRST_FRAG_SIZE), skb_headlen(skb)));
412 wqe_fragment_length[0] = cpu_to_le16(min(((unsigned int)NES_FIRST_FRAG_SIZE),
413 skb_headlen(skb)));
414 wqe_fragment_length[1] = 0;
415 if (skb_headlen(skb) > NES_FIRST_FRAG_SIZE) {
416 if ((skb_shinfo(skb)->nr_frags + 1) > 4) {
417 nes_debug(NES_DBG_NIC_TX, "%s: Packet with %u fragments not sent, skb_headlen=%u\n",
418 netdev->name, skb_shinfo(skb)->nr_frags + 2, skb_headlen(skb));
419 kfree_skb(skb);
420 nesvnic->tx_sw_dropped++;
421 return NETDEV_TX_LOCKED;
422 }
423 set_bit(nesnic->sq_head, nesnic->first_frag_overflow);
424 bus_address = pci_map_single(nesdev->pcidev, skb->data + NES_FIRST_FRAG_SIZE,
425 skb_headlen(skb) - NES_FIRST_FRAG_SIZE, PCI_DMA_TODEVICE);
426 wqe_fragment_length[wqe_fragment_index++] =
427 cpu_to_le16(skb_headlen(skb) - NES_FIRST_FRAG_SIZE);
428 wqe_fragment_length[wqe_fragment_index] = 0;
429 set_wqe_64bit_value(nic_sqe->wqe_words, NES_NIC_SQ_WQE_FRAG1_LOW_IDX,
430 ((u64)(bus_address)));
431 nesnic->tx_skb[nesnic->sq_head] = skb;
432 }
433
434 if (skb_headlen(skb) == skb->len) {
435 if (skb_headlen(skb) <= NES_FIRST_FRAG_SIZE) {
436 nic_sqe->wqe_words[NES_NIC_SQ_WQE_LENGTH_2_1_IDX] = 0;
Faisal Latif28699752009-03-06 15:12:11 -0800437 nesnic->tx_skb[nesnic->sq_head] = skb;
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800438 }
439 } else {
440 /* Deal with Fragments */
441 nesnic->tx_skb[nesnic->sq_head] = skb;
442 for (skb_fragment_index = 0; skb_fragment_index < skb_shinfo(skb)->nr_frags;
443 skb_fragment_index++) {
Ian Campbellcf383eb2011-08-24 22:28:09 +0000444 skb_frag_t *frag =
445 &skb_shinfo(skb)->frags[skb_fragment_index];
446 bus_address = skb_frag_dma_map(&nesdev->pcidev->dev,
447 frag, 0, frag->size,
Ian Campbell5d6bcdf2011-10-06 11:10:48 +0100448 DMA_TO_DEVICE);
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800449 wqe_fragment_length[wqe_fragment_index] =
450 cpu_to_le16(skb_shinfo(skb)->frags[skb_fragment_index].size);
451 set_wqe_64bit_value(nic_sqe->wqe_words, NES_NIC_SQ_WQE_FRAG0_LOW_IDX+(2*wqe_fragment_index),
452 bus_address);
453 wqe_fragment_index++;
454 if (wqe_fragment_index < 5)
455 wqe_fragment_length[wqe_fragment_index] = 0;
456 }
457 }
458
459 set_wqe_32bit_value(nic_sqe->wqe_words, NES_NIC_SQ_WQE_MISC_IDX, wqe_misc);
460 nesnic->sq_head++;
461 nesnic->sq_head &= nesnic->sq_size - 1;
462
463 return NETDEV_TX_OK;
464}
465
466
467/**
468 * nes_netdev_start_xmit
469 */
470static int nes_netdev_start_xmit(struct sk_buff *skb, struct net_device *netdev)
471{
472 struct nes_vnic *nesvnic = netdev_priv(netdev);
473 struct nes_device *nesdev = nesvnic->nesdev;
474 struct nes_hw_nic *nesnic = &nesvnic->nic;
475 struct nes_hw_nic_sq_wqe *nic_sqe;
476 struct tcphdr *tcph;
477 /* struct udphdr *udph; */
Bob Sharpa06fd262008-09-26 15:08:10 -0500478#define NES_MAX_TSO_FRAGS MAX_SKB_FRAGS
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800479 /* 64K segment plus overflow on each side */
480 dma_addr_t tso_bus_address[NES_MAX_TSO_FRAGS];
481 dma_addr_t bus_address;
482 u32 tso_frag_index;
483 u32 tso_frag_count;
484 u32 tso_wqe_length;
485 u32 curr_tcp_seq;
486 u32 wqe_count=1;
487 u32 send_rc;
488 struct iphdr *iph;
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800489 __le16 *wqe_fragment_length;
490 u32 nr_frags;
491 u32 original_first_length;
Glenn Streiff7495ab62008-04-29 13:46:54 -0700492 /* u64 *wqe_fragment_address; */
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800493 /* first fragment (0) is used by copy buffer */
494 u16 wqe_fragment_index=1;
495 u16 hoffset;
496 u16 nhoffset;
497 u16 wqes_needed;
498 u16 wqes_available;
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800499 u32 wqe_misc;
500
Glenn Streiff7495ab62008-04-29 13:46:54 -0700501 /*
502 * nes_debug(NES_DBG_NIC_TX, "%s Request to tx NIC packet length %u, headlen %u,"
503 * " (%u frags), tso_size=%u\n",
504 * netdev->name, skb->len, skb_headlen(skb),
505 * skb_shinfo(skb)->nr_frags, skb_is_gso(skb));
506 */
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800507
508 if (!netif_carrier_ok(netdev))
509 return NETDEV_TX_OK;
510
511 if (netif_queue_stopped(netdev))
512 return NETDEV_TX_BUSY;
513
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800514 /* Check if SQ is full */
515 if ((((nesnic->sq_tail+(nesnic->sq_size*2))-nesnic->sq_head) & (nesnic->sq_size - 1)) == 1) {
516 if (!netif_queue_stopped(netdev)) {
517 netif_stop_queue(netdev);
518 barrier();
519 if ((((((volatile u16)nesnic->sq_tail)+(nesnic->sq_size*2))-nesnic->sq_head) & (nesnic->sq_size - 1)) != 1) {
520 netif_start_queue(netdev);
521 goto sq_no_longer_full;
522 }
523 }
524 nesvnic->sq_full++;
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800525 return NETDEV_TX_BUSY;
526 }
527
528sq_no_longer_full:
529 nr_frags = skb_shinfo(skb)->nr_frags;
530 if (skb_headlen(skb) > NES_FIRST_FRAG_SIZE) {
531 nr_frags++;
532 }
533 /* Check if too many fragments */
534 if (unlikely((nr_frags > 4))) {
535 if (skb_is_gso(skb)) {
536 nesvnic->segmented_tso_requests++;
537 nesvnic->tso_requests++;
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800538 /* Basically 4 fragments available per WQE with extended fragments */
539 wqes_needed = nr_frags >> 2;
540 wqes_needed += (nr_frags&3)?1:0;
541 wqes_available = (((nesnic->sq_tail+nesnic->sq_size)-nesnic->sq_head) - 1) &
542 (nesnic->sq_size - 1);
543
544 if (unlikely(wqes_needed > wqes_available)) {
545 if (!netif_queue_stopped(netdev)) {
546 netif_stop_queue(netdev);
547 barrier();
548 wqes_available = (((((volatile u16)nesnic->sq_tail)+nesnic->sq_size)-nesnic->sq_head) - 1) &
549 (nesnic->sq_size - 1);
550 if (wqes_needed <= wqes_available) {
551 netif_start_queue(netdev);
552 goto tso_sq_no_longer_full;
553 }
554 }
555 nesvnic->sq_full++;
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800556 nes_debug(NES_DBG_NIC_TX, "%s: HNIC SQ full- TSO request has too many frags!\n",
557 netdev->name);
558 return NETDEV_TX_BUSY;
559 }
560tso_sq_no_longer_full:
561 /* Map all the buffers */
562 for (tso_frag_count=0; tso_frag_count < skb_shinfo(skb)->nr_frags;
563 tso_frag_count++) {
Ian Campbellcf383eb2011-08-24 22:28:09 +0000564 skb_frag_t *frag =
565 &skb_shinfo(skb)->frags[tso_frag_count];
566 tso_bus_address[tso_frag_count] =
567 skb_frag_dma_map(&nesdev->pcidev->dev,
568 frag, 0, frag->size,
Ian Campbell5d6bcdf2011-10-06 11:10:48 +0100569 DMA_TO_DEVICE);
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800570 }
571
572 tso_frag_index = 0;
573 curr_tcp_seq = ntohl(tcp_hdr(skb)->seq);
574 hoffset = skb_transport_header(skb) - skb->data;
575 nhoffset = skb_network_header(skb) - skb->data;
576 original_first_length = hoffset + ((((struct tcphdr *)skb_transport_header(skb))->doff)<<2);
577
578 for (wqe_count=0; wqe_count<((u32)wqes_needed); wqe_count++) {
579 tso_wqe_length = 0;
580 nic_sqe = &nesnic->sq_vbase[nesnic->sq_head];
581 wqe_fragment_length =
582 (__le16 *)&nic_sqe->wqe_words[NES_NIC_SQ_WQE_LENGTH_0_TAG_IDX];
583 /* setup the VLAN tag if present */
584 if (vlan_tx_tag_present(skb)) {
585 nes_debug(NES_DBG_NIC_TX, "%s: VLAN packet to send... VLAN = %08X\n",
586 netdev->name, vlan_tx_tag_get(skb) );
587 wqe_misc = NES_NIC_SQ_WQE_TAGVALUE_ENABLE;
588 wqe_fragment_length[0] = (__force __le16) vlan_tx_tag_get(skb);
589 } else
590 wqe_misc = 0;
591
592 /* bump past the vlan tag */
593 wqe_fragment_length++;
594
595 /* Assumes header totally fits in allocated buffer and is in first fragment */
596 if (original_first_length > NES_FIRST_FRAG_SIZE) {
597 nes_debug(NES_DBG_NIC_TX, "ERROR: SKB header too big, headlen=%u, FIRST_FRAG_SIZE=%u\n",
598 original_first_length, NES_FIRST_FRAG_SIZE);
599 nes_debug(NES_DBG_NIC_TX, "%s Request to tx NIC packet length %u, headlen %u,"
600 " (%u frags), tso_size=%u\n",
601 netdev->name,
602 skb->len, skb_headlen(skb),
603 skb_shinfo(skb)->nr_frags, skb_is_gso(skb));
604 }
605 memcpy(&nesnic->first_frag_vbase[nesnic->sq_head].buffer,
606 skb->data, min(((unsigned int)NES_FIRST_FRAG_SIZE),
607 original_first_length));
608 iph = (struct iphdr *)
609 (&nesnic->first_frag_vbase[nesnic->sq_head].buffer[nhoffset]);
610 tcph = (struct tcphdr *)
611 (&nesnic->first_frag_vbase[nesnic->sq_head].buffer[hoffset]);
612 if ((wqe_count+1)!=(u32)wqes_needed) {
613 tcph->fin = 0;
614 tcph->psh = 0;
615 tcph->rst = 0;
616 tcph->urg = 0;
617 }
618 if (wqe_count) {
619 tcph->syn = 0;
620 }
621 tcph->seq = htonl(curr_tcp_seq);
622 wqe_fragment_length[0] = cpu_to_le16(min(((unsigned int)NES_FIRST_FRAG_SIZE),
623 original_first_length));
624
625 wqe_fragment_index = 1;
626 if ((wqe_count==0) && (skb_headlen(skb) > original_first_length)) {
627 set_bit(nesnic->sq_head, nesnic->first_frag_overflow);
628 bus_address = pci_map_single(nesdev->pcidev, skb->data + original_first_length,
629 skb_headlen(skb) - original_first_length, PCI_DMA_TODEVICE);
630 wqe_fragment_length[wqe_fragment_index++] =
631 cpu_to_le16(skb_headlen(skb) - original_first_length);
632 wqe_fragment_length[wqe_fragment_index] = 0;
633 set_wqe_64bit_value(nic_sqe->wqe_words, NES_NIC_SQ_WQE_FRAG1_LOW_IDX,
634 bus_address);
Chien Tung168ac822008-09-26 15:08:10 -0500635 tso_wqe_length += skb_headlen(skb) -
636 original_first_length;
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800637 }
638 while (wqe_fragment_index < 5) {
639 wqe_fragment_length[wqe_fragment_index] =
640 cpu_to_le16(skb_shinfo(skb)->frags[tso_frag_index].size);
641 set_wqe_64bit_value(nic_sqe->wqe_words, NES_NIC_SQ_WQE_FRAG0_LOW_IDX+(2*wqe_fragment_index),
642 (u64)tso_bus_address[tso_frag_index]);
643 wqe_fragment_index++;
644 tso_wqe_length += skb_shinfo(skb)->frags[tso_frag_index++].size;
645 if (wqe_fragment_index < 5)
646 wqe_fragment_length[wqe_fragment_index] = 0;
647 if (tso_frag_index == tso_frag_count)
648 break;
649 }
650 if ((wqe_count+1) == (u32)wqes_needed) {
651 nesnic->tx_skb[nesnic->sq_head] = skb;
652 } else {
653 nesnic->tx_skb[nesnic->sq_head] = NULL;
654 }
655 wqe_misc |= NES_NIC_SQ_WQE_COMPLETION | (u16)skb_is_gso(skb);
656 if ((tso_wqe_length + original_first_length) > skb_is_gso(skb)) {
657 wqe_misc |= NES_NIC_SQ_WQE_LSO_ENABLE;
658 } else {
659 iph->tot_len = htons(tso_wqe_length + original_first_length - nhoffset);
660 }
661
662 set_wqe_32bit_value(nic_sqe->wqe_words, NES_NIC_SQ_WQE_MISC_IDX,
663 wqe_misc);
664 set_wqe_32bit_value(nic_sqe->wqe_words, NES_NIC_SQ_WQE_LSO_INFO_IDX,
665 ((u32)tcph->doff) | (((u32)hoffset) << 4));
666
667 set_wqe_32bit_value(nic_sqe->wqe_words, NES_NIC_SQ_WQE_TOTAL_LENGTH_IDX,
668 tso_wqe_length + original_first_length);
669 curr_tcp_seq += tso_wqe_length;
670 nesnic->sq_head++;
671 nesnic->sq_head &= nesnic->sq_size-1;
672 }
673 } else {
674 nesvnic->linearized_skbs++;
675 hoffset = skb_transport_header(skb) - skb->data;
676 nhoffset = skb_network_header(skb) - skb->data;
677 skb_linearize(skb);
678 skb_set_transport_header(skb, hoffset);
679 skb_set_network_header(skb, nhoffset);
680 send_rc = nes_nic_send(skb, netdev);
Faisal Latif28699752009-03-06 15:12:11 -0800681 if (send_rc != NETDEV_TX_OK)
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800682 return NETDEV_TX_OK;
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800683 }
684 } else {
685 send_rc = nes_nic_send(skb, netdev);
Faisal Latif28699752009-03-06 15:12:11 -0800686 if (send_rc != NETDEV_TX_OK)
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800687 return NETDEV_TX_OK;
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800688 }
689
690 barrier();
691
692 if (wqe_count)
693 nes_write32(nesdev->regs+NES_WQE_ALLOC,
694 (wqe_count << 24) | (1 << 23) | nesvnic->nic.qp_id);
695
696 netdev->trans_start = jiffies;
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800697
698 return NETDEV_TX_OK;
699}
700
701
702/**
703 * nes_netdev_get_stats
704 */
705static struct net_device_stats *nes_netdev_get_stats(struct net_device *netdev)
706{
707 struct nes_vnic *nesvnic = netdev_priv(netdev);
708 struct nes_device *nesdev = nesvnic->nesdev;
709 u64 u64temp;
710 u32 u32temp;
711
712 u32temp = nes_read_indexed(nesdev,
713 NES_IDX_ENDNODE0_NSTAT_RX_DISCARD + (nesvnic->nic_index*0x200));
714 nesvnic->netstats.rx_dropped += u32temp;
715 nesvnic->endnode_nstat_rx_discard += u32temp;
716
717 u64temp = (u64)nes_read_indexed(nesdev,
718 NES_IDX_ENDNODE0_NSTAT_RX_OCTETS_LO + (nesvnic->nic_index*0x200));
719 u64temp += ((u64)nes_read_indexed(nesdev,
720 NES_IDX_ENDNODE0_NSTAT_RX_OCTETS_HI + (nesvnic->nic_index*0x200))) << 32;
721
722 nesvnic->endnode_nstat_rx_octets += u64temp;
723 nesvnic->netstats.rx_bytes += u64temp;
724
725 u64temp = (u64)nes_read_indexed(nesdev,
726 NES_IDX_ENDNODE0_NSTAT_RX_FRAMES_LO + (nesvnic->nic_index*0x200));
727 u64temp += ((u64)nes_read_indexed(nesdev,
728 NES_IDX_ENDNODE0_NSTAT_RX_FRAMES_HI + (nesvnic->nic_index*0x200))) << 32;
729
730 nesvnic->endnode_nstat_rx_frames += u64temp;
731 nesvnic->netstats.rx_packets += u64temp;
732
733 u64temp = (u64)nes_read_indexed(nesdev,
734 NES_IDX_ENDNODE0_NSTAT_TX_OCTETS_LO + (nesvnic->nic_index*0x200));
735 u64temp += ((u64)nes_read_indexed(nesdev,
736 NES_IDX_ENDNODE0_NSTAT_TX_OCTETS_HI + (nesvnic->nic_index*0x200))) << 32;
737
738 nesvnic->endnode_nstat_tx_octets += u64temp;
739 nesvnic->netstats.tx_bytes += u64temp;
740
741 u64temp = (u64)nes_read_indexed(nesdev,
742 NES_IDX_ENDNODE0_NSTAT_TX_FRAMES_LO + (nesvnic->nic_index*0x200));
743 u64temp += ((u64)nes_read_indexed(nesdev,
744 NES_IDX_ENDNODE0_NSTAT_TX_FRAMES_HI + (nesvnic->nic_index*0x200))) << 32;
745
746 nesvnic->endnode_nstat_tx_frames += u64temp;
747 nesvnic->netstats.tx_packets += u64temp;
748
749 u32temp = nes_read_indexed(nesdev,
750 NES_IDX_MAC_RX_SHORT_FRAMES + (nesvnic->nesdev->mac_index*0x200));
751 nesvnic->netstats.rx_dropped += u32temp;
752 nesvnic->nesdev->mac_rx_errors += u32temp;
753 nesvnic->nesdev->mac_rx_short_frames += u32temp;
754
755 u32temp = nes_read_indexed(nesdev,
756 NES_IDX_MAC_RX_OVERSIZED_FRAMES + (nesvnic->nesdev->mac_index*0x200));
757 nesvnic->netstats.rx_dropped += u32temp;
758 nesvnic->nesdev->mac_rx_errors += u32temp;
759 nesvnic->nesdev->mac_rx_oversized_frames += u32temp;
760
761 u32temp = nes_read_indexed(nesdev,
762 NES_IDX_MAC_RX_JABBER_FRAMES + (nesvnic->nesdev->mac_index*0x200));
763 nesvnic->netstats.rx_dropped += u32temp;
764 nesvnic->nesdev->mac_rx_errors += u32temp;
765 nesvnic->nesdev->mac_rx_jabber_frames += u32temp;
766
767 u32temp = nes_read_indexed(nesdev,
768 NES_IDX_MAC_RX_SYMBOL_ERR_FRAMES + (nesvnic->nesdev->mac_index*0x200));
769 nesvnic->netstats.rx_dropped += u32temp;
770 nesvnic->nesdev->mac_rx_errors += u32temp;
771 nesvnic->nesdev->mac_rx_symbol_err_frames += u32temp;
772
773 u32temp = nes_read_indexed(nesdev,
774 NES_IDX_MAC_RX_LENGTH_ERR_FRAMES + (nesvnic->nesdev->mac_index*0x200));
775 nesvnic->netstats.rx_length_errors += u32temp;
776 nesvnic->nesdev->mac_rx_errors += u32temp;
777
778 u32temp = nes_read_indexed(nesdev,
779 NES_IDX_MAC_RX_CRC_ERR_FRAMES + (nesvnic->nesdev->mac_index*0x200));
780 nesvnic->nesdev->mac_rx_errors += u32temp;
781 nesvnic->nesdev->mac_rx_crc_errors += u32temp;
782 nesvnic->netstats.rx_crc_errors += u32temp;
783
784 u32temp = nes_read_indexed(nesdev,
785 NES_IDX_MAC_TX_ERRORS + (nesvnic->nesdev->mac_index*0x200));
786 nesvnic->nesdev->mac_tx_errors += u32temp;
787 nesvnic->netstats.tx_errors += u32temp;
788
789 return &nesvnic->netstats;
790}
791
792
793/**
794 * nes_netdev_tx_timeout
795 */
796static void nes_netdev_tx_timeout(struct net_device *netdev)
797{
798 struct nes_vnic *nesvnic = netdev_priv(netdev);
799
800 if (netif_msg_timer(nesvnic))
801 nes_debug(NES_DBG_NIC_TX, "%s: tx timeout\n", netdev->name);
802}
803
804
805/**
806 * nes_netdev_set_mac_address
807 */
808static int nes_netdev_set_mac_address(struct net_device *netdev, void *p)
809{
810 struct nes_vnic *nesvnic = netdev_priv(netdev);
811 struct nes_device *nesdev = nesvnic->nesdev;
812 struct sockaddr *mac_addr = p;
813 int i;
814 u32 macaddr_low;
815 u16 macaddr_high;
816
817 if (!is_valid_ether_addr(mac_addr->sa_data))
818 return -EADDRNOTAVAIL;
819
820 memcpy(netdev->dev_addr, mac_addr->sa_data, netdev->addr_len);
Johannes Berge1749612008-10-27 15:59:26 -0700821 printk(PFX "%s: Address length = %d, Address = %pM\n",
822 __func__, netdev->addr_len, mac_addr->sa_data);
Glenn Streiff7495ab62008-04-29 13:46:54 -0700823 macaddr_high = ((u16)netdev->dev_addr[0]) << 8;
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800824 macaddr_high += (u16)netdev->dev_addr[1];
Glenn Streiff7495ab62008-04-29 13:46:54 -0700825 macaddr_low = ((u32)netdev->dev_addr[2]) << 24;
826 macaddr_low += ((u32)netdev->dev_addr[3]) << 16;
827 macaddr_low += ((u32)netdev->dev_addr[4]) << 8;
828 macaddr_low += (u32)netdev->dev_addr[5];
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800829
830 for (i = 0; i < NES_MAX_PORT_COUNT; i++) {
831 if (nesvnic->qp_nic_index[i] == 0xf) {
832 break;
833 }
834 nes_write_indexed(nesdev,
835 NES_IDX_PERFECT_FILTER_LOW + (nesvnic->qp_nic_index[i] * 8),
836 macaddr_low);
837 nes_write_indexed(nesdev,
838 NES_IDX_PERFECT_FILTER_HIGH + (nesvnic->qp_nic_index[i] * 8),
839 (u32)macaddr_high | NES_MAC_ADDR_VALID |
840 ((((u32)nesvnic->nic_index) << 16)));
841 }
842 return 0;
843}
844
845
Jiri Pirkofbf219f2010-02-24 05:11:08 +0000846static void set_allmulti(struct nes_device *nesdev, u32 nic_active_bit)
847{
848 u32 nic_active;
849
850 nic_active = nes_read_indexed(nesdev, NES_IDX_NIC_MULTICAST_ALL);
851 nic_active |= nic_active_bit;
852 nes_write_indexed(nesdev, NES_IDX_NIC_MULTICAST_ALL, nic_active);
853 nic_active = nes_read_indexed(nesdev, NES_IDX_NIC_UNICAST_ALL);
854 nic_active &= ~nic_active_bit;
855 nes_write_indexed(nesdev, NES_IDX_NIC_UNICAST_ALL, nic_active);
856}
857
858#define get_addr(addrs, index) ((addrs) + (index) * ETH_ALEN)
859
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800860/**
861 * nes_netdev_set_multicast_list
862 */
Roland Dreier1a855fbf2008-04-16 21:01:09 -0700863static void nes_netdev_set_multicast_list(struct net_device *netdev)
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800864{
865 struct nes_vnic *nesvnic = netdev_priv(netdev);
866 struct nes_device *nesdev = nesvnic->nesdev;
Vadim Makhervaks7e36d3d2008-10-03 12:21:18 -0700867 struct nes_adapter *nesadapter = nesvnic->nesdev->nesadapter;
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800868 u32 nic_active_bit;
869 u32 nic_active;
870 u32 perfect_filter_register_address;
871 u32 macaddr_low;
872 u16 macaddr_high;
873 u8 mc_all_on = 0;
874 u8 mc_index;
875 int mc_nic_index = -1;
Vadim Makhervaks7e36d3d2008-10-03 12:21:18 -0700876 u8 pft_entries_preallocated = max(nesadapter->adapter_fcn_count *
877 nics_per_function, 4);
878 u8 max_pft_entries_avaiable = NES_PFT_SIZE - pft_entries_preallocated;
879 unsigned long flags;
Jiri Pirkofbf219f2010-02-24 05:11:08 +0000880 int mc_count = netdev_mc_count(netdev);
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800881
Vadim Makhervaks7e36d3d2008-10-03 12:21:18 -0700882 spin_lock_irqsave(&nesadapter->resource_lock, flags);
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800883 nic_active_bit = 1 << nesvnic->nic_index;
884
885 if (netdev->flags & IFF_PROMISC) {
886 nic_active = nes_read_indexed(nesdev, NES_IDX_NIC_MULTICAST_ALL);
887 nic_active |= nic_active_bit;
888 nes_write_indexed(nesdev, NES_IDX_NIC_MULTICAST_ALL, nic_active);
889 nic_active = nes_read_indexed(nesdev, NES_IDX_NIC_UNICAST_ALL);
890 nic_active |= nic_active_bit;
891 nes_write_indexed(nesdev, NES_IDX_NIC_UNICAST_ALL, nic_active);
892 mc_all_on = 1;
Vadim Makhervaks7e36d3d2008-10-03 12:21:18 -0700893 } else if ((netdev->flags & IFF_ALLMULTI) ||
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800894 (nesvnic->nic_index > 3)) {
Jiri Pirkofbf219f2010-02-24 05:11:08 +0000895 set_allmulti(nesdev, nic_active_bit);
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800896 mc_all_on = 1;
897 } else {
898 nic_active = nes_read_indexed(nesdev, NES_IDX_NIC_MULTICAST_ALL);
899 nic_active &= ~nic_active_bit;
900 nes_write_indexed(nesdev, NES_IDX_NIC_MULTICAST_ALL, nic_active);
901 nic_active = nes_read_indexed(nesdev, NES_IDX_NIC_UNICAST_ALL);
902 nic_active &= ~nic_active_bit;
903 nes_write_indexed(nesdev, NES_IDX_NIC_UNICAST_ALL, nic_active);
904 }
905
Lucas De Marchi25985ed2011-03-30 22:57:33 -0300906 nes_debug(NES_DBG_NIC_RX, "Number of MC entries = %d, Promiscuous = %d, All Multicast = %d.\n",
Jiri Pirkofbf219f2010-02-24 05:11:08 +0000907 mc_count, !!(netdev->flags & IFF_PROMISC),
Vadim Makhervaks7e36d3d2008-10-03 12:21:18 -0700908 !!(netdev->flags & IFF_ALLMULTI));
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800909 if (!mc_all_on) {
Jiri Pirkofbf219f2010-02-24 05:11:08 +0000910 char *addrs;
911 int i;
Jiri Pirko22bedad32010-04-01 21:22:57 +0000912 struct netdev_hw_addr *ha;
Jiri Pirkofbf219f2010-02-24 05:11:08 +0000913
914 addrs = kmalloc(ETH_ALEN * mc_count, GFP_ATOMIC);
915 if (!addrs) {
916 set_allmulti(nesdev, nic_active_bit);
917 goto unlock;
918 }
919 i = 0;
Jiri Pirko22bedad32010-04-01 21:22:57 +0000920 netdev_for_each_mc_addr(ha, netdev)
921 memcpy(get_addr(addrs, i++), ha->addr, ETH_ALEN);
Jiri Pirkofbf219f2010-02-24 05:11:08 +0000922
Vadim Makhervaks7e36d3d2008-10-03 12:21:18 -0700923 perfect_filter_register_address = NES_IDX_PERFECT_FILTER_LOW +
924 pft_entries_preallocated * 0x8;
Jiri Pirkofbf219f2010-02-24 05:11:08 +0000925 for (i = 0, mc_index = 0; mc_index < max_pft_entries_avaiable;
926 mc_index++) {
927 while (i < mc_count && nesvnic->mcrq_mcast_filter &&
Vadim Makhervaks7e36d3d2008-10-03 12:21:18 -0700928 ((mc_nic_index = nesvnic->mcrq_mcast_filter(nesvnic,
Jiri Pirkofbf219f2010-02-24 05:11:08 +0000929 get_addr(addrs, i++))) == 0));
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800930 if (mc_nic_index < 0)
931 mc_nic_index = nesvnic->nic_index;
Vadim Makhervaks7e36d3d2008-10-03 12:21:18 -0700932 while (nesadapter->pft_mcast_map[mc_index] < 16 &&
933 nesadapter->pft_mcast_map[mc_index] !=
934 nesvnic->nic_index &&
935 mc_index < max_pft_entries_avaiable) {
936 nes_debug(NES_DBG_NIC_RX,
Joe Perches601d87b2011-01-10 17:42:14 -0800937 "mc_index=%d skipping nic_index=%d, "
938 "used for=%d \n", mc_index,
Vadim Makhervaks7e36d3d2008-10-03 12:21:18 -0700939 nesvnic->nic_index,
940 nesadapter->pft_mcast_map[mc_index]);
941 mc_index++;
942 }
943 if (mc_index >= max_pft_entries_avaiable)
944 break;
Jiri Pirkofbf219f2010-02-24 05:11:08 +0000945 if (i < mc_count) {
946 char *addr = get_addr(addrs, i++);
947
Johannes Berge1749612008-10-27 15:59:26 -0700948 nes_debug(NES_DBG_NIC_RX, "Assigning MC Address %pM to register 0x%04X nic_idx=%d\n",
Jiri Pirkofbf219f2010-02-24 05:11:08 +0000949 addr,
Roland Dreier2bd01c52008-04-23 11:52:18 -0700950 perfect_filter_register_address+(mc_index * 8),
951 mc_nic_index);
Jiri Pirkofbf219f2010-02-24 05:11:08 +0000952 macaddr_high = ((u16) addr[0]) << 8;
953 macaddr_high += (u16) addr[1];
954 macaddr_low = ((u32) addr[2]) << 24;
955 macaddr_low += ((u32) addr[3]) << 16;
956 macaddr_low += ((u32) addr[4]) << 8;
957 macaddr_low += (u32) addr[5];
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800958 nes_write_indexed(nesdev,
959 perfect_filter_register_address+(mc_index * 8),
960 macaddr_low);
961 nes_write_indexed(nesdev,
962 perfect_filter_register_address+4+(mc_index * 8),
963 (u32)macaddr_high | NES_MAC_ADDR_VALID |
964 ((((u32)(1<<mc_nic_index)) << 16)));
Vadim Makhervaks7e36d3d2008-10-03 12:21:18 -0700965 nesadapter->pft_mcast_map[mc_index] =
966 nesvnic->nic_index;
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800967 } else {
968 nes_debug(NES_DBG_NIC_RX, "Clearing MC Address at register 0x%04X\n",
969 perfect_filter_register_address+(mc_index * 8));
970 nes_write_indexed(nesdev,
971 perfect_filter_register_address+4+(mc_index * 8),
972 0);
Vadim Makhervaks7e36d3d2008-10-03 12:21:18 -0700973 nesadapter->pft_mcast_map[mc_index] = 255;
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800974 }
975 }
Jiri Pirkofbf219f2010-02-24 05:11:08 +0000976 kfree(addrs);
Vadim Makhervaks7e36d3d2008-10-03 12:21:18 -0700977 /* PFT is not large enough */
Jiri Pirkofbf219f2010-02-24 05:11:08 +0000978 if (i < mc_count)
979 set_allmulti(nesdev, nic_active_bit);
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800980 }
Vadim Makhervaks7e36d3d2008-10-03 12:21:18 -0700981
Jiri Pirkofbf219f2010-02-24 05:11:08 +0000982unlock:
Vadim Makhervaks7e36d3d2008-10-03 12:21:18 -0700983 spin_unlock_irqrestore(&nesadapter->resource_lock, flags);
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800984}
985
986
987/**
988 * nes_netdev_change_mtu
989 */
Glenn Streiff7495ab62008-04-29 13:46:54 -0700990static int nes_netdev_change_mtu(struct net_device *netdev, int new_mtu)
Glenn Streiff3c2d7742008-02-04 20:20:45 -0800991{
992 struct nes_vnic *nesvnic = netdev_priv(netdev);
Glenn Streiff7495ab62008-04-29 13:46:54 -0700993 struct nes_device *nesdev = nesvnic->nesdev;
994 int ret = 0;
995 u8 jumbomode = 0;
Bob Sharpe0e31af2008-09-26 15:08:10 -0500996 u32 nic_active;
997 u32 nic_active_bit;
998 u32 uc_all_active;
999 u32 mc_all_active;
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001000
Glenn Streiff7495ab62008-04-29 13:46:54 -07001001 if ((new_mtu < ETH_ZLEN) || (new_mtu > max_mtu))
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001002 return -EINVAL;
1003
Glenn Streiff7495ab62008-04-29 13:46:54 -07001004 netdev->mtu = new_mtu;
Chien Tungedd2fd62008-02-15 21:00:36 -06001005 nesvnic->max_frame_size = new_mtu + VLAN_ETH_HLEN;
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001006
1007 if (netdev->mtu > 1500) {
1008 jumbomode=1;
1009 }
Glenn Streiff7495ab62008-04-29 13:46:54 -07001010 nes_nic_init_timer_defaults(nesdev, jumbomode);
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001011
1012 if (netif_running(netdev)) {
Bob Sharpe0e31af2008-09-26 15:08:10 -05001013 nic_active_bit = 1 << nesvnic->nic_index;
1014 mc_all_active = nes_read_indexed(nesdev,
1015 NES_IDX_NIC_MULTICAST_ALL) & nic_active_bit;
1016 uc_all_active = nes_read_indexed(nesdev,
1017 NES_IDX_NIC_UNICAST_ALL) & nic_active_bit;
1018
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001019 nes_netdev_stop(netdev);
1020 nes_netdev_open(netdev);
Bob Sharpe0e31af2008-09-26 15:08:10 -05001021
1022 nic_active = nes_read_indexed(nesdev,
1023 NES_IDX_NIC_MULTICAST_ALL);
1024 nic_active |= mc_all_active;
1025 nes_write_indexed(nesdev, NES_IDX_NIC_MULTICAST_ALL,
1026 nic_active);
1027
1028 nic_active = nes_read_indexed(nesdev, NES_IDX_NIC_UNICAST_ALL);
1029 nic_active |= uc_all_active;
1030 nes_write_indexed(nesdev, NES_IDX_NIC_UNICAST_ALL, nic_active);
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001031 }
1032
1033 return ret;
1034}
1035
Faisal Latif39942a02010-05-21 16:54:57 -05001036
Faisal Latif37dab412008-04-29 13:46:54 -07001037static const char nes_ethtool_stringset[][ETH_GSTRING_LEN] = {
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001038 "Link Change Interrupts",
1039 "Linearized SKBs",
1040 "T/GSO Requests",
1041 "Pause Frames Sent",
1042 "Pause Frames Received",
1043 "Internal Routing Errors",
1044 "SQ SW Dropped SKBs",
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001045 "SQ Full",
1046 "Segmented TSO Requests",
1047 "Rx Symbol Errors",
1048 "Rx Jabber Errors",
1049 "Rx Oversized Frames",
1050 "Rx Short Frames",
Faisal Latif39942a02010-05-21 16:54:57 -05001051 "Rx Length Errors",
1052 "Rx CRC Errors",
1053 "Rx Port Discard",
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001054 "Endnode Rx Discards",
1055 "Endnode Rx Octets",
1056 "Endnode Rx Frames",
1057 "Endnode Tx Octets",
1058 "Endnode Tx Frames",
Faisal Latif39942a02010-05-21 16:54:57 -05001059 "Tx Errors",
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001060 "mh detected",
1061 "mh pauses",
1062 "Retransmission Count",
1063 "CM Connects",
1064 "CM Accepts",
1065 "Disconnects",
1066 "Connected Events",
1067 "Connect Requests",
1068 "CM Rejects",
1069 "ModifyQP Timeouts",
1070 "CreateQPs",
1071 "SW DestroyQPs",
1072 "DestroyQPs",
1073 "CM Closes",
1074 "CM Packets Sent",
1075 "CM Packets Bounced",
1076 "CM Packets Created",
1077 "CM Packets Rcvd",
1078 "CM Packets Dropped",
1079 "CM Packets Retrans",
1080 "CM Listens Created",
1081 "CM Listens Destroyed",
1082 "CM Backlog Drops",
1083 "CM Loopbacks",
1084 "CM Nodes Created",
1085 "CM Nodes Destroyed",
1086 "CM Accel Drops",
1087 "CM Resets Received",
Faisal Latif39942a02010-05-21 16:54:57 -05001088 "Free 4Kpbls",
1089 "Free 256pbls",
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001090 "Timer Inits",
Faisal Latif37dab412008-04-29 13:46:54 -07001091 "LRO aggregated",
1092 "LRO flushed",
1093 "LRO no_desc",
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001094};
Faisal Latif37dab412008-04-29 13:46:54 -07001095#define NES_ETHTOOL_STAT_COUNT ARRAY_SIZE(nes_ethtool_stringset)
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001096
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001097
1098/**
Ben Hutchings15f0a392009-10-01 11:58:24 +00001099 * nes_netdev_get_sset_count
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001100 */
Ben Hutchings15f0a392009-10-01 11:58:24 +00001101static int nes_netdev_get_sset_count(struct net_device *netdev, int stringset)
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001102{
Ben Hutchings15f0a392009-10-01 11:58:24 +00001103 if (stringset == ETH_SS_STATS)
1104 return NES_ETHTOOL_STAT_COUNT;
1105 else
1106 return -EINVAL;
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001107}
1108
1109
1110/**
1111 * nes_netdev_get_strings
1112 */
1113static void nes_netdev_get_strings(struct net_device *netdev, u32 stringset,
1114 u8 *ethtool_strings)
1115{
1116 if (stringset == ETH_SS_STATS)
1117 memcpy(ethtool_strings,
1118 &nes_ethtool_stringset,
1119 sizeof(nes_ethtool_stringset));
1120}
1121
1122
1123/**
1124 * nes_netdev_get_ethtool_stats
1125 */
Faisal Latif39942a02010-05-21 16:54:57 -05001126
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001127static void nes_netdev_get_ethtool_stats(struct net_device *netdev,
1128 struct ethtool_stats *target_ethtool_stats, u64 *target_stat_values)
1129{
1130 u64 u64temp;
1131 struct nes_vnic *nesvnic = netdev_priv(netdev);
1132 struct nes_device *nesdev = nesvnic->nesdev;
Faisal Latif39942a02010-05-21 16:54:57 -05001133 struct nes_adapter *nesadapter = nesdev->nesadapter;
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001134 u32 nic_count;
1135 u32 u32temp;
Faisal Latif28699752009-03-06 15:12:11 -08001136 u32 index = 0;
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001137
1138 target_ethtool_stats->n_stats = NES_ETHTOOL_STAT_COUNT;
Faisal Latif28699752009-03-06 15:12:11 -08001139 target_stat_values[index] = nesvnic->nesdev->link_status_interrupts;
1140 target_stat_values[++index] = nesvnic->linearized_skbs;
1141 target_stat_values[++index] = nesvnic->tso_requests;
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001142
1143 u32temp = nes_read_indexed(nesdev,
1144 NES_IDX_MAC_TX_PAUSE_FRAMES + (nesvnic->nesdev->mac_index*0x200));
1145 nesvnic->nesdev->mac_pause_frames_sent += u32temp;
Faisal Latif28699752009-03-06 15:12:11 -08001146 target_stat_values[++index] = nesvnic->nesdev->mac_pause_frames_sent;
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001147
1148 u32temp = nes_read_indexed(nesdev,
1149 NES_IDX_MAC_RX_PAUSE_FRAMES + (nesvnic->nesdev->mac_index*0x200));
1150 nesvnic->nesdev->mac_pause_frames_received += u32temp;
1151
1152 u32temp = nes_read_indexed(nesdev,
1153 NES_IDX_PORT_RX_DISCARDS + (nesvnic->nesdev->mac_index*0x40));
1154 nesvnic->nesdev->port_rx_discards += u32temp;
1155 nesvnic->netstats.rx_dropped += u32temp;
1156
1157 u32temp = nes_read_indexed(nesdev,
1158 NES_IDX_PORT_TX_DISCARDS + (nesvnic->nesdev->mac_index*0x40));
1159 nesvnic->nesdev->port_tx_discards += u32temp;
1160 nesvnic->netstats.tx_dropped += u32temp;
1161
Faisal Latif39942a02010-05-21 16:54:57 -05001162 u32temp = nes_read_indexed(nesdev,
1163 NES_IDX_MAC_RX_SHORT_FRAMES + (nesvnic->nesdev->mac_index*0x200));
1164 nesvnic->netstats.rx_dropped += u32temp;
1165 nesvnic->nesdev->mac_rx_errors += u32temp;
1166 nesvnic->nesdev->mac_rx_short_frames += u32temp;
1167
1168 u32temp = nes_read_indexed(nesdev,
1169 NES_IDX_MAC_RX_OVERSIZED_FRAMES + (nesvnic->nesdev->mac_index*0x200));
1170 nesvnic->netstats.rx_dropped += u32temp;
1171 nesvnic->nesdev->mac_rx_errors += u32temp;
1172 nesvnic->nesdev->mac_rx_oversized_frames += u32temp;
1173
1174 u32temp = nes_read_indexed(nesdev,
1175 NES_IDX_MAC_RX_JABBER_FRAMES + (nesvnic->nesdev->mac_index*0x200));
1176 nesvnic->netstats.rx_dropped += u32temp;
1177 nesvnic->nesdev->mac_rx_errors += u32temp;
1178 nesvnic->nesdev->mac_rx_jabber_frames += u32temp;
1179
1180 u32temp = nes_read_indexed(nesdev,
1181 NES_IDX_MAC_RX_SYMBOL_ERR_FRAMES + (nesvnic->nesdev->mac_index*0x200));
1182 nesvnic->netstats.rx_dropped += u32temp;
1183 nesvnic->nesdev->mac_rx_errors += u32temp;
1184 nesvnic->nesdev->mac_rx_symbol_err_frames += u32temp;
1185
1186 u32temp = nes_read_indexed(nesdev,
1187 NES_IDX_MAC_RX_LENGTH_ERR_FRAMES + (nesvnic->nesdev->mac_index*0x200));
1188 nesvnic->netstats.rx_length_errors += u32temp;
1189 nesvnic->nesdev->mac_rx_errors += u32temp;
1190
1191 u32temp = nes_read_indexed(nesdev,
1192 NES_IDX_MAC_RX_CRC_ERR_FRAMES + (nesvnic->nesdev->mac_index*0x200));
1193 nesvnic->nesdev->mac_rx_errors += u32temp;
1194 nesvnic->nesdev->mac_rx_crc_errors += u32temp;
1195 nesvnic->netstats.rx_crc_errors += u32temp;
1196
1197 u32temp = nes_read_indexed(nesdev,
1198 NES_IDX_MAC_TX_ERRORS + (nesvnic->nesdev->mac_index*0x200));
1199 nesvnic->nesdev->mac_tx_errors += u32temp;
1200 nesvnic->netstats.tx_errors += u32temp;
1201
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001202 for (nic_count = 0; nic_count < NES_MAX_PORT_COUNT; nic_count++) {
1203 if (nesvnic->qp_nic_index[nic_count] == 0xf)
1204 break;
1205
1206 u32temp = nes_read_indexed(nesdev,
1207 NES_IDX_ENDNODE0_NSTAT_RX_DISCARD +
1208 (nesvnic->qp_nic_index[nic_count]*0x200));
1209 nesvnic->netstats.rx_dropped += u32temp;
1210 nesvnic->endnode_nstat_rx_discard += u32temp;
1211
1212 u64temp = (u64)nes_read_indexed(nesdev,
1213 NES_IDX_ENDNODE0_NSTAT_RX_OCTETS_LO +
1214 (nesvnic->qp_nic_index[nic_count]*0x200));
1215 u64temp += ((u64)nes_read_indexed(nesdev,
1216 NES_IDX_ENDNODE0_NSTAT_RX_OCTETS_HI +
1217 (nesvnic->qp_nic_index[nic_count]*0x200))) << 32;
1218
1219 nesvnic->endnode_nstat_rx_octets += u64temp;
1220 nesvnic->netstats.rx_bytes += u64temp;
1221
1222 u64temp = (u64)nes_read_indexed(nesdev,
1223 NES_IDX_ENDNODE0_NSTAT_RX_FRAMES_LO +
1224 (nesvnic->qp_nic_index[nic_count]*0x200));
1225 u64temp += ((u64)nes_read_indexed(nesdev,
1226 NES_IDX_ENDNODE0_NSTAT_RX_FRAMES_HI +
1227 (nesvnic->qp_nic_index[nic_count]*0x200))) << 32;
1228
1229 nesvnic->endnode_nstat_rx_frames += u64temp;
1230 nesvnic->netstats.rx_packets += u64temp;
1231
1232 u64temp = (u64)nes_read_indexed(nesdev,
1233 NES_IDX_ENDNODE0_NSTAT_TX_OCTETS_LO +
1234 (nesvnic->qp_nic_index[nic_count]*0x200));
1235 u64temp += ((u64)nes_read_indexed(nesdev,
1236 NES_IDX_ENDNODE0_NSTAT_TX_OCTETS_HI +
1237 (nesvnic->qp_nic_index[nic_count]*0x200))) << 32;
1238
1239 nesvnic->endnode_nstat_tx_octets += u64temp;
1240 nesvnic->netstats.tx_bytes += u64temp;
1241
1242 u64temp = (u64)nes_read_indexed(nesdev,
1243 NES_IDX_ENDNODE0_NSTAT_TX_FRAMES_LO +
1244 (nesvnic->qp_nic_index[nic_count]*0x200));
1245 u64temp += ((u64)nes_read_indexed(nesdev,
1246 NES_IDX_ENDNODE0_NSTAT_TX_FRAMES_HI +
1247 (nesvnic->qp_nic_index[nic_count]*0x200))) << 32;
1248
1249 nesvnic->endnode_nstat_tx_frames += u64temp;
1250 nesvnic->netstats.tx_packets += u64temp;
1251
1252 u32temp = nes_read_indexed(nesdev,
1253 NES_IDX_IPV4_TCP_REXMITS + (nesvnic->qp_nic_index[nic_count]*0x200));
1254 nesvnic->endnode_ipv4_tcp_retransmits += u32temp;
1255 }
1256
Faisal Latif28699752009-03-06 15:12:11 -08001257 target_stat_values[++index] = nesvnic->nesdev->mac_pause_frames_received;
1258 target_stat_values[++index] = nesdev->nesadapter->nic_rx_eth_route_err;
1259 target_stat_values[++index] = nesvnic->tx_sw_dropped;
1260 target_stat_values[++index] = nesvnic->sq_full;
1261 target_stat_values[++index] = nesvnic->segmented_tso_requests;
1262 target_stat_values[++index] = nesvnic->nesdev->mac_rx_symbol_err_frames;
1263 target_stat_values[++index] = nesvnic->nesdev->mac_rx_jabber_frames;
1264 target_stat_values[++index] = nesvnic->nesdev->mac_rx_oversized_frames;
1265 target_stat_values[++index] = nesvnic->nesdev->mac_rx_short_frames;
Faisal Latif39942a02010-05-21 16:54:57 -05001266 target_stat_values[++index] = nesvnic->netstats.rx_length_errors;
1267 target_stat_values[++index] = nesvnic->nesdev->mac_rx_crc_errors;
1268 target_stat_values[++index] = nesvnic->nesdev->port_rx_discards;
Faisal Latif28699752009-03-06 15:12:11 -08001269 target_stat_values[++index] = nesvnic->endnode_nstat_rx_discard;
1270 target_stat_values[++index] = nesvnic->endnode_nstat_rx_octets;
1271 target_stat_values[++index] = nesvnic->endnode_nstat_rx_frames;
1272 target_stat_values[++index] = nesvnic->endnode_nstat_tx_octets;
1273 target_stat_values[++index] = nesvnic->endnode_nstat_tx_frames;
Faisal Latif39942a02010-05-21 16:54:57 -05001274 target_stat_values[++index] = nesvnic->nesdev->mac_tx_errors;
Faisal Latif28699752009-03-06 15:12:11 -08001275 target_stat_values[++index] = mh_detected;
1276 target_stat_values[++index] = mh_pauses_sent;
1277 target_stat_values[++index] = nesvnic->endnode_ipv4_tcp_retransmits;
1278 target_stat_values[++index] = atomic_read(&cm_connects);
1279 target_stat_values[++index] = atomic_read(&cm_accepts);
1280 target_stat_values[++index] = atomic_read(&cm_disconnects);
1281 target_stat_values[++index] = atomic_read(&cm_connecteds);
1282 target_stat_values[++index] = atomic_read(&cm_connect_reqs);
1283 target_stat_values[++index] = atomic_read(&cm_rejects);
1284 target_stat_values[++index] = atomic_read(&mod_qp_timouts);
1285 target_stat_values[++index] = atomic_read(&qps_created);
1286 target_stat_values[++index] = atomic_read(&sw_qps_destroyed);
1287 target_stat_values[++index] = atomic_read(&qps_destroyed);
1288 target_stat_values[++index] = atomic_read(&cm_closes);
1289 target_stat_values[++index] = cm_packets_sent;
1290 target_stat_values[++index] = cm_packets_bounced;
1291 target_stat_values[++index] = cm_packets_created;
1292 target_stat_values[++index] = cm_packets_received;
1293 target_stat_values[++index] = cm_packets_dropped;
1294 target_stat_values[++index] = cm_packets_retrans;
Faisal Latif6e10d2e2010-02-12 19:55:03 +00001295 target_stat_values[++index] = atomic_read(&cm_listens_created);
1296 target_stat_values[++index] = atomic_read(&cm_listens_destroyed);
Faisal Latif28699752009-03-06 15:12:11 -08001297 target_stat_values[++index] = cm_backlog_drops;
1298 target_stat_values[++index] = atomic_read(&cm_loopbacks);
1299 target_stat_values[++index] = atomic_read(&cm_nodes_created);
1300 target_stat_values[++index] = atomic_read(&cm_nodes_destroyed);
1301 target_stat_values[++index] = atomic_read(&cm_accel_dropped_pkts);
1302 target_stat_values[++index] = atomic_read(&cm_resets_recvd);
Faisal Latif39942a02010-05-21 16:54:57 -05001303 target_stat_values[++index] = nesadapter->free_4kpbl;
1304 target_stat_values[++index] = nesadapter->free_256pbl;
Faisal Latif28699752009-03-06 15:12:11 -08001305 target_stat_values[++index] = int_mod_timer_init;
Faisal Latif28699752009-03-06 15:12:11 -08001306 target_stat_values[++index] = nesvnic->lro_mgr.stats.aggregated;
1307 target_stat_values[++index] = nesvnic->lro_mgr.stats.flushed;
1308 target_stat_values[++index] = nesvnic->lro_mgr.stats.no_desc;
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001309}
1310
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001311/**
1312 * nes_netdev_get_drvinfo
1313 */
1314static void nes_netdev_get_drvinfo(struct net_device *netdev,
1315 struct ethtool_drvinfo *drvinfo)
1316{
1317 struct nes_vnic *nesvnic = netdev_priv(netdev);
Chien Tung0c93ae32008-09-26 15:08:10 -05001318 struct nes_adapter *nesadapter = nesvnic->nesdev->nesadapter;
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001319
1320 strcpy(drvinfo->driver, DRV_NAME);
1321 strcpy(drvinfo->bus_info, pci_name(nesvnic->nesdev->pcidev));
Chien Tung0c93ae32008-09-26 15:08:10 -05001322 sprintf(drvinfo->fw_version, "%u.%u", nesadapter->firmware_version>>16,
1323 nesadapter->firmware_version & 0x000000ff);
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001324 strcpy(drvinfo->version, DRV_VERSION);
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001325 drvinfo->testinfo_len = 0;
1326 drvinfo->eedump_len = 0;
1327 drvinfo->regdump_len = 0;
1328}
1329
1330
1331/**
1332 * nes_netdev_set_coalesce
1333 */
1334static int nes_netdev_set_coalesce(struct net_device *netdev,
1335 struct ethtool_coalesce *et_coalesce)
1336{
1337 struct nes_vnic *nesvnic = netdev_priv(netdev);
Glenn Streiff7495ab62008-04-29 13:46:54 -07001338 struct nes_device *nesdev = nesvnic->nesdev;
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001339 struct nes_adapter *nesadapter = nesdev->nesadapter;
1340 struct nes_hw_tune_timer *shared_timer = &nesadapter->tune_timer;
1341 unsigned long flags;
1342
Glenn Streiff7495ab62008-04-29 13:46:54 -07001343 spin_lock_irqsave(&nesadapter->periodic_timer_lock, flags);
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001344 if (et_coalesce->rx_max_coalesced_frames_low) {
Glenn Streiff7495ab62008-04-29 13:46:54 -07001345 shared_timer->threshold_low = et_coalesce->rx_max_coalesced_frames_low;
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001346 }
1347 if (et_coalesce->rx_max_coalesced_frames_irq) {
1348 shared_timer->threshold_target = et_coalesce->rx_max_coalesced_frames_irq;
1349 }
1350 if (et_coalesce->rx_max_coalesced_frames_high) {
1351 shared_timer->threshold_high = et_coalesce->rx_max_coalesced_frames_high;
1352 }
1353 if (et_coalesce->rx_coalesce_usecs_low) {
1354 shared_timer->timer_in_use_min = et_coalesce->rx_coalesce_usecs_low;
1355 }
1356 if (et_coalesce->rx_coalesce_usecs_high) {
1357 shared_timer->timer_in_use_max = et_coalesce->rx_coalesce_usecs_high;
1358 }
1359 spin_unlock_irqrestore(&nesadapter->periodic_timer_lock, flags);
1360
1361 /* using this to drive total interrupt moderation */
1362 nesadapter->et_rx_coalesce_usecs_irq = et_coalesce->rx_coalesce_usecs_irq;
1363 if (et_coalesce->use_adaptive_rx_coalesce) {
1364 nesadapter->et_use_adaptive_rx_coalesce = 1;
Glenn Streiff7495ab62008-04-29 13:46:54 -07001365 nesadapter->timer_int_limit = NES_TIMER_INT_LIMIT_DYNAMIC;
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001366 nesadapter->et_rx_coalesce_usecs_irq = 0;
1367 if (et_coalesce->pkt_rate_low) {
Glenn Streiff7495ab62008-04-29 13:46:54 -07001368 nesadapter->et_pkt_rate_low = et_coalesce->pkt_rate_low;
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001369 }
1370 } else {
1371 nesadapter->et_use_adaptive_rx_coalesce = 0;
Glenn Streiff7495ab62008-04-29 13:46:54 -07001372 nesadapter->timer_int_limit = NES_TIMER_INT_LIMIT;
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001373 if (nesadapter->et_rx_coalesce_usecs_irq) {
1374 nes_write32(nesdev->regs+NES_PERIODIC_CONTROL,
1375 0x80000000 | ((u32)(nesadapter->et_rx_coalesce_usecs_irq*8)));
1376 }
1377 }
1378 return 0;
1379}
1380
1381
1382/**
1383 * nes_netdev_get_coalesce
1384 */
1385static int nes_netdev_get_coalesce(struct net_device *netdev,
1386 struct ethtool_coalesce *et_coalesce)
1387{
1388 struct nes_vnic *nesvnic = netdev_priv(netdev);
Glenn Streiff7495ab62008-04-29 13:46:54 -07001389 struct nes_device *nesdev = nesvnic->nesdev;
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001390 struct nes_adapter *nesadapter = nesdev->nesadapter;
1391 struct ethtool_coalesce temp_et_coalesce;
1392 struct nes_hw_tune_timer *shared_timer = &nesadapter->tune_timer;
1393 unsigned long flags;
1394
1395 memset(&temp_et_coalesce, 0, sizeof(temp_et_coalesce));
Glenn Streiff7495ab62008-04-29 13:46:54 -07001396 temp_et_coalesce.rx_coalesce_usecs_irq = nesadapter->et_rx_coalesce_usecs_irq;
1397 temp_et_coalesce.use_adaptive_rx_coalesce = nesadapter->et_use_adaptive_rx_coalesce;
1398 temp_et_coalesce.rate_sample_interval = nesadapter->et_rate_sample_interval;
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001399 temp_et_coalesce.pkt_rate_low = nesadapter->et_pkt_rate_low;
1400 spin_lock_irqsave(&nesadapter->periodic_timer_lock, flags);
Glenn Streiff7495ab62008-04-29 13:46:54 -07001401 temp_et_coalesce.rx_max_coalesced_frames_low = shared_timer->threshold_low;
1402 temp_et_coalesce.rx_max_coalesced_frames_irq = shared_timer->threshold_target;
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001403 temp_et_coalesce.rx_max_coalesced_frames_high = shared_timer->threshold_high;
Glenn Streiff7495ab62008-04-29 13:46:54 -07001404 temp_et_coalesce.rx_coalesce_usecs_low = shared_timer->timer_in_use_min;
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001405 temp_et_coalesce.rx_coalesce_usecs_high = shared_timer->timer_in_use_max;
1406 if (nesadapter->et_use_adaptive_rx_coalesce) {
1407 temp_et_coalesce.rx_coalesce_usecs_irq = shared_timer->timer_in_use;
1408 }
1409 spin_unlock_irqrestore(&nesadapter->periodic_timer_lock, flags);
Glenn Streiff7495ab62008-04-29 13:46:54 -07001410 memcpy(et_coalesce, &temp_et_coalesce, sizeof(*et_coalesce));
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001411 return 0;
1412}
1413
1414
1415/**
1416 * nes_netdev_get_pauseparam
1417 */
1418static void nes_netdev_get_pauseparam(struct net_device *netdev,
1419 struct ethtool_pauseparam *et_pauseparam)
1420{
1421 struct nes_vnic *nesvnic = netdev_priv(netdev);
1422
1423 et_pauseparam->autoneg = 0;
1424 et_pauseparam->rx_pause = (nesvnic->nesdev->disable_rx_flow_control == 0) ? 1:0;
1425 et_pauseparam->tx_pause = (nesvnic->nesdev->disable_tx_flow_control == 0) ? 1:0;
1426}
1427
1428
1429/**
1430 * nes_netdev_set_pauseparam
1431 */
1432static int nes_netdev_set_pauseparam(struct net_device *netdev,
1433 struct ethtool_pauseparam *et_pauseparam)
1434{
1435 struct nes_vnic *nesvnic = netdev_priv(netdev);
1436 struct nes_device *nesdev = nesvnic->nesdev;
1437 u32 u32temp;
1438
1439 if (et_pauseparam->autoneg) {
1440 /* TODO: should return unsupported */
1441 return 0;
1442 }
1443 if ((et_pauseparam->tx_pause == 1) && (nesdev->disable_tx_flow_control == 1)) {
1444 u32temp = nes_read_indexed(nesdev,
1445 NES_IDX_MAC_TX_CONFIG + (nesdev->mac_index*0x200));
1446 u32temp |= NES_IDX_MAC_TX_CONFIG_ENABLE_PAUSE;
1447 nes_write_indexed(nesdev,
Chien Tung70c9db02010-09-07 16:31:20 +00001448 NES_IDX_MAC_TX_CONFIG + (nesdev->mac_index*0x200), u32temp);
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001449 nesdev->disable_tx_flow_control = 0;
1450 } else if ((et_pauseparam->tx_pause == 0) && (nesdev->disable_tx_flow_control == 0)) {
1451 u32temp = nes_read_indexed(nesdev,
1452 NES_IDX_MAC_TX_CONFIG + (nesdev->mac_index*0x200));
1453 u32temp &= ~NES_IDX_MAC_TX_CONFIG_ENABLE_PAUSE;
1454 nes_write_indexed(nesdev,
Chien Tung70c9db02010-09-07 16:31:20 +00001455 NES_IDX_MAC_TX_CONFIG + (nesdev->mac_index*0x200), u32temp);
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001456 nesdev->disable_tx_flow_control = 1;
1457 }
1458 if ((et_pauseparam->rx_pause == 1) && (nesdev->disable_rx_flow_control == 1)) {
1459 u32temp = nes_read_indexed(nesdev,
1460 NES_IDX_MPP_DEBUG + (nesdev->mac_index*0x40));
1461 u32temp &= ~NES_IDX_MPP_DEBUG_PORT_DISABLE_PAUSE;
1462 nes_write_indexed(nesdev,
1463 NES_IDX_MPP_DEBUG + (nesdev->mac_index*0x40), u32temp);
1464 nesdev->disable_rx_flow_control = 0;
1465 } else if ((et_pauseparam->rx_pause == 0) && (nesdev->disable_rx_flow_control == 0)) {
1466 u32temp = nes_read_indexed(nesdev,
1467 NES_IDX_MPP_DEBUG + (nesdev->mac_index*0x40));
1468 u32temp |= NES_IDX_MPP_DEBUG_PORT_DISABLE_PAUSE;
1469 nes_write_indexed(nesdev,
1470 NES_IDX_MPP_DEBUG + (nesdev->mac_index*0x40), u32temp);
1471 nesdev->disable_rx_flow_control = 1;
1472 }
1473
1474 return 0;
1475}
1476
1477
1478/**
1479 * nes_netdev_get_settings
1480 */
1481static int nes_netdev_get_settings(struct net_device *netdev, struct ethtool_cmd *et_cmd)
1482{
1483 struct nes_vnic *nesvnic = netdev_priv(netdev);
1484 struct nes_device *nesdev = nesvnic->nesdev;
1485 struct nes_adapter *nesadapter = nesdev->nesadapter;
Chien Tung43035652009-04-08 14:27:56 -07001486 u32 mac_index = nesdev->mac_index;
1487 u8 phy_type = nesadapter->phy_type[mac_index];
1488 u8 phy_index = nesadapter->phy_index[mac_index];
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001489 u16 phy_data;
1490
1491 et_cmd->duplex = DUPLEX_FULL;
Glenn Streiff7495ab62008-04-29 13:46:54 -07001492 et_cmd->port = PORT_MII;
Chien Tung43035652009-04-08 14:27:56 -07001493 et_cmd->maxtxpkt = 511;
1494 et_cmd->maxrxpkt = 511;
Eric Schneider0e1de5d2008-04-29 13:46:54 -07001495
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001496 if (nesadapter->OneG_Mode) {
David Decotigny70739492011-04-27 18:32:40 +00001497 ethtool_cmd_speed_set(et_cmd, SPEED_1000);
Chien Tung43035652009-04-08 14:27:56 -07001498 if (phy_type == NES_PHY_TYPE_PUMA_1G) {
Eric Schneider0e1de5d2008-04-29 13:46:54 -07001499 et_cmd->supported = SUPPORTED_1000baseT_Full;
1500 et_cmd->advertising = ADVERTISED_1000baseT_Full;
1501 et_cmd->autoneg = AUTONEG_DISABLE;
1502 et_cmd->transceiver = XCVR_INTERNAL;
Chien Tung43035652009-04-08 14:27:56 -07001503 et_cmd->phy_address = mac_index;
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001504 } else {
Chien Tungce6e74f2010-03-09 21:50:40 +00001505 unsigned long flags;
Chien Tung43035652009-04-08 14:27:56 -07001506 et_cmd->supported = SUPPORTED_1000baseT_Full
1507 | SUPPORTED_Autoneg;
1508 et_cmd->advertising = ADVERTISED_1000baseT_Full
1509 | ADVERTISED_Autoneg;
Chien Tungce6e74f2010-03-09 21:50:40 +00001510 spin_lock_irqsave(&nesadapter->phy_lock, flags);
Chien Tung43035652009-04-08 14:27:56 -07001511 nes_read_1G_phy_reg(nesdev, 0, phy_index, &phy_data);
Chien Tungce6e74f2010-03-09 21:50:40 +00001512 spin_unlock_irqrestore(&nesadapter->phy_lock, flags);
Eric Schneider0e1de5d2008-04-29 13:46:54 -07001513 if (phy_data & 0x1000)
1514 et_cmd->autoneg = AUTONEG_ENABLE;
1515 else
1516 et_cmd->autoneg = AUTONEG_DISABLE;
1517 et_cmd->transceiver = XCVR_EXTERNAL;
Chien Tung43035652009-04-08 14:27:56 -07001518 et_cmd->phy_address = phy_index;
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001519 }
Chien Tung43035652009-04-08 14:27:56 -07001520 return 0;
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001521 }
Chien Tung09124e12010-02-23 17:52:10 +00001522 if ((phy_type == NES_PHY_TYPE_ARGUS) ||
1523 (phy_type == NES_PHY_TYPE_SFP_D) ||
1524 (phy_type == NES_PHY_TYPE_KR)) {
Chien Tung43035652009-04-08 14:27:56 -07001525 et_cmd->transceiver = XCVR_EXTERNAL;
1526 et_cmd->port = PORT_FIBRE;
1527 et_cmd->supported = SUPPORTED_FIBRE;
1528 et_cmd->advertising = ADVERTISED_FIBRE;
1529 et_cmd->phy_address = phy_index;
1530 } else {
1531 et_cmd->transceiver = XCVR_INTERNAL;
1532 et_cmd->supported = SUPPORTED_10000baseT_Full;
1533 et_cmd->advertising = ADVERTISED_10000baseT_Full;
1534 et_cmd->phy_address = mac_index;
1535 }
David Decotigny70739492011-04-27 18:32:40 +00001536 ethtool_cmd_speed_set(et_cmd, SPEED_10000);
Chien Tung43035652009-04-08 14:27:56 -07001537 et_cmd->autoneg = AUTONEG_DISABLE;
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001538 return 0;
1539}
1540
1541
1542/**
1543 * nes_netdev_set_settings
1544 */
1545static int nes_netdev_set_settings(struct net_device *netdev, struct ethtool_cmd *et_cmd)
1546{
1547 struct nes_vnic *nesvnic = netdev_priv(netdev);
1548 struct nes_device *nesdev = nesvnic->nesdev;
1549 struct nes_adapter *nesadapter = nesdev->nesadapter;
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001550
Eric Schneider0e1de5d2008-04-29 13:46:54 -07001551 if ((nesadapter->OneG_Mode) &&
1552 (nesadapter->phy_type[nesdev->mac_index] != NES_PHY_TYPE_PUMA_1G)) {
Chien Tungce6e74f2010-03-09 21:50:40 +00001553 unsigned long flags;
1554 u16 phy_data;
1555 u8 phy_index = nesadapter->phy_index[nesdev->mac_index];
1556
1557 spin_lock_irqsave(&nesadapter->phy_lock, flags);
1558 nes_read_1G_phy_reg(nesdev, 0, phy_index, &phy_data);
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001559 if (et_cmd->autoneg) {
1560 /* Turn on Full duplex, Autoneg, and restart autonegotiation */
1561 phy_data |= 0x1300;
1562 } else {
Glenn Streiff7495ab62008-04-29 13:46:54 -07001563 /* Turn off autoneg */
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001564 phy_data &= ~0x1000;
1565 }
Chien Tungce6e74f2010-03-09 21:50:40 +00001566 nes_write_1G_phy_reg(nesdev, 0, phy_index, phy_data);
1567 spin_unlock_irqrestore(&nesadapter->phy_lock, flags);
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001568 }
1569
1570 return 0;
1571}
1572
1573
Stephen Hemminger0fc0b732009-09-02 01:03:33 -07001574static const struct ethtool_ops nes_ethtool_ops = {
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001575 .get_link = ethtool_op_get_link,
1576 .get_settings = nes_netdev_get_settings,
1577 .set_settings = nes_netdev_set_settings,
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001578 .get_strings = nes_netdev_get_strings,
Ben Hutchings15f0a392009-10-01 11:58:24 +00001579 .get_sset_count = nes_netdev_get_sset_count,
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001580 .get_ethtool_stats = nes_netdev_get_ethtool_stats,
1581 .get_drvinfo = nes_netdev_get_drvinfo,
1582 .get_coalesce = nes_netdev_get_coalesce,
1583 .set_coalesce = nes_netdev_set_coalesce,
1584 .get_pauseparam = nes_netdev_get_pauseparam,
1585 .set_pauseparam = nes_netdev_set_pauseparam,
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001586};
1587
Jiri Pirko7033c4a2011-07-20 04:54:06 +00001588static void nes_vlan_mode(struct net_device *netdev, struct nes_device *nesdev, u32 features)
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001589{
Chien Tungedd2fd62008-02-15 21:00:36 -06001590 struct nes_adapter *nesadapter = nesdev->nesadapter;
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001591 u32 u32temp;
Chien Tungedd2fd62008-02-15 21:00:36 -06001592 unsigned long flags;
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001593
Chien Tungedd2fd62008-02-15 21:00:36 -06001594 spin_lock_irqsave(&nesadapter->phy_lock, flags);
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001595
Chien Tungedd2fd62008-02-15 21:00:36 -06001596 nes_debug(NES_DBG_NETDEV, "%s: %s\n", __func__, netdev->name);
1597
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001598 /* Enable/Disable VLAN Stripping */
1599 u32temp = nes_read_indexed(nesdev, NES_IDX_PCIX_DIAG);
Jiri Pirko7033c4a2011-07-20 04:54:06 +00001600 if (features & NETIF_F_HW_VLAN_RX)
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001601 u32temp &= 0xfdffffff;
1602 else
1603 u32temp |= 0x02000000;
1604
1605 nes_write_indexed(nesdev, NES_IDX_PCIX_DIAG, u32temp);
Chien Tungedd2fd62008-02-15 21:00:36 -06001606 spin_unlock_irqrestore(&nesadapter->phy_lock, flags);
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001607}
1608
Jiri Pirko7033c4a2011-07-20 04:54:06 +00001609static u32 nes_fix_features(struct net_device *netdev, u32 features)
1610{
1611 /*
1612 * Since there is no support for separate rx/tx vlan accel
1613 * enable/disable make sure tx flag is always in same state as rx.
1614 */
1615 if (features & NETIF_F_HW_VLAN_RX)
1616 features |= NETIF_F_HW_VLAN_TX;
1617 else
1618 features &= ~NETIF_F_HW_VLAN_TX;
1619
1620 return features;
1621}
1622
1623static int nes_set_features(struct net_device *netdev, u32 features)
1624{
1625 struct nes_vnic *nesvnic = netdev_priv(netdev);
1626 struct nes_device *nesdev = nesvnic->nesdev;
1627 u32 changed = netdev->features ^ features;
1628
1629 if (changed & NETIF_F_HW_VLAN_RX)
1630 nes_vlan_mode(netdev, nesdev, features);
1631
1632 return 0;
1633}
1634
Stephen Hemmingerd0929552009-03-20 19:35:31 +00001635static const struct net_device_ops nes_netdev_ops = {
Jiri Pirko7033c4a2011-07-20 04:54:06 +00001636 .ndo_open = nes_netdev_open,
Stephen Hemmingerd0929552009-03-20 19:35:31 +00001637 .ndo_stop = nes_netdev_stop,
Jiri Pirko7033c4a2011-07-20 04:54:06 +00001638 .ndo_start_xmit = nes_netdev_start_xmit,
Stephen Hemmingerd0929552009-03-20 19:35:31 +00001639 .ndo_get_stats = nes_netdev_get_stats,
Jiri Pirko7033c4a2011-07-20 04:54:06 +00001640 .ndo_tx_timeout = nes_netdev_tx_timeout,
Stephen Hemmingerd0929552009-03-20 19:35:31 +00001641 .ndo_set_mac_address = nes_netdev_set_mac_address,
Jiri Pirkoafc4b132011-08-16 06:29:01 +00001642 .ndo_set_rx_mode = nes_netdev_set_multicast_list,
Stephen Hemmingerd0929552009-03-20 19:35:31 +00001643 .ndo_change_mtu = nes_netdev_change_mtu,
Stephen Hemmingerd0929552009-03-20 19:35:31 +00001644 .ndo_validate_addr = eth_validate_addr,
Jiri Pirko7033c4a2011-07-20 04:54:06 +00001645 .ndo_fix_features = nes_fix_features,
1646 .ndo_set_features = nes_set_features,
Stephen Hemmingerd0929552009-03-20 19:35:31 +00001647};
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001648
1649/**
1650 * nes_netdev_init - initialize network device
1651 */
1652struct net_device *nes_netdev_init(struct nes_device *nesdev,
1653 void __iomem *mmio_addr)
1654{
1655 u64 u64temp;
Linus Torvalds13220a92009-03-26 15:54:36 -07001656 struct nes_vnic *nesvnic;
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001657 struct net_device *netdev;
1658 struct nic_qp_map *curr_qp_map;
Chien Tung09124e12010-02-23 17:52:10 +00001659 u8 phy_type = nesdev->nesadapter->phy_type[nesdev->mac_index];
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001660
1661 netdev = alloc_etherdev(sizeof(struct nes_vnic));
1662 if (!netdev) {
1663 printk(KERN_ERR PFX "nesvnic etherdev alloc failed");
1664 return NULL;
1665 }
Linus Torvalds13220a92009-03-26 15:54:36 -07001666 nesvnic = netdev_priv(netdev);
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001667
1668 nes_debug(NES_DBG_INIT, "netdev = %p, %s\n", netdev, netdev->name);
1669
1670 SET_NETDEV_DEV(netdev, &nesdev->pcidev->dev);
1671
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001672 netdev->watchdog_timeo = NES_TX_TIMEOUT;
1673 netdev->irq = nesdev->pcidev->irq;
1674 netdev->mtu = ETH_DATA_LEN;
1675 netdev->hard_header_len = ETH_HLEN;
1676 netdev->addr_len = ETH_ALEN;
1677 netdev->type = ARPHRD_ETHER;
1678 netdev->features = NETIF_F_HIGHDMA;
Stephen Hemmingerd0929552009-03-20 19:35:31 +00001679 netdev->netdev_ops = &nes_netdev_ops;
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001680 netdev->ethtool_ops = &nes_ethtool_ops;
1681 netif_napi_add(netdev, &nesvnic->napi, nes_netdev_poll, 128);
1682 nes_debug(NES_DBG_INIT, "Enabling VLAN Insert/Delete.\n");
Jiri Pirko7033c4a2011-07-20 04:54:06 +00001683 netdev->features |= NETIF_F_HW_VLAN_TX;
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001684
1685 /* Fill in the port structure */
1686 nesvnic->netdev = netdev;
1687 nesvnic->nesdev = nesdev;
1688 nesvnic->msg_enable = netif_msg_init(debug, default_msg);
1689 nesvnic->netdev_index = nesdev->netdev_count;
1690 nesvnic->perfect_filter_index = nesdev->nesadapter->netdev_count;
Chien Tungedd2fd62008-02-15 21:00:36 -06001691 nesvnic->max_frame_size = netdev->mtu + netdev->hard_header_len + VLAN_HLEN;
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001692
1693 curr_qp_map = nic_qp_mapping_per_function[PCI_FUNC(nesdev->pcidev->devfn)];
1694 nesvnic->nic.qp_id = curr_qp_map[nesdev->netdev_count].qpid;
1695 nesvnic->nic_index = curr_qp_map[nesdev->netdev_count].nic_index;
1696 nesvnic->logical_port = curr_qp_map[nesdev->netdev_count].logical_port;
1697
1698 /* Setup the burned in MAC address */
1699 u64temp = (u64)nesdev->nesadapter->mac_addr_low;
1700 u64temp += ((u64)nesdev->nesadapter->mac_addr_high) << 32;
1701 u64temp += nesvnic->nic_index;
1702 netdev->dev_addr[0] = (u8)(u64temp>>40);
1703 netdev->dev_addr[1] = (u8)(u64temp>>32);
1704 netdev->dev_addr[2] = (u8)(u64temp>>24);
1705 netdev->dev_addr[3] = (u8)(u64temp>>16);
1706 netdev->dev_addr[4] = (u8)(u64temp>>8);
1707 netdev->dev_addr[5] = (u8)u64temp;
1708 memcpy(netdev->perm_addr, netdev->dev_addr, 6);
1709
Jiri Pirko7033c4a2011-07-20 04:54:06 +00001710 netdev->hw_features = NETIF_F_RXCSUM | NETIF_F_SG | NETIF_F_IP_CSUM |
1711 NETIF_F_HW_VLAN_RX;
Michał Mirosławdd6f6d02011-04-19 00:43:20 +00001712 if ((nesvnic->logical_port < 2) || (nesdev->nesadapter->hw_rev != NE020_REV))
1713 netdev->hw_features |= NETIF_F_TSO;
1714 netdev->features |= netdev->hw_features;
1715 netdev->hw_features |= NETIF_F_LRO;
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001716
1717 nes_debug(NES_DBG_INIT, "nesvnic = %p, reported features = 0x%lX, QPid = %d,"
1718 " nic_index = %d, logical_port = %d, mac_index = %d.\n",
1719 nesvnic, (unsigned long)netdev->features, nesvnic->nic.qp_id,
1720 nesvnic->nic_index, nesvnic->logical_port, nesdev->mac_index);
1721
Vadim Makhervaks7e36d3d2008-10-03 12:21:18 -07001722 if (nesvnic->nesdev->nesadapter->port_count == 1 &&
1723 nesvnic->nesdev->nesadapter->adapter_fcn_count == 1) {
1724
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001725 nesvnic->qp_nic_index[0] = nesvnic->nic_index;
1726 nesvnic->qp_nic_index[1] = nesvnic->nic_index + 1;
1727 if (nes_drv_opt & NES_DRV_OPT_DUAL_LOGICAL_PORT) {
1728 nesvnic->qp_nic_index[2] = 0xf;
1729 nesvnic->qp_nic_index[3] = 0xf;
1730 } else {
1731 nesvnic->qp_nic_index[2] = nesvnic->nic_index + 2;
1732 nesvnic->qp_nic_index[3] = nesvnic->nic_index + 3;
1733 }
1734 } else {
Vadim Makhervaks7e36d3d2008-10-03 12:21:18 -07001735 if (nesvnic->nesdev->nesadapter->port_count == 2 ||
1736 (nesvnic->nesdev->nesadapter->port_count == 1 &&
1737 nesvnic->nesdev->nesadapter->adapter_fcn_count == 2)) {
1738 nesvnic->qp_nic_index[0] = nesvnic->nic_index;
1739 nesvnic->qp_nic_index[1] = nesvnic->nic_index
1740 + 2;
1741 nesvnic->qp_nic_index[2] = 0xf;
1742 nesvnic->qp_nic_index[3] = 0xf;
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001743 } else {
1744 nesvnic->qp_nic_index[0] = nesvnic->nic_index;
1745 nesvnic->qp_nic_index[1] = 0xf;
1746 nesvnic->qp_nic_index[2] = 0xf;
1747 nesvnic->qp_nic_index[3] = 0xf;
1748 }
1749 }
1750 nesvnic->next_qp_nic_index = 0;
1751
1752 if (nesdev->netdev_count == 0) {
1753 nesvnic->rdma_enabled = 1;
1754 } else {
1755 nesvnic->rdma_enabled = 0;
1756 }
1757 nesvnic->nic_cq.cq_number = nesvnic->nic.qp_id;
Maciej Sosnowskiea623452010-11-24 17:29:38 +00001758 init_timer(&nesvnic->event_timer);
1759 nesvnic->event_timer.function = NULL;
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001760 spin_lock_init(&nesvnic->tx_lock);
Maciej Sosnowskiea623452010-11-24 17:29:38 +00001761 spin_lock_init(&nesvnic->port_ibevent_lock);
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001762 nesdev->netdev[nesdev->netdev_count] = netdev;
1763
1764 nes_debug(NES_DBG_INIT, "Adding nesvnic (%p) to the adapters nesvnic_list for MAC%d.\n",
1765 nesvnic, nesdev->mac_index);
1766 list_add_tail(&nesvnic->list, &nesdev->nesadapter->nesvnic_list[nesdev->mac_index]);
1767
1768 if ((nesdev->netdev_count == 0) &&
Eric Schneider0e1de5d2008-04-29 13:46:54 -07001769 ((PCI_FUNC(nesdev->pcidev->devfn) == nesdev->mac_index) ||
Chien Tung09124e12010-02-23 17:52:10 +00001770 ((phy_type == NES_PHY_TYPE_PUMA_1G) &&
Eric Schneider0e1de5d2008-04-29 13:46:54 -07001771 (((PCI_FUNC(nesdev->pcidev->devfn) == 1) && (nesdev->mac_index == 2)) ||
1772 ((PCI_FUNC(nesdev->pcidev->devfn) == 2) && (nesdev->mac_index == 1)))))) {
Chien Tunga72042c2010-03-03 19:13:26 +00001773 u32 u32temp;
Maciej Sosnowski843276a2010-11-24 17:29:54 +00001774 u32 link_mask = 0;
1775 u32 link_val = 0;
1776 u16 temp_phy_data;
1777 u16 phy_data = 0;
1778 unsigned long flags;
Chien Tunga72042c2010-03-03 19:13:26 +00001779
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001780 u32temp = nes_read_indexed(nesdev, NES_IDX_PHY_PCS_CONTROL_STATUS0 +
Eric Schneider0e1de5d2008-04-29 13:46:54 -07001781 (0x200 * (nesdev->mac_index & 1)));
Chien Tung09124e12010-02-23 17:52:10 +00001782 if (phy_type != NES_PHY_TYPE_PUMA_1G) {
Eric Schneider0e1de5d2008-04-29 13:46:54 -07001783 u32temp |= 0x00200000;
1784 nes_write_indexed(nesdev, NES_IDX_PHY_PCS_CONTROL_STATUS0 +
1785 (0x200 * (nesdev->mac_index & 1)), u32temp);
1786 }
1787
Chien Tunga72042c2010-03-03 19:13:26 +00001788 /* Check and set linkup here. This is for back to back */
1789 /* configuration where second port won't get link interrupt */
1790 switch (phy_type) {
1791 case NES_PHY_TYPE_PUMA_1G:
1792 if (nesdev->mac_index < 2) {
1793 link_mask = 0x01010000;
1794 link_val = 0x01010000;
1795 } else {
1796 link_mask = 0x02020000;
1797 link_val = 0x02020000;
1798 }
1799 break;
Maciej Sosnowski843276a2010-11-24 17:29:54 +00001800 case NES_PHY_TYPE_SFP_D:
1801 spin_lock_irqsave(&nesdev->nesadapter->phy_lock, flags);
1802 nes_read_10G_phy_reg(nesdev,
1803 nesdev->nesadapter->phy_index[nesdev->mac_index],
1804 1, 0x9003);
1805 temp_phy_data = (u16)nes_read_indexed(nesdev, NES_IDX_MAC_MDIO_CONTROL);
1806 nes_read_10G_phy_reg(nesdev,
1807 nesdev->nesadapter->phy_index[nesdev->mac_index],
1808 3, 0x0021);
1809 nes_read_indexed(nesdev, NES_IDX_MAC_MDIO_CONTROL);
1810 nes_read_10G_phy_reg(nesdev,
1811 nesdev->nesadapter->phy_index[nesdev->mac_index],
1812 3, 0x0021);
1813 phy_data = (u16)nes_read_indexed(nesdev, NES_IDX_MAC_MDIO_CONTROL);
1814 spin_unlock_irqrestore(&nesdev->nesadapter->phy_lock, flags);
1815 phy_data = (!temp_phy_data && (phy_data == 0x8000)) ? 0x4 : 0x0;
1816 break;
Chien Tunga72042c2010-03-03 19:13:26 +00001817 default:
1818 link_mask = 0x0f1f0000;
1819 link_val = 0x0f0f0000;
1820 break;
1821 }
1822
1823 u32temp = nes_read_indexed(nesdev,
1824 NES_IDX_PHY_PCS_CONTROL_STATUS0 +
1825 (0x200 * (nesdev->mac_index & 1)));
Maciej Sosnowski843276a2010-11-24 17:29:54 +00001826
1827 if (phy_type == NES_PHY_TYPE_SFP_D) {
1828 if (phy_data & 0x0004)
1829 nesvnic->linkup = 1;
1830 } else {
1831 if ((u32temp & link_mask) == link_val)
1832 nesvnic->linkup = 1;
1833 }
Chien Tunga72042c2010-03-03 19:13:26 +00001834
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001835 /* clear the MAC interrupt status, assumes direct logical to physical mapping */
Glenn Streiff11e07042008-02-15 11:41:27 -06001836 u32temp = nes_read_indexed(nesdev, NES_IDX_MAC_INT_STATUS + (0x200 * nesdev->mac_index));
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001837 nes_debug(NES_DBG_INIT, "Phy interrupt status = 0x%X.\n", u32temp);
Glenn Streiff11e07042008-02-15 11:41:27 -06001838 nes_write_indexed(nesdev, NES_IDX_MAC_INT_STATUS + (0x200 * nesdev->mac_index), u32temp);
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001839
Chien Tung09124e12010-02-23 17:52:10 +00001840 nes_init_phy(nesdev);
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001841 }
1842
Jiri Pirko7033c4a2011-07-20 04:54:06 +00001843 nes_vlan_mode(netdev, nesdev, netdev->features);
1844
Glenn Streiff3c2d7742008-02-04 20:20:45 -08001845 return netdev;
1846}
1847
1848
1849/**
1850 * nes_netdev_destroy - destroy network device structure
1851 */
1852void nes_netdev_destroy(struct net_device *netdev)
1853{
1854 struct nes_vnic *nesvnic = netdev_priv(netdev);
1855
1856 /* make sure 'stop' method is called by Linux stack */
1857 /* nes_netdev_stop(netdev); */
1858
1859 list_del(&nesvnic->list);
1860
1861 if (nesvnic->of_device_registered) {
1862 nes_destroy_ofa_device(nesvnic->nesibdev);
1863 }
1864
1865 free_netdev(netdev);
1866}
1867
1868
1869/**
1870 * nes_nic_cm_xmit -- CM calls this to send out pkts
1871 */
1872int nes_nic_cm_xmit(struct sk_buff *skb, struct net_device *netdev)
1873{
1874 int ret;
1875
1876 skb->dev = netdev;
1877 ret = dev_queue_xmit(skb);
1878 if (ret) {
1879 nes_debug(NES_DBG_CM, "Bad return code from dev_queue_xmit %d\n", ret);
1880 }
1881
1882 return ret;
1883}