net/mlx4: Set steering mode according to device capabilities
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / net / ethernet / mellanox / mlx4 / en_netdev.c
CommitLineData
c27a02cd
YP
1/*
2 * Copyright (c) 2007 Mellanox Technologies. All rights reserved.
3 *
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/etherdevice.h>
35#include <linux/tcp.h>
36#include <linux/if_vlan.h>
37#include <linux/delay.h>
5a0e3ad6 38#include <linux/slab.h>
c27a02cd
YP
39
40#include <linux/mlx4/driver.h>
41#include <linux/mlx4/device.h>
42#include <linux/mlx4/cmd.h>
43#include <linux/mlx4/cq.h>
44
45#include "mlx4_en.h"
46#include "en_port.h"
47
897d7846
AV
48static int mlx4_en_setup_tc(struct net_device *dev, u8 up)
49{
bc6a4744
AV
50 struct mlx4_en_priv *priv = netdev_priv(dev);
51 int i;
52 unsigned int q, offset = 0;
53
54 if (up && up != MLX4_EN_NUM_UP)
897d7846
AV
55 return -EINVAL;
56
bc6a4744
AV
57 netdev_set_num_tc(dev, up);
58
59 /* Partition Tx queues evenly amongst UP's */
60 q = priv->tx_ring_num / up;
61 for (i = 0; i < up; i++) {
62 netdev_set_tc_queue(dev, i, q, offset);
63 offset += q;
64 }
65
897d7846
AV
66 return 0;
67}
68
8e586137 69static int mlx4_en_vlan_rx_add_vid(struct net_device *dev, unsigned short vid)
c27a02cd
YP
70{
71 struct mlx4_en_priv *priv = netdev_priv(dev);
72 struct mlx4_en_dev *mdev = priv->mdev;
73 int err;
4c3eb3ca 74 int idx;
c27a02cd 75
f1b553fb 76 en_dbg(HW, priv, "adding VLAN:%d\n", vid);
c27a02cd 77
f1b553fb 78 set_bit(vid, priv->active_vlans);
c27a02cd
YP
79
80 /* Add VID to port VLAN filter */
81 mutex_lock(&mdev->state_lock);
82 if (mdev->device_up && priv->port_up) {
f1b553fb 83 err = mlx4_SET_VLAN_FLTR(mdev->dev, priv);
c27a02cd 84 if (err)
453a6082 85 en_err(priv, "Failed configuring VLAN filter\n");
c27a02cd 86 }
4c3eb3ca
EC
87 if (mlx4_register_vlan(mdev->dev, priv->port, vid, &idx))
88 en_err(priv, "failed adding vlan %d\n", vid);
c27a02cd 89 mutex_unlock(&mdev->state_lock);
4c3eb3ca 90
8e586137 91 return 0;
c27a02cd
YP
92}
93
8e586137 94static int mlx4_en_vlan_rx_kill_vid(struct net_device *dev, unsigned short vid)
c27a02cd
YP
95{
96 struct mlx4_en_priv *priv = netdev_priv(dev);
97 struct mlx4_en_dev *mdev = priv->mdev;
98 int err;
4c3eb3ca 99 int idx;
c27a02cd 100
f1b553fb 101 en_dbg(HW, priv, "Killing VID:%d\n", vid);
c27a02cd 102
f1b553fb 103 clear_bit(vid, priv->active_vlans);
c27a02cd
YP
104
105 /* Remove VID from port VLAN filter */
106 mutex_lock(&mdev->state_lock);
4c3eb3ca
EC
107 if (!mlx4_find_cached_vlan(mdev->dev, priv->port, vid, &idx))
108 mlx4_unregister_vlan(mdev->dev, priv->port, idx);
109 else
110 en_err(priv, "could not find vid %d in cache\n", vid);
111
c27a02cd 112 if (mdev->device_up && priv->port_up) {
f1b553fb 113 err = mlx4_SET_VLAN_FLTR(mdev->dev, priv);
c27a02cd 114 if (err)
453a6082 115 en_err(priv, "Failed configuring VLAN filter\n");
c27a02cd
YP
116 }
117 mutex_unlock(&mdev->state_lock);
8e586137
JP
118
119 return 0;
c27a02cd
YP
120}
121
e7c1c2c4 122u64 mlx4_en_mac_to_u64(u8 *addr)
c27a02cd
YP
123{
124 u64 mac = 0;
125 int i;
126
127 for (i = 0; i < ETH_ALEN; i++) {
128 mac <<= 8;
129 mac |= addr[i];
130 }
131 return mac;
132}
133
134static int mlx4_en_set_mac(struct net_device *dev, void *addr)
135{
136 struct mlx4_en_priv *priv = netdev_priv(dev);
137 struct mlx4_en_dev *mdev = priv->mdev;
138 struct sockaddr *saddr = addr;
139
140 if (!is_valid_ether_addr(saddr->sa_data))
141 return -EADDRNOTAVAIL;
142
143 memcpy(dev->dev_addr, saddr->sa_data, ETH_ALEN);
144 priv->mac = mlx4_en_mac_to_u64(dev->dev_addr);
145 queue_work(mdev->workqueue, &priv->mac_task);
146 return 0;
147}
148
149static void mlx4_en_do_set_mac(struct work_struct *work)
150{
151 struct mlx4_en_priv *priv = container_of(work, struct mlx4_en_priv,
152 mac_task);
153 struct mlx4_en_dev *mdev = priv->mdev;
154 int err = 0;
155
156 mutex_lock(&mdev->state_lock);
157 if (priv->port_up) {
158 /* Remove old MAC and insert the new one */
1679200f 159 err = mlx4_replace_mac(mdev->dev, priv->port,
ffe455ad 160 priv->base_qpn, priv->mac);
c27a02cd 161 if (err)
453a6082 162 en_err(priv, "Failed changing HW MAC address\n");
c27a02cd 163 } else
453a6082
YP
164 en_dbg(HW, priv, "Port is down while "
165 "registering mac, exiting...\n");
c27a02cd
YP
166
167 mutex_unlock(&mdev->state_lock);
168}
169
170static void mlx4_en_clear_list(struct net_device *dev)
171{
172 struct mlx4_en_priv *priv = netdev_priv(dev);
6d199937 173 struct mlx4_en_mc_list *tmp, *mc_to_del;
c27a02cd 174
6d199937
YP
175 list_for_each_entry_safe(mc_to_del, tmp, &priv->mc_list, list) {
176 list_del(&mc_to_del->list);
177 kfree(mc_to_del);
178 }
c27a02cd
YP
179}
180
181static void mlx4_en_cache_mclist(struct net_device *dev)
182{
183 struct mlx4_en_priv *priv = netdev_priv(dev);
22bedad3 184 struct netdev_hw_addr *ha;
6d199937 185 struct mlx4_en_mc_list *tmp;
ff6e2163 186
0e03567a 187 mlx4_en_clear_list(dev);
6d199937
YP
188 netdev_for_each_mc_addr(ha, dev) {
189 tmp = kzalloc(sizeof(struct mlx4_en_mc_list), GFP_ATOMIC);
190 if (!tmp) {
191 en_err(priv, "failed to allocate multicast list\n");
192 mlx4_en_clear_list(dev);
193 return;
194 }
195 memcpy(tmp->addr, ha->addr, ETH_ALEN);
196 list_add_tail(&tmp->list, &priv->mc_list);
197 }
c27a02cd
YP
198}
199
6d199937
YP
200static void update_mclist_flags(struct mlx4_en_priv *priv,
201 struct list_head *dst,
202 struct list_head *src)
203{
204 struct mlx4_en_mc_list *dst_tmp, *src_tmp, *new_mc;
205 bool found;
206
207 /* Find all the entries that should be removed from dst,
208 * These are the entries that are not found in src
209 */
210 list_for_each_entry(dst_tmp, dst, list) {
211 found = false;
212 list_for_each_entry(src_tmp, src, list) {
213 if (!memcmp(dst_tmp->addr, src_tmp->addr, ETH_ALEN)) {
214 found = true;
215 break;
216 }
217 }
218 if (!found)
219 dst_tmp->action = MCLIST_REM;
220 }
221
222 /* Add entries that exist in src but not in dst
223 * mark them as need to add
224 */
225 list_for_each_entry(src_tmp, src, list) {
226 found = false;
227 list_for_each_entry(dst_tmp, dst, list) {
228 if (!memcmp(dst_tmp->addr, src_tmp->addr, ETH_ALEN)) {
229 dst_tmp->action = MCLIST_NONE;
230 found = true;
231 break;
232 }
233 }
234 if (!found) {
235 new_mc = kmalloc(sizeof(struct mlx4_en_mc_list),
236 GFP_KERNEL);
237 if (!new_mc) {
238 en_err(priv, "Failed to allocate current multicast list\n");
239 return;
240 }
241 memcpy(new_mc, src_tmp,
242 sizeof(struct mlx4_en_mc_list));
243 new_mc->action = MCLIST_ADD;
244 list_add_tail(&new_mc->list, dst);
245 }
246 }
247}
c27a02cd
YP
248
249static void mlx4_en_set_multicast(struct net_device *dev)
250{
251 struct mlx4_en_priv *priv = netdev_priv(dev);
252
253 if (!priv->port_up)
254 return;
255
256 queue_work(priv->mdev->workqueue, &priv->mcast_task);
257}
258
259static void mlx4_en_do_set_multicast(struct work_struct *work)
260{
261 struct mlx4_en_priv *priv = container_of(work, struct mlx4_en_priv,
262 mcast_task);
263 struct mlx4_en_dev *mdev = priv->mdev;
264 struct net_device *dev = priv->dev;
6d199937 265 struct mlx4_en_mc_list *mclist, *tmp;
c27a02cd 266 u64 mcast_addr = 0;
1679200f 267 u8 mc_list[16] = {0};
c96d97f4 268 int err = 0;
c27a02cd
YP
269
270 mutex_lock(&mdev->state_lock);
271 if (!mdev->device_up) {
453a6082
YP
272 en_dbg(HW, priv, "Card is not up, "
273 "ignoring multicast change.\n");
c27a02cd
YP
274 goto out;
275 }
276 if (!priv->port_up) {
453a6082
YP
277 en_dbg(HW, priv, "Port is down, "
278 "ignoring multicast change.\n");
c27a02cd
YP
279 goto out;
280 }
281
ffe455ad
EE
282 if (!netif_carrier_ok(dev)) {
283 if (!mlx4_en_QUERY_PORT(mdev, priv->port)) {
284 if (priv->port_state.link_state) {
285 priv->last_link_state = MLX4_DEV_EVENT_PORT_UP;
286 netif_carrier_on(dev);
287 en_dbg(LINK, priv, "Link Up\n");
288 }
289 }
290 }
291
c27a02cd
YP
292 /*
293 * Promsicuous mode: disable all filters
294 */
295
296 if (dev->flags & IFF_PROMISC) {
297 if (!(priv->flags & MLX4_EN_FLAG_PROMISC)) {
298 if (netif_msg_rx_status(priv))
453a6082 299 en_warn(priv, "Entering promiscuous mode\n");
c27a02cd
YP
300 priv->flags |= MLX4_EN_FLAG_PROMISC;
301
302 /* Enable promiscouos mode */
c96d97f4
HHZ
303 switch (mdev->dev->caps.steering_mode) {
304 case MLX4_STEERING_MODE_B0:
305 err = mlx4_unicast_promisc_add(mdev->dev,
306 priv->base_qpn,
1679200f 307 priv->port);
c96d97f4
HHZ
308 if (err)
309 en_err(priv, "Failed enabling unicast promiscuous mode\n");
310
311 /* Add the default qp number as multicast
312 * promisc
313 */
314 if (!(priv->flags & MLX4_EN_FLAG_MC_PROMISC)) {
315 err = mlx4_multicast_promisc_add(mdev->dev,
316 priv->base_qpn,
317 priv->port);
318 if (err)
319 en_err(priv, "Failed enabling multicast promiscuous mode\n");
320 priv->flags |= MLX4_EN_FLAG_MC_PROMISC;
321 }
322 break;
323
324 case MLX4_STEERING_MODE_A0:
325 err = mlx4_SET_PORT_qpn_calc(mdev->dev,
326 priv->port,
327 priv->base_qpn,
328 1);
329 if (err)
330 en_err(priv, "Failed enabling promiscuous mode\n");
331 break;
332 }
c27a02cd
YP
333
334 /* Disable port multicast filter (unconditionally) */
335 err = mlx4_SET_MCAST_FLTR(mdev->dev, priv->port, 0,
336 0, MLX4_MCAST_DISABLE);
337 if (err)
453a6082
YP
338 en_err(priv, "Failed disabling "
339 "multicast filter\n");
c27a02cd 340
f1b553fb
JP
341 /* Disable port VLAN filter */
342 err = mlx4_SET_VLAN_FLTR(mdev->dev, priv);
343 if (err)
344 en_err(priv, "Failed disabling VLAN filter\n");
c27a02cd
YP
345 }
346 goto out;
347 }
348
349 /*
25985edc 350 * Not in promiscuous mode
c27a02cd
YP
351 */
352
353 if (priv->flags & MLX4_EN_FLAG_PROMISC) {
354 if (netif_msg_rx_status(priv))
453a6082 355 en_warn(priv, "Leaving promiscuous mode\n");
c27a02cd
YP
356 priv->flags &= ~MLX4_EN_FLAG_PROMISC;
357
358 /* Disable promiscouos mode */
c96d97f4
HHZ
359 switch (mdev->dev->caps.steering_mode) {
360 case MLX4_STEERING_MODE_B0:
361 err = mlx4_unicast_promisc_remove(mdev->dev,
362 priv->base_qpn,
1679200f 363 priv->port);
c96d97f4
HHZ
364 if (err)
365 en_err(priv, "Failed disabling unicast promiscuous mode\n");
366 /* Disable Multicast promisc */
367 if (priv->flags & MLX4_EN_FLAG_MC_PROMISC) {
368 err = mlx4_multicast_promisc_remove(mdev->dev,
369 priv->base_qpn,
370 priv->port);
371 if (err)
372 en_err(priv, "Failed disabling multicast promiscuous mode\n");
373 priv->flags &= ~MLX4_EN_FLAG_MC_PROMISC;
374 }
375 break;
c27a02cd 376
c96d97f4
HHZ
377 case MLX4_STEERING_MODE_A0:
378 err = mlx4_SET_PORT_qpn_calc(mdev->dev,
379 priv->port,
380 priv->base_qpn, 0);
1679200f 381 if (err)
c96d97f4
HHZ
382 en_err(priv, "Failed disabling promiscuous mode\n");
383 break;
1679200f
YP
384 }
385
c27a02cd 386 /* Enable port VLAN filter */
f1b553fb 387 err = mlx4_SET_VLAN_FLTR(mdev->dev, priv);
c27a02cd 388 if (err)
453a6082 389 en_err(priv, "Failed enabling VLAN filter\n");
c27a02cd
YP
390 }
391
392 /* Enable/disable the multicast filter according to IFF_ALLMULTI */
393 if (dev->flags & IFF_ALLMULTI) {
394 err = mlx4_SET_MCAST_FLTR(mdev->dev, priv->port, 0,
395 0, MLX4_MCAST_DISABLE);
396 if (err)
453a6082 397 en_err(priv, "Failed disabling multicast filter\n");
1679200f
YP
398
399 /* Add the default qp number as multicast promisc */
400 if (!(priv->flags & MLX4_EN_FLAG_MC_PROMISC)) {
c96d97f4
HHZ
401 switch (mdev->dev->caps.steering_mode) {
402 case MLX4_STEERING_MODE_B0:
403 err = mlx4_multicast_promisc_add(mdev->dev,
404 priv->base_qpn,
405 priv->port);
406 break;
407
408 case MLX4_STEERING_MODE_A0:
409 break;
410 }
1679200f
YP
411 if (err)
412 en_err(priv, "Failed entering multicast promisc mode\n");
413 priv->flags |= MLX4_EN_FLAG_MC_PROMISC;
414 }
c27a02cd 415 } else {
1679200f
YP
416 /* Disable Multicast promisc */
417 if (priv->flags & MLX4_EN_FLAG_MC_PROMISC) {
c96d97f4
HHZ
418 switch (mdev->dev->caps.steering_mode) {
419 case MLX4_STEERING_MODE_B0:
420 err = mlx4_multicast_promisc_remove(mdev->dev,
421 priv->base_qpn,
422 priv->port);
423 break;
424
425 case MLX4_STEERING_MODE_A0:
426 break;
427 }
1679200f 428 if (err)
25985edc 429 en_err(priv, "Failed disabling multicast promiscuous mode\n");
1679200f
YP
430 priv->flags &= ~MLX4_EN_FLAG_MC_PROMISC;
431 }
ff6e2163 432
c27a02cd
YP
433 err = mlx4_SET_MCAST_FLTR(mdev->dev, priv->port, 0,
434 0, MLX4_MCAST_DISABLE);
435 if (err)
453a6082 436 en_err(priv, "Failed disabling multicast filter\n");
c27a02cd
YP
437
438 /* Flush mcast filter and init it with broadcast address */
439 mlx4_SET_MCAST_FLTR(mdev->dev, priv->port, ETH_BCAST,
440 1, MLX4_MCAST_CONFIG);
441
442 /* Update multicast list - we cache all addresses so they won't
443 * change while HW is updated holding the command semaphor */
444 netif_tx_lock_bh(dev);
445 mlx4_en_cache_mclist(dev);
446 netif_tx_unlock_bh(dev);
6d199937
YP
447 list_for_each_entry(mclist, &priv->mc_list, list) {
448 mcast_addr = mlx4_en_mac_to_u64(mclist->addr);
c27a02cd
YP
449 mlx4_SET_MCAST_FLTR(mdev->dev, priv->port,
450 mcast_addr, 0, MLX4_MCAST_CONFIG);
451 }
452 err = mlx4_SET_MCAST_FLTR(mdev->dev, priv->port, 0,
453 0, MLX4_MCAST_ENABLE);
454 if (err)
453a6082 455 en_err(priv, "Failed enabling multicast filter\n");
6d199937
YP
456
457 update_mclist_flags(priv, &priv->curr_list, &priv->mc_list);
458 list_for_each_entry_safe(mclist, tmp, &priv->curr_list, list) {
459 if (mclist->action == MCLIST_REM) {
460 /* detach this address and delete from list */
461 memcpy(&mc_list[10], mclist->addr, ETH_ALEN);
462 mc_list[5] = priv->port;
463 err = mlx4_multicast_detach(mdev->dev,
464 &priv->rss_map.indir_qp,
465 mc_list,
466 MLX4_PROT_ETH);
467 if (err)
468 en_err(priv, "Fail to detach multicast address\n");
469
470 /* remove from list */
471 list_del(&mclist->list);
472 kfree(mclist);
473 }
474
475 if (mclist->action == MCLIST_ADD) {
476 /* attach the address */
477 memcpy(&mc_list[10], mclist->addr, ETH_ALEN);
478 mc_list[5] = priv->port;
479 err = mlx4_multicast_attach(mdev->dev,
480 &priv->rss_map.indir_qp,
481 mc_list, 0,
482 MLX4_PROT_ETH);
483 if (err)
484 en_err(priv, "Fail to attach multicast address\n");
485
486 }
487 }
c27a02cd
YP
488 }
489out:
490 mutex_unlock(&mdev->state_lock);
491}
492
493#ifdef CONFIG_NET_POLL_CONTROLLER
494static void mlx4_en_netpoll(struct net_device *dev)
495{
496 struct mlx4_en_priv *priv = netdev_priv(dev);
497 struct mlx4_en_cq *cq;
498 unsigned long flags;
499 int i;
500
501 for (i = 0; i < priv->rx_ring_num; i++) {
502 cq = &priv->rx_cq[i];
503 spin_lock_irqsave(&cq->lock, flags);
504 napi_synchronize(&cq->napi);
505 mlx4_en_process_rx_cq(dev, cq, 0);
506 spin_unlock_irqrestore(&cq->lock, flags);
507 }
508}
509#endif
510
511static void mlx4_en_tx_timeout(struct net_device *dev)
512{
513 struct mlx4_en_priv *priv = netdev_priv(dev);
514 struct mlx4_en_dev *mdev = priv->mdev;
515
516 if (netif_msg_timer(priv))
453a6082 517 en_warn(priv, "Tx timeout called on port:%d\n", priv->port);
c27a02cd 518
1e338db5 519 priv->port_stats.tx_timeout++;
453a6082 520 en_dbg(DRV, priv, "Scheduling watchdog\n");
1e338db5 521 queue_work(mdev->workqueue, &priv->watchdog_task);
c27a02cd
YP
522}
523
524
525static struct net_device_stats *mlx4_en_get_stats(struct net_device *dev)
526{
527 struct mlx4_en_priv *priv = netdev_priv(dev);
528
529 spin_lock_bh(&priv->stats_lock);
530 memcpy(&priv->ret_stats, &priv->stats, sizeof(priv->stats));
531 spin_unlock_bh(&priv->stats_lock);
532
533 return &priv->ret_stats;
534}
535
536static void mlx4_en_set_default_moderation(struct mlx4_en_priv *priv)
537{
c27a02cd
YP
538 struct mlx4_en_cq *cq;
539 int i;
540
541 /* If we haven't received a specific coalescing setting
98a1708d 542 * (module param), we set the moderation parameters as follows:
c27a02cd
YP
543 * - moder_cnt is set to the number of mtu sized packets to
544 * satisfy our coelsing target.
545 * - moder_time is set to a fixed value.
546 */
3db36fb2 547 priv->rx_frames = MLX4_EN_RX_COAL_TARGET;
60b9f9e5 548 priv->rx_usecs = MLX4_EN_RX_COAL_TIME;
a19a848a
YP
549 priv->tx_frames = MLX4_EN_TX_COAL_PKTS;
550 priv->tx_usecs = MLX4_EN_TX_COAL_TIME;
453a6082
YP
551 en_dbg(INTR, priv, "Default coalesing params for mtu:%d - "
552 "rx_frames:%d rx_usecs:%d\n",
c27a02cd
YP
553 priv->dev->mtu, priv->rx_frames, priv->rx_usecs);
554
555 /* Setup cq moderation params */
556 for (i = 0; i < priv->rx_ring_num; i++) {
557 cq = &priv->rx_cq[i];
558 cq->moder_cnt = priv->rx_frames;
559 cq->moder_time = priv->rx_usecs;
6b4d8d9f
AG
560 priv->last_moder_time[i] = MLX4_EN_AUTO_CONF;
561 priv->last_moder_packets[i] = 0;
562 priv->last_moder_bytes[i] = 0;
c27a02cd
YP
563 }
564
565 for (i = 0; i < priv->tx_ring_num; i++) {
566 cq = &priv->tx_cq[i];
a19a848a
YP
567 cq->moder_cnt = priv->tx_frames;
568 cq->moder_time = priv->tx_usecs;
c27a02cd
YP
569 }
570
571 /* Reset auto-moderation params */
572 priv->pkt_rate_low = MLX4_EN_RX_RATE_LOW;
573 priv->rx_usecs_low = MLX4_EN_RX_COAL_TIME_LOW;
574 priv->pkt_rate_high = MLX4_EN_RX_RATE_HIGH;
575 priv->rx_usecs_high = MLX4_EN_RX_COAL_TIME_HIGH;
576 priv->sample_interval = MLX4_EN_SAMPLE_INTERVAL;
60b9f9e5 577 priv->adaptive_rx_coal = 1;
c27a02cd 578 priv->last_moder_jiffies = 0;
c27a02cd 579 priv->last_moder_tx_packets = 0;
c27a02cd
YP
580}
581
582static void mlx4_en_auto_moderation(struct mlx4_en_priv *priv)
583{
584 unsigned long period = (unsigned long) (jiffies - priv->last_moder_jiffies);
c27a02cd
YP
585 struct mlx4_en_cq *cq;
586 unsigned long packets;
587 unsigned long rate;
588 unsigned long avg_pkt_size;
589 unsigned long rx_packets;
590 unsigned long rx_bytes;
c27a02cd
YP
591 unsigned long rx_pkt_diff;
592 int moder_time;
6b4d8d9f 593 int ring, err;
c27a02cd
YP
594
595 if (!priv->adaptive_rx_coal || period < priv->sample_interval * HZ)
596 return;
597
6b4d8d9f
AG
598 for (ring = 0; ring < priv->rx_ring_num; ring++) {
599 spin_lock_bh(&priv->stats_lock);
600 rx_packets = priv->rx_ring[ring].packets;
601 rx_bytes = priv->rx_ring[ring].bytes;
602 spin_unlock_bh(&priv->stats_lock);
603
604 rx_pkt_diff = ((unsigned long) (rx_packets -
605 priv->last_moder_packets[ring]));
606 packets = rx_pkt_diff;
607 rate = packets * HZ / period;
608 avg_pkt_size = packets ? ((unsigned long) (rx_bytes -
609 priv->last_moder_bytes[ring])) / packets : 0;
610
611 /* Apply auto-moderation only when packet rate
612 * exceeds a rate that it matters */
613 if (rate > (MLX4_EN_RX_RATE_THRESH / priv->rx_ring_num) &&
614 avg_pkt_size > MLX4_EN_AVG_PKT_SMALL) {
c27a02cd
YP
615 if (rate < priv->pkt_rate_low)
616 moder_time = priv->rx_usecs_low;
617 else if (rate > priv->pkt_rate_high)
618 moder_time = priv->rx_usecs_high;
619 else
620 moder_time = (rate - priv->pkt_rate_low) *
621 (priv->rx_usecs_high - priv->rx_usecs_low) /
622 (priv->pkt_rate_high - priv->pkt_rate_low) +
623 priv->rx_usecs_low;
6b4d8d9f
AG
624 } else {
625 moder_time = priv->rx_usecs_low;
c27a02cd 626 }
c27a02cd 627
6b4d8d9f
AG
628 if (moder_time != priv->last_moder_time[ring]) {
629 priv->last_moder_time[ring] = moder_time;
630 cq = &priv->rx_cq[ring];
c27a02cd
YP
631 cq->moder_time = moder_time;
632 err = mlx4_en_set_cq_moder(priv, cq);
6b4d8d9f
AG
633 if (err)
634 en_err(priv, "Failed modifying moderation "
635 "for cq:%d\n", ring);
c27a02cd 636 }
6b4d8d9f
AG
637 priv->last_moder_packets[ring] = rx_packets;
638 priv->last_moder_bytes[ring] = rx_bytes;
c27a02cd
YP
639 }
640
c27a02cd
YP
641 priv->last_moder_jiffies = jiffies;
642}
643
644static void mlx4_en_do_get_stats(struct work_struct *work)
645{
bf6aede7 646 struct delayed_work *delay = to_delayed_work(work);
c27a02cd
YP
647 struct mlx4_en_priv *priv = container_of(delay, struct mlx4_en_priv,
648 stats_task);
649 struct mlx4_en_dev *mdev = priv->mdev;
650 int err;
651
652 err = mlx4_en_DUMP_ETH_STATS(mdev, priv->port, 0);
653 if (err)
2381a55c 654 en_dbg(HW, priv, "Could not update stats\n");
c27a02cd
YP
655
656 mutex_lock(&mdev->state_lock);
657 if (mdev->device_up) {
658 if (priv->port_up)
659 mlx4_en_auto_moderation(priv);
660
661 queue_delayed_work(mdev->workqueue, &priv->stats_task, STATS_DELAY);
662 }
d7e1a487
YP
663 if (mdev->mac_removed[MLX4_MAX_PORTS + 1 - priv->port]) {
664 queue_work(mdev->workqueue, &priv->mac_task);
665 mdev->mac_removed[MLX4_MAX_PORTS + 1 - priv->port] = 0;
666 }
c27a02cd
YP
667 mutex_unlock(&mdev->state_lock);
668}
669
670static void mlx4_en_linkstate(struct work_struct *work)
671{
672 struct mlx4_en_priv *priv = container_of(work, struct mlx4_en_priv,
673 linkstate_task);
674 struct mlx4_en_dev *mdev = priv->mdev;
675 int linkstate = priv->link_state;
676
677 mutex_lock(&mdev->state_lock);
678 /* If observable port state changed set carrier state and
679 * report to system log */
680 if (priv->last_link_state != linkstate) {
681 if (linkstate == MLX4_DEV_EVENT_PORT_DOWN) {
e5cc44b2 682 en_info(priv, "Link Down\n");
c27a02cd
YP
683 netif_carrier_off(priv->dev);
684 } else {
e5cc44b2 685 en_info(priv, "Link Up\n");
c27a02cd
YP
686 netif_carrier_on(priv->dev);
687 }
688 }
689 priv->last_link_state = linkstate;
690 mutex_unlock(&mdev->state_lock);
691}
692
693
18cc42a3 694int mlx4_en_start_port(struct net_device *dev)
c27a02cd
YP
695{
696 struct mlx4_en_priv *priv = netdev_priv(dev);
697 struct mlx4_en_dev *mdev = priv->mdev;
698 struct mlx4_en_cq *cq;
699 struct mlx4_en_tx_ring *tx_ring;
c27a02cd
YP
700 int rx_index = 0;
701 int tx_index = 0;
c27a02cd
YP
702 int err = 0;
703 int i;
704 int j;
1679200f 705 u8 mc_list[16] = {0};
c27a02cd
YP
706
707 if (priv->port_up) {
453a6082 708 en_dbg(DRV, priv, "start port called while port already up\n");
c27a02cd
YP
709 return 0;
710 }
711
6d199937
YP
712 INIT_LIST_HEAD(&priv->mc_list);
713 INIT_LIST_HEAD(&priv->curr_list);
714
c27a02cd
YP
715 /* Calculate Rx buf size */
716 dev->mtu = min(dev->mtu, priv->max_mtu);
717 mlx4_en_calc_rx_buf(dev);
453a6082 718 en_dbg(DRV, priv, "Rx buf size:%d\n", priv->rx_skb_size);
38aab07c 719
c27a02cd 720 /* Configure rx cq's and rings */
38aab07c
YP
721 err = mlx4_en_activate_rx_rings(priv);
722 if (err) {
453a6082 723 en_err(priv, "Failed to activate RX rings\n");
38aab07c
YP
724 return err;
725 }
c27a02cd
YP
726 for (i = 0; i < priv->rx_ring_num; i++) {
727 cq = &priv->rx_cq[i];
c27a02cd 728
76532d0c 729 err = mlx4_en_activate_cq(priv, cq, i);
c27a02cd 730 if (err) {
453a6082 731 en_err(priv, "Failed activating Rx CQ\n");
a4233304 732 goto cq_err;
c27a02cd
YP
733 }
734 for (j = 0; j < cq->size; j++)
735 cq->buf[j].owner_sr_opcode = MLX4_CQE_OWNER_MASK;
736 err = mlx4_en_set_cq_moder(priv, cq);
737 if (err) {
453a6082 738 en_err(priv, "Failed setting cq moderation parameters");
c27a02cd
YP
739 mlx4_en_deactivate_cq(priv, cq);
740 goto cq_err;
741 }
742 mlx4_en_arm_cq(priv, cq);
38aab07c 743 priv->rx_ring[i].cqn = cq->mcq.cqn;
c27a02cd
YP
744 ++rx_index;
745 }
746
ffe455ad
EE
747 /* Set qp number */
748 en_dbg(DRV, priv, "Getting qp number for port %d\n", priv->port);
749 err = mlx4_get_eth_qp(mdev->dev, priv->port,
750 priv->mac, &priv->base_qpn);
1679200f 751 if (err) {
ffe455ad 752 en_err(priv, "Failed getting eth qp\n");
1679200f
YP
753 goto cq_err;
754 }
755 mdev->mac_removed[priv->port] = 0;
756
c27a02cd
YP
757 err = mlx4_en_config_rss_steer(priv);
758 if (err) {
453a6082 759 en_err(priv, "Failed configuring rss steering\n");
1679200f 760 goto mac_err;
c27a02cd
YP
761 }
762
763 /* Configure tx cq's and rings */
764 for (i = 0; i < priv->tx_ring_num; i++) {
765 /* Configure cq */
766 cq = &priv->tx_cq[i];
76532d0c 767 err = mlx4_en_activate_cq(priv, cq, i);
c27a02cd 768 if (err) {
453a6082 769 en_err(priv, "Failed allocating Tx CQ\n");
c27a02cd
YP
770 goto tx_err;
771 }
772 err = mlx4_en_set_cq_moder(priv, cq);
773 if (err) {
453a6082 774 en_err(priv, "Failed setting cq moderation parameters");
c27a02cd
YP
775 mlx4_en_deactivate_cq(priv, cq);
776 goto tx_err;
777 }
453a6082 778 en_dbg(DRV, priv, "Resetting index of collapsed CQ:%d to -1\n", i);
c27a02cd
YP
779 cq->buf->wqe_index = cpu_to_be16(0xffff);
780
781 /* Configure ring */
782 tx_ring = &priv->tx_ring[i];
0e98b523 783 err = mlx4_en_activate_tx_ring(priv, tx_ring, cq->mcq.cqn,
bc6a4744 784 i / priv->mdev->profile.num_tx_rings_p_up);
c27a02cd 785 if (err) {
453a6082 786 en_err(priv, "Failed allocating Tx ring\n");
c27a02cd
YP
787 mlx4_en_deactivate_cq(priv, cq);
788 goto tx_err;
789 }
5b263f53 790 tx_ring->tx_queue = netdev_get_tx_queue(dev, i);
e22979d9
YP
791
792 /* Arm CQ for TX completions */
793 mlx4_en_arm_cq(priv, cq);
794
c27a02cd
YP
795 /* Set initial ownership of all Tx TXBBs to SW (1) */
796 for (j = 0; j < tx_ring->buf_size; j += STAMP_STRIDE)
797 *((u32 *) (tx_ring->buf + j)) = 0xffffffff;
798 ++tx_index;
799 }
800
801 /* Configure port */
802 err = mlx4_SET_PORT_general(mdev->dev, priv->port,
803 priv->rx_skb_size + ETH_FCS_LEN,
d53b93f2
YP
804 priv->prof->tx_pause,
805 priv->prof->tx_ppp,
806 priv->prof->rx_pause,
807 priv->prof->rx_ppp);
c27a02cd 808 if (err) {
453a6082
YP
809 en_err(priv, "Failed setting port general configurations "
810 "for port %d, with error %d\n", priv->port, err);
c27a02cd
YP
811 goto tx_err;
812 }
813 /* Set default qp number */
814 err = mlx4_SET_PORT_qpn_calc(mdev->dev, priv->port, priv->base_qpn, 0);
815 if (err) {
453a6082 816 en_err(priv, "Failed setting default qp numbers\n");
c27a02cd
YP
817 goto tx_err;
818 }
c27a02cd
YP
819
820 /* Init port */
453a6082 821 en_dbg(HW, priv, "Initializing port\n");
c27a02cd
YP
822 err = mlx4_INIT_PORT(mdev->dev, priv->port);
823 if (err) {
453a6082 824 en_err(priv, "Failed Initializing port\n");
1679200f 825 goto tx_err;
c27a02cd
YP
826 }
827
1679200f
YP
828 /* Attach rx QP to bradcast address */
829 memset(&mc_list[10], 0xff, ETH_ALEN);
830 mc_list[5] = priv->port;
831 if (mlx4_multicast_attach(mdev->dev, &priv->rss_map.indir_qp, mc_list,
832 0, MLX4_PROT_ETH))
833 mlx4_warn(mdev, "Failed Attaching Broadcast\n");
834
b5845f98
HX
835 /* Must redo promiscuous mode setup. */
836 priv->flags &= ~(MLX4_EN_FLAG_PROMISC | MLX4_EN_FLAG_MC_PROMISC);
837
c27a02cd
YP
838 /* Schedule multicast task to populate multicast list */
839 queue_work(mdev->workqueue, &priv->mcast_task);
840
93ece0c1
EE
841 mlx4_set_stats_bitmap(mdev->dev, &priv->stats_bitmap);
842
c27a02cd 843 priv->port_up = true;
a11faac7 844 netif_tx_start_all_queues(dev);
c27a02cd
YP
845 return 0;
846
c27a02cd
YP
847tx_err:
848 while (tx_index--) {
849 mlx4_en_deactivate_tx_ring(priv, &priv->tx_ring[tx_index]);
850 mlx4_en_deactivate_cq(priv, &priv->tx_cq[tx_index]);
851 }
852
853 mlx4_en_release_rss_steer(priv);
1679200f 854mac_err:
ffe455ad 855 mlx4_put_eth_qp(mdev->dev, priv->port, priv->mac, priv->base_qpn);
c27a02cd
YP
856cq_err:
857 while (rx_index--)
858 mlx4_en_deactivate_cq(priv, &priv->rx_cq[rx_index]);
38aab07c
YP
859 for (i = 0; i < priv->rx_ring_num; i++)
860 mlx4_en_deactivate_rx_ring(priv, &priv->rx_ring[i]);
c27a02cd
YP
861
862 return err; /* need to close devices */
863}
864
865
18cc42a3 866void mlx4_en_stop_port(struct net_device *dev)
c27a02cd
YP
867{
868 struct mlx4_en_priv *priv = netdev_priv(dev);
869 struct mlx4_en_dev *mdev = priv->mdev;
6d199937 870 struct mlx4_en_mc_list *mclist, *tmp;
c27a02cd 871 int i;
1679200f 872 u8 mc_list[16] = {0};
c27a02cd
YP
873
874 if (!priv->port_up) {
453a6082 875 en_dbg(DRV, priv, "stop port called while port already down\n");
c27a02cd
YP
876 return;
877 }
c27a02cd
YP
878
879 /* Synchronize with tx routine */
880 netif_tx_lock_bh(dev);
3c05f5ef 881 netif_tx_stop_all_queues(dev);
c27a02cd
YP
882 netif_tx_unlock_bh(dev);
883
7c287380 884 /* Set port as not active */
3c05f5ef 885 priv->port_up = false;
c27a02cd 886
1679200f
YP
887 /* Detach All multicasts */
888 memset(&mc_list[10], 0xff, ETH_ALEN);
889 mc_list[5] = priv->port;
890 mlx4_multicast_detach(mdev->dev, &priv->rss_map.indir_qp, mc_list,
891 MLX4_PROT_ETH);
6d199937
YP
892 list_for_each_entry(mclist, &priv->curr_list, list) {
893 memcpy(&mc_list[10], mclist->addr, ETH_ALEN);
1679200f
YP
894 mc_list[5] = priv->port;
895 mlx4_multicast_detach(mdev->dev, &priv->rss_map.indir_qp,
896 mc_list, MLX4_PROT_ETH);
897 }
898 mlx4_en_clear_list(dev);
6d199937
YP
899 list_for_each_entry_safe(mclist, tmp, &priv->curr_list, list) {
900 list_del(&mclist->list);
901 kfree(mclist);
902 }
903
1679200f
YP
904 /* Flush multicast filter */
905 mlx4_SET_MCAST_FLTR(mdev->dev, priv->port, 0, 1, MLX4_MCAST_CONFIG);
906
c27a02cd
YP
907 /* Free TX Rings */
908 for (i = 0; i < priv->tx_ring_num; i++) {
909 mlx4_en_deactivate_tx_ring(priv, &priv->tx_ring[i]);
910 mlx4_en_deactivate_cq(priv, &priv->tx_cq[i]);
911 }
912 msleep(10);
913
914 for (i = 0; i < priv->tx_ring_num; i++)
915 mlx4_en_free_tx_buf(dev, &priv->tx_ring[i]);
916
917 /* Free RSS qps */
918 mlx4_en_release_rss_steer(priv);
919
ffe455ad
EE
920 /* Unregister Mac address for the port */
921 mlx4_put_eth_qp(mdev->dev, priv->port, priv->mac, priv->base_qpn);
922 mdev->mac_removed[priv->port] = 1;
923
c27a02cd
YP
924 /* Free RX Rings */
925 for (i = 0; i < priv->rx_ring_num; i++) {
926 mlx4_en_deactivate_rx_ring(priv, &priv->rx_ring[i]);
927 while (test_bit(NAPI_STATE_SCHED, &priv->rx_cq[i].napi.state))
928 msleep(1);
929 mlx4_en_deactivate_cq(priv, &priv->rx_cq[i]);
930 }
7c287380
YP
931
932 /* close port*/
933 mlx4_CLOSE_PORT(mdev->dev, priv->port);
c27a02cd
YP
934}
935
936static void mlx4_en_restart(struct work_struct *work)
937{
938 struct mlx4_en_priv *priv = container_of(work, struct mlx4_en_priv,
939 watchdog_task);
940 struct mlx4_en_dev *mdev = priv->mdev;
941 struct net_device *dev = priv->dev;
5b263f53 942 int i;
c27a02cd 943
453a6082 944 en_dbg(DRV, priv, "Watchdog task called for port %d\n", priv->port);
1e338db5
YP
945
946 mutex_lock(&mdev->state_lock);
947 if (priv->port_up) {
948 mlx4_en_stop_port(dev);
5b263f53
YP
949 for (i = 0; i < priv->tx_ring_num; i++)
950 netdev_tx_reset_queue(priv->tx_ring[i].tx_queue);
1e338db5 951 if (mlx4_en_start_port(dev))
453a6082 952 en_err(priv, "Failed restarting port %d\n", priv->port);
1e338db5
YP
953 }
954 mutex_unlock(&mdev->state_lock);
c27a02cd
YP
955}
956
b477ba62 957static void mlx4_en_clear_stats(struct net_device *dev)
c27a02cd
YP
958{
959 struct mlx4_en_priv *priv = netdev_priv(dev);
960 struct mlx4_en_dev *mdev = priv->mdev;
961 int i;
c27a02cd 962
c27a02cd 963 if (mlx4_en_DUMP_ETH_STATS(mdev, priv->port, 1))
453a6082 964 en_dbg(HW, priv, "Failed dumping statistics\n");
c27a02cd
YP
965
966 memset(&priv->stats, 0, sizeof(priv->stats));
967 memset(&priv->pstats, 0, sizeof(priv->pstats));
b477ba62
EE
968 memset(&priv->pkstats, 0, sizeof(priv->pkstats));
969 memset(&priv->port_stats, 0, sizeof(priv->port_stats));
c27a02cd
YP
970
971 for (i = 0; i < priv->tx_ring_num; i++) {
972 priv->tx_ring[i].bytes = 0;
973 priv->tx_ring[i].packets = 0;
b477ba62 974 priv->tx_ring[i].tx_csum = 0;
c27a02cd
YP
975 }
976 for (i = 0; i < priv->rx_ring_num; i++) {
977 priv->rx_ring[i].bytes = 0;
978 priv->rx_ring[i].packets = 0;
b477ba62
EE
979 priv->rx_ring[i].csum_ok = 0;
980 priv->rx_ring[i].csum_none = 0;
c27a02cd 981 }
b477ba62
EE
982}
983
984static int mlx4_en_open(struct net_device *dev)
985{
986 struct mlx4_en_priv *priv = netdev_priv(dev);
987 struct mlx4_en_dev *mdev = priv->mdev;
988 int err = 0;
989
990 mutex_lock(&mdev->state_lock);
991
992 if (!mdev->device_up) {
993 en_err(priv, "Cannot open - device down/disabled\n");
994 err = -EBUSY;
995 goto out;
996 }
997
998 /* Reset HW statistics and SW counters */
999 mlx4_en_clear_stats(dev);
c27a02cd 1000
c27a02cd
YP
1001 err = mlx4_en_start_port(dev);
1002 if (err)
453a6082 1003 en_err(priv, "Failed starting port:%d\n", priv->port);
c27a02cd
YP
1004
1005out:
1006 mutex_unlock(&mdev->state_lock);
1007 return err;
1008}
1009
1010
1011static int mlx4_en_close(struct net_device *dev)
1012{
1013 struct mlx4_en_priv *priv = netdev_priv(dev);
1014 struct mlx4_en_dev *mdev = priv->mdev;
1015
453a6082 1016 en_dbg(IFDOWN, priv, "Close port called\n");
c27a02cd
YP
1017
1018 mutex_lock(&mdev->state_lock);
1019
1020 mlx4_en_stop_port(dev);
1021 netif_carrier_off(dev);
1022
1023 mutex_unlock(&mdev->state_lock);
1024 return 0;
1025}
1026
fe0af03c 1027void mlx4_en_free_resources(struct mlx4_en_priv *priv)
c27a02cd
YP
1028{
1029 int i;
1030
1031 for (i = 0; i < priv->tx_ring_num; i++) {
1032 if (priv->tx_ring[i].tx_info)
1033 mlx4_en_destroy_tx_ring(priv, &priv->tx_ring[i]);
1034 if (priv->tx_cq[i].buf)
fe0af03c 1035 mlx4_en_destroy_cq(priv, &priv->tx_cq[i]);
c27a02cd
YP
1036 }
1037
1038 for (i = 0; i < priv->rx_ring_num; i++) {
1039 if (priv->rx_ring[i].rx_info)
68355f71
TLSC
1040 mlx4_en_destroy_rx_ring(priv, &priv->rx_ring[i],
1041 priv->prof->rx_ring_size, priv->stride);
c27a02cd 1042 if (priv->rx_cq[i].buf)
fe0af03c 1043 mlx4_en_destroy_cq(priv, &priv->rx_cq[i]);
c27a02cd 1044 }
044ca2a5
YP
1045
1046 if (priv->base_tx_qpn) {
1047 mlx4_qp_release_range(priv->mdev->dev, priv->base_tx_qpn, priv->tx_ring_num);
1048 priv->base_tx_qpn = 0;
1049 }
c27a02cd
YP
1050}
1051
18cc42a3 1052int mlx4_en_alloc_resources(struct mlx4_en_priv *priv)
c27a02cd 1053{
c27a02cd
YP
1054 struct mlx4_en_port_profile *prof = priv->prof;
1055 int i;
044ca2a5 1056 int err;
87a5c389 1057
044ca2a5 1058 err = mlx4_qp_reserve_range(priv->mdev->dev, priv->tx_ring_num, 256, &priv->base_tx_qpn);
87a5c389
YP
1059 if (err) {
1060 en_err(priv, "failed reserving range for TX rings\n");
1061 return err;
1062 }
c27a02cd
YP
1063
1064 /* Create tx Rings */
1065 for (i = 0; i < priv->tx_ring_num; i++) {
1066 if (mlx4_en_create_cq(priv, &priv->tx_cq[i],
1067 prof->tx_ring_size, i, TX))
1068 goto err;
1069
044ca2a5 1070 if (mlx4_en_create_tx_ring(priv, &priv->tx_ring[i], priv->base_tx_qpn + i,
c27a02cd
YP
1071 prof->tx_ring_size, TXBB_SIZE))
1072 goto err;
1073 }
1074
1075 /* Create rx Rings */
1076 for (i = 0; i < priv->rx_ring_num; i++) {
1077 if (mlx4_en_create_cq(priv, &priv->rx_cq[i],
1078 prof->rx_ring_size, i, RX))
1079 goto err;
1080
1081 if (mlx4_en_create_rx_ring(priv, &priv->rx_ring[i],
1082 prof->rx_ring_size, priv->stride))
1083 goto err;
1084 }
1085
1086 return 0;
1087
1088err:
453a6082 1089 en_err(priv, "Failed to allocate NIC resources\n");
c27a02cd
YP
1090 return -ENOMEM;
1091}
1092
1093
1094void mlx4_en_destroy_netdev(struct net_device *dev)
1095{
1096 struct mlx4_en_priv *priv = netdev_priv(dev);
1097 struct mlx4_en_dev *mdev = priv->mdev;
1098
453a6082 1099 en_dbg(DRV, priv, "Destroying netdev on port:%d\n", priv->port);
c27a02cd
YP
1100
1101 /* Unregister device - this will close the port if it was up */
1102 if (priv->registered)
1103 unregister_netdev(dev);
1104
1105 if (priv->allocated)
1106 mlx4_free_hwq_res(mdev->dev, &priv->res, MLX4_EN_PAGE_SIZE);
1107
1108 cancel_delayed_work(&priv->stats_task);
c27a02cd
YP
1109 /* flush any pending task for this netdev */
1110 flush_workqueue(mdev->workqueue);
1111
1112 /* Detach the netdev so tasks would not attempt to access it */
1113 mutex_lock(&mdev->state_lock);
1114 mdev->pndev[priv->port] = NULL;
1115 mutex_unlock(&mdev->state_lock);
1116
fe0af03c 1117 mlx4_en_free_resources(priv);
564c274c 1118
bc6a4744
AV
1119 kfree(priv->tx_ring);
1120 kfree(priv->tx_cq);
1121
c27a02cd
YP
1122 free_netdev(dev);
1123}
1124
1125static int mlx4_en_change_mtu(struct net_device *dev, int new_mtu)
1126{
1127 struct mlx4_en_priv *priv = netdev_priv(dev);
1128 struct mlx4_en_dev *mdev = priv->mdev;
1129 int err = 0;
1130
453a6082 1131 en_dbg(DRV, priv, "Change MTU called - current:%d new:%d\n",
c27a02cd
YP
1132 dev->mtu, new_mtu);
1133
1134 if ((new_mtu < MLX4_EN_MIN_MTU) || (new_mtu > priv->max_mtu)) {
453a6082 1135 en_err(priv, "Bad MTU size:%d.\n", new_mtu);
c27a02cd
YP
1136 return -EPERM;
1137 }
1138 dev->mtu = new_mtu;
1139
1140 if (netif_running(dev)) {
1141 mutex_lock(&mdev->state_lock);
1142 if (!mdev->device_up) {
1143 /* NIC is probably restarting - let watchdog task reset
1144 * the port */
453a6082 1145 en_dbg(DRV, priv, "Change MTU called with card down!?\n");
c27a02cd
YP
1146 } else {
1147 mlx4_en_stop_port(dev);
c27a02cd
YP
1148 err = mlx4_en_start_port(dev);
1149 if (err) {
453a6082 1150 en_err(priv, "Failed restarting port:%d\n",
c27a02cd
YP
1151 priv->port);
1152 queue_work(mdev->workqueue, &priv->watchdog_task);
1153 }
1154 }
1155 mutex_unlock(&mdev->state_lock);
1156 }
1157 return 0;
1158}
1159
60d6fe99
AV
1160static int mlx4_en_set_features(struct net_device *netdev,
1161 netdev_features_t features)
1162{
1163 struct mlx4_en_priv *priv = netdev_priv(netdev);
1164
1165 if (features & NETIF_F_LOOPBACK)
1166 priv->ctrl_flags |= cpu_to_be32(MLX4_WQE_CTRL_FORCE_LOOPBACK);
1167 else
1168 priv->ctrl_flags &=
1169 cpu_to_be32(~MLX4_WQE_CTRL_FORCE_LOOPBACK);
1170
1171 return 0;
1172
1173}
1174
3addc568
SH
1175static const struct net_device_ops mlx4_netdev_ops = {
1176 .ndo_open = mlx4_en_open,
1177 .ndo_stop = mlx4_en_close,
1178 .ndo_start_xmit = mlx4_en_xmit,
f813cad8 1179 .ndo_select_queue = mlx4_en_select_queue,
3addc568 1180 .ndo_get_stats = mlx4_en_get_stats,
afc4b13d 1181 .ndo_set_rx_mode = mlx4_en_set_multicast,
3addc568 1182 .ndo_set_mac_address = mlx4_en_set_mac,
52255bbe 1183 .ndo_validate_addr = eth_validate_addr,
3addc568
SH
1184 .ndo_change_mtu = mlx4_en_change_mtu,
1185 .ndo_tx_timeout = mlx4_en_tx_timeout,
3addc568
SH
1186 .ndo_vlan_rx_add_vid = mlx4_en_vlan_rx_add_vid,
1187 .ndo_vlan_rx_kill_vid = mlx4_en_vlan_rx_kill_vid,
1188#ifdef CONFIG_NET_POLL_CONTROLLER
1189 .ndo_poll_controller = mlx4_en_netpoll,
1190#endif
60d6fe99 1191 .ndo_set_features = mlx4_en_set_features,
897d7846 1192 .ndo_setup_tc = mlx4_en_setup_tc,
3addc568
SH
1193};
1194
c27a02cd
YP
1195int mlx4_en_init_netdev(struct mlx4_en_dev *mdev, int port,
1196 struct mlx4_en_port_profile *prof)
1197{
1198 struct net_device *dev;
1199 struct mlx4_en_priv *priv;
1200 int i;
1201 int err;
1202
f1593d22
TH
1203 dev = alloc_etherdev_mqs(sizeof(struct mlx4_en_priv),
1204 prof->tx_ring_num, prof->rx_ring_num);
41de8d4c 1205 if (dev == NULL)
c27a02cd 1206 return -ENOMEM;
c27a02cd
YP
1207
1208 SET_NETDEV_DEV(dev, &mdev->dev->pdev->dev);
741a00be 1209 dev->dev_id = port - 1;
c27a02cd
YP
1210
1211 /*
1212 * Initialize driver private data
1213 */
1214
1215 priv = netdev_priv(dev);
1216 memset(priv, 0, sizeof(struct mlx4_en_priv));
1217 priv->dev = dev;
1218 priv->mdev = mdev;
ebf8c9aa 1219 priv->ddev = &mdev->pdev->dev;
c27a02cd
YP
1220 priv->prof = prof;
1221 priv->port = port;
1222 priv->port_up = false;
c27a02cd 1223 priv->flags = prof->flags;
60d6fe99
AV
1224 priv->ctrl_flags = cpu_to_be32(MLX4_WQE_CTRL_CQ_UPDATE |
1225 MLX4_WQE_CTRL_SOLICITED);
c27a02cd 1226 priv->tx_ring_num = prof->tx_ring_num;
bc6a4744
AV
1227 priv->tx_ring = kzalloc(sizeof(struct mlx4_en_tx_ring) *
1228 priv->tx_ring_num, GFP_KERNEL);
1229 if (!priv->tx_ring) {
1230 err = -ENOMEM;
1231 goto out;
1232 }
1233 priv->tx_cq = kzalloc(sizeof(struct mlx4_en_cq) * priv->tx_ring_num,
1234 GFP_KERNEL);
1235 if (!priv->tx_cq) {
1236 err = -ENOMEM;
1237 goto out;
1238 }
c27a02cd 1239 priv->rx_ring_num = prof->rx_ring_num;
c27a02cd
YP
1240 priv->mac_index = -1;
1241 priv->msg_enable = MLX4_EN_MSG_LEVEL;
1242 spin_lock_init(&priv->stats_lock);
1243 INIT_WORK(&priv->mcast_task, mlx4_en_do_set_multicast);
1244 INIT_WORK(&priv->mac_task, mlx4_en_do_set_mac);
c27a02cd
YP
1245 INIT_WORK(&priv->watchdog_task, mlx4_en_restart);
1246 INIT_WORK(&priv->linkstate_task, mlx4_en_linkstate);
1247 INIT_DELAYED_WORK(&priv->stats_task, mlx4_en_do_get_stats);
564c274c
AV
1248#ifdef CONFIG_MLX4_EN_DCB
1249 if (!mlx4_is_slave(priv->mdev->dev))
1250 dev->dcbnl_ops = &mlx4_en_dcbnl_ops;
1251#endif
c27a02cd
YP
1252
1253 /* Query for default mac and max mtu */
1254 priv->max_mtu = mdev->dev->caps.eth_mtu_cap[priv->port];
1255 priv->mac = mdev->dev->caps.def_mac[priv->port];
1256 if (ILLEGAL_MAC(priv->mac)) {
453a6082 1257 en_err(priv, "Port: %d, invalid mac burned: 0x%llx, quiting\n",
c27a02cd
YP
1258 priv->port, priv->mac);
1259 err = -EINVAL;
1260 goto out;
1261 }
1262
1263 priv->stride = roundup_pow_of_two(sizeof(struct mlx4_en_rx_desc) +
1264 DS_SIZE * MLX4_EN_MAX_RX_FRAGS);
1265 err = mlx4_en_alloc_resources(priv);
1266 if (err)
1267 goto out;
1268
c27a02cd
YP
1269 /* Allocate page for receive rings */
1270 err = mlx4_alloc_hwq_res(mdev->dev, &priv->res,
1271 MLX4_EN_PAGE_SIZE, MLX4_EN_PAGE_SIZE);
1272 if (err) {
453a6082 1273 en_err(priv, "Failed to allocate page for rx qps\n");
c27a02cd
YP
1274 goto out;
1275 }
1276 priv->allocated = 1;
1277
c27a02cd
YP
1278 /*
1279 * Initialize netdev entry points
1280 */
3addc568 1281 dev->netdev_ops = &mlx4_netdev_ops;
c27a02cd 1282 dev->watchdog_timeo = MLX4_EN_WATCHDOG_TIMEOUT;
1eb63a28
BH
1283 netif_set_real_num_tx_queues(dev, priv->tx_ring_num);
1284 netif_set_real_num_rx_queues(dev, priv->rx_ring_num);
3addc568 1285
c27a02cd
YP
1286 SET_ETHTOOL_OPS(dev, &mlx4_en_ethtool_ops);
1287
1288 /* Set defualt MAC */
1289 dev->addr_len = ETH_ALEN;
8bf2e58f
YP
1290 for (i = 0; i < ETH_ALEN; i++) {
1291 dev->dev_addr[ETH_ALEN - 1 - i] = (u8) (priv->mac >> (8 * i));
1292 dev->perm_addr[ETH_ALEN - 1 - i] = (u8) (priv->mac >> (8 * i));
1293 }
c27a02cd
YP
1294
1295 /*
1296 * Set driver features
1297 */
c8c64cff
MM
1298 dev->hw_features = NETIF_F_SG | NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM;
1299 if (mdev->LSO_support)
1300 dev->hw_features |= NETIF_F_TSO | NETIF_F_TSO6;
1301
1302 dev->vlan_features = dev->hw_features;
1303
ad86107f 1304 dev->hw_features |= NETIF_F_RXCSUM | NETIF_F_RXHASH;
c8c64cff
MM
1305 dev->features = dev->hw_features | NETIF_F_HIGHDMA |
1306 NETIF_F_HW_VLAN_TX | NETIF_F_HW_VLAN_RX |
1307 NETIF_F_HW_VLAN_FILTER;
60d6fe99 1308 dev->hw_features |= NETIF_F_LOOPBACK;
c27a02cd
YP
1309
1310 mdev->pndev[port] = dev;
1311
1312 netif_carrier_off(dev);
1313 err = register_netdev(dev);
1314 if (err) {
453a6082 1315 en_err(priv, "Netdev registration failed for port %d\n", port);
c27a02cd
YP
1316 goto out;
1317 }
4234144f 1318 priv->registered = 1;
453a6082
YP
1319
1320 en_warn(priv, "Using %d TX rings\n", prof->tx_ring_num);
1321 en_warn(priv, "Using %d RX rings\n", prof->rx_ring_num);
1322
90822265 1323 /* Configure port */
5c8e9046 1324 mlx4_en_calc_rx_buf(dev);
90822265 1325 err = mlx4_SET_PORT_general(mdev->dev, priv->port,
5c8e9046
YP
1326 priv->rx_skb_size + ETH_FCS_LEN,
1327 prof->tx_pause, prof->tx_ppp,
1328 prof->rx_pause, prof->rx_ppp);
90822265
YP
1329 if (err) {
1330 en_err(priv, "Failed setting port general configurations "
1331 "for port %d, with error %d\n", priv->port, err);
1332 goto out;
1333 }
1334
1335 /* Init port */
1336 en_warn(priv, "Initializing port\n");
1337 err = mlx4_INIT_PORT(mdev->dev, priv->port);
1338 if (err) {
1339 en_err(priv, "Failed Initializing port\n");
1340 goto out;
1341 }
39f17b44 1342 mlx4_en_set_default_moderation(priv);
c27a02cd
YP
1343 queue_delayed_work(mdev->workqueue, &priv->stats_task, STATS_DELAY);
1344 return 0;
1345
1346out:
1347 mlx4_en_destroy_netdev(dev);
1348 return err;
1349}
1350