2 * Copyright (c) 2015, Mellanox Technologies. All rights reserved.
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:
10 * Redistribution and use in source and binary forms, with or
11 * without modification, are permitted provided that the following
14 * - Redistributions of source code must retain the above
15 * copyright notice, this list of conditions and the following
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.
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
35 #include "lib/clock.h"
37 void mlx5e_ethtool_get_drvinfo(struct mlx5e_priv
*priv
,
38 struct ethtool_drvinfo
*drvinfo
)
40 struct mlx5_core_dev
*mdev
= priv
->mdev
;
42 strlcpy(drvinfo
->driver
, DRIVER_NAME
, sizeof(drvinfo
->driver
));
43 strlcpy(drvinfo
->version
, DRIVER_VERSION
,
44 sizeof(drvinfo
->version
));
45 snprintf(drvinfo
->fw_version
, sizeof(drvinfo
->fw_version
),
47 fw_rev_maj(mdev
), fw_rev_min(mdev
), fw_rev_sub(mdev
),
49 strlcpy(drvinfo
->bus_info
, pci_name(mdev
->pdev
),
50 sizeof(drvinfo
->bus_info
));
53 static void mlx5e_get_drvinfo(struct net_device
*dev
,
54 struct ethtool_drvinfo
*drvinfo
)
56 struct mlx5e_priv
*priv
= netdev_priv(dev
);
58 mlx5e_ethtool_get_drvinfo(priv
, drvinfo
);
61 struct ptys2ethtool_config
{
62 __ETHTOOL_DECLARE_LINK_MODE_MASK(supported
);
63 __ETHTOOL_DECLARE_LINK_MODE_MASK(advertised
);
66 static struct ptys2ethtool_config ptys2ethtool_table
[MLX5E_LINK_MODES_NUMBER
];
68 #define MLX5_BUILD_PTYS2ETHTOOL_CONFIG(reg_, ...) \
70 struct ptys2ethtool_config *cfg; \
71 const unsigned int modes[] = { __VA_ARGS__ }; \
73 cfg = &ptys2ethtool_table[reg_]; \
74 bitmap_zero(cfg->supported, \
75 __ETHTOOL_LINK_MODE_MASK_NBITS); \
76 bitmap_zero(cfg->advertised, \
77 __ETHTOOL_LINK_MODE_MASK_NBITS); \
78 for (i = 0 ; i < ARRAY_SIZE(modes) ; ++i) { \
79 __set_bit(modes[i], cfg->supported); \
80 __set_bit(modes[i], cfg->advertised); \
84 void mlx5e_build_ptys2ethtool_map(void)
86 MLX5_BUILD_PTYS2ETHTOOL_CONFIG(MLX5E_1000BASE_CX_SGMII
,
87 ETHTOOL_LINK_MODE_1000baseKX_Full_BIT
);
88 MLX5_BUILD_PTYS2ETHTOOL_CONFIG(MLX5E_1000BASE_KX
,
89 ETHTOOL_LINK_MODE_1000baseKX_Full_BIT
);
90 MLX5_BUILD_PTYS2ETHTOOL_CONFIG(MLX5E_10GBASE_CX4
,
91 ETHTOOL_LINK_MODE_10000baseKX4_Full_BIT
);
92 MLX5_BUILD_PTYS2ETHTOOL_CONFIG(MLX5E_10GBASE_KX4
,
93 ETHTOOL_LINK_MODE_10000baseKX4_Full_BIT
);
94 MLX5_BUILD_PTYS2ETHTOOL_CONFIG(MLX5E_10GBASE_KR
,
95 ETHTOOL_LINK_MODE_10000baseKR_Full_BIT
);
96 MLX5_BUILD_PTYS2ETHTOOL_CONFIG(MLX5E_20GBASE_KR2
,
97 ETHTOOL_LINK_MODE_20000baseKR2_Full_BIT
);
98 MLX5_BUILD_PTYS2ETHTOOL_CONFIG(MLX5E_40GBASE_CR4
,
99 ETHTOOL_LINK_MODE_40000baseCR4_Full_BIT
);
100 MLX5_BUILD_PTYS2ETHTOOL_CONFIG(MLX5E_40GBASE_KR4
,
101 ETHTOOL_LINK_MODE_40000baseKR4_Full_BIT
);
102 MLX5_BUILD_PTYS2ETHTOOL_CONFIG(MLX5E_56GBASE_R4
,
103 ETHTOOL_LINK_MODE_56000baseKR4_Full_BIT
);
104 MLX5_BUILD_PTYS2ETHTOOL_CONFIG(MLX5E_10GBASE_CR
,
105 ETHTOOL_LINK_MODE_10000baseKR_Full_BIT
);
106 MLX5_BUILD_PTYS2ETHTOOL_CONFIG(MLX5E_10GBASE_SR
,
107 ETHTOOL_LINK_MODE_10000baseKR_Full_BIT
);
108 MLX5_BUILD_PTYS2ETHTOOL_CONFIG(MLX5E_10GBASE_ER
,
109 ETHTOOL_LINK_MODE_10000baseKR_Full_BIT
);
110 MLX5_BUILD_PTYS2ETHTOOL_CONFIG(MLX5E_40GBASE_SR4
,
111 ETHTOOL_LINK_MODE_40000baseSR4_Full_BIT
);
112 MLX5_BUILD_PTYS2ETHTOOL_CONFIG(MLX5E_40GBASE_LR4
,
113 ETHTOOL_LINK_MODE_40000baseLR4_Full_BIT
);
114 MLX5_BUILD_PTYS2ETHTOOL_CONFIG(MLX5E_50GBASE_SR2
,
115 ETHTOOL_LINK_MODE_50000baseSR2_Full_BIT
);
116 MLX5_BUILD_PTYS2ETHTOOL_CONFIG(MLX5E_100GBASE_CR4
,
117 ETHTOOL_LINK_MODE_100000baseCR4_Full_BIT
);
118 MLX5_BUILD_PTYS2ETHTOOL_CONFIG(MLX5E_100GBASE_SR4
,
119 ETHTOOL_LINK_MODE_100000baseSR4_Full_BIT
);
120 MLX5_BUILD_PTYS2ETHTOOL_CONFIG(MLX5E_100GBASE_KR4
,
121 ETHTOOL_LINK_MODE_100000baseKR4_Full_BIT
);
122 MLX5_BUILD_PTYS2ETHTOOL_CONFIG(MLX5E_100GBASE_LR4
,
123 ETHTOOL_LINK_MODE_100000baseLR4_ER4_Full_BIT
);
124 MLX5_BUILD_PTYS2ETHTOOL_CONFIG(MLX5E_10GBASE_T
,
125 ETHTOOL_LINK_MODE_10000baseT_Full_BIT
);
126 MLX5_BUILD_PTYS2ETHTOOL_CONFIG(MLX5E_25GBASE_CR
,
127 ETHTOOL_LINK_MODE_25000baseCR_Full_BIT
);
128 MLX5_BUILD_PTYS2ETHTOOL_CONFIG(MLX5E_25GBASE_KR
,
129 ETHTOOL_LINK_MODE_25000baseKR_Full_BIT
);
130 MLX5_BUILD_PTYS2ETHTOOL_CONFIG(MLX5E_25GBASE_SR
,
131 ETHTOOL_LINK_MODE_25000baseSR_Full_BIT
);
132 MLX5_BUILD_PTYS2ETHTOOL_CONFIG(MLX5E_50GBASE_CR2
,
133 ETHTOOL_LINK_MODE_50000baseCR2_Full_BIT
);
134 MLX5_BUILD_PTYS2ETHTOOL_CONFIG(MLX5E_50GBASE_KR2
,
135 ETHTOOL_LINK_MODE_50000baseKR2_Full_BIT
);
138 typedef int (*mlx5e_pflag_handler
)(struct net_device
*netdev
, bool enable
);
141 char name
[ETH_GSTRING_LEN
];
142 mlx5e_pflag_handler handler
;
145 static const struct pflag_desc mlx5e_priv_flags
[MLX5E_NUM_PFLAGS
];
147 int mlx5e_ethtool_get_sset_count(struct mlx5e_priv
*priv
, int sset
)
149 int i
, num_stats
= 0;
153 for (i
= 0; i
< mlx5e_num_stats_grps
; i
++)
154 num_stats
+= mlx5e_stats_grps
[i
].get_num_stats(priv
);
156 case ETH_SS_PRIV_FLAGS
:
157 return MLX5E_NUM_PFLAGS
;
159 return mlx5e_self_test_num(priv
);
166 static int mlx5e_get_sset_count(struct net_device
*dev
, int sset
)
168 struct mlx5e_priv
*priv
= netdev_priv(dev
);
170 return mlx5e_ethtool_get_sset_count(priv
, sset
);
173 static void mlx5e_fill_stats_strings(struct mlx5e_priv
*priv
, u8
*data
)
177 for (i
= 0; i
< mlx5e_num_stats_grps
; i
++)
178 idx
= mlx5e_stats_grps
[i
].fill_strings(priv
, data
, idx
);
181 void mlx5e_ethtool_get_strings(struct mlx5e_priv
*priv
, u32 stringset
, u8
*data
)
186 case ETH_SS_PRIV_FLAGS
:
187 for (i
= 0; i
< MLX5E_NUM_PFLAGS
; i
++)
188 strcpy(data
+ i
* ETH_GSTRING_LEN
,
189 mlx5e_priv_flags
[i
].name
);
193 for (i
= 0; i
< mlx5e_self_test_num(priv
); i
++)
194 strcpy(data
+ i
* ETH_GSTRING_LEN
,
195 mlx5e_self_tests
[i
]);
199 mlx5e_fill_stats_strings(priv
, data
);
204 static void mlx5e_get_strings(struct net_device
*dev
, u32 stringset
, u8
*data
)
206 struct mlx5e_priv
*priv
= netdev_priv(dev
);
208 mlx5e_ethtool_get_strings(priv
, stringset
, data
);
211 void mlx5e_ethtool_get_ethtool_stats(struct mlx5e_priv
*priv
,
212 struct ethtool_stats
*stats
, u64
*data
)
216 mutex_lock(&priv
->state_lock
);
217 mlx5e_update_stats(priv
);
218 mutex_unlock(&priv
->state_lock
);
220 for (i
= 0; i
< mlx5e_num_stats_grps
; i
++)
221 idx
= mlx5e_stats_grps
[i
].fill_stats(priv
, data
, idx
);
224 static void mlx5e_get_ethtool_stats(struct net_device
*dev
,
225 struct ethtool_stats
*stats
,
228 struct mlx5e_priv
*priv
= netdev_priv(dev
);
230 mlx5e_ethtool_get_ethtool_stats(priv
, stats
, data
);
233 void mlx5e_ethtool_get_ringparam(struct mlx5e_priv
*priv
,
234 struct ethtool_ringparam
*param
)
236 param
->rx_max_pending
= 1 << MLX5E_PARAMS_MAXIMUM_LOG_RQ_SIZE
;
237 param
->tx_max_pending
= 1 << MLX5E_PARAMS_MAXIMUM_LOG_SQ_SIZE
;
238 param
->rx_pending
= 1 << priv
->channels
.params
.log_rq_mtu_frames
;
239 param
->tx_pending
= 1 << priv
->channels
.params
.log_sq_size
;
242 static void mlx5e_get_ringparam(struct net_device
*dev
,
243 struct ethtool_ringparam
*param
)
245 struct mlx5e_priv
*priv
= netdev_priv(dev
);
247 mlx5e_ethtool_get_ringparam(priv
, param
);
250 int mlx5e_ethtool_set_ringparam(struct mlx5e_priv
*priv
,
251 struct ethtool_ringparam
*param
)
253 struct mlx5e_channels new_channels
= {};
258 if (param
->rx_jumbo_pending
) {
259 netdev_info(priv
->netdev
, "%s: rx_jumbo_pending not supported\n",
263 if (param
->rx_mini_pending
) {
264 netdev_info(priv
->netdev
, "%s: rx_mini_pending not supported\n",
269 if (param
->rx_pending
< (1 << MLX5E_PARAMS_MINIMUM_LOG_RQ_SIZE
)) {
270 netdev_info(priv
->netdev
, "%s: rx_pending (%d) < min (%d)\n",
271 __func__
, param
->rx_pending
,
272 1 << MLX5E_PARAMS_MINIMUM_LOG_RQ_SIZE
);
276 if (param
->tx_pending
< (1 << MLX5E_PARAMS_MINIMUM_LOG_SQ_SIZE
)) {
277 netdev_info(priv
->netdev
, "%s: tx_pending (%d) < min (%d)\n",
278 __func__
, param
->tx_pending
,
279 1 << MLX5E_PARAMS_MINIMUM_LOG_SQ_SIZE
);
283 log_rq_size
= order_base_2(param
->rx_pending
);
284 log_sq_size
= order_base_2(param
->tx_pending
);
286 if (log_rq_size
== priv
->channels
.params
.log_rq_mtu_frames
&&
287 log_sq_size
== priv
->channels
.params
.log_sq_size
)
290 mutex_lock(&priv
->state_lock
);
292 new_channels
.params
= priv
->channels
.params
;
293 new_channels
.params
.log_rq_mtu_frames
= log_rq_size
;
294 new_channels
.params
.log_sq_size
= log_sq_size
;
296 if (!test_bit(MLX5E_STATE_OPENED
, &priv
->state
)) {
297 priv
->channels
.params
= new_channels
.params
;
301 err
= mlx5e_open_channels(priv
, &new_channels
);
305 mlx5e_switch_priv_channels(priv
, &new_channels
, NULL
);
308 mutex_unlock(&priv
->state_lock
);
313 static int mlx5e_set_ringparam(struct net_device
*dev
,
314 struct ethtool_ringparam
*param
)
316 struct mlx5e_priv
*priv
= netdev_priv(dev
);
318 return mlx5e_ethtool_set_ringparam(priv
, param
);
321 void mlx5e_ethtool_get_channels(struct mlx5e_priv
*priv
,
322 struct ethtool_channels
*ch
)
324 ch
->max_combined
= mlx5e_get_netdev_max_channels(priv
->netdev
);
325 ch
->combined_count
= priv
->channels
.params
.num_channels
;
328 static void mlx5e_get_channels(struct net_device
*dev
,
329 struct ethtool_channels
*ch
)
331 struct mlx5e_priv
*priv
= netdev_priv(dev
);
333 mlx5e_ethtool_get_channels(priv
, ch
);
336 int mlx5e_ethtool_set_channels(struct mlx5e_priv
*priv
,
337 struct ethtool_channels
*ch
)
339 unsigned int count
= ch
->combined_count
;
340 struct mlx5e_channels new_channels
= {};
345 netdev_info(priv
->netdev
, "%s: combined_count=0 not supported\n",
350 if (priv
->channels
.params
.num_channels
== count
)
353 mutex_lock(&priv
->state_lock
);
355 new_channels
.params
= priv
->channels
.params
;
356 new_channels
.params
.num_channels
= count
;
358 if (!test_bit(MLX5E_STATE_OPENED
, &priv
->state
)) {
359 priv
->channels
.params
= new_channels
.params
;
363 /* Create fresh channels with new parameters */
364 err
= mlx5e_open_channels(priv
, &new_channels
);
368 arfs_enabled
= priv
->netdev
->features
& NETIF_F_NTUPLE
;
370 mlx5e_arfs_disable(priv
);
372 if (!netif_is_rxfh_configured(priv
->netdev
))
373 mlx5e_build_default_indir_rqt(priv
->rss_params
.indirection_rqt
,
374 MLX5E_INDIR_RQT_SIZE
, count
);
376 /* Switch to new channels, set new parameters and close old ones */
377 mlx5e_switch_priv_channels(priv
, &new_channels
, NULL
);
380 err
= mlx5e_arfs_enable(priv
);
382 netdev_err(priv
->netdev
, "%s: mlx5e_arfs_enable failed: %d\n",
387 mutex_unlock(&priv
->state_lock
);
392 static int mlx5e_set_channels(struct net_device
*dev
,
393 struct ethtool_channels
*ch
)
395 struct mlx5e_priv
*priv
= netdev_priv(dev
);
397 return mlx5e_ethtool_set_channels(priv
, ch
);
400 int mlx5e_ethtool_get_coalesce(struct mlx5e_priv
*priv
,
401 struct ethtool_coalesce
*coal
)
403 struct net_dim_cq_moder
*rx_moder
, *tx_moder
;
405 if (!MLX5_CAP_GEN(priv
->mdev
, cq_moderation
))
408 rx_moder
= &priv
->channels
.params
.rx_cq_moderation
;
409 coal
->rx_coalesce_usecs
= rx_moder
->usec
;
410 coal
->rx_max_coalesced_frames
= rx_moder
->pkts
;
411 coal
->use_adaptive_rx_coalesce
= priv
->channels
.params
.rx_dim_enabled
;
413 tx_moder
= &priv
->channels
.params
.tx_cq_moderation
;
414 coal
->tx_coalesce_usecs
= tx_moder
->usec
;
415 coal
->tx_max_coalesced_frames
= tx_moder
->pkts
;
416 coal
->use_adaptive_tx_coalesce
= priv
->channels
.params
.tx_dim_enabled
;
421 static int mlx5e_get_coalesce(struct net_device
*netdev
,
422 struct ethtool_coalesce
*coal
)
424 struct mlx5e_priv
*priv
= netdev_priv(netdev
);
426 return mlx5e_ethtool_get_coalesce(priv
, coal
);
429 #define MLX5E_MAX_COAL_TIME MLX5_MAX_CQ_PERIOD
430 #define MLX5E_MAX_COAL_FRAMES MLX5_MAX_CQ_COUNT
433 mlx5e_set_priv_channels_coalesce(struct mlx5e_priv
*priv
, struct ethtool_coalesce
*coal
)
435 struct mlx5_core_dev
*mdev
= priv
->mdev
;
439 for (i
= 0; i
< priv
->channels
.num
; ++i
) {
440 struct mlx5e_channel
*c
= priv
->channels
.c
[i
];
442 for (tc
= 0; tc
< c
->num_tc
; tc
++) {
443 mlx5_core_modify_cq_moderation(mdev
,
445 coal
->tx_coalesce_usecs
,
446 coal
->tx_max_coalesced_frames
);
449 mlx5_core_modify_cq_moderation(mdev
, &c
->rq
.cq
.mcq
,
450 coal
->rx_coalesce_usecs
,
451 coal
->rx_max_coalesced_frames
);
455 int mlx5e_ethtool_set_coalesce(struct mlx5e_priv
*priv
,
456 struct ethtool_coalesce
*coal
)
458 struct net_dim_cq_moder
*rx_moder
, *tx_moder
;
459 struct mlx5_core_dev
*mdev
= priv
->mdev
;
460 struct mlx5e_channels new_channels
= {};
464 if (!MLX5_CAP_GEN(mdev
, cq_moderation
))
467 if (coal
->tx_coalesce_usecs
> MLX5E_MAX_COAL_TIME
||
468 coal
->rx_coalesce_usecs
> MLX5E_MAX_COAL_TIME
) {
469 netdev_info(priv
->netdev
, "%s: maximum coalesce time supported is %lu usecs\n",
470 __func__
, MLX5E_MAX_COAL_TIME
);
474 if (coal
->tx_max_coalesced_frames
> MLX5E_MAX_COAL_FRAMES
||
475 coal
->rx_max_coalesced_frames
> MLX5E_MAX_COAL_FRAMES
) {
476 netdev_info(priv
->netdev
, "%s: maximum coalesced frames supported is %lu\n",
477 __func__
, MLX5E_MAX_COAL_FRAMES
);
481 mutex_lock(&priv
->state_lock
);
482 new_channels
.params
= priv
->channels
.params
;
484 rx_moder
= &new_channels
.params
.rx_cq_moderation
;
485 rx_moder
->usec
= coal
->rx_coalesce_usecs
;
486 rx_moder
->pkts
= coal
->rx_max_coalesced_frames
;
487 new_channels
.params
.rx_dim_enabled
= !!coal
->use_adaptive_rx_coalesce
;
489 tx_moder
= &new_channels
.params
.tx_cq_moderation
;
490 tx_moder
->usec
= coal
->tx_coalesce_usecs
;
491 tx_moder
->pkts
= coal
->tx_max_coalesced_frames
;
492 new_channels
.params
.tx_dim_enabled
= !!coal
->use_adaptive_tx_coalesce
;
494 if (!test_bit(MLX5E_STATE_OPENED
, &priv
->state
)) {
495 priv
->channels
.params
= new_channels
.params
;
500 reset
= (!!coal
->use_adaptive_rx_coalesce
!= priv
->channels
.params
.rx_dim_enabled
) ||
501 (!!coal
->use_adaptive_tx_coalesce
!= priv
->channels
.params
.tx_dim_enabled
);
504 mlx5e_set_priv_channels_coalesce(priv
, coal
);
505 priv
->channels
.params
= new_channels
.params
;
509 /* open fresh channels with new coal parameters */
510 err
= mlx5e_open_channels(priv
, &new_channels
);
514 mlx5e_switch_priv_channels(priv
, &new_channels
, NULL
);
517 mutex_unlock(&priv
->state_lock
);
521 static int mlx5e_set_coalesce(struct net_device
*netdev
,
522 struct ethtool_coalesce
*coal
)
524 struct mlx5e_priv
*priv
= netdev_priv(netdev
);
526 return mlx5e_ethtool_set_coalesce(priv
, coal
);
529 static void ptys2ethtool_supported_link(unsigned long *supported_modes
,
532 unsigned long proto_cap
= eth_proto_cap
;
535 for_each_set_bit(proto
, &proto_cap
, MLX5E_LINK_MODES_NUMBER
)
536 bitmap_or(supported_modes
, supported_modes
,
537 ptys2ethtool_table
[proto
].supported
,
538 __ETHTOOL_LINK_MODE_MASK_NBITS
);
541 static void ptys2ethtool_adver_link(unsigned long *advertising_modes
,
544 unsigned long proto_cap
= eth_proto_cap
;
547 for_each_set_bit(proto
, &proto_cap
, MLX5E_LINK_MODES_NUMBER
)
548 bitmap_or(advertising_modes
, advertising_modes
,
549 ptys2ethtool_table
[proto
].advertised
,
550 __ETHTOOL_LINK_MODE_MASK_NBITS
);
553 static const u32 pplm_fec_2_ethtool
[] = {
554 [MLX5E_FEC_NOFEC
] = ETHTOOL_FEC_OFF
,
555 [MLX5E_FEC_FIRECODE
] = ETHTOOL_FEC_BASER
,
556 [MLX5E_FEC_RS_528_514
] = ETHTOOL_FEC_RS
,
559 static u32
pplm2ethtool_fec(u_long fec_mode
, unsigned long size
)
564 return ETHTOOL_FEC_AUTO
;
566 mode
= find_first_bit(&fec_mode
, size
);
568 if (mode
< ARRAY_SIZE(pplm_fec_2_ethtool
))
569 return pplm_fec_2_ethtool
[mode
];
574 /* we use ETHTOOL_FEC_* offset and apply it to ETHTOOL_LINK_MODE_FEC_*_BIT */
575 static u32
ethtool_fec2ethtool_caps(u_long ethtool_fec_code
)
579 offset
= find_first_bit(ðtool_fec_code
, sizeof(u32
));
580 offset
-= ETHTOOL_FEC_OFF_BIT
;
581 offset
+= ETHTOOL_LINK_MODE_FEC_NONE_BIT
;
586 static int get_fec_supported_advertised(struct mlx5_core_dev
*dev
,
587 struct ethtool_link_ksettings
*link_ksettings
)
595 err
= mlx5e_get_fec_caps(dev
, (u8
*)&fec_caps
);
597 return (err
== -EOPNOTSUPP
) ? 0 : err
;
599 err
= mlx5e_get_fec_mode(dev
, &active_fec
, NULL
);
603 for_each_set_bit(bitn
, &fec_caps
, ARRAY_SIZE(pplm_fec_2_ethtool
)) {
604 u_long ethtool_bitmask
= pplm_fec_2_ethtool
[bitn
];
606 offset
= ethtool_fec2ethtool_caps(ethtool_bitmask
);
607 __set_bit(offset
, link_ksettings
->link_modes
.supported
);
610 active_fec
= pplm2ethtool_fec(active_fec
, sizeof(u32
) * BITS_PER_BYTE
);
611 offset
= ethtool_fec2ethtool_caps(active_fec
);
612 __set_bit(offset
, link_ksettings
->link_modes
.advertising
);
617 static void ptys2ethtool_supported_advertised_port(struct ethtool_link_ksettings
*link_ksettings
,
621 if (!connector_type
|| connector_type
>= MLX5E_CONNECTOR_TYPE_NUMBER
) {
622 if (eth_proto_cap
& (MLX5E_PROT_MASK(MLX5E_10GBASE_CR
)
623 | MLX5E_PROT_MASK(MLX5E_10GBASE_SR
)
624 | MLX5E_PROT_MASK(MLX5E_40GBASE_CR4
)
625 | MLX5E_PROT_MASK(MLX5E_40GBASE_SR4
)
626 | MLX5E_PROT_MASK(MLX5E_100GBASE_SR4
)
627 | MLX5E_PROT_MASK(MLX5E_1000BASE_CX_SGMII
))) {
628 ethtool_link_ksettings_add_link_mode(link_ksettings
,
631 ethtool_link_ksettings_add_link_mode(link_ksettings
,
636 if (eth_proto_cap
& (MLX5E_PROT_MASK(MLX5E_100GBASE_KR4
)
637 | MLX5E_PROT_MASK(MLX5E_40GBASE_KR4
)
638 | MLX5E_PROT_MASK(MLX5E_10GBASE_KR
)
639 | MLX5E_PROT_MASK(MLX5E_10GBASE_KX4
)
640 | MLX5E_PROT_MASK(MLX5E_1000BASE_KX
))) {
641 ethtool_link_ksettings_add_link_mode(link_ksettings
,
644 ethtool_link_ksettings_add_link_mode(link_ksettings
,
651 switch (connector_type
) {
653 ethtool_link_ksettings_add_link_mode(link_ksettings
,
655 ethtool_link_ksettings_add_link_mode(link_ksettings
,
659 ethtool_link_ksettings_add_link_mode(link_ksettings
,
661 ethtool_link_ksettings_add_link_mode(link_ksettings
,
665 ethtool_link_ksettings_add_link_mode(link_ksettings
,
667 ethtool_link_ksettings_add_link_mode(link_ksettings
,
671 ethtool_link_ksettings_add_link_mode(link_ksettings
,
673 ethtool_link_ksettings_add_link_mode(link_ksettings
,
676 case MLX5E_PORT_FIBRE
:
677 ethtool_link_ksettings_add_link_mode(link_ksettings
,
679 ethtool_link_ksettings_add_link_mode(link_ksettings
,
683 ethtool_link_ksettings_add_link_mode(link_ksettings
,
684 supported
, Backplane
);
685 ethtool_link_ksettings_add_link_mode(link_ksettings
,
686 advertising
, Backplane
);
688 case MLX5E_PORT_NONE
:
689 case MLX5E_PORT_OTHER
:
695 static void get_speed_duplex(struct net_device
*netdev
,
697 struct ethtool_link_ksettings
*link_ksettings
)
699 u32 speed
= SPEED_UNKNOWN
;
700 u8 duplex
= DUPLEX_UNKNOWN
;
702 if (!netif_carrier_ok(netdev
))
705 speed
= mlx5e_port_ptys2speed(eth_proto_oper
);
707 speed
= SPEED_UNKNOWN
;
711 duplex
= DUPLEX_FULL
;
714 link_ksettings
->base
.speed
= speed
;
715 link_ksettings
->base
.duplex
= duplex
;
718 static void get_supported(u32 eth_proto_cap
,
719 struct ethtool_link_ksettings
*link_ksettings
)
721 unsigned long *supported
= link_ksettings
->link_modes
.supported
;
723 ptys2ethtool_supported_link(supported
, eth_proto_cap
);
724 ethtool_link_ksettings_add_link_mode(link_ksettings
, supported
, Pause
);
727 static void get_advertising(u32 eth_proto_cap
, u8 tx_pause
,
729 struct ethtool_link_ksettings
*link_ksettings
)
731 unsigned long *advertising
= link_ksettings
->link_modes
.advertising
;
733 ptys2ethtool_adver_link(advertising
, eth_proto_cap
);
735 ethtool_link_ksettings_add_link_mode(link_ksettings
, advertising
, Pause
);
736 if (tx_pause
^ rx_pause
)
737 ethtool_link_ksettings_add_link_mode(link_ksettings
, advertising
, Asym_Pause
);
740 static int ptys2connector_type
[MLX5E_CONNECTOR_TYPE_NUMBER
] = {
741 [MLX5E_PORT_UNKNOWN
] = PORT_OTHER
,
742 [MLX5E_PORT_NONE
] = PORT_NONE
,
743 [MLX5E_PORT_TP
] = PORT_TP
,
744 [MLX5E_PORT_AUI
] = PORT_AUI
,
745 [MLX5E_PORT_BNC
] = PORT_BNC
,
746 [MLX5E_PORT_MII
] = PORT_MII
,
747 [MLX5E_PORT_FIBRE
] = PORT_FIBRE
,
748 [MLX5E_PORT_DA
] = PORT_DA
,
749 [MLX5E_PORT_OTHER
] = PORT_OTHER
,
752 static u8
get_connector_port(u32 eth_proto
, u8 connector_type
)
754 if (connector_type
&& connector_type
< MLX5E_CONNECTOR_TYPE_NUMBER
)
755 return ptys2connector_type
[connector_type
];
758 (MLX5E_PROT_MASK(MLX5E_10GBASE_SR
) |
759 MLX5E_PROT_MASK(MLX5E_40GBASE_SR4
) |
760 MLX5E_PROT_MASK(MLX5E_100GBASE_SR4
) |
761 MLX5E_PROT_MASK(MLX5E_1000BASE_CX_SGMII
))) {
766 (MLX5E_PROT_MASK(MLX5E_40GBASE_CR4
) |
767 MLX5E_PROT_MASK(MLX5E_10GBASE_CR
) |
768 MLX5E_PROT_MASK(MLX5E_100GBASE_CR4
))) {
773 (MLX5E_PROT_MASK(MLX5E_10GBASE_KX4
) |
774 MLX5E_PROT_MASK(MLX5E_10GBASE_KR
) |
775 MLX5E_PROT_MASK(MLX5E_40GBASE_KR4
) |
776 MLX5E_PROT_MASK(MLX5E_100GBASE_KR4
))) {
783 static void get_lp_advertising(u32 eth_proto_lp
,
784 struct ethtool_link_ksettings
*link_ksettings
)
786 unsigned long *lp_advertising
= link_ksettings
->link_modes
.lp_advertising
;
788 ptys2ethtool_adver_link(lp_advertising
, eth_proto_lp
);
791 int mlx5e_ethtool_get_link_ksettings(struct mlx5e_priv
*priv
,
792 struct ethtool_link_ksettings
*link_ksettings
)
794 struct mlx5_core_dev
*mdev
= priv
->mdev
;
795 u32 out
[MLX5_ST_SZ_DW(ptys_reg
)] = {0};
807 err
= mlx5_query_port_ptys(mdev
, out
, sizeof(out
), MLX5_PTYS_EN
, 1);
809 netdev_err(priv
->netdev
, "%s: query port ptys failed: %d\n",
814 eth_proto_cap
= MLX5_GET(ptys_reg
, out
, eth_proto_capability
);
815 eth_proto_admin
= MLX5_GET(ptys_reg
, out
, eth_proto_admin
);
816 eth_proto_oper
= MLX5_GET(ptys_reg
, out
, eth_proto_oper
);
817 eth_proto_lp
= MLX5_GET(ptys_reg
, out
, eth_proto_lp_advertise
);
818 an_disable_admin
= MLX5_GET(ptys_reg
, out
, an_disable_admin
);
819 an_status
= MLX5_GET(ptys_reg
, out
, an_status
);
820 connector_type
= MLX5_GET(ptys_reg
, out
, connector_type
);
822 mlx5_query_port_pause(mdev
, &rx_pause
, &tx_pause
);
824 ethtool_link_ksettings_zero_link_mode(link_ksettings
, supported
);
825 ethtool_link_ksettings_zero_link_mode(link_ksettings
, advertising
);
827 get_supported(eth_proto_cap
, link_ksettings
);
828 get_advertising(eth_proto_admin
, tx_pause
, rx_pause
, link_ksettings
);
829 get_speed_duplex(priv
->netdev
, eth_proto_oper
, link_ksettings
);
831 eth_proto_oper
= eth_proto_oper
? eth_proto_oper
: eth_proto_cap
;
833 link_ksettings
->base
.port
= get_connector_port(eth_proto_oper
,
835 ptys2ethtool_supported_advertised_port(link_ksettings
, eth_proto_admin
,
837 get_lp_advertising(eth_proto_lp
, link_ksettings
);
839 if (an_status
== MLX5_AN_COMPLETE
)
840 ethtool_link_ksettings_add_link_mode(link_ksettings
,
841 lp_advertising
, Autoneg
);
843 link_ksettings
->base
.autoneg
= an_disable_admin
? AUTONEG_DISABLE
:
845 ethtool_link_ksettings_add_link_mode(link_ksettings
, supported
,
848 err
= get_fec_supported_advertised(mdev
, link_ksettings
);
850 netdev_dbg(priv
->netdev
, "%s: FEC caps query failed: %d\n",
852 err
= 0; /* don't fail caps query because of FEC error */
855 if (!an_disable_admin
)
856 ethtool_link_ksettings_add_link_mode(link_ksettings
,
857 advertising
, Autoneg
);
863 static int mlx5e_get_link_ksettings(struct net_device
*netdev
,
864 struct ethtool_link_ksettings
*link_ksettings
)
866 struct mlx5e_priv
*priv
= netdev_priv(netdev
);
868 return mlx5e_ethtool_get_link_ksettings(priv
, link_ksettings
);
871 static u32
mlx5e_ethtool2ptys_adver_link(const unsigned long *link_modes
)
873 u32 i
, ptys_modes
= 0;
875 for (i
= 0; i
< MLX5E_LINK_MODES_NUMBER
; ++i
) {
876 if (bitmap_intersects(ptys2ethtool_table
[i
].advertised
,
878 __ETHTOOL_LINK_MODE_MASK_NBITS
))
879 ptys_modes
|= MLX5E_PROT_MASK(i
);
885 int mlx5e_ethtool_set_link_ksettings(struct mlx5e_priv
*priv
,
886 const struct ethtool_link_ksettings
*link_ksettings
)
888 struct mlx5_core_dev
*mdev
= priv
->mdev
;
889 u32 eth_proto_cap
, eth_proto_admin
;
890 bool an_changes
= false;
899 speed
= link_ksettings
->base
.speed
;
901 link_modes
= link_ksettings
->base
.autoneg
== AUTONEG_ENABLE
?
902 mlx5e_ethtool2ptys_adver_link(link_ksettings
->link_modes
.advertising
) :
903 mlx5e_port_speed2linkmodes(speed
);
905 err
= mlx5_query_port_proto_cap(mdev
, ð_proto_cap
, MLX5_PTYS_EN
);
907 netdev_err(priv
->netdev
, "%s: query port eth proto cap failed: %d\n",
912 link_modes
= link_modes
& eth_proto_cap
;
914 netdev_err(priv
->netdev
, "%s: Not supported link mode(s) requested",
920 err
= mlx5_query_port_proto_admin(mdev
, ð_proto_admin
, MLX5_PTYS_EN
);
922 netdev_err(priv
->netdev
, "%s: query port eth proto admin failed: %d\n",
927 mlx5_query_port_autoneg(mdev
, MLX5_PTYS_EN
, &an_status
,
928 &an_disable_cap
, &an_disable_admin
);
930 an_disable
= link_ksettings
->base
.autoneg
== AUTONEG_DISABLE
;
931 an_changes
= ((!an_disable
&& an_disable_admin
) ||
932 (an_disable
&& !an_disable_admin
));
934 if (!an_changes
&& link_modes
== eth_proto_admin
)
937 mlx5_set_port_ptys(mdev
, an_disable
, link_modes
, MLX5_PTYS_EN
);
938 mlx5_toggle_port_link(mdev
);
944 static int mlx5e_set_link_ksettings(struct net_device
*netdev
,
945 const struct ethtool_link_ksettings
*link_ksettings
)
947 struct mlx5e_priv
*priv
= netdev_priv(netdev
);
949 return mlx5e_ethtool_set_link_ksettings(priv
, link_ksettings
);
952 u32
mlx5e_ethtool_get_rxfh_key_size(struct mlx5e_priv
*priv
)
954 return sizeof(priv
->rss_params
.toeplitz_hash_key
);
957 static u32
mlx5e_get_rxfh_key_size(struct net_device
*netdev
)
959 struct mlx5e_priv
*priv
= netdev_priv(netdev
);
961 return mlx5e_ethtool_get_rxfh_key_size(priv
);
964 u32
mlx5e_ethtool_get_rxfh_indir_size(struct mlx5e_priv
*priv
)
966 return MLX5E_INDIR_RQT_SIZE
;
969 static u32
mlx5e_get_rxfh_indir_size(struct net_device
*netdev
)
971 struct mlx5e_priv
*priv
= netdev_priv(netdev
);
973 return mlx5e_ethtool_get_rxfh_indir_size(priv
);
976 static int mlx5e_get_rxfh(struct net_device
*netdev
, u32
*indir
, u8
*key
,
979 struct mlx5e_priv
*priv
= netdev_priv(netdev
);
980 struct mlx5e_rss_params
*rss
= &priv
->rss_params
;
983 memcpy(indir
, rss
->indirection_rqt
,
984 sizeof(rss
->indirection_rqt
));
987 memcpy(key
, rss
->toeplitz_hash_key
,
988 sizeof(rss
->toeplitz_hash_key
));
996 static int mlx5e_set_rxfh(struct net_device
*dev
, const u32
*indir
,
997 const u8
*key
, const u8 hfunc
)
999 struct mlx5e_priv
*priv
= netdev_priv(dev
);
1000 struct mlx5e_rss_params
*rss
= &priv
->rss_params
;
1001 int inlen
= MLX5_ST_SZ_BYTES(modify_tir_in
);
1002 bool hash_changed
= false;
1005 if ((hfunc
!= ETH_RSS_HASH_NO_CHANGE
) &&
1006 (hfunc
!= ETH_RSS_HASH_XOR
) &&
1007 (hfunc
!= ETH_RSS_HASH_TOP
))
1010 in
= kvzalloc(inlen
, GFP_KERNEL
);
1014 mutex_lock(&priv
->state_lock
);
1016 if (hfunc
!= ETH_RSS_HASH_NO_CHANGE
&& hfunc
!= rss
->hfunc
) {
1018 hash_changed
= true;
1022 memcpy(rss
->indirection_rqt
, indir
,
1023 sizeof(rss
->indirection_rqt
));
1025 if (test_bit(MLX5E_STATE_OPENED
, &priv
->state
)) {
1026 u32 rqtn
= priv
->indir_rqt
.rqtn
;
1027 struct mlx5e_redirect_rqt_param rrp
= {
1031 .hfunc
= rss
->hfunc
,
1032 .channels
= &priv
->channels
,
1037 mlx5e_redirect_rqt(priv
, rqtn
, MLX5E_INDIR_RQT_SIZE
, rrp
);
1042 memcpy(rss
->toeplitz_hash_key
, key
,
1043 sizeof(rss
->toeplitz_hash_key
));
1044 hash_changed
= hash_changed
|| rss
->hfunc
== ETH_RSS_HASH_TOP
;
1048 mlx5e_modify_tirs_hash(priv
, in
, inlen
);
1050 mutex_unlock(&priv
->state_lock
);
1057 #define MLX5E_PFC_PREVEN_AUTO_TOUT_MSEC 100
1058 #define MLX5E_PFC_PREVEN_TOUT_MAX_MSEC 8000
1059 #define MLX5E_PFC_PREVEN_MINOR_PRECENT 85
1060 #define MLX5E_PFC_PREVEN_TOUT_MIN_MSEC 80
1061 #define MLX5E_DEVICE_STALL_MINOR_WATERMARK(critical_tout) \
1062 max_t(u16, MLX5E_PFC_PREVEN_TOUT_MIN_MSEC, \
1063 (critical_tout * MLX5E_PFC_PREVEN_MINOR_PRECENT) / 100)
1065 static int mlx5e_get_pfc_prevention_tout(struct net_device
*netdev
,
1066 u16
*pfc_prevention_tout
)
1068 struct mlx5e_priv
*priv
= netdev_priv(netdev
);
1069 struct mlx5_core_dev
*mdev
= priv
->mdev
;
1071 if (!MLX5_CAP_PCAM_FEATURE((priv
)->mdev
, pfcc_mask
) ||
1072 !MLX5_CAP_DEBUG((priv
)->mdev
, stall_detect
))
1075 return mlx5_query_port_stall_watermark(mdev
, pfc_prevention_tout
, NULL
);
1078 static int mlx5e_set_pfc_prevention_tout(struct net_device
*netdev
,
1081 struct mlx5e_priv
*priv
= netdev_priv(netdev
);
1082 struct mlx5_core_dev
*mdev
= priv
->mdev
;
1086 if (!MLX5_CAP_PCAM_FEATURE((priv
)->mdev
, pfcc_mask
) ||
1087 !MLX5_CAP_DEBUG((priv
)->mdev
, stall_detect
))
1090 critical_tout
= (pfc_preven
== PFC_STORM_PREVENTION_AUTO
) ?
1091 MLX5E_PFC_PREVEN_AUTO_TOUT_MSEC
:
1094 if (critical_tout
!= PFC_STORM_PREVENTION_DISABLE
&&
1095 (critical_tout
> MLX5E_PFC_PREVEN_TOUT_MAX_MSEC
||
1096 critical_tout
< MLX5E_PFC_PREVEN_TOUT_MIN_MSEC
)) {
1097 netdev_info(netdev
, "%s: pfc prevention tout not in range (%d-%d)\n",
1098 __func__
, MLX5E_PFC_PREVEN_TOUT_MIN_MSEC
,
1099 MLX5E_PFC_PREVEN_TOUT_MAX_MSEC
);
1103 minor
= MLX5E_DEVICE_STALL_MINOR_WATERMARK(critical_tout
);
1104 return mlx5_set_port_stall_watermark(mdev
, critical_tout
,
1108 static int mlx5e_get_tunable(struct net_device
*dev
,
1109 const struct ethtool_tunable
*tuna
,
1115 case ETHTOOL_PFC_PREVENTION_TOUT
:
1116 err
= mlx5e_get_pfc_prevention_tout(dev
, data
);
1126 static int mlx5e_set_tunable(struct net_device
*dev
,
1127 const struct ethtool_tunable
*tuna
,
1130 struct mlx5e_priv
*priv
= netdev_priv(dev
);
1133 mutex_lock(&priv
->state_lock
);
1136 case ETHTOOL_PFC_PREVENTION_TOUT
:
1137 err
= mlx5e_set_pfc_prevention_tout(dev
, *(u16
*)data
);
1144 mutex_unlock(&priv
->state_lock
);
1148 void mlx5e_ethtool_get_pauseparam(struct mlx5e_priv
*priv
,
1149 struct ethtool_pauseparam
*pauseparam
)
1151 struct mlx5_core_dev
*mdev
= priv
->mdev
;
1154 err
= mlx5_query_port_pause(mdev
, &pauseparam
->rx_pause
,
1155 &pauseparam
->tx_pause
);
1157 netdev_err(priv
->netdev
, "%s: mlx5_query_port_pause failed:0x%x\n",
1162 static void mlx5e_get_pauseparam(struct net_device
*netdev
,
1163 struct ethtool_pauseparam
*pauseparam
)
1165 struct mlx5e_priv
*priv
= netdev_priv(netdev
);
1167 mlx5e_ethtool_get_pauseparam(priv
, pauseparam
);
1170 int mlx5e_ethtool_set_pauseparam(struct mlx5e_priv
*priv
,
1171 struct ethtool_pauseparam
*pauseparam
)
1173 struct mlx5_core_dev
*mdev
= priv
->mdev
;
1176 if (pauseparam
->autoneg
)
1179 err
= mlx5_set_port_pause(mdev
,
1180 pauseparam
->rx_pause
? 1 : 0,
1181 pauseparam
->tx_pause
? 1 : 0);
1183 netdev_err(priv
->netdev
, "%s: mlx5_set_port_pause failed:0x%x\n",
1190 static int mlx5e_set_pauseparam(struct net_device
*netdev
,
1191 struct ethtool_pauseparam
*pauseparam
)
1193 struct mlx5e_priv
*priv
= netdev_priv(netdev
);
1195 return mlx5e_ethtool_set_pauseparam(priv
, pauseparam
);
1198 int mlx5e_ethtool_get_ts_info(struct mlx5e_priv
*priv
,
1199 struct ethtool_ts_info
*info
)
1201 struct mlx5_core_dev
*mdev
= priv
->mdev
;
1203 info
->phc_index
= mlx5_clock_get_ptp_index(mdev
);
1205 if (!MLX5_CAP_GEN(priv
->mdev
, device_frequency_khz
) ||
1206 info
->phc_index
== -1)
1209 info
->so_timestamping
= SOF_TIMESTAMPING_TX_HARDWARE
|
1210 SOF_TIMESTAMPING_RX_HARDWARE
|
1211 SOF_TIMESTAMPING_RAW_HARDWARE
;
1213 info
->tx_types
= BIT(HWTSTAMP_TX_OFF
) |
1214 BIT(HWTSTAMP_TX_ON
);
1216 info
->rx_filters
= BIT(HWTSTAMP_FILTER_NONE
) |
1217 BIT(HWTSTAMP_FILTER_ALL
);
1222 static int mlx5e_get_ts_info(struct net_device
*dev
,
1223 struct ethtool_ts_info
*info
)
1225 struct mlx5e_priv
*priv
= netdev_priv(dev
);
1227 return mlx5e_ethtool_get_ts_info(priv
, info
);
1230 static __u32
mlx5e_get_wol_supported(struct mlx5_core_dev
*mdev
)
1234 if (MLX5_CAP_GEN(mdev
, wol_g
))
1237 if (MLX5_CAP_GEN(mdev
, wol_s
))
1238 ret
|= WAKE_MAGICSECURE
;
1240 if (MLX5_CAP_GEN(mdev
, wol_a
))
1243 if (MLX5_CAP_GEN(mdev
, wol_b
))
1246 if (MLX5_CAP_GEN(mdev
, wol_m
))
1249 if (MLX5_CAP_GEN(mdev
, wol_u
))
1252 if (MLX5_CAP_GEN(mdev
, wol_p
))
1258 static __u32
mlx5e_refomrat_wol_mode_mlx5_to_linux(u8 mode
)
1262 if (mode
& MLX5_WOL_MAGIC
)
1265 if (mode
& MLX5_WOL_SECURED_MAGIC
)
1266 ret
|= WAKE_MAGICSECURE
;
1268 if (mode
& MLX5_WOL_ARP
)
1271 if (mode
& MLX5_WOL_BROADCAST
)
1274 if (mode
& MLX5_WOL_MULTICAST
)
1277 if (mode
& MLX5_WOL_UNICAST
)
1280 if (mode
& MLX5_WOL_PHY_ACTIVITY
)
1286 static u8
mlx5e_refomrat_wol_mode_linux_to_mlx5(__u32 mode
)
1290 if (mode
& WAKE_MAGIC
)
1291 ret
|= MLX5_WOL_MAGIC
;
1293 if (mode
& WAKE_MAGICSECURE
)
1294 ret
|= MLX5_WOL_SECURED_MAGIC
;
1296 if (mode
& WAKE_ARP
)
1297 ret
|= MLX5_WOL_ARP
;
1299 if (mode
& WAKE_BCAST
)
1300 ret
|= MLX5_WOL_BROADCAST
;
1302 if (mode
& WAKE_MCAST
)
1303 ret
|= MLX5_WOL_MULTICAST
;
1305 if (mode
& WAKE_UCAST
)
1306 ret
|= MLX5_WOL_UNICAST
;
1308 if (mode
& WAKE_PHY
)
1309 ret
|= MLX5_WOL_PHY_ACTIVITY
;
1314 static void mlx5e_get_wol(struct net_device
*netdev
,
1315 struct ethtool_wolinfo
*wol
)
1317 struct mlx5e_priv
*priv
= netdev_priv(netdev
);
1318 struct mlx5_core_dev
*mdev
= priv
->mdev
;
1322 memset(wol
, 0, sizeof(*wol
));
1324 wol
->supported
= mlx5e_get_wol_supported(mdev
);
1325 if (!wol
->supported
)
1328 err
= mlx5_query_port_wol(mdev
, &mlx5_wol_mode
);
1332 wol
->wolopts
= mlx5e_refomrat_wol_mode_mlx5_to_linux(mlx5_wol_mode
);
1335 static int mlx5e_set_wol(struct net_device
*netdev
, struct ethtool_wolinfo
*wol
)
1337 struct mlx5e_priv
*priv
= netdev_priv(netdev
);
1338 struct mlx5_core_dev
*mdev
= priv
->mdev
;
1339 __u32 wol_supported
= mlx5e_get_wol_supported(mdev
);
1345 if (wol
->wolopts
& ~wol_supported
)
1348 mlx5_wol_mode
= mlx5e_refomrat_wol_mode_linux_to_mlx5(wol
->wolopts
);
1350 return mlx5_set_port_wol(mdev
, mlx5_wol_mode
);
1353 static int mlx5e_get_fecparam(struct net_device
*netdev
,
1354 struct ethtool_fecparam
*fecparam
)
1356 struct mlx5e_priv
*priv
= netdev_priv(netdev
);
1357 struct mlx5_core_dev
*mdev
= priv
->mdev
;
1358 u8 fec_configured
= 0;
1362 err
= mlx5e_get_fec_mode(mdev
, &fec_active
, &fec_configured
);
1367 fecparam
->active_fec
= pplm2ethtool_fec((u_long
)fec_active
,
1368 sizeof(u32
) * BITS_PER_BYTE
);
1370 if (!fecparam
->active_fec
)
1373 fecparam
->fec
= pplm2ethtool_fec((u_long
)fec_configured
,
1374 sizeof(u8
) * BITS_PER_BYTE
);
1379 static int mlx5e_set_fecparam(struct net_device
*netdev
,
1380 struct ethtool_fecparam
*fecparam
)
1382 struct mlx5e_priv
*priv
= netdev_priv(netdev
);
1383 struct mlx5_core_dev
*mdev
= priv
->mdev
;
1388 for (mode
= 0; mode
< ARRAY_SIZE(pplm_fec_2_ethtool
); mode
++) {
1389 if (!(pplm_fec_2_ethtool
[mode
] & fecparam
->fec
))
1391 fec_policy
|= (1 << mode
);
1395 err
= mlx5e_set_fec_mode(mdev
, fec_policy
);
1400 mlx5_toggle_port_link(mdev
);
1405 static u32
mlx5e_get_msglevel(struct net_device
*dev
)
1407 return ((struct mlx5e_priv
*)netdev_priv(dev
))->msglevel
;
1410 static void mlx5e_set_msglevel(struct net_device
*dev
, u32 val
)
1412 ((struct mlx5e_priv
*)netdev_priv(dev
))->msglevel
= val
;
1415 static int mlx5e_set_phys_id(struct net_device
*dev
,
1416 enum ethtool_phys_id_state state
)
1418 struct mlx5e_priv
*priv
= netdev_priv(dev
);
1419 struct mlx5_core_dev
*mdev
= priv
->mdev
;
1420 u16 beacon_duration
;
1422 if (!MLX5_CAP_GEN(mdev
, beacon_led
))
1426 case ETHTOOL_ID_ACTIVE
:
1427 beacon_duration
= MLX5_BEACON_DURATION_INF
;
1429 case ETHTOOL_ID_INACTIVE
:
1430 beacon_duration
= MLX5_BEACON_DURATION_OFF
;
1436 return mlx5_set_port_beacon(mdev
, beacon_duration
);
1439 static int mlx5e_get_module_info(struct net_device
*netdev
,
1440 struct ethtool_modinfo
*modinfo
)
1442 struct mlx5e_priv
*priv
= netdev_priv(netdev
);
1443 struct mlx5_core_dev
*dev
= priv
->mdev
;
1447 size_read
= mlx5_query_module_eeprom(dev
, 0, 2, data
);
1451 /* data[0] = identifier byte */
1453 case MLX5_MODULE_ID_QSFP
:
1454 modinfo
->type
= ETH_MODULE_SFF_8436
;
1455 modinfo
->eeprom_len
= ETH_MODULE_SFF_8436_LEN
;
1457 case MLX5_MODULE_ID_QSFP_PLUS
:
1458 case MLX5_MODULE_ID_QSFP28
:
1459 /* data[1] = revision id */
1460 if (data
[0] == MLX5_MODULE_ID_QSFP28
|| data
[1] >= 0x3) {
1461 modinfo
->type
= ETH_MODULE_SFF_8636
;
1462 modinfo
->eeprom_len
= ETH_MODULE_SFF_8636_LEN
;
1464 modinfo
->type
= ETH_MODULE_SFF_8436
;
1465 modinfo
->eeprom_len
= ETH_MODULE_SFF_8436_LEN
;
1468 case MLX5_MODULE_ID_SFP
:
1469 modinfo
->type
= ETH_MODULE_SFF_8472
;
1470 modinfo
->eeprom_len
= ETH_MODULE_SFF_8472_LEN
;
1473 netdev_err(priv
->netdev
, "%s: cable type not recognized:0x%x\n",
1481 static int mlx5e_get_module_eeprom(struct net_device
*netdev
,
1482 struct ethtool_eeprom
*ee
,
1485 struct mlx5e_priv
*priv
= netdev_priv(netdev
);
1486 struct mlx5_core_dev
*mdev
= priv
->mdev
;
1487 int offset
= ee
->offset
;
1494 memset(data
, 0, ee
->len
);
1496 while (i
< ee
->len
) {
1497 size_read
= mlx5_query_module_eeprom(mdev
, offset
, ee
->len
- i
,
1504 if (size_read
< 0) {
1505 netdev_err(priv
->netdev
, "%s: mlx5_query_eeprom failed:0x%x\n",
1506 __func__
, size_read
);
1511 offset
+= size_read
;
1517 static int set_pflag_cqe_based_moder(struct net_device
*netdev
, bool enable
,
1520 struct mlx5e_priv
*priv
= netdev_priv(netdev
);
1521 struct mlx5_core_dev
*mdev
= priv
->mdev
;
1522 struct mlx5e_channels new_channels
= {};
1524 u8 cq_period_mode
, current_cq_period_mode
;
1527 cq_period_mode
= enable
?
1528 MLX5_CQ_PERIOD_MODE_START_FROM_CQE
:
1529 MLX5_CQ_PERIOD_MODE_START_FROM_EQE
;
1530 current_cq_period_mode
= is_rx_cq
?
1531 priv
->channels
.params
.rx_cq_moderation
.cq_period_mode
:
1532 priv
->channels
.params
.tx_cq_moderation
.cq_period_mode
;
1533 mode_changed
= cq_period_mode
!= current_cq_period_mode
;
1535 if (cq_period_mode
== MLX5_CQ_PERIOD_MODE_START_FROM_CQE
&&
1536 !MLX5_CAP_GEN(mdev
, cq_period_start_from_cqe
))
1542 new_channels
.params
= priv
->channels
.params
;
1544 mlx5e_set_rx_cq_mode_params(&new_channels
.params
, cq_period_mode
);
1546 mlx5e_set_tx_cq_mode_params(&new_channels
.params
, cq_period_mode
);
1548 if (!test_bit(MLX5E_STATE_OPENED
, &priv
->state
)) {
1549 priv
->channels
.params
= new_channels
.params
;
1553 err
= mlx5e_open_channels(priv
, &new_channels
);
1557 mlx5e_switch_priv_channels(priv
, &new_channels
, NULL
);
1561 static int set_pflag_tx_cqe_based_moder(struct net_device
*netdev
, bool enable
)
1563 return set_pflag_cqe_based_moder(netdev
, enable
, false);
1566 static int set_pflag_rx_cqe_based_moder(struct net_device
*netdev
, bool enable
)
1568 return set_pflag_cqe_based_moder(netdev
, enable
, true);
1571 int mlx5e_modify_rx_cqe_compression_locked(struct mlx5e_priv
*priv
, bool new_val
)
1573 bool curr_val
= MLX5E_GET_PFLAG(&priv
->channels
.params
, MLX5E_PFLAG_RX_CQE_COMPRESS
);
1574 struct mlx5e_channels new_channels
= {};
1577 if (!MLX5_CAP_GEN(priv
->mdev
, cqe_compression
))
1578 return new_val
? -EOPNOTSUPP
: 0;
1580 if (curr_val
== new_val
)
1583 new_channels
.params
= priv
->channels
.params
;
1584 MLX5E_SET_PFLAG(&new_channels
.params
, MLX5E_PFLAG_RX_CQE_COMPRESS
, new_val
);
1586 if (!test_bit(MLX5E_STATE_OPENED
, &priv
->state
)) {
1587 priv
->channels
.params
= new_channels
.params
;
1591 err
= mlx5e_open_channels(priv
, &new_channels
);
1595 mlx5e_switch_priv_channels(priv
, &new_channels
, NULL
);
1596 mlx5e_dbg(DRV
, priv
, "MLX5E: RxCqeCmprss was turned %s\n",
1597 MLX5E_GET_PFLAG(&priv
->channels
.params
,
1598 MLX5E_PFLAG_RX_CQE_COMPRESS
) ? "ON" : "OFF");
1603 static int set_pflag_rx_cqe_compress(struct net_device
*netdev
,
1606 struct mlx5e_priv
*priv
= netdev_priv(netdev
);
1607 struct mlx5_core_dev
*mdev
= priv
->mdev
;
1609 if (!MLX5_CAP_GEN(mdev
, cqe_compression
))
1612 if (enable
&& priv
->tstamp
.rx_filter
!= HWTSTAMP_FILTER_NONE
) {
1613 netdev_err(netdev
, "Can't enable cqe compression while timestamping is enabled.\n");
1617 mlx5e_modify_rx_cqe_compression_locked(priv
, enable
);
1618 priv
->channels
.params
.rx_cqe_compress_def
= enable
;
1623 static int set_pflag_rx_striding_rq(struct net_device
*netdev
, bool enable
)
1625 struct mlx5e_priv
*priv
= netdev_priv(netdev
);
1626 struct mlx5_core_dev
*mdev
= priv
->mdev
;
1627 struct mlx5e_channels new_channels
= {};
1631 if (!mlx5e_check_fragmented_striding_rq_cap(mdev
))
1633 if (!mlx5e_striding_rq_possible(mdev
, &priv
->channels
.params
))
1635 } else if (priv
->channels
.params
.lro_en
) {
1636 netdev_warn(netdev
, "Can't set legacy RQ with LRO, disable LRO first\n");
1640 new_channels
.params
= priv
->channels
.params
;
1642 MLX5E_SET_PFLAG(&new_channels
.params
, MLX5E_PFLAG_RX_STRIDING_RQ
, enable
);
1643 mlx5e_set_rq_type(mdev
, &new_channels
.params
);
1645 if (!test_bit(MLX5E_STATE_OPENED
, &priv
->state
)) {
1646 priv
->channels
.params
= new_channels
.params
;
1650 err
= mlx5e_open_channels(priv
, &new_channels
);
1654 mlx5e_switch_priv_channels(priv
, &new_channels
, NULL
);
1658 static int set_pflag_rx_no_csum_complete(struct net_device
*netdev
, bool enable
)
1660 struct mlx5e_priv
*priv
= netdev_priv(netdev
);
1661 struct mlx5e_channels
*channels
= &priv
->channels
;
1662 struct mlx5e_channel
*c
;
1665 if (!test_bit(MLX5E_STATE_OPENED
, &priv
->state
))
1668 for (i
= 0; i
< channels
->num
; i
++) {
1671 __set_bit(MLX5E_RQ_STATE_NO_CSUM_COMPLETE
, &c
->rq
.state
);
1673 __clear_bit(MLX5E_RQ_STATE_NO_CSUM_COMPLETE
, &c
->rq
.state
);
1679 static int set_pflag_xdp_tx_mpwqe(struct net_device
*netdev
, bool enable
)
1681 struct mlx5e_priv
*priv
= netdev_priv(netdev
);
1682 struct mlx5_core_dev
*mdev
= priv
->mdev
;
1683 struct mlx5e_channels new_channels
= {};
1686 if (enable
&& !MLX5_CAP_ETH(mdev
, enhanced_multi_pkt_send_wqe
))
1689 new_channels
.params
= priv
->channels
.params
;
1691 MLX5E_SET_PFLAG(&new_channels
.params
, MLX5E_PFLAG_XDP_TX_MPWQE
, enable
);
1693 if (!test_bit(MLX5E_STATE_OPENED
, &priv
->state
)) {
1694 priv
->channels
.params
= new_channels
.params
;
1698 err
= mlx5e_open_channels(priv
, &new_channels
);
1702 mlx5e_switch_priv_channels(priv
, &new_channels
, NULL
);
1706 static const struct pflag_desc mlx5e_priv_flags
[MLX5E_NUM_PFLAGS
] = {
1707 { "rx_cqe_moder", set_pflag_rx_cqe_based_moder
},
1708 { "tx_cqe_moder", set_pflag_tx_cqe_based_moder
},
1709 { "rx_cqe_compress", set_pflag_rx_cqe_compress
},
1710 { "rx_striding_rq", set_pflag_rx_striding_rq
},
1711 { "rx_no_csum_complete", set_pflag_rx_no_csum_complete
},
1712 { "xdp_tx_mpwqe", set_pflag_xdp_tx_mpwqe
},
1715 static int mlx5e_handle_pflag(struct net_device
*netdev
,
1717 enum mlx5e_priv_flag flag
)
1719 struct mlx5e_priv
*priv
= netdev_priv(netdev
);
1720 bool enable
= !!(wanted_flags
& BIT(flag
));
1721 u32 changes
= wanted_flags
^ priv
->channels
.params
.pflags
;
1724 if (!(changes
& BIT(flag
)))
1727 err
= mlx5e_priv_flags
[flag
].handler(netdev
, enable
);
1729 netdev_err(netdev
, "%s private flag '%s' failed err %d\n",
1730 enable
? "Enable" : "Disable", mlx5e_priv_flags
[flag
].name
, err
);
1734 MLX5E_SET_PFLAG(&priv
->channels
.params
, flag
, enable
);
1738 static int mlx5e_set_priv_flags(struct net_device
*netdev
, u32 pflags
)
1740 struct mlx5e_priv
*priv
= netdev_priv(netdev
);
1741 enum mlx5e_priv_flag pflag
;
1744 mutex_lock(&priv
->state_lock
);
1746 for (pflag
= 0; pflag
< MLX5E_NUM_PFLAGS
; pflag
++) {
1747 err
= mlx5e_handle_pflag(netdev
, pflags
, pflag
);
1752 mutex_unlock(&priv
->state_lock
);
1754 /* Need to fix some features.. */
1755 netdev_update_features(netdev
);
1760 static u32
mlx5e_get_priv_flags(struct net_device
*netdev
)
1762 struct mlx5e_priv
*priv
= netdev_priv(netdev
);
1764 return priv
->channels
.params
.pflags
;
1767 int mlx5e_ethtool_flash_device(struct mlx5e_priv
*priv
,
1768 struct ethtool_flash
*flash
)
1770 struct mlx5_core_dev
*mdev
= priv
->mdev
;
1771 struct net_device
*dev
= priv
->netdev
;
1772 const struct firmware
*fw
;
1775 if (flash
->region
!= ETHTOOL_FLASH_ALL_REGIONS
)
1778 err
= request_firmware_direct(&fw
, flash
->data
, &dev
->dev
);
1785 err
= mlx5_firmware_flash(mdev
, fw
);
1786 release_firmware(fw
);
1793 static int mlx5e_flash_device(struct net_device
*dev
,
1794 struct ethtool_flash
*flash
)
1796 struct mlx5e_priv
*priv
= netdev_priv(dev
);
1798 return mlx5e_ethtool_flash_device(priv
, flash
);
1801 const struct ethtool_ops mlx5e_ethtool_ops
= {
1802 .get_drvinfo
= mlx5e_get_drvinfo
,
1803 .get_link
= ethtool_op_get_link
,
1804 .get_strings
= mlx5e_get_strings
,
1805 .get_sset_count
= mlx5e_get_sset_count
,
1806 .get_ethtool_stats
= mlx5e_get_ethtool_stats
,
1807 .get_ringparam
= mlx5e_get_ringparam
,
1808 .set_ringparam
= mlx5e_set_ringparam
,
1809 .get_channels
= mlx5e_get_channels
,
1810 .set_channels
= mlx5e_set_channels
,
1811 .get_coalesce
= mlx5e_get_coalesce
,
1812 .set_coalesce
= mlx5e_set_coalesce
,
1813 .get_link_ksettings
= mlx5e_get_link_ksettings
,
1814 .set_link_ksettings
= mlx5e_set_link_ksettings
,
1815 .get_rxfh_key_size
= mlx5e_get_rxfh_key_size
,
1816 .get_rxfh_indir_size
= mlx5e_get_rxfh_indir_size
,
1817 .get_rxfh
= mlx5e_get_rxfh
,
1818 .set_rxfh
= mlx5e_set_rxfh
,
1819 #ifdef CONFIG_MLX5_EN_RXNFC
1820 .get_rxnfc
= mlx5e_get_rxnfc
,
1821 .set_rxnfc
= mlx5e_set_rxnfc
,
1823 .flash_device
= mlx5e_flash_device
,
1824 .get_tunable
= mlx5e_get_tunable
,
1825 .set_tunable
= mlx5e_set_tunable
,
1826 .get_pauseparam
= mlx5e_get_pauseparam
,
1827 .set_pauseparam
= mlx5e_set_pauseparam
,
1828 .get_ts_info
= mlx5e_get_ts_info
,
1829 .set_phys_id
= mlx5e_set_phys_id
,
1830 .get_wol
= mlx5e_get_wol
,
1831 .set_wol
= mlx5e_set_wol
,
1832 .get_module_info
= mlx5e_get_module_info
,
1833 .get_module_eeprom
= mlx5e_get_module_eeprom
,
1834 .get_priv_flags
= mlx5e_get_priv_flags
,
1835 .set_priv_flags
= mlx5e_set_priv_flags
,
1836 .self_test
= mlx5e_self_test
,
1837 .get_msglevel
= mlx5e_get_msglevel
,
1838 .set_msglevel
= mlx5e_set_msglevel
,
1839 .get_fecparam
= mlx5e_get_fecparam
,
1840 .set_fecparam
= mlx5e_set_fecparam
,