2060 lines
57 KiB
C
2060 lines
57 KiB
C
/* QLogic qede NIC Driver
|
|
* Copyright (c) 2015-2017 QLogic Corporation
|
|
*
|
|
* This software is available to you under a choice of one of two
|
|
* licenses. You may choose to be licensed under the terms of the GNU
|
|
* General Public License (GPL) Version 2, available from the file
|
|
* COPYING in the main directory of this source tree, or the
|
|
* OpenIB.org BSD license below:
|
|
*
|
|
* Redistribution and use in source and binary forms, with or
|
|
* without modification, are permitted provided that the following
|
|
* conditions are met:
|
|
*
|
|
* - Redistributions of source code must retain the above
|
|
* copyright notice, this list of conditions and the following
|
|
* disclaimer.
|
|
*
|
|
* - Redistributions in binary form must reproduce the above
|
|
* copyright notice, this list of conditions and the following
|
|
* disclaimer in the documentation and /or other materials
|
|
* provided with the distribution.
|
|
*
|
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
|
|
* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
|
|
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
|
|
* NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
|
|
* BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
|
|
* ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
|
|
* CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
|
|
* SOFTWARE.
|
|
*/
|
|
#include <linux/version.h>
|
|
#include <linux/types.h>
|
|
#include <linux/netdevice.h>
|
|
#include <linux/etherdevice.h>
|
|
#include <linux/ethtool.h>
|
|
#include <linux/string.h>
|
|
#include <linux/pci.h>
|
|
#include <linux/capability.h>
|
|
#include <linux/vmalloc.h>
|
|
#include "qede.h"
|
|
#include "qede_ptp.h"
|
|
|
|
#define QEDE_RQSTAT_OFFSET(stat_name) \
|
|
(offsetof(struct qede_rx_queue, stat_name))
|
|
#define QEDE_RQSTAT_STRING(stat_name) (#stat_name)
|
|
#define QEDE_RQSTAT(stat_name) \
|
|
{QEDE_RQSTAT_OFFSET(stat_name), QEDE_RQSTAT_STRING(stat_name)}
|
|
|
|
#define QEDE_SELFTEST_POLL_COUNT 100
|
|
|
|
static const struct {
|
|
u64 offset;
|
|
char string[ETH_GSTRING_LEN];
|
|
} qede_rqstats_arr[] = {
|
|
QEDE_RQSTAT(rcv_pkts),
|
|
QEDE_RQSTAT(rx_hw_errors),
|
|
QEDE_RQSTAT(rx_alloc_errors),
|
|
QEDE_RQSTAT(rx_ip_frags),
|
|
QEDE_RQSTAT(xdp_no_pass),
|
|
};
|
|
|
|
#define QEDE_NUM_RQSTATS ARRAY_SIZE(qede_rqstats_arr)
|
|
#define QEDE_TQSTAT_OFFSET(stat_name) \
|
|
(offsetof(struct qede_tx_queue, stat_name))
|
|
#define QEDE_TQSTAT_STRING(stat_name) (#stat_name)
|
|
#define QEDE_TQSTAT(stat_name) \
|
|
{QEDE_TQSTAT_OFFSET(stat_name), QEDE_TQSTAT_STRING(stat_name)}
|
|
#define QEDE_NUM_TQSTATS ARRAY_SIZE(qede_tqstats_arr)
|
|
static const struct {
|
|
u64 offset;
|
|
char string[ETH_GSTRING_LEN];
|
|
} qede_tqstats_arr[] = {
|
|
QEDE_TQSTAT(xmit_pkts),
|
|
QEDE_TQSTAT(stopped_cnt),
|
|
QEDE_TQSTAT(tx_mem_alloc_err),
|
|
};
|
|
|
|
#define QEDE_STAT_OFFSET(stat_name, type, base) \
|
|
(offsetof(type, stat_name) + (base))
|
|
#define QEDE_STAT_STRING(stat_name) (#stat_name)
|
|
#define _QEDE_STAT(stat_name, type, base, attr) \
|
|
{QEDE_STAT_OFFSET(stat_name, type, base), \
|
|
QEDE_STAT_STRING(stat_name), \
|
|
attr}
|
|
#define QEDE_STAT(stat_name) \
|
|
_QEDE_STAT(stat_name, struct qede_stats_common, 0, 0x0)
|
|
#define QEDE_PF_STAT(stat_name) \
|
|
_QEDE_STAT(stat_name, struct qede_stats_common, 0, \
|
|
BIT(QEDE_STAT_PF_ONLY))
|
|
#define QEDE_PF_BB_STAT(stat_name) \
|
|
_QEDE_STAT(stat_name, struct qede_stats_bb, \
|
|
offsetof(struct qede_stats, bb), \
|
|
BIT(QEDE_STAT_PF_ONLY) | BIT(QEDE_STAT_BB_ONLY))
|
|
#define QEDE_PF_AH_STAT(stat_name) \
|
|
_QEDE_STAT(stat_name, struct qede_stats_ah, \
|
|
offsetof(struct qede_stats, ah), \
|
|
BIT(QEDE_STAT_PF_ONLY) | BIT(QEDE_STAT_AH_ONLY))
|
|
static const struct {
|
|
u64 offset;
|
|
char string[ETH_GSTRING_LEN];
|
|
unsigned long attr;
|
|
#define QEDE_STAT_PF_ONLY 0
|
|
#define QEDE_STAT_BB_ONLY 1
|
|
#define QEDE_STAT_AH_ONLY 2
|
|
} qede_stats_arr[] = {
|
|
QEDE_STAT(rx_ucast_bytes),
|
|
QEDE_STAT(rx_mcast_bytes),
|
|
QEDE_STAT(rx_bcast_bytes),
|
|
QEDE_STAT(rx_ucast_pkts),
|
|
QEDE_STAT(rx_mcast_pkts),
|
|
QEDE_STAT(rx_bcast_pkts),
|
|
|
|
QEDE_STAT(tx_ucast_bytes),
|
|
QEDE_STAT(tx_mcast_bytes),
|
|
QEDE_STAT(tx_bcast_bytes),
|
|
QEDE_STAT(tx_ucast_pkts),
|
|
QEDE_STAT(tx_mcast_pkts),
|
|
QEDE_STAT(tx_bcast_pkts),
|
|
|
|
QEDE_PF_STAT(rx_64_byte_packets),
|
|
QEDE_PF_STAT(rx_65_to_127_byte_packets),
|
|
QEDE_PF_STAT(rx_128_to_255_byte_packets),
|
|
QEDE_PF_STAT(rx_256_to_511_byte_packets),
|
|
QEDE_PF_STAT(rx_512_to_1023_byte_packets),
|
|
QEDE_PF_STAT(rx_1024_to_1518_byte_packets),
|
|
QEDE_PF_BB_STAT(rx_1519_to_1522_byte_packets),
|
|
QEDE_PF_BB_STAT(rx_1519_to_2047_byte_packets),
|
|
QEDE_PF_BB_STAT(rx_2048_to_4095_byte_packets),
|
|
QEDE_PF_BB_STAT(rx_4096_to_9216_byte_packets),
|
|
QEDE_PF_BB_STAT(rx_9217_to_16383_byte_packets),
|
|
QEDE_PF_AH_STAT(rx_1519_to_max_byte_packets),
|
|
QEDE_PF_STAT(tx_64_byte_packets),
|
|
QEDE_PF_STAT(tx_65_to_127_byte_packets),
|
|
QEDE_PF_STAT(tx_128_to_255_byte_packets),
|
|
QEDE_PF_STAT(tx_256_to_511_byte_packets),
|
|
QEDE_PF_STAT(tx_512_to_1023_byte_packets),
|
|
QEDE_PF_STAT(tx_1024_to_1518_byte_packets),
|
|
QEDE_PF_BB_STAT(tx_1519_to_2047_byte_packets),
|
|
QEDE_PF_BB_STAT(tx_2048_to_4095_byte_packets),
|
|
QEDE_PF_BB_STAT(tx_4096_to_9216_byte_packets),
|
|
QEDE_PF_BB_STAT(tx_9217_to_16383_byte_packets),
|
|
QEDE_PF_AH_STAT(tx_1519_to_max_byte_packets),
|
|
QEDE_PF_STAT(rx_mac_crtl_frames),
|
|
QEDE_PF_STAT(tx_mac_ctrl_frames),
|
|
QEDE_PF_STAT(rx_pause_frames),
|
|
QEDE_PF_STAT(tx_pause_frames),
|
|
QEDE_PF_STAT(rx_pfc_frames),
|
|
QEDE_PF_STAT(tx_pfc_frames),
|
|
|
|
QEDE_PF_STAT(rx_crc_errors),
|
|
QEDE_PF_STAT(rx_align_errors),
|
|
QEDE_PF_STAT(rx_carrier_errors),
|
|
QEDE_PF_STAT(rx_oversize_packets),
|
|
QEDE_PF_STAT(rx_jabbers),
|
|
QEDE_PF_STAT(rx_undersize_packets),
|
|
QEDE_PF_STAT(rx_fragments),
|
|
QEDE_PF_BB_STAT(tx_lpi_entry_count),
|
|
QEDE_PF_BB_STAT(tx_total_collisions),
|
|
QEDE_PF_STAT(brb_truncates),
|
|
QEDE_PF_STAT(brb_discards),
|
|
QEDE_STAT(no_buff_discards),
|
|
QEDE_PF_STAT(mftag_filter_discards),
|
|
QEDE_PF_STAT(mac_filter_discards),
|
|
QEDE_PF_STAT(gft_filter_drop),
|
|
QEDE_STAT(tx_err_drop_pkts),
|
|
QEDE_STAT(ttl0_discard),
|
|
QEDE_STAT(packet_too_big_discard),
|
|
|
|
QEDE_STAT(coalesced_pkts),
|
|
QEDE_STAT(coalesced_events),
|
|
QEDE_STAT(coalesced_aborts_num),
|
|
QEDE_STAT(non_coalesced_pkts),
|
|
QEDE_STAT(coalesced_bytes),
|
|
|
|
QEDE_STAT(link_change_count),
|
|
};
|
|
|
|
#define QEDE_NUM_STATS ARRAY_SIZE(qede_stats_arr)
|
|
#define QEDE_STAT_IS_PF_ONLY(i) \
|
|
test_bit(QEDE_STAT_PF_ONLY, &qede_stats_arr[i].attr)
|
|
#define QEDE_STAT_IS_BB_ONLY(i) \
|
|
test_bit(QEDE_STAT_BB_ONLY, &qede_stats_arr[i].attr)
|
|
#define QEDE_STAT_IS_AH_ONLY(i) \
|
|
test_bit(QEDE_STAT_AH_ONLY, &qede_stats_arr[i].attr)
|
|
|
|
enum {
|
|
QEDE_PRI_FLAG_CMT,
|
|
QEDE_PRI_FLAG_SMART_AN_SUPPORT, /* MFW supports SmartAN */
|
|
QEDE_PRI_FLAG_LEN,
|
|
};
|
|
|
|
static const char qede_private_arr[QEDE_PRI_FLAG_LEN][ETH_GSTRING_LEN] = {
|
|
"Coupled-Function",
|
|
"SmartAN capable",
|
|
};
|
|
|
|
enum qede_ethtool_tests {
|
|
QEDE_ETHTOOL_INT_LOOPBACK,
|
|
QEDE_ETHTOOL_INTERRUPT_TEST,
|
|
QEDE_ETHTOOL_MEMORY_TEST,
|
|
QEDE_ETHTOOL_REGISTER_TEST,
|
|
QEDE_ETHTOOL_CLOCK_TEST,
|
|
QEDE_ETHTOOL_NVRAM_TEST,
|
|
QEDE_ETHTOOL_TEST_MAX
|
|
};
|
|
|
|
static const char qede_tests_str_arr[QEDE_ETHTOOL_TEST_MAX][ETH_GSTRING_LEN] = {
|
|
"Internal loopback (offline)",
|
|
"Interrupt (online)\t",
|
|
"Memory (online)\t\t",
|
|
"Register (online)\t",
|
|
"Clock (online)\t\t",
|
|
"Nvram (online)\t\t",
|
|
};
|
|
|
|
static void qede_get_strings_stats_txq(struct qede_dev *edev,
|
|
struct qede_tx_queue *txq, u8 **buf)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < QEDE_NUM_TQSTATS; i++) {
|
|
if (txq->is_xdp)
|
|
sprintf(*buf, "%d [XDP]: %s",
|
|
QEDE_TXQ_XDP_TO_IDX(edev, txq),
|
|
qede_tqstats_arr[i].string);
|
|
else
|
|
sprintf(*buf, "%d_%d: %s", txq->index, txq->cos,
|
|
qede_tqstats_arr[i].string);
|
|
*buf += ETH_GSTRING_LEN;
|
|
}
|
|
}
|
|
|
|
static void qede_get_strings_stats_rxq(struct qede_dev *edev,
|
|
struct qede_rx_queue *rxq, u8 **buf)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < QEDE_NUM_RQSTATS; i++) {
|
|
sprintf(*buf, "%d: %s", rxq->rxq_id,
|
|
qede_rqstats_arr[i].string);
|
|
*buf += ETH_GSTRING_LEN;
|
|
}
|
|
}
|
|
|
|
static bool qede_is_irrelevant_stat(struct qede_dev *edev, int stat_index)
|
|
{
|
|
return (IS_VF(edev) && QEDE_STAT_IS_PF_ONLY(stat_index)) ||
|
|
(QEDE_IS_BB(edev) && QEDE_STAT_IS_AH_ONLY(stat_index)) ||
|
|
(QEDE_IS_AH(edev) && QEDE_STAT_IS_BB_ONLY(stat_index));
|
|
}
|
|
|
|
static void qede_get_strings_stats(struct qede_dev *edev, u8 *buf)
|
|
{
|
|
struct qede_fastpath *fp;
|
|
int i;
|
|
|
|
/* Account for queue statistics */
|
|
for (i = 0; i < QEDE_QUEUE_CNT(edev); i++) {
|
|
fp = &edev->fp_array[i];
|
|
|
|
if (fp->type & QEDE_FASTPATH_RX)
|
|
qede_get_strings_stats_rxq(edev, fp->rxq, &buf);
|
|
|
|
if (fp->type & QEDE_FASTPATH_XDP)
|
|
qede_get_strings_stats_txq(edev, fp->xdp_tx, &buf);
|
|
|
|
if (fp->type & QEDE_FASTPATH_TX) {
|
|
int cos;
|
|
|
|
for_each_cos_in_txq(edev, cos)
|
|
qede_get_strings_stats_txq(edev,
|
|
&fp->txq[cos], &buf);
|
|
}
|
|
}
|
|
|
|
/* Account for non-queue statistics */
|
|
for (i = 0; i < QEDE_NUM_STATS; i++) {
|
|
if (qede_is_irrelevant_stat(edev, i))
|
|
continue;
|
|
strcpy(buf, qede_stats_arr[i].string);
|
|
buf += ETH_GSTRING_LEN;
|
|
}
|
|
}
|
|
|
|
static void qede_get_strings(struct net_device *dev, u32 stringset, u8 *buf)
|
|
{
|
|
struct qede_dev *edev = netdev_priv(dev);
|
|
|
|
switch (stringset) {
|
|
case ETH_SS_STATS:
|
|
qede_get_strings_stats(edev, buf);
|
|
break;
|
|
case ETH_SS_PRIV_FLAGS:
|
|
memcpy(buf, qede_private_arr,
|
|
ETH_GSTRING_LEN * QEDE_PRI_FLAG_LEN);
|
|
break;
|
|
case ETH_SS_TEST:
|
|
memcpy(buf, qede_tests_str_arr,
|
|
ETH_GSTRING_LEN * QEDE_ETHTOOL_TEST_MAX);
|
|
break;
|
|
default:
|
|
DP_VERBOSE(edev, QED_MSG_DEBUG,
|
|
"Unsupported stringset 0x%08x\n", stringset);
|
|
}
|
|
}
|
|
|
|
static void qede_get_ethtool_stats_txq(struct qede_tx_queue *txq, u64 **buf)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < QEDE_NUM_TQSTATS; i++) {
|
|
**buf = *((u64 *)(((void *)txq) + qede_tqstats_arr[i].offset));
|
|
(*buf)++;
|
|
}
|
|
}
|
|
|
|
static void qede_get_ethtool_stats_rxq(struct qede_rx_queue *rxq, u64 **buf)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < QEDE_NUM_RQSTATS; i++) {
|
|
**buf = *((u64 *)(((void *)rxq) + qede_rqstats_arr[i].offset));
|
|
(*buf)++;
|
|
}
|
|
}
|
|
|
|
static void qede_get_ethtool_stats(struct net_device *dev,
|
|
struct ethtool_stats *stats, u64 *buf)
|
|
{
|
|
struct qede_dev *edev = netdev_priv(dev);
|
|
struct qede_fastpath *fp;
|
|
int i;
|
|
|
|
qede_fill_by_demand_stats(edev);
|
|
|
|
/* Need to protect the access to the fastpath array */
|
|
__qede_lock(edev);
|
|
|
|
for (i = 0; i < QEDE_QUEUE_CNT(edev); i++) {
|
|
fp = &edev->fp_array[i];
|
|
|
|
if (fp->type & QEDE_FASTPATH_RX)
|
|
qede_get_ethtool_stats_rxq(fp->rxq, &buf);
|
|
|
|
if (fp->type & QEDE_FASTPATH_XDP)
|
|
qede_get_ethtool_stats_txq(fp->xdp_tx, &buf);
|
|
|
|
if (fp->type & QEDE_FASTPATH_TX) {
|
|
int cos;
|
|
|
|
for_each_cos_in_txq(edev, cos)
|
|
qede_get_ethtool_stats_txq(&fp->txq[cos], &buf);
|
|
}
|
|
}
|
|
|
|
for (i = 0; i < QEDE_NUM_STATS; i++) {
|
|
if (qede_is_irrelevant_stat(edev, i))
|
|
continue;
|
|
*buf = *((u64 *)(((void *)&edev->stats) +
|
|
qede_stats_arr[i].offset));
|
|
|
|
buf++;
|
|
}
|
|
|
|
__qede_unlock(edev);
|
|
}
|
|
|
|
static int qede_get_sset_count(struct net_device *dev, int stringset)
|
|
{
|
|
struct qede_dev *edev = netdev_priv(dev);
|
|
int num_stats = QEDE_NUM_STATS, i;
|
|
|
|
switch (stringset) {
|
|
case ETH_SS_STATS:
|
|
for (i = 0; i < QEDE_NUM_STATS; i++)
|
|
if (qede_is_irrelevant_stat(edev, i))
|
|
num_stats--;
|
|
|
|
/* Account for the Regular Tx statistics */
|
|
num_stats += QEDE_TSS_COUNT(edev) * QEDE_NUM_TQSTATS *
|
|
edev->dev_info.num_tc;
|
|
|
|
/* Account for the Regular Rx statistics */
|
|
num_stats += QEDE_RSS_COUNT(edev) * QEDE_NUM_RQSTATS;
|
|
|
|
/* Account for XDP statistics [if needed] */
|
|
if (edev->xdp_prog)
|
|
num_stats += QEDE_RSS_COUNT(edev) * QEDE_NUM_TQSTATS;
|
|
return num_stats;
|
|
|
|
case ETH_SS_PRIV_FLAGS:
|
|
return QEDE_PRI_FLAG_LEN;
|
|
case ETH_SS_TEST:
|
|
if (!IS_VF(edev))
|
|
return QEDE_ETHTOOL_TEST_MAX;
|
|
else
|
|
return 0;
|
|
default:
|
|
DP_VERBOSE(edev, QED_MSG_DEBUG,
|
|
"Unsupported stringset 0x%08x\n", stringset);
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
|
|
static u32 qede_get_priv_flags(struct net_device *dev)
|
|
{
|
|
struct qede_dev *edev = netdev_priv(dev);
|
|
u32 flags = 0;
|
|
|
|
if (edev->dev_info.common.num_hwfns > 1)
|
|
flags |= BIT(QEDE_PRI_FLAG_CMT);
|
|
|
|
if (edev->dev_info.common.smart_an)
|
|
flags |= BIT(QEDE_PRI_FLAG_SMART_AN_SUPPORT);
|
|
|
|
return flags;
|
|
}
|
|
|
|
struct qede_link_mode_mapping {
|
|
u32 qed_link_mode;
|
|
u32 ethtool_link_mode;
|
|
};
|
|
|
|
static const struct qede_link_mode_mapping qed_lm_map[] = {
|
|
{QED_LM_Autoneg_BIT, ETHTOOL_LINK_MODE_Autoneg_BIT},
|
|
{QED_LM_Asym_Pause_BIT, ETHTOOL_LINK_MODE_Asym_Pause_BIT},
|
|
{QED_LM_Pause_BIT, ETHTOOL_LINK_MODE_Pause_BIT},
|
|
{QED_LM_1000baseT_Full_BIT, ETHTOOL_LINK_MODE_1000baseT_Full_BIT},
|
|
{QED_LM_10000baseT_Full_BIT, ETHTOOL_LINK_MODE_10000baseT_Full_BIT},
|
|
{QED_LM_2500baseX_Full_BIT, ETHTOOL_LINK_MODE_2500baseX_Full_BIT},
|
|
{QED_LM_Backplane_BIT, ETHTOOL_LINK_MODE_Backplane_BIT},
|
|
{QED_LM_1000baseKX_Full_BIT, ETHTOOL_LINK_MODE_1000baseKX_Full_BIT},
|
|
{QED_LM_10000baseKX4_Full_BIT, ETHTOOL_LINK_MODE_10000baseKX4_Full_BIT},
|
|
{QED_LM_10000baseKR_Full_BIT, ETHTOOL_LINK_MODE_10000baseKR_Full_BIT},
|
|
{QED_LM_10000baseKR_Full_BIT, ETHTOOL_LINK_MODE_10000baseKR_Full_BIT},
|
|
{QED_LM_10000baseR_FEC_BIT, ETHTOOL_LINK_MODE_10000baseR_FEC_BIT},
|
|
{QED_LM_20000baseKR2_Full_BIT, ETHTOOL_LINK_MODE_20000baseKR2_Full_BIT},
|
|
{QED_LM_40000baseKR4_Full_BIT, ETHTOOL_LINK_MODE_40000baseKR4_Full_BIT},
|
|
{QED_LM_40000baseCR4_Full_BIT, ETHTOOL_LINK_MODE_40000baseCR4_Full_BIT},
|
|
{QED_LM_40000baseSR4_Full_BIT, ETHTOOL_LINK_MODE_40000baseSR4_Full_BIT},
|
|
{QED_LM_40000baseLR4_Full_BIT, ETHTOOL_LINK_MODE_40000baseLR4_Full_BIT},
|
|
{QED_LM_25000baseCR_Full_BIT, ETHTOOL_LINK_MODE_25000baseCR_Full_BIT},
|
|
{QED_LM_25000baseKR_Full_BIT, ETHTOOL_LINK_MODE_25000baseKR_Full_BIT},
|
|
{QED_LM_25000baseSR_Full_BIT, ETHTOOL_LINK_MODE_25000baseSR_Full_BIT},
|
|
{QED_LM_50000baseCR2_Full_BIT, ETHTOOL_LINK_MODE_50000baseCR2_Full_BIT},
|
|
{QED_LM_50000baseKR2_Full_BIT, ETHTOOL_LINK_MODE_50000baseKR2_Full_BIT},
|
|
{QED_LM_100000baseKR4_Full_BIT,
|
|
ETHTOOL_LINK_MODE_100000baseKR4_Full_BIT},
|
|
{QED_LM_100000baseSR4_Full_BIT,
|
|
ETHTOOL_LINK_MODE_100000baseSR4_Full_BIT},
|
|
{QED_LM_100000baseCR4_Full_BIT,
|
|
ETHTOOL_LINK_MODE_100000baseCR4_Full_BIT},
|
|
{QED_LM_100000baseLR4_ER4_Full_BIT,
|
|
ETHTOOL_LINK_MODE_100000baseLR4_ER4_Full_BIT},
|
|
{QED_LM_50000baseSR2_Full_BIT, ETHTOOL_LINK_MODE_50000baseSR2_Full_BIT},
|
|
{QED_LM_1000baseX_Full_BIT, ETHTOOL_LINK_MODE_1000baseX_Full_BIT},
|
|
{QED_LM_10000baseCR_Full_BIT, ETHTOOL_LINK_MODE_10000baseCR_Full_BIT},
|
|
{QED_LM_10000baseSR_Full_BIT, ETHTOOL_LINK_MODE_10000baseSR_Full_BIT},
|
|
{QED_LM_10000baseLR_Full_BIT, ETHTOOL_LINK_MODE_10000baseLR_Full_BIT},
|
|
{QED_LM_10000baseLRM_Full_BIT, ETHTOOL_LINK_MODE_10000baseLRM_Full_BIT},
|
|
};
|
|
|
|
#define QEDE_DRV_TO_ETHTOOL_CAPS(caps, lk_ksettings, name) \
|
|
{ \
|
|
int i; \
|
|
\
|
|
for (i = 0; i < ARRAY_SIZE(qed_lm_map); i++) { \
|
|
if ((caps) & (qed_lm_map[i].qed_link_mode)) \
|
|
__set_bit(qed_lm_map[i].ethtool_link_mode,\
|
|
lk_ksettings->link_modes.name); \
|
|
} \
|
|
}
|
|
|
|
#define QEDE_ETHTOOL_TO_DRV_CAPS(caps, lk_ksettings, name) \
|
|
{ \
|
|
int i; \
|
|
\
|
|
for (i = 0; i < ARRAY_SIZE(qed_lm_map); i++) { \
|
|
if (test_bit(qed_lm_map[i].ethtool_link_mode, \
|
|
lk_ksettings->link_modes.name)) \
|
|
caps |= qed_lm_map[i].qed_link_mode; \
|
|
} \
|
|
}
|
|
|
|
static int qede_get_link_ksettings(struct net_device *dev,
|
|
struct ethtool_link_ksettings *cmd)
|
|
{
|
|
struct ethtool_link_settings *base = &cmd->base;
|
|
struct qede_dev *edev = netdev_priv(dev);
|
|
struct qed_link_output current_link;
|
|
|
|
__qede_lock(edev);
|
|
|
|
memset(¤t_link, 0, sizeof(current_link));
|
|
edev->ops->common->get_link(edev->cdev, ¤t_link);
|
|
|
|
ethtool_link_ksettings_zero_link_mode(cmd, supported);
|
|
QEDE_DRV_TO_ETHTOOL_CAPS(current_link.supported_caps, cmd, supported)
|
|
|
|
ethtool_link_ksettings_zero_link_mode(cmd, advertising);
|
|
QEDE_DRV_TO_ETHTOOL_CAPS(current_link.advertised_caps, cmd, advertising)
|
|
|
|
ethtool_link_ksettings_zero_link_mode(cmd, lp_advertising);
|
|
QEDE_DRV_TO_ETHTOOL_CAPS(current_link.lp_caps, cmd, lp_advertising)
|
|
|
|
if ((edev->state == QEDE_STATE_OPEN) && (current_link.link_up)) {
|
|
base->speed = current_link.speed;
|
|
base->duplex = current_link.duplex;
|
|
} else {
|
|
base->speed = SPEED_UNKNOWN;
|
|
base->duplex = DUPLEX_UNKNOWN;
|
|
}
|
|
|
|
__qede_unlock(edev);
|
|
|
|
base->port = current_link.port;
|
|
base->autoneg = (current_link.autoneg) ? AUTONEG_ENABLE :
|
|
AUTONEG_DISABLE;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int qede_set_link_ksettings(struct net_device *dev,
|
|
const struct ethtool_link_ksettings *cmd)
|
|
{
|
|
const struct ethtool_link_settings *base = &cmd->base;
|
|
struct qede_dev *edev = netdev_priv(dev);
|
|
struct qed_link_output current_link;
|
|
struct qed_link_params params;
|
|
u32 sup_caps;
|
|
|
|
if (!edev->ops || !edev->ops->common->can_link_change(edev->cdev)) {
|
|
DP_INFO(edev, "Link settings are not allowed to be changed\n");
|
|
return -EOPNOTSUPP;
|
|
}
|
|
memset(¤t_link, 0, sizeof(current_link));
|
|
memset(¶ms, 0, sizeof(params));
|
|
edev->ops->common->get_link(edev->cdev, ¤t_link);
|
|
|
|
params.override_flags |= QED_LINK_OVERRIDE_SPEED_ADV_SPEEDS;
|
|
params.override_flags |= QED_LINK_OVERRIDE_SPEED_AUTONEG;
|
|
if (base->autoneg == AUTONEG_ENABLE) {
|
|
if (!(current_link.supported_caps & QED_LM_Autoneg_BIT)) {
|
|
DP_INFO(edev, "Auto negotiation is not supported\n");
|
|
return -EOPNOTSUPP;
|
|
}
|
|
|
|
params.autoneg = true;
|
|
params.forced_speed = 0;
|
|
QEDE_ETHTOOL_TO_DRV_CAPS(params.adv_speeds, cmd, advertising)
|
|
} else { /* forced speed */
|
|
params.override_flags |= QED_LINK_OVERRIDE_SPEED_FORCED_SPEED;
|
|
params.autoneg = false;
|
|
params.forced_speed = base->speed;
|
|
switch (base->speed) {
|
|
case SPEED_1000:
|
|
sup_caps = QED_LM_1000baseT_Full_BIT |
|
|
QED_LM_1000baseKX_Full_BIT |
|
|
QED_LM_1000baseX_Full_BIT;
|
|
if (!(current_link.supported_caps & sup_caps)) {
|
|
DP_INFO(edev, "1G speed not supported\n");
|
|
return -EINVAL;
|
|
}
|
|
params.adv_speeds = current_link.supported_caps &
|
|
sup_caps;
|
|
break;
|
|
case SPEED_10000:
|
|
sup_caps = QED_LM_10000baseT_Full_BIT |
|
|
QED_LM_10000baseKR_Full_BIT |
|
|
QED_LM_10000baseKX4_Full_BIT |
|
|
QED_LM_10000baseR_FEC_BIT |
|
|
QED_LM_10000baseCR_Full_BIT |
|
|
QED_LM_10000baseSR_Full_BIT |
|
|
QED_LM_10000baseLR_Full_BIT |
|
|
QED_LM_10000baseLRM_Full_BIT;
|
|
if (!(current_link.supported_caps & sup_caps)) {
|
|
DP_INFO(edev, "10G speed not supported\n");
|
|
return -EINVAL;
|
|
}
|
|
params.adv_speeds = current_link.supported_caps &
|
|
sup_caps;
|
|
break;
|
|
case SPEED_20000:
|
|
if (!(current_link.supported_caps &
|
|
QED_LM_20000baseKR2_Full_BIT)) {
|
|
DP_INFO(edev, "20G speed not supported\n");
|
|
return -EINVAL;
|
|
}
|
|
params.adv_speeds = QED_LM_20000baseKR2_Full_BIT;
|
|
break;
|
|
case SPEED_25000:
|
|
sup_caps = QED_LM_25000baseKR_Full_BIT |
|
|
QED_LM_25000baseCR_Full_BIT |
|
|
QED_LM_25000baseSR_Full_BIT;
|
|
if (!(current_link.supported_caps & sup_caps)) {
|
|
DP_INFO(edev, "25G speed not supported\n");
|
|
return -EINVAL;
|
|
}
|
|
params.adv_speeds = current_link.supported_caps &
|
|
sup_caps;
|
|
break;
|
|
case SPEED_40000:
|
|
sup_caps = QED_LM_40000baseLR4_Full_BIT |
|
|
QED_LM_40000baseKR4_Full_BIT |
|
|
QED_LM_40000baseCR4_Full_BIT |
|
|
QED_LM_40000baseSR4_Full_BIT;
|
|
if (!(current_link.supported_caps & sup_caps)) {
|
|
DP_INFO(edev, "40G speed not supported\n");
|
|
return -EINVAL;
|
|
}
|
|
params.adv_speeds = current_link.supported_caps &
|
|
sup_caps;
|
|
break;
|
|
case SPEED_50000:
|
|
sup_caps = QED_LM_50000baseKR2_Full_BIT |
|
|
QED_LM_50000baseCR2_Full_BIT |
|
|
QED_LM_50000baseSR2_Full_BIT;
|
|
if (!(current_link.supported_caps & sup_caps)) {
|
|
DP_INFO(edev, "50G speed not supported\n");
|
|
return -EINVAL;
|
|
}
|
|
params.adv_speeds = current_link.supported_caps &
|
|
sup_caps;
|
|
break;
|
|
case SPEED_100000:
|
|
sup_caps = QED_LM_100000baseKR4_Full_BIT |
|
|
QED_LM_100000baseSR4_Full_BIT |
|
|
QED_LM_100000baseCR4_Full_BIT |
|
|
QED_LM_100000baseLR4_ER4_Full_BIT;
|
|
if (!(current_link.supported_caps & sup_caps)) {
|
|
DP_INFO(edev, "100G speed not supported\n");
|
|
return -EINVAL;
|
|
}
|
|
params.adv_speeds = current_link.supported_caps &
|
|
sup_caps;
|
|
break;
|
|
default:
|
|
DP_INFO(edev, "Unsupported speed %u\n", base->speed);
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
|
|
params.link_up = true;
|
|
edev->ops->common->set_link(edev->cdev, ¶ms);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void qede_get_drvinfo(struct net_device *ndev,
|
|
struct ethtool_drvinfo *info)
|
|
{
|
|
char mfw[ETHTOOL_FWVERS_LEN], storm[ETHTOOL_FWVERS_LEN];
|
|
struct qede_dev *edev = netdev_priv(ndev);
|
|
char mbi[ETHTOOL_FWVERS_LEN];
|
|
|
|
strlcpy(info->driver, "qede", sizeof(info->driver));
|
|
|
|
snprintf(storm, ETHTOOL_FWVERS_LEN, "%d.%d.%d.%d",
|
|
edev->dev_info.common.fw_major,
|
|
edev->dev_info.common.fw_minor,
|
|
edev->dev_info.common.fw_rev,
|
|
edev->dev_info.common.fw_eng);
|
|
|
|
snprintf(mfw, ETHTOOL_FWVERS_LEN, "%d.%d.%d.%d",
|
|
(edev->dev_info.common.mfw_rev >> 24) & 0xFF,
|
|
(edev->dev_info.common.mfw_rev >> 16) & 0xFF,
|
|
(edev->dev_info.common.mfw_rev >> 8) & 0xFF,
|
|
edev->dev_info.common.mfw_rev & 0xFF);
|
|
|
|
if ((strlen(storm) + strlen(DRV_MODULE_VERSION) + strlen("[storm] ")) <
|
|
sizeof(info->version))
|
|
snprintf(info->version, sizeof(info->version),
|
|
"%s [storm %s]", DRV_MODULE_VERSION, storm);
|
|
else
|
|
snprintf(info->version, sizeof(info->version),
|
|
"%s %s", DRV_MODULE_VERSION, storm);
|
|
|
|
if (edev->dev_info.common.mbi_version) {
|
|
snprintf(mbi, ETHTOOL_FWVERS_LEN, "%d.%d.%d",
|
|
(edev->dev_info.common.mbi_version &
|
|
QED_MBI_VERSION_2_MASK) >> QED_MBI_VERSION_2_OFFSET,
|
|
(edev->dev_info.common.mbi_version &
|
|
QED_MBI_VERSION_1_MASK) >> QED_MBI_VERSION_1_OFFSET,
|
|
(edev->dev_info.common.mbi_version &
|
|
QED_MBI_VERSION_0_MASK) >> QED_MBI_VERSION_0_OFFSET);
|
|
snprintf(info->fw_version, sizeof(info->fw_version),
|
|
"mbi %s [mfw %s]", mbi, mfw);
|
|
} else {
|
|
snprintf(info->fw_version, sizeof(info->fw_version),
|
|
"mfw %s", mfw);
|
|
}
|
|
|
|
strlcpy(info->bus_info, pci_name(edev->pdev), sizeof(info->bus_info));
|
|
}
|
|
|
|
static void qede_get_wol(struct net_device *ndev, struct ethtool_wolinfo *wol)
|
|
{
|
|
struct qede_dev *edev = netdev_priv(ndev);
|
|
|
|
if (edev->dev_info.common.wol_support) {
|
|
wol->supported = WAKE_MAGIC;
|
|
wol->wolopts = edev->wol_enabled ? WAKE_MAGIC : 0;
|
|
}
|
|
}
|
|
|
|
static int qede_set_wol(struct net_device *ndev, struct ethtool_wolinfo *wol)
|
|
{
|
|
struct qede_dev *edev = netdev_priv(ndev);
|
|
bool wol_requested;
|
|
int rc;
|
|
|
|
if (wol->wolopts & ~WAKE_MAGIC) {
|
|
DP_INFO(edev,
|
|
"Can't support WoL options other than magic-packet\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
wol_requested = !!(wol->wolopts & WAKE_MAGIC);
|
|
if (wol_requested == edev->wol_enabled)
|
|
return 0;
|
|
|
|
/* Need to actually change configuration */
|
|
if (!edev->dev_info.common.wol_support) {
|
|
DP_INFO(edev, "Device doesn't support WoL\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
rc = edev->ops->common->update_wol(edev->cdev, wol_requested);
|
|
if (!rc)
|
|
edev->wol_enabled = wol_requested;
|
|
|
|
return rc;
|
|
}
|
|
|
|
static u32 qede_get_msglevel(struct net_device *ndev)
|
|
{
|
|
struct qede_dev *edev = netdev_priv(ndev);
|
|
|
|
return ((u32)edev->dp_level << QED_LOG_LEVEL_SHIFT) | edev->dp_module;
|
|
}
|
|
|
|
static void qede_set_msglevel(struct net_device *ndev, u32 level)
|
|
{
|
|
struct qede_dev *edev = netdev_priv(ndev);
|
|
u32 dp_module = 0;
|
|
u8 dp_level = 0;
|
|
|
|
qede_config_debug(level, &dp_module, &dp_level);
|
|
|
|
edev->dp_level = dp_level;
|
|
edev->dp_module = dp_module;
|
|
edev->ops->common->update_msglvl(edev->cdev,
|
|
dp_module, dp_level);
|
|
}
|
|
|
|
static int qede_nway_reset(struct net_device *dev)
|
|
{
|
|
struct qede_dev *edev = netdev_priv(dev);
|
|
struct qed_link_output current_link;
|
|
struct qed_link_params link_params;
|
|
|
|
if (!edev->ops || !edev->ops->common->can_link_change(edev->cdev)) {
|
|
DP_INFO(edev, "Link settings are not allowed to be changed\n");
|
|
return -EOPNOTSUPP;
|
|
}
|
|
|
|
if (!netif_running(dev))
|
|
return 0;
|
|
|
|
memset(¤t_link, 0, sizeof(current_link));
|
|
edev->ops->common->get_link(edev->cdev, ¤t_link);
|
|
if (!current_link.link_up)
|
|
return 0;
|
|
|
|
/* Toggle the link */
|
|
memset(&link_params, 0, sizeof(link_params));
|
|
link_params.link_up = false;
|
|
edev->ops->common->set_link(edev->cdev, &link_params);
|
|
link_params.link_up = true;
|
|
edev->ops->common->set_link(edev->cdev, &link_params);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static u32 qede_get_link(struct net_device *dev)
|
|
{
|
|
struct qede_dev *edev = netdev_priv(dev);
|
|
struct qed_link_output current_link;
|
|
|
|
memset(¤t_link, 0, sizeof(current_link));
|
|
edev->ops->common->get_link(edev->cdev, ¤t_link);
|
|
|
|
return current_link.link_up;
|
|
}
|
|
|
|
static int qede_flash_device(struct net_device *dev,
|
|
struct ethtool_flash *flash)
|
|
{
|
|
struct qede_dev *edev = netdev_priv(dev);
|
|
|
|
return edev->ops->common->nvm_flash(edev->cdev, flash->data);
|
|
}
|
|
|
|
static int qede_get_coalesce(struct net_device *dev,
|
|
struct ethtool_coalesce *coal)
|
|
{
|
|
void *rx_handle = NULL, *tx_handle = NULL;
|
|
struct qede_dev *edev = netdev_priv(dev);
|
|
u16 rx_coal, tx_coal, i, rc = 0;
|
|
struct qede_fastpath *fp;
|
|
|
|
rx_coal = QED_DEFAULT_RX_USECS;
|
|
tx_coal = QED_DEFAULT_TX_USECS;
|
|
|
|
memset(coal, 0, sizeof(struct ethtool_coalesce));
|
|
|
|
__qede_lock(edev);
|
|
if (edev->state == QEDE_STATE_OPEN) {
|
|
for_each_queue(i) {
|
|
fp = &edev->fp_array[i];
|
|
|
|
if (fp->type & QEDE_FASTPATH_RX) {
|
|
rx_handle = fp->rxq->handle;
|
|
break;
|
|
}
|
|
}
|
|
|
|
rc = edev->ops->get_coalesce(edev->cdev, &rx_coal, rx_handle);
|
|
if (rc) {
|
|
DP_INFO(edev, "Read Rx coalesce error\n");
|
|
goto out;
|
|
}
|
|
|
|
for_each_queue(i) {
|
|
struct qede_tx_queue *txq;
|
|
|
|
fp = &edev->fp_array[i];
|
|
|
|
/* All TX queues of given fastpath uses same
|
|
* coalescing value, so no need to iterate over
|
|
* all TCs, TC0 txq should suffice.
|
|
*/
|
|
if (fp->type & QEDE_FASTPATH_TX) {
|
|
txq = QEDE_FP_TC0_TXQ(fp);
|
|
tx_handle = txq->handle;
|
|
break;
|
|
}
|
|
}
|
|
|
|
rc = edev->ops->get_coalesce(edev->cdev, &tx_coal, tx_handle);
|
|
if (rc)
|
|
DP_INFO(edev, "Read Tx coalesce error\n");
|
|
}
|
|
|
|
out:
|
|
__qede_unlock(edev);
|
|
|
|
coal->rx_coalesce_usecs = rx_coal;
|
|
coal->tx_coalesce_usecs = tx_coal;
|
|
|
|
return rc;
|
|
}
|
|
|
|
static int qede_set_coalesce(struct net_device *dev,
|
|
struct ethtool_coalesce *coal)
|
|
{
|
|
struct qede_dev *edev = netdev_priv(dev);
|
|
struct qede_fastpath *fp;
|
|
int i, rc = 0;
|
|
u16 rxc, txc;
|
|
|
|
if (!netif_running(dev)) {
|
|
DP_INFO(edev, "Interface is down\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (coal->rx_coalesce_usecs > QED_COALESCE_MAX ||
|
|
coal->tx_coalesce_usecs > QED_COALESCE_MAX) {
|
|
DP_INFO(edev,
|
|
"Can't support requested %s coalesce value [max supported value %d]\n",
|
|
coal->rx_coalesce_usecs > QED_COALESCE_MAX ? "rx" :
|
|
"tx", QED_COALESCE_MAX);
|
|
return -EINVAL;
|
|
}
|
|
|
|
rxc = (u16)coal->rx_coalesce_usecs;
|
|
txc = (u16)coal->tx_coalesce_usecs;
|
|
for_each_queue(i) {
|
|
fp = &edev->fp_array[i];
|
|
|
|
if (edev->fp_array[i].type & QEDE_FASTPATH_RX) {
|
|
rc = edev->ops->common->set_coalesce(edev->cdev,
|
|
rxc, 0,
|
|
fp->rxq->handle);
|
|
if (rc) {
|
|
DP_INFO(edev,
|
|
"Set RX coalesce error, rc = %d\n", rc);
|
|
return rc;
|
|
}
|
|
}
|
|
|
|
if (edev->fp_array[i].type & QEDE_FASTPATH_TX) {
|
|
struct qede_tx_queue *txq;
|
|
|
|
/* All TX queues of given fastpath uses same
|
|
* coalescing value, so no need to iterate over
|
|
* all TCs, TC0 txq should suffice.
|
|
*/
|
|
txq = QEDE_FP_TC0_TXQ(fp);
|
|
|
|
rc = edev->ops->common->set_coalesce(edev->cdev,
|
|
0, txc,
|
|
txq->handle);
|
|
if (rc) {
|
|
DP_INFO(edev,
|
|
"Set TX coalesce error, rc = %d\n", rc);
|
|
return rc;
|
|
}
|
|
}
|
|
}
|
|
|
|
return rc;
|
|
}
|
|
|
|
static void qede_get_ringparam(struct net_device *dev,
|
|
struct ethtool_ringparam *ering)
|
|
{
|
|
struct qede_dev *edev = netdev_priv(dev);
|
|
|
|
ering->rx_max_pending = NUM_RX_BDS_MAX;
|
|
ering->rx_pending = edev->q_num_rx_buffers;
|
|
ering->tx_max_pending = NUM_TX_BDS_MAX;
|
|
ering->tx_pending = edev->q_num_tx_buffers;
|
|
}
|
|
|
|
static int qede_set_ringparam(struct net_device *dev,
|
|
struct ethtool_ringparam *ering)
|
|
{
|
|
struct qede_dev *edev = netdev_priv(dev);
|
|
|
|
DP_VERBOSE(edev, (NETIF_MSG_IFUP | NETIF_MSG_IFDOWN),
|
|
"Set ring params command parameters: rx_pending = %d, tx_pending = %d\n",
|
|
ering->rx_pending, ering->tx_pending);
|
|
|
|
/* Validate legality of configuration */
|
|
if (ering->rx_pending > NUM_RX_BDS_MAX ||
|
|
ering->rx_pending < NUM_RX_BDS_MIN ||
|
|
ering->tx_pending > NUM_TX_BDS_MAX ||
|
|
ering->tx_pending < NUM_TX_BDS_MIN) {
|
|
DP_VERBOSE(edev, (NETIF_MSG_IFUP | NETIF_MSG_IFDOWN),
|
|
"Can only support Rx Buffer size [0%08x,...,0x%08x] and Tx Buffer size [0x%08x,...,0x%08x]\n",
|
|
NUM_RX_BDS_MIN, NUM_RX_BDS_MAX,
|
|
NUM_TX_BDS_MIN, NUM_TX_BDS_MAX);
|
|
return -EINVAL;
|
|
}
|
|
|
|
/* Change ring size and re-load */
|
|
edev->q_num_rx_buffers = ering->rx_pending;
|
|
edev->q_num_tx_buffers = ering->tx_pending;
|
|
|
|
qede_reload(edev, NULL, false);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void qede_get_pauseparam(struct net_device *dev,
|
|
struct ethtool_pauseparam *epause)
|
|
{
|
|
struct qede_dev *edev = netdev_priv(dev);
|
|
struct qed_link_output current_link;
|
|
|
|
memset(¤t_link, 0, sizeof(current_link));
|
|
edev->ops->common->get_link(edev->cdev, ¤t_link);
|
|
|
|
if (current_link.pause_config & QED_LINK_PAUSE_AUTONEG_ENABLE)
|
|
epause->autoneg = true;
|
|
if (current_link.pause_config & QED_LINK_PAUSE_RX_ENABLE)
|
|
epause->rx_pause = true;
|
|
if (current_link.pause_config & QED_LINK_PAUSE_TX_ENABLE)
|
|
epause->tx_pause = true;
|
|
|
|
DP_VERBOSE(edev, QED_MSG_DEBUG,
|
|
"ethtool_pauseparam: cmd %d autoneg %d rx_pause %d tx_pause %d\n",
|
|
epause->cmd, epause->autoneg, epause->rx_pause,
|
|
epause->tx_pause);
|
|
}
|
|
|
|
static int qede_set_pauseparam(struct net_device *dev,
|
|
struct ethtool_pauseparam *epause)
|
|
{
|
|
struct qede_dev *edev = netdev_priv(dev);
|
|
struct qed_link_params params;
|
|
struct qed_link_output current_link;
|
|
|
|
if (!edev->ops || !edev->ops->common->can_link_change(edev->cdev)) {
|
|
DP_INFO(edev,
|
|
"Pause settings are not allowed to be changed\n");
|
|
return -EOPNOTSUPP;
|
|
}
|
|
|
|
memset(¤t_link, 0, sizeof(current_link));
|
|
edev->ops->common->get_link(edev->cdev, ¤t_link);
|
|
|
|
memset(¶ms, 0, sizeof(params));
|
|
params.override_flags |= QED_LINK_OVERRIDE_PAUSE_CONFIG;
|
|
if (epause->autoneg) {
|
|
if (!(current_link.supported_caps & QED_LM_Autoneg_BIT)) {
|
|
DP_INFO(edev, "autoneg not supported\n");
|
|
return -EINVAL;
|
|
}
|
|
params.pause_config |= QED_LINK_PAUSE_AUTONEG_ENABLE;
|
|
}
|
|
if (epause->rx_pause)
|
|
params.pause_config |= QED_LINK_PAUSE_RX_ENABLE;
|
|
if (epause->tx_pause)
|
|
params.pause_config |= QED_LINK_PAUSE_TX_ENABLE;
|
|
|
|
params.link_up = true;
|
|
edev->ops->common->set_link(edev->cdev, ¶ms);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void qede_get_regs(struct net_device *ndev,
|
|
struct ethtool_regs *regs, void *buffer)
|
|
{
|
|
struct qede_dev *edev = netdev_priv(ndev);
|
|
|
|
regs->version = 0;
|
|
memset(buffer, 0, regs->len);
|
|
|
|
if (edev->ops && edev->ops->common)
|
|
edev->ops->common->dbg_all_data(edev->cdev, buffer);
|
|
}
|
|
|
|
static int qede_get_regs_len(struct net_device *ndev)
|
|
{
|
|
struct qede_dev *edev = netdev_priv(ndev);
|
|
|
|
if (edev->ops && edev->ops->common)
|
|
return edev->ops->common->dbg_all_data_size(edev->cdev);
|
|
else
|
|
return -EINVAL;
|
|
}
|
|
|
|
static void qede_update_mtu(struct qede_dev *edev,
|
|
struct qede_reload_args *args)
|
|
{
|
|
edev->ndev->mtu = args->u.mtu;
|
|
}
|
|
|
|
/* Netdevice NDOs */
|
|
int qede_change_mtu(struct net_device *ndev, int new_mtu)
|
|
{
|
|
struct qede_dev *edev = netdev_priv(ndev);
|
|
struct qede_reload_args args;
|
|
|
|
DP_VERBOSE(edev, (NETIF_MSG_IFUP | NETIF_MSG_IFDOWN),
|
|
"Configuring MTU size of %d\n", new_mtu);
|
|
|
|
if (new_mtu > PAGE_SIZE)
|
|
ndev->features &= ~NETIF_F_GRO_HW;
|
|
|
|
/* Set the mtu field and re-start the interface if needed */
|
|
args.u.mtu = new_mtu;
|
|
args.func = &qede_update_mtu;
|
|
qede_reload(edev, &args, false);
|
|
|
|
edev->ops->common->update_mtu(edev->cdev, new_mtu);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void qede_get_channels(struct net_device *dev,
|
|
struct ethtool_channels *channels)
|
|
{
|
|
struct qede_dev *edev = netdev_priv(dev);
|
|
|
|
channels->max_combined = QEDE_MAX_RSS_CNT(edev);
|
|
channels->max_rx = QEDE_MAX_RSS_CNT(edev);
|
|
channels->max_tx = QEDE_MAX_RSS_CNT(edev);
|
|
channels->combined_count = QEDE_QUEUE_CNT(edev) - edev->fp_num_tx -
|
|
edev->fp_num_rx;
|
|
channels->tx_count = edev->fp_num_tx;
|
|
channels->rx_count = edev->fp_num_rx;
|
|
}
|
|
|
|
static int qede_set_channels(struct net_device *dev,
|
|
struct ethtool_channels *channels)
|
|
{
|
|
struct qede_dev *edev = netdev_priv(dev);
|
|
u32 count;
|
|
|
|
DP_VERBOSE(edev, (NETIF_MSG_IFUP | NETIF_MSG_IFDOWN),
|
|
"set-channels command parameters: rx = %d, tx = %d, other = %d, combined = %d\n",
|
|
channels->rx_count, channels->tx_count,
|
|
channels->other_count, channels->combined_count);
|
|
|
|
count = channels->rx_count + channels->tx_count +
|
|
channels->combined_count;
|
|
|
|
/* We don't support `other' channels */
|
|
if (channels->other_count) {
|
|
DP_VERBOSE(edev, (NETIF_MSG_IFUP | NETIF_MSG_IFDOWN),
|
|
"command parameters not supported\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (!(channels->combined_count || (channels->rx_count &&
|
|
channels->tx_count))) {
|
|
DP_VERBOSE(edev, (NETIF_MSG_IFUP | NETIF_MSG_IFDOWN),
|
|
"need to request at least one transmit and one receive channel\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (count > QEDE_MAX_RSS_CNT(edev)) {
|
|
DP_VERBOSE(edev, (NETIF_MSG_IFUP | NETIF_MSG_IFDOWN),
|
|
"requested channels = %d max supported channels = %d\n",
|
|
count, QEDE_MAX_RSS_CNT(edev));
|
|
return -EINVAL;
|
|
}
|
|
|
|
/* Check if there was a change in the active parameters */
|
|
if ((count == QEDE_QUEUE_CNT(edev)) &&
|
|
(channels->tx_count == edev->fp_num_tx) &&
|
|
(channels->rx_count == edev->fp_num_rx)) {
|
|
DP_VERBOSE(edev, (NETIF_MSG_IFUP | NETIF_MSG_IFDOWN),
|
|
"No change in active parameters\n");
|
|
return 0;
|
|
}
|
|
|
|
/* We need the number of queues to be divisible between the hwfns */
|
|
if ((count % edev->dev_info.common.num_hwfns) ||
|
|
(channels->tx_count % edev->dev_info.common.num_hwfns) ||
|
|
(channels->rx_count % edev->dev_info.common.num_hwfns)) {
|
|
DP_VERBOSE(edev, (NETIF_MSG_IFUP | NETIF_MSG_IFDOWN),
|
|
"Number of channels must be divisible by %04x\n",
|
|
edev->dev_info.common.num_hwfns);
|
|
return -EINVAL;
|
|
}
|
|
|
|
/* Set number of queues and reload if necessary */
|
|
edev->req_queues = count;
|
|
edev->req_num_tx = channels->tx_count;
|
|
edev->req_num_rx = channels->rx_count;
|
|
/* Reset the indirection table if rx queue count is updated */
|
|
if ((edev->req_queues - edev->req_num_tx) != QEDE_RSS_COUNT(edev)) {
|
|
edev->rss_params_inited &= ~QEDE_RSS_INDIR_INITED;
|
|
memset(edev->rss_ind_table, 0, sizeof(edev->rss_ind_table));
|
|
}
|
|
|
|
qede_reload(edev, NULL, false);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int qede_get_ts_info(struct net_device *dev,
|
|
struct ethtool_ts_info *info)
|
|
{
|
|
struct qede_dev *edev = netdev_priv(dev);
|
|
|
|
return qede_ptp_get_ts_info(edev, info);
|
|
}
|
|
|
|
static int qede_set_phys_id(struct net_device *dev,
|
|
enum ethtool_phys_id_state state)
|
|
{
|
|
struct qede_dev *edev = netdev_priv(dev);
|
|
u8 led_state = 0;
|
|
|
|
switch (state) {
|
|
case ETHTOOL_ID_ACTIVE:
|
|
return 1; /* cycle on/off once per second */
|
|
|
|
case ETHTOOL_ID_ON:
|
|
led_state = QED_LED_MODE_ON;
|
|
break;
|
|
|
|
case ETHTOOL_ID_OFF:
|
|
led_state = QED_LED_MODE_OFF;
|
|
break;
|
|
|
|
case ETHTOOL_ID_INACTIVE:
|
|
led_state = QED_LED_MODE_RESTORE;
|
|
break;
|
|
}
|
|
|
|
edev->ops->common->set_led(edev->cdev, led_state);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int qede_get_rss_flags(struct qede_dev *edev, struct ethtool_rxnfc *info)
|
|
{
|
|
info->data = RXH_IP_SRC | RXH_IP_DST;
|
|
|
|
switch (info->flow_type) {
|
|
case TCP_V4_FLOW:
|
|
case TCP_V6_FLOW:
|
|
info->data |= RXH_L4_B_0_1 | RXH_L4_B_2_3;
|
|
break;
|
|
case UDP_V4_FLOW:
|
|
if (edev->rss_caps & QED_RSS_IPV4_UDP)
|
|
info->data |= RXH_L4_B_0_1 | RXH_L4_B_2_3;
|
|
break;
|
|
case UDP_V6_FLOW:
|
|
if (edev->rss_caps & QED_RSS_IPV6_UDP)
|
|
info->data |= RXH_L4_B_0_1 | RXH_L4_B_2_3;
|
|
break;
|
|
case IPV4_FLOW:
|
|
case IPV6_FLOW:
|
|
break;
|
|
default:
|
|
info->data = 0;
|
|
break;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int qede_get_rxnfc(struct net_device *dev, struct ethtool_rxnfc *info,
|
|
u32 *rule_locs)
|
|
{
|
|
struct qede_dev *edev = netdev_priv(dev);
|
|
int rc = 0;
|
|
|
|
switch (info->cmd) {
|
|
case ETHTOOL_GRXRINGS:
|
|
info->data = QEDE_RSS_COUNT(edev);
|
|
break;
|
|
case ETHTOOL_GRXFH:
|
|
rc = qede_get_rss_flags(edev, info);
|
|
break;
|
|
case ETHTOOL_GRXCLSRLCNT:
|
|
info->rule_cnt = qede_get_arfs_filter_count(edev);
|
|
info->data = QEDE_RFS_MAX_FLTR;
|
|
break;
|
|
case ETHTOOL_GRXCLSRULE:
|
|
rc = qede_get_cls_rule_entry(edev, info);
|
|
break;
|
|
case ETHTOOL_GRXCLSRLALL:
|
|
rc = qede_get_cls_rule_all(edev, info, rule_locs);
|
|
break;
|
|
default:
|
|
DP_ERR(edev, "Command parameters not supported\n");
|
|
rc = -EOPNOTSUPP;
|
|
}
|
|
|
|
return rc;
|
|
}
|
|
|
|
static int qede_set_rss_flags(struct qede_dev *edev, struct ethtool_rxnfc *info)
|
|
{
|
|
struct qed_update_vport_params *vport_update_params;
|
|
u8 set_caps = 0, clr_caps = 0;
|
|
int rc = 0;
|
|
|
|
DP_VERBOSE(edev, QED_MSG_DEBUG,
|
|
"Set rss flags command parameters: flow type = %d, data = %llu\n",
|
|
info->flow_type, info->data);
|
|
|
|
switch (info->flow_type) {
|
|
case TCP_V4_FLOW:
|
|
case TCP_V6_FLOW:
|
|
/* For TCP only 4-tuple hash is supported */
|
|
if (info->data ^ (RXH_IP_SRC | RXH_IP_DST |
|
|
RXH_L4_B_0_1 | RXH_L4_B_2_3)) {
|
|
DP_INFO(edev, "Command parameters not supported\n");
|
|
return -EINVAL;
|
|
}
|
|
return 0;
|
|
case UDP_V4_FLOW:
|
|
/* For UDP either 2-tuple hash or 4-tuple hash is supported */
|
|
if (info->data == (RXH_IP_SRC | RXH_IP_DST |
|
|
RXH_L4_B_0_1 | RXH_L4_B_2_3)) {
|
|
set_caps = QED_RSS_IPV4_UDP;
|
|
DP_VERBOSE(edev, QED_MSG_DEBUG,
|
|
"UDP 4-tuple enabled\n");
|
|
} else if (info->data == (RXH_IP_SRC | RXH_IP_DST)) {
|
|
clr_caps = QED_RSS_IPV4_UDP;
|
|
DP_VERBOSE(edev, QED_MSG_DEBUG,
|
|
"UDP 4-tuple disabled\n");
|
|
} else {
|
|
return -EINVAL;
|
|
}
|
|
break;
|
|
case UDP_V6_FLOW:
|
|
/* For UDP either 2-tuple hash or 4-tuple hash is supported */
|
|
if (info->data == (RXH_IP_SRC | RXH_IP_DST |
|
|
RXH_L4_B_0_1 | RXH_L4_B_2_3)) {
|
|
set_caps = QED_RSS_IPV6_UDP;
|
|
DP_VERBOSE(edev, QED_MSG_DEBUG,
|
|
"UDP 4-tuple enabled\n");
|
|
} else if (info->data == (RXH_IP_SRC | RXH_IP_DST)) {
|
|
clr_caps = QED_RSS_IPV6_UDP;
|
|
DP_VERBOSE(edev, QED_MSG_DEBUG,
|
|
"UDP 4-tuple disabled\n");
|
|
} else {
|
|
return -EINVAL;
|
|
}
|
|
break;
|
|
case IPV4_FLOW:
|
|
case IPV6_FLOW:
|
|
/* For IP only 2-tuple hash is supported */
|
|
if (info->data ^ (RXH_IP_SRC | RXH_IP_DST)) {
|
|
DP_INFO(edev, "Command parameters not supported\n");
|
|
return -EINVAL;
|
|
}
|
|
return 0;
|
|
case SCTP_V4_FLOW:
|
|
case AH_ESP_V4_FLOW:
|
|
case AH_V4_FLOW:
|
|
case ESP_V4_FLOW:
|
|
case SCTP_V6_FLOW:
|
|
case AH_ESP_V6_FLOW:
|
|
case AH_V6_FLOW:
|
|
case ESP_V6_FLOW:
|
|
case IP_USER_FLOW:
|
|
case ETHER_FLOW:
|
|
/* RSS is not supported for these protocols */
|
|
if (info->data) {
|
|
DP_INFO(edev, "Command parameters not supported\n");
|
|
return -EINVAL;
|
|
}
|
|
return 0;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
|
|
/* No action is needed if there is no change in the rss capability */
|
|
if (edev->rss_caps == ((edev->rss_caps & ~clr_caps) | set_caps))
|
|
return 0;
|
|
|
|
/* Update internal configuration */
|
|
edev->rss_caps = ((edev->rss_caps & ~clr_caps) | set_caps);
|
|
edev->rss_params_inited |= QEDE_RSS_CAPS_INITED;
|
|
|
|
/* Re-configure if possible */
|
|
__qede_lock(edev);
|
|
if (edev->state == QEDE_STATE_OPEN) {
|
|
vport_update_params = vzalloc(sizeof(*vport_update_params));
|
|
if (!vport_update_params) {
|
|
__qede_unlock(edev);
|
|
return -ENOMEM;
|
|
}
|
|
qede_fill_rss_params(edev, &vport_update_params->rss_params,
|
|
&vport_update_params->update_rss_flg);
|
|
rc = edev->ops->vport_update(edev->cdev, vport_update_params);
|
|
vfree(vport_update_params);
|
|
}
|
|
__qede_unlock(edev);
|
|
|
|
return rc;
|
|
}
|
|
|
|
static int qede_set_rxnfc(struct net_device *dev, struct ethtool_rxnfc *info)
|
|
{
|
|
struct qede_dev *edev = netdev_priv(dev);
|
|
int rc;
|
|
|
|
switch (info->cmd) {
|
|
case ETHTOOL_SRXFH:
|
|
rc = qede_set_rss_flags(edev, info);
|
|
break;
|
|
case ETHTOOL_SRXCLSRLINS:
|
|
rc = qede_add_cls_rule(edev, info);
|
|
break;
|
|
case ETHTOOL_SRXCLSRLDEL:
|
|
rc = qede_delete_flow_filter(edev, info->fs.location);
|
|
break;
|
|
default:
|
|
DP_INFO(edev, "Command parameters not supported\n");
|
|
rc = -EOPNOTSUPP;
|
|
}
|
|
|
|
return rc;
|
|
}
|
|
|
|
static u32 qede_get_rxfh_indir_size(struct net_device *dev)
|
|
{
|
|
return QED_RSS_IND_TABLE_SIZE;
|
|
}
|
|
|
|
static u32 qede_get_rxfh_key_size(struct net_device *dev)
|
|
{
|
|
struct qede_dev *edev = netdev_priv(dev);
|
|
|
|
return sizeof(edev->rss_key);
|
|
}
|
|
|
|
static int qede_get_rxfh(struct net_device *dev, u32 *indir, u8 *key, u8 *hfunc)
|
|
{
|
|
struct qede_dev *edev = netdev_priv(dev);
|
|
int i;
|
|
|
|
if (hfunc)
|
|
*hfunc = ETH_RSS_HASH_TOP;
|
|
|
|
if (!indir)
|
|
return 0;
|
|
|
|
for (i = 0; i < QED_RSS_IND_TABLE_SIZE; i++)
|
|
indir[i] = edev->rss_ind_table[i];
|
|
|
|
if (key)
|
|
memcpy(key, edev->rss_key, qede_get_rxfh_key_size(dev));
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int qede_set_rxfh(struct net_device *dev, const u32 *indir,
|
|
const u8 *key, const u8 hfunc)
|
|
{
|
|
struct qed_update_vport_params *vport_update_params;
|
|
struct qede_dev *edev = netdev_priv(dev);
|
|
int i, rc = 0;
|
|
|
|
if (edev->dev_info.common.num_hwfns > 1) {
|
|
DP_INFO(edev,
|
|
"RSS configuration is not supported for 100G devices\n");
|
|
return -EOPNOTSUPP;
|
|
}
|
|
|
|
if (hfunc != ETH_RSS_HASH_NO_CHANGE && hfunc != ETH_RSS_HASH_TOP)
|
|
return -EOPNOTSUPP;
|
|
|
|
if (!indir && !key)
|
|
return 0;
|
|
|
|
if (indir) {
|
|
for (i = 0; i < QED_RSS_IND_TABLE_SIZE; i++)
|
|
edev->rss_ind_table[i] = indir[i];
|
|
edev->rss_params_inited |= QEDE_RSS_INDIR_INITED;
|
|
}
|
|
|
|
if (key) {
|
|
memcpy(&edev->rss_key, key, qede_get_rxfh_key_size(dev));
|
|
edev->rss_params_inited |= QEDE_RSS_KEY_INITED;
|
|
}
|
|
|
|
__qede_lock(edev);
|
|
if (edev->state == QEDE_STATE_OPEN) {
|
|
vport_update_params = vzalloc(sizeof(*vport_update_params));
|
|
if (!vport_update_params) {
|
|
__qede_unlock(edev);
|
|
return -ENOMEM;
|
|
}
|
|
qede_fill_rss_params(edev, &vport_update_params->rss_params,
|
|
&vport_update_params->update_rss_flg);
|
|
rc = edev->ops->vport_update(edev->cdev, vport_update_params);
|
|
vfree(vport_update_params);
|
|
}
|
|
__qede_unlock(edev);
|
|
|
|
return rc;
|
|
}
|
|
|
|
/* This function enables the interrupt generation and the NAPI on the device */
|
|
static void qede_netif_start(struct qede_dev *edev)
|
|
{
|
|
int i;
|
|
|
|
if (!netif_running(edev->ndev))
|
|
return;
|
|
|
|
for_each_queue(i) {
|
|
/* Update and reenable interrupts */
|
|
qed_sb_ack(edev->fp_array[i].sb_info, IGU_INT_ENABLE, 1);
|
|
napi_enable(&edev->fp_array[i].napi);
|
|
}
|
|
}
|
|
|
|
/* This function disables the NAPI and the interrupt generation on the device */
|
|
static void qede_netif_stop(struct qede_dev *edev)
|
|
{
|
|
int i;
|
|
|
|
for_each_queue(i) {
|
|
napi_disable(&edev->fp_array[i].napi);
|
|
/* Disable interrupts */
|
|
qed_sb_ack(edev->fp_array[i].sb_info, IGU_INT_DISABLE, 0);
|
|
}
|
|
}
|
|
|
|
static int qede_selftest_transmit_traffic(struct qede_dev *edev,
|
|
struct sk_buff *skb)
|
|
{
|
|
struct qede_tx_queue *txq = NULL;
|
|
struct eth_tx_1st_bd *first_bd;
|
|
dma_addr_t mapping;
|
|
int i, idx;
|
|
u16 val;
|
|
|
|
for_each_queue(i) {
|
|
struct qede_fastpath *fp = &edev->fp_array[i];
|
|
|
|
if (fp->type & QEDE_FASTPATH_TX) {
|
|
txq = QEDE_FP_TC0_TXQ(fp);
|
|
break;
|
|
}
|
|
}
|
|
|
|
if (!txq) {
|
|
DP_NOTICE(edev, "Tx path is not available\n");
|
|
return -1;
|
|
}
|
|
|
|
/* Fill the entry in the SW ring and the BDs in the FW ring */
|
|
idx = txq->sw_tx_prod;
|
|
txq->sw_tx_ring.skbs[idx].skb = skb;
|
|
first_bd = qed_chain_produce(&txq->tx_pbl);
|
|
memset(first_bd, 0, sizeof(*first_bd));
|
|
val = 1 << ETH_TX_1ST_BD_FLAGS_START_BD_SHIFT;
|
|
first_bd->data.bd_flags.bitfields = val;
|
|
val = skb->len & ETH_TX_DATA_1ST_BD_PKT_LEN_MASK;
|
|
val = val << ETH_TX_DATA_1ST_BD_PKT_LEN_SHIFT;
|
|
first_bd->data.bitfields |= cpu_to_le16(val);
|
|
|
|
/* Map skb linear data for DMA and set in the first BD */
|
|
mapping = dma_map_single(&edev->pdev->dev, skb->data,
|
|
skb_headlen(skb), DMA_TO_DEVICE);
|
|
if (unlikely(dma_mapping_error(&edev->pdev->dev, mapping))) {
|
|
DP_NOTICE(edev, "SKB mapping failed\n");
|
|
return -ENOMEM;
|
|
}
|
|
BD_SET_UNMAP_ADDR_LEN(first_bd, mapping, skb_headlen(skb));
|
|
|
|
/* update the first BD with the actual num BDs */
|
|
first_bd->data.nbds = 1;
|
|
txq->sw_tx_prod = (txq->sw_tx_prod + 1) % txq->num_tx_buffers;
|
|
/* 'next page' entries are counted in the producer value */
|
|
val = qed_chain_get_prod_idx(&txq->tx_pbl);
|
|
txq->tx_db.data.bd_prod = cpu_to_le16(val);
|
|
|
|
/* wmb makes sure that the BDs data is updated before updating the
|
|
* producer, otherwise FW may read old data from the BDs.
|
|
*/
|
|
wmb();
|
|
barrier();
|
|
writel(txq->tx_db.raw, txq->doorbell_addr);
|
|
|
|
/* mmiowb is needed to synchronize doorbell writes from more than one
|
|
* processor. It guarantees that the write arrives to the device before
|
|
* the queue lock is released and another start_xmit is called (possibly
|
|
* on another CPU). Without this barrier, the next doorbell can bypass
|
|
* this doorbell. This is applicable to IA64/Altix systems.
|
|
*/
|
|
mmiowb();
|
|
|
|
for (i = 0; i < QEDE_SELFTEST_POLL_COUNT; i++) {
|
|
if (qede_txq_has_work(txq))
|
|
break;
|
|
usleep_range(100, 200);
|
|
}
|
|
|
|
if (!qede_txq_has_work(txq)) {
|
|
DP_NOTICE(edev, "Tx completion didn't happen\n");
|
|
return -1;
|
|
}
|
|
|
|
first_bd = (struct eth_tx_1st_bd *)qed_chain_consume(&txq->tx_pbl);
|
|
dma_unmap_single(&edev->pdev->dev, BD_UNMAP_ADDR(first_bd),
|
|
BD_UNMAP_LEN(first_bd), DMA_TO_DEVICE);
|
|
txq->sw_tx_cons = (txq->sw_tx_cons + 1) % txq->num_tx_buffers;
|
|
txq->sw_tx_ring.skbs[idx].skb = NULL;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int qede_selftest_receive_traffic(struct qede_dev *edev)
|
|
{
|
|
u16 hw_comp_cons, sw_comp_cons, sw_rx_index, len;
|
|
struct eth_fast_path_rx_reg_cqe *fp_cqe;
|
|
struct qede_rx_queue *rxq = NULL;
|
|
struct sw_rx_data *sw_rx_data;
|
|
union eth_rx_cqe *cqe;
|
|
int i, iter, rc = 0;
|
|
u8 *data_ptr;
|
|
|
|
for_each_queue(i) {
|
|
if (edev->fp_array[i].type & QEDE_FASTPATH_RX) {
|
|
rxq = edev->fp_array[i].rxq;
|
|
break;
|
|
}
|
|
}
|
|
|
|
if (!rxq) {
|
|
DP_NOTICE(edev, "Rx path is not available\n");
|
|
return -1;
|
|
}
|
|
|
|
/* The packet is expected to receive on rx-queue 0 even though RSS is
|
|
* enabled. This is because the queue 0 is configured as the default
|
|
* queue and that the loopback traffic is not IP.
|
|
*/
|
|
for (iter = 0; iter < QEDE_SELFTEST_POLL_COUNT; iter++) {
|
|
if (!qede_has_rx_work(rxq)) {
|
|
usleep_range(100, 200);
|
|
continue;
|
|
}
|
|
|
|
hw_comp_cons = le16_to_cpu(*rxq->hw_cons_ptr);
|
|
sw_comp_cons = qed_chain_get_cons_idx(&rxq->rx_comp_ring);
|
|
|
|
/* Memory barrier to prevent the CPU from doing speculative
|
|
* reads of CQE/BD before reading hw_comp_cons. If the CQE is
|
|
* read before it is written by FW, then FW writes CQE and SB,
|
|
* and then the CPU reads the hw_comp_cons, it will use an old
|
|
* CQE.
|
|
*/
|
|
rmb();
|
|
|
|
/* Get the CQE from the completion ring */
|
|
cqe = (union eth_rx_cqe *)qed_chain_consume(&rxq->rx_comp_ring);
|
|
|
|
/* Get the data from the SW ring */
|
|
sw_rx_index = rxq->sw_rx_cons & NUM_RX_BDS_MAX;
|
|
sw_rx_data = &rxq->sw_rx_ring[sw_rx_index];
|
|
fp_cqe = &cqe->fast_path_regular;
|
|
len = le16_to_cpu(fp_cqe->len_on_first_bd);
|
|
data_ptr = (u8 *)(page_address(sw_rx_data->data) +
|
|
fp_cqe->placement_offset +
|
|
sw_rx_data->page_offset +
|
|
rxq->rx_headroom);
|
|
if (ether_addr_equal(data_ptr, edev->ndev->dev_addr) &&
|
|
ether_addr_equal(data_ptr + ETH_ALEN,
|
|
edev->ndev->dev_addr)) {
|
|
for (i = ETH_HLEN; i < len; i++)
|
|
if (data_ptr[i] != (unsigned char)(i & 0xff)) {
|
|
rc = -1;
|
|
break;
|
|
}
|
|
|
|
qede_recycle_rx_bd_ring(rxq, 1);
|
|
qed_chain_recycle_consumed(&rxq->rx_comp_ring);
|
|
break;
|
|
}
|
|
|
|
DP_INFO(edev, "Not the transmitted packet\n");
|
|
qede_recycle_rx_bd_ring(rxq, 1);
|
|
qed_chain_recycle_consumed(&rxq->rx_comp_ring);
|
|
}
|
|
|
|
if (iter == QEDE_SELFTEST_POLL_COUNT) {
|
|
DP_NOTICE(edev, "Failed to receive the traffic\n");
|
|
return -1;
|
|
}
|
|
|
|
qede_update_rx_prod(edev, rxq);
|
|
|
|
return rc;
|
|
}
|
|
|
|
static int qede_selftest_run_loopback(struct qede_dev *edev, u32 loopback_mode)
|
|
{
|
|
struct qed_link_params link_params;
|
|
struct sk_buff *skb = NULL;
|
|
int rc = 0, i;
|
|
u32 pkt_size;
|
|
u8 *packet;
|
|
|
|
if (!netif_running(edev->ndev)) {
|
|
DP_NOTICE(edev, "Interface is down\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
qede_netif_stop(edev);
|
|
|
|
/* Bring up the link in Loopback mode */
|
|
memset(&link_params, 0, sizeof(link_params));
|
|
link_params.link_up = true;
|
|
link_params.override_flags = QED_LINK_OVERRIDE_LOOPBACK_MODE;
|
|
link_params.loopback_mode = loopback_mode;
|
|
edev->ops->common->set_link(edev->cdev, &link_params);
|
|
|
|
/* Wait for loopback configuration to apply */
|
|
msleep_interruptible(500);
|
|
|
|
/* Setting max packet size to 1.5K to avoid data being split over
|
|
* multiple BDs in cases where MTU > PAGE_SIZE.
|
|
*/
|
|
pkt_size = (((edev->ndev->mtu < ETH_DATA_LEN) ?
|
|
edev->ndev->mtu : ETH_DATA_LEN) + ETH_HLEN);
|
|
|
|
skb = netdev_alloc_skb(edev->ndev, pkt_size);
|
|
if (!skb) {
|
|
DP_INFO(edev, "Can't allocate skb\n");
|
|
rc = -ENOMEM;
|
|
goto test_loopback_exit;
|
|
}
|
|
packet = skb_put(skb, pkt_size);
|
|
ether_addr_copy(packet, edev->ndev->dev_addr);
|
|
ether_addr_copy(packet + ETH_ALEN, edev->ndev->dev_addr);
|
|
memset(packet + (2 * ETH_ALEN), 0x77, (ETH_HLEN - (2 * ETH_ALEN)));
|
|
for (i = ETH_HLEN; i < pkt_size; i++)
|
|
packet[i] = (unsigned char)(i & 0xff);
|
|
|
|
rc = qede_selftest_transmit_traffic(edev, skb);
|
|
if (rc)
|
|
goto test_loopback_exit;
|
|
|
|
rc = qede_selftest_receive_traffic(edev);
|
|
if (rc)
|
|
goto test_loopback_exit;
|
|
|
|
DP_VERBOSE(edev, NETIF_MSG_RX_STATUS, "Loopback test successful\n");
|
|
|
|
test_loopback_exit:
|
|
dev_kfree_skb(skb);
|
|
|
|
/* Bring up the link in Normal mode */
|
|
memset(&link_params, 0, sizeof(link_params));
|
|
link_params.link_up = true;
|
|
link_params.override_flags = QED_LINK_OVERRIDE_LOOPBACK_MODE;
|
|
link_params.loopback_mode = QED_LINK_LOOPBACK_NONE;
|
|
edev->ops->common->set_link(edev->cdev, &link_params);
|
|
|
|
/* Wait for loopback configuration to apply */
|
|
msleep_interruptible(500);
|
|
|
|
qede_netif_start(edev);
|
|
|
|
return rc;
|
|
}
|
|
|
|
static void qede_self_test(struct net_device *dev,
|
|
struct ethtool_test *etest, u64 *buf)
|
|
{
|
|
struct qede_dev *edev = netdev_priv(dev);
|
|
|
|
DP_VERBOSE(edev, QED_MSG_DEBUG,
|
|
"Self-test command parameters: offline = %d, external_lb = %d\n",
|
|
(etest->flags & ETH_TEST_FL_OFFLINE),
|
|
(etest->flags & ETH_TEST_FL_EXTERNAL_LB) >> 2);
|
|
|
|
memset(buf, 0, sizeof(u64) * QEDE_ETHTOOL_TEST_MAX);
|
|
|
|
if (etest->flags & ETH_TEST_FL_OFFLINE) {
|
|
if (qede_selftest_run_loopback(edev,
|
|
QED_LINK_LOOPBACK_INT_PHY)) {
|
|
buf[QEDE_ETHTOOL_INT_LOOPBACK] = 1;
|
|
etest->flags |= ETH_TEST_FL_FAILED;
|
|
}
|
|
}
|
|
|
|
if (edev->ops->common->selftest->selftest_interrupt(edev->cdev)) {
|
|
buf[QEDE_ETHTOOL_INTERRUPT_TEST] = 1;
|
|
etest->flags |= ETH_TEST_FL_FAILED;
|
|
}
|
|
|
|
if (edev->ops->common->selftest->selftest_memory(edev->cdev)) {
|
|
buf[QEDE_ETHTOOL_MEMORY_TEST] = 1;
|
|
etest->flags |= ETH_TEST_FL_FAILED;
|
|
}
|
|
|
|
if (edev->ops->common->selftest->selftest_register(edev->cdev)) {
|
|
buf[QEDE_ETHTOOL_REGISTER_TEST] = 1;
|
|
etest->flags |= ETH_TEST_FL_FAILED;
|
|
}
|
|
|
|
if (edev->ops->common->selftest->selftest_clock(edev->cdev)) {
|
|
buf[QEDE_ETHTOOL_CLOCK_TEST] = 1;
|
|
etest->flags |= ETH_TEST_FL_FAILED;
|
|
}
|
|
|
|
if (edev->ops->common->selftest->selftest_nvram(edev->cdev)) {
|
|
buf[QEDE_ETHTOOL_NVRAM_TEST] = 1;
|
|
etest->flags |= ETH_TEST_FL_FAILED;
|
|
}
|
|
}
|
|
|
|
static int qede_set_tunable(struct net_device *dev,
|
|
const struct ethtool_tunable *tuna,
|
|
const void *data)
|
|
{
|
|
struct qede_dev *edev = netdev_priv(dev);
|
|
u32 val;
|
|
|
|
switch (tuna->id) {
|
|
case ETHTOOL_RX_COPYBREAK:
|
|
val = *(u32 *)data;
|
|
if (val < QEDE_MIN_PKT_LEN || val > QEDE_RX_HDR_SIZE) {
|
|
DP_VERBOSE(edev, QED_MSG_DEBUG,
|
|
"Invalid rx copy break value, range is [%u, %u]",
|
|
QEDE_MIN_PKT_LEN, QEDE_RX_HDR_SIZE);
|
|
return -EINVAL;
|
|
}
|
|
|
|
edev->rx_copybreak = *(u32 *)data;
|
|
break;
|
|
default:
|
|
return -EOPNOTSUPP;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int qede_get_tunable(struct net_device *dev,
|
|
const struct ethtool_tunable *tuna, void *data)
|
|
{
|
|
struct qede_dev *edev = netdev_priv(dev);
|
|
|
|
switch (tuna->id) {
|
|
case ETHTOOL_RX_COPYBREAK:
|
|
*(u32 *)data = edev->rx_copybreak;
|
|
break;
|
|
default:
|
|
return -EOPNOTSUPP;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int qede_get_eee(struct net_device *dev, struct ethtool_eee *edata)
|
|
{
|
|
struct qede_dev *edev = netdev_priv(dev);
|
|
struct qed_link_output current_link;
|
|
|
|
memset(¤t_link, 0, sizeof(current_link));
|
|
edev->ops->common->get_link(edev->cdev, ¤t_link);
|
|
|
|
if (!current_link.eee_supported) {
|
|
DP_INFO(edev, "EEE is not supported\n");
|
|
return -EOPNOTSUPP;
|
|
}
|
|
|
|
if (current_link.eee.adv_caps & QED_EEE_1G_ADV)
|
|
edata->advertised = ADVERTISED_1000baseT_Full;
|
|
if (current_link.eee.adv_caps & QED_EEE_10G_ADV)
|
|
edata->advertised |= ADVERTISED_10000baseT_Full;
|
|
if (current_link.sup_caps & QED_EEE_1G_ADV)
|
|
edata->supported = ADVERTISED_1000baseT_Full;
|
|
if (current_link.sup_caps & QED_EEE_10G_ADV)
|
|
edata->supported |= ADVERTISED_10000baseT_Full;
|
|
if (current_link.eee.lp_adv_caps & QED_EEE_1G_ADV)
|
|
edata->lp_advertised = ADVERTISED_1000baseT_Full;
|
|
if (current_link.eee.lp_adv_caps & QED_EEE_10G_ADV)
|
|
edata->lp_advertised |= ADVERTISED_10000baseT_Full;
|
|
|
|
edata->tx_lpi_timer = current_link.eee.tx_lpi_timer;
|
|
edata->eee_enabled = current_link.eee.enable;
|
|
edata->tx_lpi_enabled = current_link.eee.tx_lpi_enable;
|
|
edata->eee_active = current_link.eee_active;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int qede_set_eee(struct net_device *dev, struct ethtool_eee *edata)
|
|
{
|
|
struct qede_dev *edev = netdev_priv(dev);
|
|
struct qed_link_output current_link;
|
|
struct qed_link_params params;
|
|
|
|
if (!edev->ops->common->can_link_change(edev->cdev)) {
|
|
DP_INFO(edev, "Link settings are not allowed to be changed\n");
|
|
return -EOPNOTSUPP;
|
|
}
|
|
|
|
memset(¤t_link, 0, sizeof(current_link));
|
|
edev->ops->common->get_link(edev->cdev, ¤t_link);
|
|
|
|
if (!current_link.eee_supported) {
|
|
DP_INFO(edev, "EEE is not supported\n");
|
|
return -EOPNOTSUPP;
|
|
}
|
|
|
|
memset(¶ms, 0, sizeof(params));
|
|
params.override_flags |= QED_LINK_OVERRIDE_EEE_CONFIG;
|
|
|
|
if (!(edata->advertised & (ADVERTISED_1000baseT_Full |
|
|
ADVERTISED_10000baseT_Full)) ||
|
|
((edata->advertised & (ADVERTISED_1000baseT_Full |
|
|
ADVERTISED_10000baseT_Full)) !=
|
|
edata->advertised)) {
|
|
DP_VERBOSE(edev, QED_MSG_DEBUG,
|
|
"Invalid advertised capabilities %d\n",
|
|
edata->advertised);
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (edata->advertised & ADVERTISED_1000baseT_Full)
|
|
params.eee.adv_caps = QED_EEE_1G_ADV;
|
|
if (edata->advertised & ADVERTISED_10000baseT_Full)
|
|
params.eee.adv_caps |= QED_EEE_10G_ADV;
|
|
params.eee.enable = edata->eee_enabled;
|
|
params.eee.tx_lpi_enable = edata->tx_lpi_enabled;
|
|
params.eee.tx_lpi_timer = edata->tx_lpi_timer;
|
|
|
|
params.link_up = true;
|
|
edev->ops->common->set_link(edev->cdev, ¶ms);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int qede_get_module_info(struct net_device *dev,
|
|
struct ethtool_modinfo *modinfo)
|
|
{
|
|
struct qede_dev *edev = netdev_priv(dev);
|
|
u8 buf[4];
|
|
int rc;
|
|
|
|
/* Read first 4 bytes to find the sfp type */
|
|
rc = edev->ops->common->read_module_eeprom(edev->cdev, buf,
|
|
QED_I2C_DEV_ADDR_A0, 0, 4);
|
|
if (rc) {
|
|
DP_ERR(edev, "Failed reading EEPROM data %d\n", rc);
|
|
return rc;
|
|
}
|
|
|
|
switch (buf[0]) {
|
|
case 0x3: /* SFP, SFP+, SFP-28 */
|
|
modinfo->type = ETH_MODULE_SFF_8472;
|
|
modinfo->eeprom_len = ETH_MODULE_SFF_8472_LEN;
|
|
break;
|
|
case 0xc: /* QSFP */
|
|
case 0xd: /* QSFP+ */
|
|
modinfo->type = ETH_MODULE_SFF_8436;
|
|
modinfo->eeprom_len = ETH_MODULE_SFF_8436_LEN;
|
|
break;
|
|
case 0x11: /* QSFP-28 */
|
|
modinfo->type = ETH_MODULE_SFF_8636;
|
|
modinfo->eeprom_len = ETH_MODULE_SFF_8636_LEN;
|
|
break;
|
|
default:
|
|
DP_ERR(edev, "Unknown transceiver type 0x%x\n", buf[0]);
|
|
return -EINVAL;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int qede_get_module_eeprom(struct net_device *dev,
|
|
struct ethtool_eeprom *ee, u8 *data)
|
|
{
|
|
struct qede_dev *edev = netdev_priv(dev);
|
|
u32 start_addr = ee->offset, size = 0;
|
|
u8 *buf = data;
|
|
int rc = 0;
|
|
|
|
/* Read A0 section */
|
|
if (ee->offset < ETH_MODULE_SFF_8079_LEN) {
|
|
/* Limit transfer size to the A0 section boundary */
|
|
if (ee->offset + ee->len > ETH_MODULE_SFF_8079_LEN)
|
|
size = ETH_MODULE_SFF_8079_LEN - ee->offset;
|
|
else
|
|
size = ee->len;
|
|
|
|
rc = edev->ops->common->read_module_eeprom(edev->cdev, buf,
|
|
QED_I2C_DEV_ADDR_A0,
|
|
start_addr, size);
|
|
if (rc) {
|
|
DP_ERR(edev, "Failed reading A0 section %d\n", rc);
|
|
return rc;
|
|
}
|
|
|
|
buf += size;
|
|
start_addr += size;
|
|
}
|
|
|
|
/* Read A2 section */
|
|
if (start_addr >= ETH_MODULE_SFF_8079_LEN &&
|
|
start_addr < ETH_MODULE_SFF_8472_LEN) {
|
|
size = ee->len - size;
|
|
/* Limit transfer size to the A2 section boundary */
|
|
if (start_addr + size > ETH_MODULE_SFF_8472_LEN)
|
|
size = ETH_MODULE_SFF_8472_LEN - start_addr;
|
|
start_addr -= ETH_MODULE_SFF_8079_LEN;
|
|
rc = edev->ops->common->read_module_eeprom(edev->cdev, buf,
|
|
QED_I2C_DEV_ADDR_A2,
|
|
start_addr, size);
|
|
if (rc) {
|
|
DP_VERBOSE(edev, QED_MSG_DEBUG,
|
|
"Failed reading A2 section %d\n", rc);
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
return rc;
|
|
}
|
|
|
|
static const struct ethtool_ops qede_ethtool_ops = {
|
|
.get_link_ksettings = qede_get_link_ksettings,
|
|
.set_link_ksettings = qede_set_link_ksettings,
|
|
.get_drvinfo = qede_get_drvinfo,
|
|
.get_regs_len = qede_get_regs_len,
|
|
.get_regs = qede_get_regs,
|
|
.get_wol = qede_get_wol,
|
|
.set_wol = qede_set_wol,
|
|
.get_msglevel = qede_get_msglevel,
|
|
.set_msglevel = qede_set_msglevel,
|
|
.nway_reset = qede_nway_reset,
|
|
.get_link = qede_get_link,
|
|
.get_coalesce = qede_get_coalesce,
|
|
.set_coalesce = qede_set_coalesce,
|
|
.get_ringparam = qede_get_ringparam,
|
|
.set_ringparam = qede_set_ringparam,
|
|
.get_pauseparam = qede_get_pauseparam,
|
|
.set_pauseparam = qede_set_pauseparam,
|
|
.get_strings = qede_get_strings,
|
|
.set_phys_id = qede_set_phys_id,
|
|
.get_ethtool_stats = qede_get_ethtool_stats,
|
|
.get_priv_flags = qede_get_priv_flags,
|
|
.get_sset_count = qede_get_sset_count,
|
|
.get_rxnfc = qede_get_rxnfc,
|
|
.set_rxnfc = qede_set_rxnfc,
|
|
.get_rxfh_indir_size = qede_get_rxfh_indir_size,
|
|
.get_rxfh_key_size = qede_get_rxfh_key_size,
|
|
.get_rxfh = qede_get_rxfh,
|
|
.set_rxfh = qede_set_rxfh,
|
|
.get_ts_info = qede_get_ts_info,
|
|
.get_channels = qede_get_channels,
|
|
.set_channels = qede_set_channels,
|
|
.self_test = qede_self_test,
|
|
.get_module_info = qede_get_module_info,
|
|
.get_module_eeprom = qede_get_module_eeprom,
|
|
.get_eee = qede_get_eee,
|
|
.set_eee = qede_set_eee,
|
|
|
|
.get_tunable = qede_get_tunable,
|
|
.set_tunable = qede_set_tunable,
|
|
.flash_device = qede_flash_device,
|
|
};
|
|
|
|
static const struct ethtool_ops qede_vf_ethtool_ops = {
|
|
.get_link_ksettings = qede_get_link_ksettings,
|
|
.get_drvinfo = qede_get_drvinfo,
|
|
.get_msglevel = qede_get_msglevel,
|
|
.set_msglevel = qede_set_msglevel,
|
|
.get_link = qede_get_link,
|
|
.get_coalesce = qede_get_coalesce,
|
|
.set_coalesce = qede_set_coalesce,
|
|
.get_ringparam = qede_get_ringparam,
|
|
.set_ringparam = qede_set_ringparam,
|
|
.get_strings = qede_get_strings,
|
|
.get_ethtool_stats = qede_get_ethtool_stats,
|
|
.get_priv_flags = qede_get_priv_flags,
|
|
.get_sset_count = qede_get_sset_count,
|
|
.get_rxnfc = qede_get_rxnfc,
|
|
.set_rxnfc = qede_set_rxnfc,
|
|
.get_rxfh_indir_size = qede_get_rxfh_indir_size,
|
|
.get_rxfh_key_size = qede_get_rxfh_key_size,
|
|
.get_rxfh = qede_get_rxfh,
|
|
.set_rxfh = qede_set_rxfh,
|
|
.get_channels = qede_get_channels,
|
|
.set_channels = qede_set_channels,
|
|
.get_tunable = qede_get_tunable,
|
|
.set_tunable = qede_set_tunable,
|
|
};
|
|
|
|
void qede_set_ethtool_ops(struct net_device *dev)
|
|
{
|
|
struct qede_dev *edev = netdev_priv(dev);
|
|
|
|
if (IS_VF(edev))
|
|
dev->ethtool_ops = &qede_vf_ethtool_ops;
|
|
else
|
|
dev->ethtool_ops = &qede_ethtool_ops;
|
|
}
|