// SPDX-License-Identifier: (GPL-2.0-only OR BSD-2-Clause) /* Copyright (C) 2015-2018 Netronome Systems, Inc. */ /* * nfp_net_ethtool.c * Netronome network device driver: ethtool support * Authors: Jakub Kicinski * Jason McMullan * Rolf Neugebauer * Brad Petrus */ #include #include #include #include #include #include #include #include #include #include "nfpcore/nfp.h" #include "nfpcore/nfp_dev.h" #include "nfpcore/nfp_nsp.h" #include "nfp_app.h" #include "nfp_main.h" #include "nfp_net_ctrl.h" #include "nfp_net_dp.h" #include "nfp_net.h" #include "nfp_port.h" #include "nfpcore/nfp_cpp.h" struct nfp_et_stat { char name[ETH_GSTRING_LEN]; int off; }; static const struct nfp_et_stat nfp_net_et_stats[] = { /* Stats from the device */ { "dev_rx_discards", NFP_NET_CFG_STATS_RX_DISCARDS }, { "dev_rx_errors", NFP_NET_CFG_STATS_RX_ERRORS }, { "dev_rx_bytes", NFP_NET_CFG_STATS_RX_OCTETS }, { "dev_rx_uc_bytes", NFP_NET_CFG_STATS_RX_UC_OCTETS }, { "dev_rx_mc_bytes", NFP_NET_CFG_STATS_RX_MC_OCTETS }, { "dev_rx_bc_bytes", NFP_NET_CFG_STATS_RX_BC_OCTETS }, { "dev_rx_pkts", NFP_NET_CFG_STATS_RX_FRAMES }, { "dev_rx_mc_pkts", NFP_NET_CFG_STATS_RX_MC_FRAMES }, { "dev_rx_bc_pkts", NFP_NET_CFG_STATS_RX_BC_FRAMES }, { "dev_tx_discards", NFP_NET_CFG_STATS_TX_DISCARDS }, { "dev_tx_errors", NFP_NET_CFG_STATS_TX_ERRORS }, { "dev_tx_bytes", NFP_NET_CFG_STATS_TX_OCTETS }, { "dev_tx_uc_bytes", NFP_NET_CFG_STATS_TX_UC_OCTETS }, { "dev_tx_mc_bytes", NFP_NET_CFG_STATS_TX_MC_OCTETS }, { "dev_tx_bc_bytes", NFP_NET_CFG_STATS_TX_BC_OCTETS }, { "dev_tx_pkts", NFP_NET_CFG_STATS_TX_FRAMES }, { "dev_tx_mc_pkts", NFP_NET_CFG_STATS_TX_MC_FRAMES }, { "dev_tx_bc_pkts", NFP_NET_CFG_STATS_TX_BC_FRAMES }, { "bpf_pass_pkts", NFP_NET_CFG_STATS_APP0_FRAMES }, { "bpf_pass_bytes", NFP_NET_CFG_STATS_APP0_BYTES }, /* see comments in outro functions in nfp_bpf_jit.c to find out * how different BPF modes use app-specific counters */ { "bpf_app1_pkts", NFP_NET_CFG_STATS_APP1_FRAMES }, { "bpf_app1_bytes", NFP_NET_CFG_STATS_APP1_BYTES }, { "bpf_app2_pkts", NFP_NET_CFG_STATS_APP2_FRAMES }, { "bpf_app2_bytes", NFP_NET_CFG_STATS_APP2_BYTES }, { "bpf_app3_pkts", NFP_NET_CFG_STATS_APP3_FRAMES }, { "bpf_app3_bytes", NFP_NET_CFG_STATS_APP3_BYTES }, }; static const struct nfp_et_stat nfp_mac_et_stats[] = { { "rx_octets", NFP_MAC_STATS_RX_IN_OCTETS, }, { "rx_frame_too_long_errors", NFP_MAC_STATS_RX_FRAME_TOO_LONG_ERRORS, }, { "rx_range_length_errors", NFP_MAC_STATS_RX_RANGE_LENGTH_ERRORS, }, { "rx_vlan_received_ok", NFP_MAC_STATS_RX_VLAN_RECEIVED_OK, }, { "rx_errors", NFP_MAC_STATS_RX_IN_ERRORS, }, { "rx_broadcast_pkts", NFP_MAC_STATS_RX_IN_BROADCAST_PKTS, }, { "rx_drop_events", NFP_MAC_STATS_RX_DROP_EVENTS, }, { "rx_alignment_errors", NFP_MAC_STATS_RX_ALIGNMENT_ERRORS, }, { "rx_pause_mac_ctrl_frames", NFP_MAC_STATS_RX_PAUSE_MAC_CTRL_FRAMES, }, { "rx_frames_received_ok", NFP_MAC_STATS_RX_FRAMES_RECEIVED_OK, }, { "rx_frame_check_sequence_errors", NFP_MAC_STATS_RX_FRAME_CHECK_SEQUENCE_ERRORS, }, { "rx_unicast_pkts", NFP_MAC_STATS_RX_UNICAST_PKTS, }, { "rx_multicast_pkts", NFP_MAC_STATS_RX_MULTICAST_PKTS, }, { "rx_pkts", NFP_MAC_STATS_RX_PKTS, }, { "rx_undersize_pkts", NFP_MAC_STATS_RX_UNDERSIZE_PKTS, }, { "rx_pkts_64_octets", NFP_MAC_STATS_RX_PKTS_64_OCTETS, }, { "rx_pkts_65_to_127_octets", NFP_MAC_STATS_RX_PKTS_65_TO_127_OCTETS, }, { "rx_pkts_128_to_255_octets", NFP_MAC_STATS_RX_PKTS_128_TO_255_OCTETS, }, { "rx_pkts_256_to_511_octets", NFP_MAC_STATS_RX_PKTS_256_TO_511_OCTETS, }, { "rx_pkts_512_to_1023_octets", NFP_MAC_STATS_RX_PKTS_512_TO_1023_OCTETS, }, { "rx_pkts_1024_to_1518_octets", NFP_MAC_STATS_RX_PKTS_1024_TO_1518_OCTETS, }, { "rx_pkts_1519_to_max_octets", NFP_MAC_STATS_RX_PKTS_1519_TO_MAX_OCTETS, }, { "rx_jabbers", NFP_MAC_STATS_RX_JABBERS, }, { "rx_fragments", NFP_MAC_STATS_RX_FRAGMENTS, }, { "rx_oversize_pkts", NFP_MAC_STATS_RX_OVERSIZE_PKTS, }, { "rx_pause_frames_class0", NFP_MAC_STATS_RX_PAUSE_FRAMES_CLASS0, }, { "rx_pause_frames_class1", NFP_MAC_STATS_RX_PAUSE_FRAMES_CLASS1, }, { "rx_pause_frames_class2", NFP_MAC_STATS_RX_PAUSE_FRAMES_CLASS2, }, { "rx_pause_frames_class3", NFP_MAC_STATS_RX_PAUSE_FRAMES_CLASS3, }, { "rx_pause_frames_class4", NFP_MAC_STATS_RX_PAUSE_FRAMES_CLASS4, }, { "rx_pause_frames_class5", NFP_MAC_STATS_RX_PAUSE_FRAMES_CLASS5, }, { "rx_pause_frames_class6", NFP_MAC_STATS_RX_PAUSE_FRAMES_CLASS6, }, { "rx_pause_frames_class7", NFP_MAC_STATS_RX_PAUSE_FRAMES_CLASS7, }, { "rx_mac_ctrl_frames_received", NFP_MAC_STATS_RX_MAC_CTRL_FRAMES_RECEIVED, }, { "rx_mac_head_drop", NFP_MAC_STATS_RX_MAC_HEAD_DROP, }, { "tx_queue_drop", NFP_MAC_STATS_TX_QUEUE_DROP, }, { "tx_octets", NFP_MAC_STATS_TX_OUT_OCTETS, }, { "tx_vlan_transmitted_ok", NFP_MAC_STATS_TX_VLAN_TRANSMITTED_OK, }, { "tx_errors", NFP_MAC_STATS_TX_OUT_ERRORS, }, { "tx_broadcast_pkts", NFP_MAC_STATS_TX_BROADCAST_PKTS, }, { "tx_pause_mac_ctrl_frames", NFP_MAC_STATS_TX_PAUSE_MAC_CTRL_FRAMES, }, { "tx_frames_transmitted_ok", NFP_MAC_STATS_TX_FRAMES_TRANSMITTED_OK, }, { "tx_unicast_pkts", NFP_MAC_STATS_TX_UNICAST_PKTS, }, { "tx_multicast_pkts", NFP_MAC_STATS_TX_MULTICAST_PKTS, }, { "tx_pkts_64_octets", NFP_MAC_STATS_TX_PKTS_64_OCTETS, }, { "tx_pkts_65_to_127_octets", NFP_MAC_STATS_TX_PKTS_65_TO_127_OCTETS, }, { "tx_pkts_128_to_255_octets", NFP_MAC_STATS_TX_PKTS_128_TO_255_OCTETS, }, { "tx_pkts_256_to_511_octets", NFP_MAC_STATS_TX_PKTS_256_TO_511_OCTETS, }, { "tx_pkts_512_to_1023_octets", NFP_MAC_STATS_TX_PKTS_512_TO_1023_OCTETS, }, { "tx_pkts_1024_to_1518_octets", NFP_MAC_STATS_TX_PKTS_1024_TO_1518_OCTETS, }, { "tx_pkts_1519_to_max_octets", NFP_MAC_STATS_TX_PKTS_1519_TO_MAX_OCTETS, }, { "tx_pause_frames_class0", NFP_MAC_STATS_TX_PAUSE_FRAMES_CLASS0, }, { "tx_pause_frames_class1", NFP_MAC_STATS_TX_PAUSE_FRAMES_CLASS1, }, { "tx_pause_frames_class2", NFP_MAC_STATS_TX_PAUSE_FRAMES_CLASS2, }, { "tx_pause_frames_class3", NFP_MAC_STATS_TX_PAUSE_FRAMES_CLASS3, }, { "tx_pause_frames_class4", NFP_MAC_STATS_TX_PAUSE_FRAMES_CLASS4, }, { "tx_pause_frames_class5", NFP_MAC_STATS_TX_PAUSE_FRAMES_CLASS5, }, { "tx_pause_frames_class6", NFP_MAC_STATS_TX_PAUSE_FRAMES_CLASS6, }, { "tx_pause_frames_class7", NFP_MAC_STATS_TX_PAUSE_FRAMES_CLASS7, }, }; static const char nfp_tlv_stat_names[][ETH_GSTRING_LEN] = { [1] = "dev_rx_discards", [2] = "dev_rx_errors", [3] = "dev_rx_bytes", [4] = "dev_rx_uc_bytes", [5] = "dev_rx_mc_bytes", [6] = "dev_rx_bc_bytes", [7] = "dev_rx_pkts", [8] = "dev_rx_mc_pkts", [9] = "dev_rx_bc_pkts", [10] = "dev_tx_discards", [11] = "dev_tx_errors", [12] = "dev_tx_bytes", [13] = "dev_tx_uc_bytes", [14] = "dev_tx_mc_bytes", [15] = "dev_tx_bc_bytes", [16] = "dev_tx_pkts", [17] = "dev_tx_mc_pkts", [18] = "dev_tx_bc_pkts", }; #define NN_ET_GLOBAL_STATS_LEN ARRAY_SIZE(nfp_net_et_stats) #define NN_ET_SWITCH_STATS_LEN 9 #define NN_RVEC_GATHER_STATS 13 #define NN_RVEC_PER_Q_STATS 3 #define NN_CTRL_PATH_STATS 4 #define SFP_SFF_REV_COMPLIANCE 1 static void nfp_net_get_nspinfo(struct nfp_app *app, char *version) { struct nfp_nsp *nsp; if (!app) return; nsp = nfp_nsp_open(app->cpp); if (IS_ERR(nsp)) return; snprintf(version, ETHTOOL_FWVERS_LEN, "%hu.%hu", nfp_nsp_get_abi_ver_major(nsp), nfp_nsp_get_abi_ver_minor(nsp)); nfp_nsp_close(nsp); } static void nfp_get_drvinfo(struct nfp_app *app, struct pci_dev *pdev, const char *vnic_version, struct ethtool_drvinfo *drvinfo) { char nsp_version[ETHTOOL_FWVERS_LEN] = {}; strscpy(drvinfo->driver, dev_driver_string(&pdev->dev), sizeof(drvinfo->driver)); nfp_net_get_nspinfo(app, nsp_version); snprintf(drvinfo->fw_version, sizeof(drvinfo->fw_version), "%s %s %s %s", vnic_version, nsp_version, nfp_app_mip_name(app), nfp_app_name(app)); } static void nfp_net_get_drvinfo(struct net_device *netdev, struct ethtool_drvinfo *drvinfo) { char vnic_version[ETHTOOL_FWVERS_LEN] = {}; struct nfp_net *nn = netdev_priv(netdev); snprintf(vnic_version, sizeof(vnic_version), "%d.%d.%d.%d", nn->fw_ver.extend, nn->fw_ver.class, nn->fw_ver.major, nn->fw_ver.minor); strscpy(drvinfo->bus_info, pci_name(nn->pdev), sizeof(drvinfo->bus_info)); nfp_get_drvinfo(nn->app, nn->pdev, vnic_version, drvinfo); } static int nfp_net_nway_reset(struct net_device *netdev) { struct nfp_eth_table_port *eth_port; struct nfp_port *port; int err; port = nfp_port_from_netdev(netdev); eth_port = nfp_port_get_eth_port(port); if (!eth_port) return -EOPNOTSUPP; if (!netif_running(netdev)) return 0; err = nfp_eth_set_configured(port->app->cpp, eth_port->index, false); if (err) { netdev_info(netdev, "Link down failed: %d\n", err); return err; } err = nfp_eth_set_configured(port->app->cpp, eth_port->index, true); if (err) { netdev_info(netdev, "Link up failed: %d\n", err); return err; } netdev_info(netdev, "Link reset succeeded\n"); return 0; } static void nfp_app_get_drvinfo(struct net_device *netdev, struct ethtool_drvinfo *drvinfo) { struct nfp_app *app = nfp_app_from_netdev(netdev); strscpy(drvinfo->bus_info, pci_name(app->pdev), sizeof(drvinfo->bus_info)); nfp_get_drvinfo(app, app->pdev, "*", drvinfo); } static void nfp_net_set_fec_link_mode(struct nfp_eth_table_port *eth_port, struct ethtool_link_ksettings *c) { unsigned int modes; ethtool_link_ksettings_add_link_mode(c, supported, FEC_NONE); if (!nfp_eth_can_support_fec(eth_port)) { ethtool_link_ksettings_add_link_mode(c, advertising, FEC_NONE); return; } modes = nfp_eth_supported_fec_modes(eth_port); if (modes & NFP_FEC_BASER) { ethtool_link_ksettings_add_link_mode(c, supported, FEC_BASER); ethtool_link_ksettings_add_link_mode(c, advertising, FEC_BASER); } if (modes & NFP_FEC_REED_SOLOMON) { ethtool_link_ksettings_add_link_mode(c, supported, FEC_RS); ethtool_link_ksettings_add_link_mode(c, advertising, FEC_RS); } } static const struct nfp_eth_media_link_mode { u16 ethtool_link_mode; u16 speed; } nfp_eth_media_table[NFP_MEDIA_LINK_MODES_NUMBER] = { [NFP_MEDIA_1000BASE_CX] = { .ethtool_link_mode = ETHTOOL_LINK_MODE_1000baseKX_Full_BIT, .speed = NFP_SPEED_1G, }, [NFP_MEDIA_1000BASE_KX] = { .ethtool_link_mode = ETHTOOL_LINK_MODE_1000baseKX_Full_BIT, .speed = NFP_SPEED_1G, }, [NFP_MEDIA_10GBASE_KX4] = { .ethtool_link_mode = ETHTOOL_LINK_MODE_10000baseKX4_Full_BIT, .speed = NFP_SPEED_10G, }, [NFP_MEDIA_10GBASE_KR] = { .ethtool_link_mode = ETHTOOL_LINK_MODE_10000baseKR_Full_BIT, .speed = NFP_SPEED_10G, }, [NFP_MEDIA_10GBASE_LR] = { .ethtool_link_mode = ETHTOOL_LINK_MODE_10000baseLR_Full_BIT, .speed = NFP_SPEED_10G, }, [NFP_MEDIA_10GBASE_CX4] = { .ethtool_link_mode = ETHTOOL_LINK_MODE_10000baseKX4_Full_BIT, .speed = NFP_SPEED_10G, }, [NFP_MEDIA_10GBASE_CR] = { .ethtool_link_mode = ETHTOOL_LINK_MODE_10000baseCR_Full_BIT, .speed = NFP_SPEED_10G, }, [NFP_MEDIA_10GBASE_SR] = { .ethtool_link_mode = ETHTOOL_LINK_MODE_10000baseSR_Full_BIT, .speed = NFP_SPEED_10G, }, [NFP_MEDIA_10GBASE_ER] = { .ethtool_link_mode = ETHTOOL_LINK_MODE_10000baseER_Full_BIT, .speed = NFP_SPEED_10G, }, [NFP_MEDIA_25GBASE_KR] = { .ethtool_link_mode = ETHTOOL_LINK_MODE_25000baseKR_Full_BIT, .speed = NFP_SPEED_25G, }, [NFP_MEDIA_25GBASE_KR_S] = { .ethtool_link_mode = ETHTOOL_LINK_MODE_25000baseKR_Full_BIT, .speed = NFP_SPEED_25G, }, [NFP_MEDIA_25GBASE_CR] = { .ethtool_link_mode = ETHTOOL_LINK_MODE_25000baseCR_Full_BIT, .speed = NFP_SPEED_25G, }, [NFP_MEDIA_25GBASE_CR_S] = { .ethtool_link_mode = ETHTOOL_LINK_MODE_25000baseCR_Full_BIT, .speed = NFP_SPEED_25G, }, [NFP_MEDIA_25GBASE_SR] = { .ethtool_link_mode = ETHTOOL_LINK_MODE_25000baseSR_Full_BIT, .speed = NFP_SPEED_25G, }, [NFP_MEDIA_25GBASE_LR] = { .ethtool_link_mode = ETHTOOL_LINK_MODE_25000baseSR_Full_BIT, .speed = NFP_SPEED_25G, }, [NFP_MEDIA_25GBASE_ER] = { .ethtool_link_mode = ETHTOOL_LINK_MODE_25000baseSR_Full_BIT, .speed = NFP_SPEED_25G, }, [NFP_MEDIA_40GBASE_CR4] = { .ethtool_link_mode = ETHTOOL_LINK_MODE_40000baseCR4_Full_BIT, .speed = NFP_SPEED_40G, }, [NFP_MEDIA_40GBASE_KR4] = { .ethtool_link_mode = ETHTOOL_LINK_MODE_40000baseKR4_Full_BIT, .speed = NFP_SPEED_40G, }, [NFP_MEDIA_40GBASE_SR4] = { .ethtool_link_mode = ETHTOOL_LINK_MODE_40000baseSR4_Full_BIT, .speed = NFP_SPEED_40G, }, [NFP_MEDIA_40GBASE_LR4] = { .ethtool_link_mode = ETHTOOL_LINK_MODE_40000baseLR4_Full_BIT, .speed = NFP_SPEED_40G, }, [NFP_MEDIA_50GBASE_KR] = { .ethtool_link_mode = ETHTOOL_LINK_MODE_50000baseKR_Full_BIT, .speed = NFP_SPEED_50G, }, [NFP_MEDIA_50GBASE_SR] = { .ethtool_link_mode = ETHTOOL_LINK_MODE_50000baseSR_Full_BIT, .speed = NFP_SPEED_50G, }, [NFP_MEDIA_50GBASE_CR] = { .ethtool_link_mode = ETHTOOL_LINK_MODE_50000baseCR_Full_BIT, .speed = NFP_SPEED_50G, }, [NFP_MEDIA_50GBASE_LR] = { .ethtool_link_mode = ETHTOOL_LINK_MODE_50000baseLR_ER_FR_Full_BIT, .speed = NFP_SPEED_50G, }, [NFP_MEDIA_50GBASE_ER] = { .ethtool_link_mode = ETHTOOL_LINK_MODE_50000baseLR_ER_FR_Full_BIT, .speed = NFP_SPEED_50G, }, [NFP_MEDIA_50GBASE_FR] = { .ethtool_link_mode = ETHTOOL_LINK_MODE_50000baseLR_ER_FR_Full_BIT, .speed = NFP_SPEED_50G, }, [NFP_MEDIA_100GBASE_KR4] = { .ethtool_link_mode = ETHTOOL_LINK_MODE_100000baseKR4_Full_BIT, .speed = NFP_SPEED_100G, }, [NFP_MEDIA_100GBASE_SR4] = { .ethtool_link_mode = ETHTOOL_LINK_MODE_100000baseSR4_Full_BIT, .speed = NFP_SPEED_100G, }, [NFP_MEDIA_100GBASE_CR4] = { .ethtool_link_mode = ETHTOOL_LINK_MODE_100000baseCR4_Full_BIT, .speed = NFP_SPEED_100G, }, [NFP_MEDIA_100GBASE_KP4] = { .ethtool_link_mode = ETHTOOL_LINK_MODE_100000baseKR4_Full_BIT, .speed = NFP_SPEED_100G, }, [NFP_MEDIA_100GBASE_CR10] = { .ethtool_link_mode = ETHTOOL_LINK_MODE_100000baseCR4_Full_BIT, .speed = NFP_SPEED_100G, }, }; static const unsigned int nfp_eth_speed_map[NFP_SUP_SPEED_NUMBER] = { [NFP_SPEED_1G] = SPEED_1000, [NFP_SPEED_10G] = SPEED_10000, [NFP_SPEED_25G] = SPEED_25000, [NFP_SPEED_40G] = SPEED_40000, [NFP_SPEED_50G] = SPEED_50000, [NFP_SPEED_100G] = SPEED_100000, }; static void nfp_add_media_link_mode(struct nfp_port *port, struct nfp_eth_table_port *eth_port, struct ethtool_link_ksettings *cmd) { bitmap_zero(port->speed_bitmap, NFP_SUP_SPEED_NUMBER); for (u32 i = 0; i < NFP_MEDIA_LINK_MODES_NUMBER; i++) { if (i < 64) { if (eth_port->link_modes_supp[0] & BIT_ULL(i)) { __set_bit(nfp_eth_media_table[i].ethtool_link_mode, cmd->link_modes.supported); __set_bit(nfp_eth_media_table[i].speed, port->speed_bitmap); } if (eth_port->link_modes_ad[0] & BIT_ULL(i)) __set_bit(nfp_eth_media_table[i].ethtool_link_mode, cmd->link_modes.advertising); } else { if (eth_port->link_modes_supp[1] & BIT_ULL(i - 64)) { __set_bit(nfp_eth_media_table[i].ethtool_link_mode, cmd->link_modes.supported); __set_bit(nfp_eth_media_table[i].speed, port->speed_bitmap); } if (eth_port->link_modes_ad[1] & BIT_ULL(i - 64)) __set_bit(nfp_eth_media_table[i].ethtool_link_mode, cmd->link_modes.advertising); } } /* We take all speeds as supported when it fails to read * link modes due to old management firmware that doesn't * support link modes reading or error occurring, so that * speed change of this port is allowed. */ if (bitmap_empty(port->speed_bitmap, NFP_SUP_SPEED_NUMBER)) bitmap_fill(port->speed_bitmap, NFP_SUP_SPEED_NUMBER); } /** * nfp_net_get_link_ksettings - Get Link Speed settings * @netdev: network interface device structure * @cmd: ethtool command * * Reports speed settings based on info in the BAR provided by the fw. */ static int nfp_net_get_link_ksettings(struct net_device *netdev, struct ethtool_link_ksettings *cmd) { struct nfp_eth_table_port *eth_port; struct nfp_port *port; struct nfp_net *nn; unsigned int speed; u16 sts; /* Init to unknowns */ ethtool_link_ksettings_zero_link_mode(cmd, supported); ethtool_link_ksettings_zero_link_mode(cmd, advertising); ethtool_link_ksettings_add_link_mode(cmd, supported, FIBRE); cmd->base.port = PORT_OTHER; cmd->base.speed = SPEED_UNKNOWN; cmd->base.duplex = DUPLEX_UNKNOWN; port = nfp_port_from_netdev(netdev); eth_port = nfp_port_get_eth_port(port); if (eth_port) { ethtool_link_ksettings_add_link_mode(cmd, supported, Pause); ethtool_link_ksettings_add_link_mode(cmd, advertising, Pause); nfp_add_media_link_mode(port, eth_port, cmd); if (eth_port->supp_aneg) { ethtool_link_ksettings_add_link_mode(cmd, supported, Autoneg); if (eth_port->aneg == NFP_ANEG_AUTO) { ethtool_link_ksettings_add_link_mode(cmd, advertising, Autoneg); cmd->base.autoneg = AUTONEG_ENABLE; } } nfp_net_set_fec_link_mode(eth_port, cmd); } if (!netif_carrier_ok(netdev)) return 0; /* Use link speed from ETH table if available, otherwise try the BAR */ if (eth_port) { cmd->base.port = eth_port->port_type; cmd->base.speed = eth_port->speed; cmd->base.duplex = DUPLEX_FULL; return 0; } if (!nfp_netdev_is_nfp_net(netdev)) return -EOPNOTSUPP; nn = netdev_priv(netdev); sts = nn_readw(nn, NFP_NET_CFG_STS); speed = nfp_net_lr2speed(FIELD_GET(NFP_NET_CFG_STS_LINK_RATE, sts)); if (!speed) return -EOPNOTSUPP; if (speed != SPEED_UNKNOWN) { cmd->base.speed = speed; cmd->base.duplex = DUPLEX_FULL; } return 0; } static int nfp_net_set_link_ksettings(struct net_device *netdev, const struct ethtool_link_ksettings *cmd) { bool req_aneg = (cmd->base.autoneg == AUTONEG_ENABLE); struct nfp_eth_table_port *eth_port; struct nfp_port *port; struct nfp_nsp *nsp; int err; port = nfp_port_from_netdev(netdev); eth_port = __nfp_port_get_eth_port(port); if (!eth_port) return -EOPNOTSUPP; if (netif_running(netdev)) { netdev_warn(netdev, "Changing settings not allowed on an active interface. It may cause the port to be disabled until driver reload.\n"); return -EBUSY; } nsp = nfp_eth_config_start(port->app->cpp, eth_port->index); if (IS_ERR(nsp)) return PTR_ERR(nsp); if (req_aneg && !eth_port->supp_aneg) { netdev_warn(netdev, "Autoneg is not supported.\n"); err = -EOPNOTSUPP; goto err_bad_set; } err = __nfp_eth_set_aneg(nsp, req_aneg ? NFP_ANEG_AUTO : NFP_ANEG_DISABLED); if (err) goto err_bad_set; if (cmd->base.speed != SPEED_UNKNOWN) { u32 speed = cmd->base.speed / eth_port->lanes; bool is_supported = false; for (u32 i = 0; i < NFP_SUP_SPEED_NUMBER; i++) { if (cmd->base.speed == nfp_eth_speed_map[i] && test_bit(i, port->speed_bitmap)) { is_supported = true; break; } } if (!is_supported) { netdev_err(netdev, "Speed %u is not supported.\n", cmd->base.speed); err = -EINVAL; goto err_bad_set; } if (req_aneg) { netdev_err(netdev, "Speed changing is not allowed when working on autoneg mode.\n"); err = -EINVAL; goto err_bad_set; } err = __nfp_eth_set_speed(nsp, speed); if (err) goto err_bad_set; } err = nfp_eth_config_commit_end(nsp); if (err > 0) return 0; /* no change */ nfp_net_refresh_port_table(port); return err; err_bad_set: nfp_eth_config_cleanup_end(nsp); return err; } static void nfp_net_get_ringparam(struct net_device *netdev, struct ethtool_ringparam *ring, struct kernel_ethtool_ringparam *kernel_ring, struct netlink_ext_ack *extack) { struct nfp_net *nn = netdev_priv(netdev); u32 qc_max = nn->dev_info->max_qc_size; ring->rx_max_pending = qc_max; ring->tx_max_pending = qc_max / nn->dp.ops->tx_min_desc_per_pkt; ring->rx_pending = nn->dp.rxd_cnt; ring->tx_pending = nn->dp.txd_cnt; } static int nfp_net_set_ring_size(struct nfp_net *nn, u32 rxd_cnt, u32 txd_cnt, struct netlink_ext_ack *extack) { struct nfp_net_dp *dp; dp = nfp_net_clone_dp(nn); if (!dp) return -ENOMEM; dp->rxd_cnt = rxd_cnt; dp->txd_cnt = txd_cnt; return nfp_net_ring_reconfig(nn, dp, extack); } static int nfp_net_set_ringparam(struct net_device *netdev, struct ethtool_ringparam *ring, struct kernel_ethtool_ringparam *kernel_ring, struct netlink_ext_ack *extack) { u32 tx_dpp, qc_min, qc_max, rxd_cnt, txd_cnt; struct nfp_net *nn = netdev_priv(netdev); /* We don't have separate queues/rings for small/large frames. */ if (ring->rx_mini_pending || ring->rx_jumbo_pending) return -EOPNOTSUPP; qc_min = nn->dev_info->min_qc_size; qc_max = nn->dev_info->max_qc_size; tx_dpp = nn->dp.ops->tx_min_desc_per_pkt; /* Round up to supported values */ rxd_cnt = roundup_pow_of_two(ring->rx_pending); txd_cnt = roundup_pow_of_two(ring->tx_pending); if (rxd_cnt < qc_min || rxd_cnt > qc_max) { NL_SET_ERR_MSG_MOD(extack, "rx parameter out of bounds"); return -EINVAL; } if (txd_cnt < qc_min / tx_dpp || txd_cnt > qc_max / tx_dpp) { NL_SET_ERR_MSG_MOD(extack, "tx parameter out of bounds"); return -EINVAL; } if (nn->dp.rxd_cnt == rxd_cnt && nn->dp.txd_cnt == txd_cnt) return 0; nn_dbg(nn, "Change ring size: RxQ %u->%u, TxQ %u->%u\n", nn->dp.rxd_cnt, rxd_cnt, nn->dp.txd_cnt, txd_cnt); return nfp_net_set_ring_size(nn, rxd_cnt, txd_cnt, extack); } static int nfp_test_link(struct net_device *netdev) { if (!netif_carrier_ok(netdev) || !(netdev->flags & IFF_UP)) return 1; return 0; } static int nfp_test_nsp(struct net_device *netdev) { struct nfp_app *app = nfp_app_from_netdev(netdev); struct nfp_nsp_identify *nspi; struct nfp_nsp *nsp; int err; nsp = nfp_nsp_open(app->cpp); if (IS_ERR(nsp)) { err = PTR_ERR(nsp); netdev_info(netdev, "NSP Test: failed to access the NSP: %d\n", err); goto exit; } if (nfp_nsp_get_abi_ver_minor(nsp) < 15) { err = -EOPNOTSUPP; goto exit_close_nsp; } nspi = kzalloc(sizeof(*nspi), GFP_KERNEL); if (!nspi) { err = -ENOMEM; goto exit_close_nsp; } err = nfp_nsp_read_identify(nsp, nspi, sizeof(*nspi)); if (err < 0) netdev_info(netdev, "NSP Test: reading bsp version failed %d\n", err); kfree(nspi); exit_close_nsp: nfp_nsp_close(nsp); exit: return err; } static int nfp_test_fw(struct net_device *netdev) { struct nfp_net *nn = netdev_priv(netdev); int err; err = nfp_net_reconfig(nn, NFP_NET_CFG_UPDATE_GEN); if (err) netdev_info(netdev, "FW Test: update failed %d\n", err); return err; } static int nfp_test_reg(struct net_device *netdev) { struct nfp_app *app = nfp_app_from_netdev(netdev); struct nfp_cpp *cpp = app->cpp; u32 model = nfp_cpp_model(cpp); u32 value; int err; err = nfp_cpp_model_autodetect(cpp, &value); if (err < 0) { netdev_info(netdev, "REG Test: NFP model detection failed %d\n", err); return err; } return (value == model) ? 0 : 1; } static bool link_test_supported(struct net_device *netdev) { return true; } static bool nsp_test_supported(struct net_device *netdev) { if (nfp_app_from_netdev(netdev)) return true; return false; } static bool fw_test_supported(struct net_device *netdev) { if (nfp_netdev_is_nfp_net(netdev)) return true; return false; } static bool reg_test_supported(struct net_device *netdev) { if (nfp_app_from_netdev(netdev)) return true; return false; } static struct nfp_self_test_item { char name[ETH_GSTRING_LEN]; bool (*is_supported)(struct net_device *dev); int (*func)(struct net_device *dev); } nfp_self_test[] = { {"Link Test", link_test_supported, nfp_test_link}, {"NSP Test", nsp_test_supported, nfp_test_nsp}, {"Firmware Test", fw_test_supported, nfp_test_fw}, {"Register Test", reg_test_supported, nfp_test_reg} }; #define NFP_TEST_TOTAL_NUM ARRAY_SIZE(nfp_self_test) static void nfp_get_self_test_strings(struct net_device *netdev, u8 *data) { int i; for (i = 0; i < NFP_TEST_TOTAL_NUM; i++) if (nfp_self_test[i].is_supported(netdev)) ethtool_puts(&data, nfp_self_test[i].name); } static int nfp_get_self_test_count(struct net_device *netdev) { int i, count = 0; for (i = 0; i < NFP_TEST_TOTAL_NUM; i++) if (nfp_self_test[i].is_supported(netdev)) count++; return count; } static void nfp_net_self_test(struct net_device *netdev, struct ethtool_test *eth_test, u64 *data) { int i, ret, count = 0; netdev_info(netdev, "Start self test\n"); for (i = 0; i < NFP_TEST_TOTAL_NUM; i++) { if (nfp_self_test[i].is_supported(netdev)) { ret = nfp_self_test[i].func(netdev); if (ret) eth_test->flags |= ETH_TEST_FL_FAILED; data[count++] = ret; } } netdev_info(netdev, "Test end\n"); } static unsigned int nfp_vnic_get_sw_stats_count(struct net_device *netdev) { struct nfp_net *nn = netdev_priv(netdev); return NN_RVEC_GATHER_STATS + nn->max_r_vecs * NN_RVEC_PER_Q_STATS + NN_CTRL_PATH_STATS; } static u8 *nfp_vnic_get_sw_stats_strings(struct net_device *netdev, u8 *data) { struct nfp_net *nn = netdev_priv(netdev); int i; for (i = 0; i < nn->max_r_vecs; i++) { ethtool_sprintf(&data, "rvec_%u_rx_pkts", i); ethtool_sprintf(&data, "rvec_%u_tx_pkts", i); ethtool_sprintf(&data, "rvec_%u_tx_busy", i); } ethtool_puts(&data, "hw_rx_csum_ok"); ethtool_puts(&data, "hw_rx_csum_inner_ok"); ethtool_puts(&data, "hw_rx_csum_complete"); ethtool_puts(&data, "hw_rx_csum_err"); ethtool_puts(&data, "rx_replace_buf_alloc_fail"); ethtool_puts(&data, "rx_tls_decrypted_packets"); ethtool_puts(&data, "hw_tx_csum"); ethtool_puts(&data, "hw_tx_inner_csum"); ethtool_puts(&data, "tx_gather"); ethtool_puts(&data, "tx_lso"); ethtool_puts(&data, "tx_tls_encrypted_packets"); ethtool_puts(&data, "tx_tls_ooo"); ethtool_puts(&data, "tx_tls_drop_no_sync_data"); ethtool_puts(&data, "hw_tls_no_space"); ethtool_puts(&data, "rx_tls_resync_req_ok"); ethtool_puts(&data, "rx_tls_resync_req_ign"); ethtool_puts(&data, "rx_tls_resync_sent"); return data; } static u64 *nfp_vnic_get_sw_stats(struct net_device *netdev, u64 *data) { u64 gathered_stats[NN_RVEC_GATHER_STATS] = {}; struct nfp_net *nn = netdev_priv(netdev); u64 tmp[NN_RVEC_GATHER_STATS]; unsigned int i, j; for (i = 0; i < nn->max_r_vecs; i++) { unsigned int start; do { start = u64_stats_fetch_begin(&nn->r_vecs[i].rx_sync); data[0] = nn->r_vecs[i].rx_pkts; tmp[0] = nn->r_vecs[i].hw_csum_rx_ok; tmp[1] = nn->r_vecs[i].hw_csum_rx_inner_ok; tmp[2] = nn->r_vecs[i].hw_csum_rx_complete; tmp[3] = nn->r_vecs[i].hw_csum_rx_error; tmp[4] = nn->r_vecs[i].rx_replace_buf_alloc_fail; tmp[5] = nn->r_vecs[i].hw_tls_rx; } while (u64_stats_fetch_retry(&nn->r_vecs[i].rx_sync, start)); do { start = u64_stats_fetch_begin(&nn->r_vecs[i].tx_sync); data[1] = nn->r_vecs[i].tx_pkts; data[2] = nn->r_vecs[i].tx_busy; tmp[6] = nn->r_vecs[i].hw_csum_tx; tmp[7] = nn->r_vecs[i].hw_csum_tx_inner; tmp[8] = nn->r_vecs[i].tx_gather; tmp[9] = nn->r_vecs[i].tx_lso; tmp[10] = nn->r_vecs[i].hw_tls_tx; tmp[11] = nn->r_vecs[i].tls_tx_fallback; tmp[12] = nn->r_vecs[i].tls_tx_no_fallback; } while (u64_stats_fetch_retry(&nn->r_vecs[i].tx_sync, start)); data += NN_RVEC_PER_Q_STATS; for (j = 0; j < NN_RVEC_GATHER_STATS; j++) gathered_stats[j] += tmp[j]; } for (j = 0; j < NN_RVEC_GATHER_STATS; j++) *data++ = gathered_stats[j]; *data++ = atomic_read(&nn->ktls_no_space); *data++ = atomic_read(&nn->ktls_rx_resync_req); *data++ = atomic_read(&nn->ktls_rx_resync_ign); *data++ = atomic_read(&nn->ktls_rx_resync_sent); return data; } static unsigned int nfp_vnic_get_hw_stats_count(unsigned int num_vecs) { return NN_ET_GLOBAL_STATS_LEN + num_vecs * 4; } static u8 * nfp_vnic_get_hw_stats_strings(u8 *data, unsigned int num_vecs, bool repr) { int swap_off, i; BUILD_BUG_ON(NN_ET_GLOBAL_STATS_LEN < NN_ET_SWITCH_STATS_LEN * 2); /* If repr is true first add SWITCH_STATS_LEN and then subtract it * effectively swapping the RX and TX statistics (giving us the RX * and TX from perspective of the switch). */ swap_off = repr * NN_ET_SWITCH_STATS_LEN; for (i = 0; i < NN_ET_SWITCH_STATS_LEN; i++) ethtool_puts(&data, nfp_net_et_stats[i + swap_off].name); for (i = NN_ET_SWITCH_STATS_LEN; i < NN_ET_SWITCH_STATS_LEN * 2; i++) ethtool_puts(&data, nfp_net_et_stats[i - swap_off].name); for (i = NN_ET_SWITCH_STATS_LEN * 2; i < NN_ET_GLOBAL_STATS_LEN; i++) ethtool_puts(&data, nfp_net_et_stats[i].name); for (i = 0; i < num_vecs; i++) { ethtool_sprintf(&data, "rxq_%u_pkts", i); ethtool_sprintf(&data, "rxq_%u_bytes", i); ethtool_sprintf(&data, "txq_%u_pkts", i); ethtool_sprintf(&data, "txq_%u_bytes", i); } return data; } static u64 * nfp_vnic_get_hw_stats(u64 *data, u8 __iomem *mem, unsigned int num_vecs) { unsigned int i; for (i = 0; i < NN_ET_GLOBAL_STATS_LEN; i++) *data++ = readq(mem + nfp_net_et_stats[i].off); for (i = 0; i < num_vecs; i++) { *data++ = readq(mem + NFP_NET_CFG_RXR_STATS(i)); *data++ = readq(mem + NFP_NET_CFG_RXR_STATS(i) + 8); *data++ = readq(mem + NFP_NET_CFG_TXR_STATS(i)); *data++ = readq(mem + NFP_NET_CFG_TXR_STATS(i) + 8); } return data; } static unsigned int nfp_vnic_get_tlv_stats_count(struct nfp_net *nn) { return nn->tlv_caps.vnic_stats_cnt + nn->max_r_vecs * 4; } static u8 *nfp_vnic_get_tlv_stats_strings(struct nfp_net *nn, u8 *data) { unsigned int i, id; u8 __iomem *mem; u64 id_word = 0; mem = nn->dp.ctrl_bar + nn->tlv_caps.vnic_stats_off; for (i = 0; i < nn->tlv_caps.vnic_stats_cnt; i++) { if (!(i % 4)) id_word = readq(mem + i * 2); id = (u16)id_word; id_word >>= 16; if (id < ARRAY_SIZE(nfp_tlv_stat_names) && nfp_tlv_stat_names[id][0]) { memcpy(data, nfp_tlv_stat_names[id], ETH_GSTRING_LEN); data += ETH_GSTRING_LEN; } else { ethtool_sprintf(&data, "dev_unknown_stat%u", id); } } for (i = 0; i < nn->max_r_vecs; i++) { ethtool_sprintf(&data, "rxq_%u_pkts", i); ethtool_sprintf(&data, "rxq_%u_bytes", i); ethtool_sprintf(&data, "txq_%u_pkts", i); ethtool_sprintf(&data, "txq_%u_bytes", i); } return data; } static u64 *nfp_vnic_get_tlv_stats(struct nfp_net *nn, u64 *data) { u8 __iomem *mem; unsigned int i; mem = nn->dp.ctrl_bar + nn->tlv_caps.vnic_stats_off; mem += roundup(2 * nn->tlv_caps.vnic_stats_cnt, 8); for (i = 0; i < nn->tlv_caps.vnic_stats_cnt; i++) *data++ = readq(mem + i * 8); mem = nn->dp.ctrl_bar; for (i = 0; i < nn->max_r_vecs; i++) { *data++ = readq(mem + NFP_NET_CFG_RXR_STATS(i)); *data++ = readq(mem + NFP_NET_CFG_RXR_STATS(i) + 8); *data++ = readq(mem + NFP_NET_CFG_TXR_STATS(i)); *data++ = readq(mem + NFP_NET_CFG_TXR_STATS(i) + 8); } return data; } static unsigned int nfp_mac_get_stats_count(struct net_device *netdev) { struct nfp_port *port; port = nfp_port_from_netdev(netdev); if (!__nfp_port_get_eth_port(port) || !port->eth_stats) return 0; return ARRAY_SIZE(nfp_mac_et_stats); } static u8 *nfp_mac_get_stats_strings(struct net_device *netdev, u8 *data) { struct nfp_port *port; unsigned int i; port = nfp_port_from_netdev(netdev); if (!__nfp_port_get_eth_port(port) || !port->eth_stats) return data; for (i = 0; i < ARRAY_SIZE(nfp_mac_et_stats); i++) ethtool_sprintf(&data, "mac.%s", nfp_mac_et_stats[i].name); return data; } static u64 *nfp_mac_get_stats(struct net_device *netdev, u64 *data) { struct nfp_port *port; unsigned int i; port = nfp_port_from_netdev(netdev); if (!__nfp_port_get_eth_port(port) || !port->eth_stats) return data; for (i = 0; i < ARRAY_SIZE(nfp_mac_et_stats); i++) *data++ = readq(port->eth_stats + nfp_mac_et_stats[i].off); return data; } static void nfp_net_get_strings(struct net_device *netdev, u32 stringset, u8 *data) { struct nfp_net *nn = netdev_priv(netdev); switch (stringset) { case ETH_SS_STATS: data = nfp_vnic_get_sw_stats_strings(netdev, data); if (!nn->tlv_caps.vnic_stats_off) data = nfp_vnic_get_hw_stats_strings(data, nn->max_r_vecs, false); else data = nfp_vnic_get_tlv_stats_strings(nn, data); data = nfp_mac_get_stats_strings(netdev, data); data = nfp_app_port_get_stats_strings(nn->port, data); break; case ETH_SS_TEST: nfp_get_self_test_strings(netdev, data); break; } } static void nfp_net_get_stats(struct net_device *netdev, struct ethtool_stats *stats, u64 *data) { struct nfp_net *nn = netdev_priv(netdev); data = nfp_vnic_get_sw_stats(netdev, data); if (!nn->tlv_caps.vnic_stats_off) data = nfp_vnic_get_hw_stats(data, nn->dp.ctrl_bar, nn->max_r_vecs); else data = nfp_vnic_get_tlv_stats(nn, data); data = nfp_mac_get_stats(netdev, data); data = nfp_app_port_get_stats(nn->port, data); } static int nfp_net_get_sset_count(struct net_device *netdev, int sset) { struct nfp_net *nn = netdev_priv(netdev); unsigned int cnt; switch (sset) { case ETH_SS_STATS: cnt = nfp_vnic_get_sw_stats_count(netdev); if (!nn->tlv_caps.vnic_stats_off) cnt += nfp_vnic_get_hw_stats_count(nn->max_r_vecs); else cnt += nfp_vnic_get_tlv_stats_count(nn); cnt += nfp_mac_get_stats_count(netdev); cnt += nfp_app_port_get_stats_count(nn->port); return cnt; case ETH_SS_TEST: return nfp_get_self_test_count(netdev); default: return -EOPNOTSUPP; } } static void nfp_port_get_strings(struct net_device *netdev, u32 stringset, u8 *data) { struct nfp_port *port = nfp_port_from_netdev(netdev); switch (stringset) { case ETH_SS_STATS: if (nfp_port_is_vnic(port)) data = nfp_vnic_get_hw_stats_strings(data, 0, true); else data = nfp_mac_get_stats_strings(netdev, data); data = nfp_app_port_get_stats_strings(port, data); break; case ETH_SS_TEST: nfp_get_self_test_strings(netdev, data); break; } } static void nfp_port_get_stats(struct net_device *netdev, struct ethtool_stats *stats, u64 *data) { struct nfp_port *port = nfp_port_from_netdev(netdev); if (nfp_port_is_vnic(port)) data = nfp_vnic_get_hw_stats(data, port->vnic, 0); else data = nfp_mac_get_stats(netdev, data); data = nfp_app_port_get_stats(port, data); } static int nfp_port_get_sset_count(struct net_device *netdev, int sset) { struct nfp_port *port = nfp_port_from_netdev(netdev); unsigned int count; switch (sset) { case ETH_SS_STATS: if (nfp_port_is_vnic(port)) count = nfp_vnic_get_hw_stats_count(0); else count = nfp_mac_get_stats_count(netdev); count += nfp_app_port_get_stats_count(port); return count; case ETH_SS_TEST: return nfp_get_self_test_count(netdev); default: return -EOPNOTSUPP; } } static int nfp_port_fec_ethtool_to_nsp(u32 fec) { switch (fec) { case ETHTOOL_FEC_AUTO: return NFP_FEC_AUTO_BIT; case ETHTOOL_FEC_OFF: return NFP_FEC_DISABLED_BIT; case ETHTOOL_FEC_RS: return NFP_FEC_REED_SOLOMON_BIT; case ETHTOOL_FEC_BASER: return NFP_FEC_BASER_BIT; default: /* NSP only supports a single mode at a time */ return -EOPNOTSUPP; } } static u32 nfp_port_fec_nsp_to_ethtool(u32 fec) { u32 result = 0; if (fec & NFP_FEC_AUTO) result |= ETHTOOL_FEC_AUTO; if (fec & NFP_FEC_BASER) result |= ETHTOOL_FEC_BASER; if (fec & NFP_FEC_REED_SOLOMON) result |= ETHTOOL_FEC_RS; if (fec & NFP_FEC_DISABLED) result |= ETHTOOL_FEC_OFF; return result ?: ETHTOOL_FEC_NONE; } static int nfp_port_get_fecparam(struct net_device *netdev, struct ethtool_fecparam *param) { struct nfp_eth_table_port *eth_port; struct nfp_port *port; param->active_fec = ETHTOOL_FEC_NONE; param->fec = ETHTOOL_FEC_NONE; port = nfp_port_from_netdev(netdev); eth_port = nfp_port_get_eth_port(port); if (!eth_port) return -EOPNOTSUPP; if (!nfp_eth_can_support_fec(eth_port)) return 0; param->fec = nfp_port_fec_nsp_to_ethtool(eth_port->fec_modes_supported); param->active_fec = nfp_port_fec_nsp_to_ethtool(BIT(eth_port->act_fec)); return 0; } static int nfp_port_set_fecparam(struct net_device *netdev, struct ethtool_fecparam *param) { struct nfp_eth_table_port *eth_port; struct nfp_port *port; int err, fec; port = nfp_port_from_netdev(netdev); eth_port = nfp_port_get_eth_port(port); if (!eth_port) return -EOPNOTSUPP; if (!nfp_eth_can_support_fec(eth_port)) return -EOPNOTSUPP; fec = nfp_port_fec_ethtool_to_nsp(param->fec); if (fec < 0) return fec; err = nfp_eth_set_fec(port->app->cpp, eth_port->index, fec); if (!err) /* Only refresh if we did something */ nfp_net_refresh_port_table(port); return err < 0 ? err : 0; } /* RX network flow classification (RSS, filters, etc) */ static u32 ethtool_flow_to_nfp_flag(u32 flow_type) { static const u32 xlate_ethtool_to_nfp[IPV6_FLOW + 1] = { [TCP_V4_FLOW] = NFP_NET_CFG_RSS_IPV4_TCP, [TCP_V6_FLOW] = NFP_NET_CFG_RSS_IPV6_TCP, [UDP_V4_FLOW] = NFP_NET_CFG_RSS_IPV4_UDP, [UDP_V6_FLOW] = NFP_NET_CFG_RSS_IPV6_UDP, [IPV4_FLOW] = NFP_NET_CFG_RSS_IPV4, [IPV6_FLOW] = NFP_NET_CFG_RSS_IPV6, }; if (flow_type >= ARRAY_SIZE(xlate_ethtool_to_nfp)) return 0; return xlate_ethtool_to_nfp[flow_type]; } static int nfp_net_get_rss_hash_opts(struct nfp_net *nn, struct ethtool_rxnfc *cmd) { u32 nfp_rss_flag; cmd->data = 0; if (!(nn->cap & NFP_NET_CFG_CTRL_RSS_ANY)) return -EOPNOTSUPP; nfp_rss_flag = ethtool_flow_to_nfp_flag(cmd->flow_type); if (!nfp_rss_flag) return -EINVAL; cmd->data |= RXH_IP_SRC | RXH_IP_DST; if (nn->rss_cfg & nfp_rss_flag) cmd->data |= RXH_L4_B_0_1 | RXH_L4_B_2_3; return 0; } #define NFP_FS_MAX_ENTRY 1024 static int nfp_net_fs_to_ethtool(struct nfp_fs_entry *entry, struct ethtool_rxnfc *cmd) { struct ethtool_rx_flow_spec *fs = &cmd->fs; unsigned int i; switch (entry->flow_type & ~FLOW_RSS) { case TCP_V4_FLOW: case UDP_V4_FLOW: case SCTP_V4_FLOW: fs->h_u.tcp_ip4_spec.ip4src = entry->key.sip4; fs->h_u.tcp_ip4_spec.ip4dst = entry->key.dip4; fs->h_u.tcp_ip4_spec.psrc = entry->key.sport; fs->h_u.tcp_ip4_spec.pdst = entry->key.dport; fs->m_u.tcp_ip4_spec.ip4src = entry->msk.sip4; fs->m_u.tcp_ip4_spec.ip4dst = entry->msk.dip4; fs->m_u.tcp_ip4_spec.psrc = entry->msk.sport; fs->m_u.tcp_ip4_spec.pdst = entry->msk.dport; break; case TCP_V6_FLOW: case UDP_V6_FLOW: case SCTP_V6_FLOW: for (i = 0; i < 4; i++) { fs->h_u.tcp_ip6_spec.ip6src[i] = entry->key.sip6[i]; fs->h_u.tcp_ip6_spec.ip6dst[i] = entry->key.dip6[i]; fs->m_u.tcp_ip6_spec.ip6src[i] = entry->msk.sip6[i]; fs->m_u.tcp_ip6_spec.ip6dst[i] = entry->msk.dip6[i]; } fs->h_u.tcp_ip6_spec.psrc = entry->key.sport; fs->h_u.tcp_ip6_spec.pdst = entry->key.dport; fs->m_u.tcp_ip6_spec.psrc = entry->msk.sport; fs->m_u.tcp_ip6_spec.pdst = entry->msk.dport; break; case IPV4_USER_FLOW: fs->h_u.usr_ip4_spec.ip_ver = ETH_RX_NFC_IP4; fs->h_u.usr_ip4_spec.ip4src = entry->key.sip4; fs->h_u.usr_ip4_spec.ip4dst = entry->key.dip4; fs->h_u.usr_ip4_spec.proto = entry->key.l4_proto; fs->m_u.usr_ip4_spec.ip4src = entry->msk.sip4; fs->m_u.usr_ip4_spec.ip4dst = entry->msk.dip4; fs->m_u.usr_ip4_spec.proto = entry->msk.l4_proto; break; case IPV6_USER_FLOW: for (i = 0; i < 4; i++) { fs->h_u.usr_ip6_spec.ip6src[i] = entry->key.sip6[i]; fs->h_u.usr_ip6_spec.ip6dst[i] = entry->key.dip6[i]; fs->m_u.usr_ip6_spec.ip6src[i] = entry->msk.sip6[i]; fs->m_u.usr_ip6_spec.ip6dst[i] = entry->msk.dip6[i]; } fs->h_u.usr_ip6_spec.l4_proto = entry->key.l4_proto; fs->m_u.usr_ip6_spec.l4_proto = entry->msk.l4_proto; break; case ETHER_FLOW: fs->h_u.ether_spec.h_proto = entry->key.l3_proto; fs->m_u.ether_spec.h_proto = entry->msk.l3_proto; break; default: return -EINVAL; } fs->flow_type = entry->flow_type; fs->ring_cookie = entry->action; if (fs->flow_type & FLOW_RSS) { /* Only rss_context of 0 is supported. */ cmd->rss_context = 0; /* RSS is used, mask the ring. */ fs->ring_cookie |= ETHTOOL_RX_FLOW_SPEC_RING; } return 0; } static int nfp_net_get_fs_rule(struct nfp_net *nn, struct ethtool_rxnfc *cmd) { struct nfp_fs_entry *entry; if (!(nn->cap_w1 & NFP_NET_CFG_CTRL_FLOW_STEER)) return -EOPNOTSUPP; if (cmd->fs.location >= NFP_FS_MAX_ENTRY) return -EINVAL; list_for_each_entry(entry, &nn->fs.list, node) { if (entry->loc == cmd->fs.location) return nfp_net_fs_to_ethtool(entry, cmd); if (entry->loc > cmd->fs.location) /* no need to continue */ return -ENOENT; } return -ENOENT; } static int nfp_net_get_fs_loc(struct nfp_net *nn, u32 *rule_locs) { struct nfp_fs_entry *entry; u32 count = 0; if (!(nn->cap_w1 & NFP_NET_CFG_CTRL_FLOW_STEER)) return -EOPNOTSUPP; list_for_each_entry(entry, &nn->fs.list, node) rule_locs[count++] = entry->loc; return 0; } static int nfp_net_get_rxnfc(struct net_device *netdev, struct ethtool_rxnfc *cmd, u32 *rule_locs) { struct nfp_net *nn = netdev_priv(netdev); switch (cmd->cmd) { case ETHTOOL_GRXRINGS: cmd->data = nn->dp.num_rx_rings; return 0; case ETHTOOL_GRXCLSRLCNT: cmd->rule_cnt = nn->fs.count; return 0; case ETHTOOL_GRXCLSRULE: return nfp_net_get_fs_rule(nn, cmd); case ETHTOOL_GRXCLSRLALL: cmd->data = NFP_FS_MAX_ENTRY; return nfp_net_get_fs_loc(nn, rule_locs); case ETHTOOL_GRXFH: return nfp_net_get_rss_hash_opts(nn, cmd); default: return -EOPNOTSUPP; } } static int nfp_net_set_rss_hash_opt(struct nfp_net *nn, struct ethtool_rxnfc *nfc) { u32 new_rss_cfg = nn->rss_cfg; u32 nfp_rss_flag; int err; if (!(nn->cap & NFP_NET_CFG_CTRL_RSS_ANY)) return -EOPNOTSUPP; /* RSS only supports IP SA/DA and L4 src/dst ports */ if (nfc->data & ~(RXH_IP_SRC | RXH_IP_DST | RXH_L4_B_0_1 | RXH_L4_B_2_3)) return -EINVAL; /* We need at least the IP SA/DA fields for hashing */ if (!(nfc->data & RXH_IP_SRC) || !(nfc->data & RXH_IP_DST)) return -EINVAL; nfp_rss_flag = ethtool_flow_to_nfp_flag(nfc->flow_type); if (!nfp_rss_flag) return -EINVAL; switch (nfc->data & (RXH_L4_B_0_1 | RXH_L4_B_2_3)) { case 0: new_rss_cfg &= ~nfp_rss_flag; break; case (RXH_L4_B_0_1 | RXH_L4_B_2_3): new_rss_cfg |= nfp_rss_flag; break; default: return -EINVAL; } new_rss_cfg |= FIELD_PREP(NFP_NET_CFG_RSS_HFUNC, nn->rss_hfunc); new_rss_cfg |= NFP_NET_CFG_RSS_MASK; if (new_rss_cfg == nn->rss_cfg) return 0; writel(new_rss_cfg, nn->dp.ctrl_bar + NFP_NET_CFG_RSS_CTRL); err = nfp_net_reconfig(nn, NFP_NET_CFG_UPDATE_RSS); if (err) return err; nn->rss_cfg = new_rss_cfg; nn_dbg(nn, "Changed RSS config to 0x%x\n", nn->rss_cfg); return 0; } static int nfp_net_fs_from_ethtool(struct nfp_fs_entry *entry, struct ethtool_rx_flow_spec *fs) { unsigned int i; /* FLOW_EXT/FLOW_MAC_EXT is not supported. */ switch (fs->flow_type & ~FLOW_RSS) { case TCP_V4_FLOW: case UDP_V4_FLOW: case SCTP_V4_FLOW: entry->msk.sip4 = fs->m_u.tcp_ip4_spec.ip4src; entry->msk.dip4 = fs->m_u.tcp_ip4_spec.ip4dst; entry->msk.sport = fs->m_u.tcp_ip4_spec.psrc; entry->msk.dport = fs->m_u.tcp_ip4_spec.pdst; entry->key.sip4 = fs->h_u.tcp_ip4_spec.ip4src & entry->msk.sip4; entry->key.dip4 = fs->h_u.tcp_ip4_spec.ip4dst & entry->msk.dip4; entry->key.sport = fs->h_u.tcp_ip4_spec.psrc & entry->msk.sport; entry->key.dport = fs->h_u.tcp_ip4_spec.pdst & entry->msk.dport; break; case TCP_V6_FLOW: case UDP_V6_FLOW: case SCTP_V6_FLOW: for (i = 0; i < 4; i++) { entry->msk.sip6[i] = fs->m_u.tcp_ip6_spec.ip6src[i]; entry->msk.dip6[i] = fs->m_u.tcp_ip6_spec.ip6dst[i]; entry->key.sip6[i] = fs->h_u.tcp_ip6_spec.ip6src[i] & entry->msk.sip6[i]; entry->key.dip6[i] = fs->h_u.tcp_ip6_spec.ip6dst[i] & entry->msk.dip6[i]; } entry->msk.sport = fs->m_u.tcp_ip6_spec.psrc; entry->msk.dport = fs->m_u.tcp_ip6_spec.pdst; entry->key.sport = fs->h_u.tcp_ip6_spec.psrc & entry->msk.sport; entry->key.dport = fs->h_u.tcp_ip6_spec.pdst & entry->msk.dport; break; case IPV4_USER_FLOW: entry->msk.sip4 = fs->m_u.usr_ip4_spec.ip4src; entry->msk.dip4 = fs->m_u.usr_ip4_spec.ip4dst; entry->msk.l4_proto = fs->m_u.usr_ip4_spec.proto; entry->key.sip4 = fs->h_u.usr_ip4_spec.ip4src & entry->msk.sip4; entry->key.dip4 = fs->h_u.usr_ip4_spec.ip4dst & entry->msk.dip4; entry->key.l4_proto = fs->h_u.usr_ip4_spec.proto & entry->msk.l4_proto; break; case IPV6_USER_FLOW: for (i = 0; i < 4; i++) { entry->msk.sip6[i] = fs->m_u.usr_ip6_spec.ip6src[i]; entry->msk.dip6[i] = fs->m_u.usr_ip6_spec.ip6dst[i]; entry->key.sip6[i] = fs->h_u.usr_ip6_spec.ip6src[i] & entry->msk.sip6[i]; entry->key.dip6[i] = fs->h_u.usr_ip6_spec.ip6dst[i] & entry->msk.dip6[i]; } entry->msk.l4_proto = fs->m_u.usr_ip6_spec.l4_proto; entry->key.l4_proto = fs->h_u.usr_ip6_spec.l4_proto & entry->msk.l4_proto; break; case ETHER_FLOW: entry->msk.l3_proto = fs->m_u.ether_spec.h_proto; entry->key.l3_proto = fs->h_u.ether_spec.h_proto & entry->msk.l3_proto; break; default: return -EINVAL; } switch (fs->flow_type & ~FLOW_RSS) { case TCP_V4_FLOW: case TCP_V6_FLOW: entry->key.l4_proto = IPPROTO_TCP; entry->msk.l4_proto = 0xff; break; case UDP_V4_FLOW: case UDP_V6_FLOW: entry->key.l4_proto = IPPROTO_UDP; entry->msk.l4_proto = 0xff; break; case SCTP_V4_FLOW: case SCTP_V6_FLOW: entry->key.l4_proto = IPPROTO_SCTP; entry->msk.l4_proto = 0xff; break; } entry->flow_type = fs->flow_type; entry->action = fs->ring_cookie; entry->loc = fs->location; return 0; } static int nfp_net_fs_check_existing(struct nfp_net *nn, struct nfp_fs_entry *new) { struct nfp_fs_entry *entry; list_for_each_entry(entry, &nn->fs.list, node) { if (new->loc != entry->loc && !((new->flow_type ^ entry->flow_type) & ~FLOW_RSS) && !memcmp(&new->key, &entry->key, sizeof(new->key)) && !memcmp(&new->msk, &entry->msk, sizeof(new->msk))) return entry->loc; } /* -1 means no duplicates */ return -1; } static int nfp_net_fs_add(struct nfp_net *nn, struct ethtool_rxnfc *cmd) { struct ethtool_rx_flow_spec *fs = &cmd->fs; struct nfp_fs_entry *new, *entry; bool unsupp_mask; int err, id; if (!(nn->cap_w1 & NFP_NET_CFG_CTRL_FLOW_STEER)) return -EOPNOTSUPP; /* Only default RSS context(0) is supported. */ if ((fs->flow_type & FLOW_RSS) && cmd->rss_context) return -EOPNOTSUPP; if (fs->location >= NFP_FS_MAX_ENTRY) return -EINVAL; if (fs->ring_cookie != RX_CLS_FLOW_DISC && fs->ring_cookie >= nn->dp.num_rx_rings) return -EINVAL; /* FLOW_EXT/FLOW_MAC_EXT is not supported. */ switch (fs->flow_type & ~FLOW_RSS) { case TCP_V4_FLOW: case UDP_V4_FLOW: case SCTP_V4_FLOW: unsupp_mask = !!fs->m_u.tcp_ip4_spec.tos; break; case TCP_V6_FLOW: case UDP_V6_FLOW: case SCTP_V6_FLOW: unsupp_mask = !!fs->m_u.tcp_ip6_spec.tclass; break; case IPV4_USER_FLOW: unsupp_mask = !!fs->m_u.usr_ip4_spec.l4_4_bytes || !!fs->m_u.usr_ip4_spec.tos || !!fs->m_u.usr_ip4_spec.ip_ver; /* ip_ver must be ETH_RX_NFC_IP4. */ unsupp_mask |= fs->h_u.usr_ip4_spec.ip_ver != ETH_RX_NFC_IP4; break; case IPV6_USER_FLOW: unsupp_mask = !!fs->m_u.usr_ip6_spec.l4_4_bytes || !!fs->m_u.usr_ip6_spec.tclass; break; case ETHER_FLOW: if (fs->h_u.ether_spec.h_proto == htons(ETH_P_IP) || fs->h_u.ether_spec.h_proto == htons(ETH_P_IPV6)) { nn_err(nn, "Please use ip4/ip6 flow type instead.\n"); return -EOPNOTSUPP; } /* Only unmasked ethtype is supported. */ unsupp_mask = !is_zero_ether_addr(fs->m_u.ether_spec.h_dest) || !is_zero_ether_addr(fs->m_u.ether_spec.h_source) || (fs->m_u.ether_spec.h_proto != htons(0xffff)); break; default: return -EOPNOTSUPP; } if (unsupp_mask) return -EOPNOTSUPP; new = kzalloc(sizeof(*new), GFP_KERNEL); if (!new) return -ENOMEM; nfp_net_fs_from_ethtool(new, fs); id = nfp_net_fs_check_existing(nn, new); if (id >= 0) { nn_err(nn, "Identical rule is existing in %d.\n", id); err = -EINVAL; goto err; } /* Insert to list in ascending order of location. */ list_for_each_entry(entry, &nn->fs.list, node) { if (entry->loc == fs->location) { err = nfp_net_fs_del_hw(nn, entry); if (err) goto err; nn->fs.count--; err = nfp_net_fs_add_hw(nn, new); if (err) goto err; nn->fs.count++; list_replace(&entry->node, &new->node); kfree(entry); return 0; } if (entry->loc > fs->location) break; } if (nn->fs.count == NFP_FS_MAX_ENTRY) { err = -ENOSPC; goto err; } err = nfp_net_fs_add_hw(nn, new); if (err) goto err; list_add_tail(&new->node, &entry->node); nn->fs.count++; return 0; err: kfree(new); return err; } static int nfp_net_fs_del(struct nfp_net *nn, struct ethtool_rxnfc *cmd) { struct nfp_fs_entry *entry; int err; if (!(nn->cap_w1 & NFP_NET_CFG_CTRL_FLOW_STEER)) return -EOPNOTSUPP; if (!nn->fs.count || cmd->fs.location >= NFP_FS_MAX_ENTRY) return -EINVAL; list_for_each_entry(entry, &nn->fs.list, node) { if (entry->loc == cmd->fs.location) { err = nfp_net_fs_del_hw(nn, entry); if (err) return err; list_del(&entry->node); kfree(entry); nn->fs.count--; return 0; } else if (entry->loc > cmd->fs.location) { /* no need to continue */ break; } } return -ENOENT; } static int nfp_net_set_rxnfc(struct net_device *netdev, struct ethtool_rxnfc *cmd) { struct nfp_net *nn = netdev_priv(netdev); switch (cmd->cmd) { case ETHTOOL_SRXFH: return nfp_net_set_rss_hash_opt(nn, cmd); case ETHTOOL_SRXCLSRLINS: return nfp_net_fs_add(nn, cmd); case ETHTOOL_SRXCLSRLDEL: return nfp_net_fs_del(nn, cmd); default: return -EOPNOTSUPP; } } static u32 nfp_net_get_rxfh_indir_size(struct net_device *netdev) { struct nfp_net *nn = netdev_priv(netdev); if (!(nn->cap & NFP_NET_CFG_CTRL_RSS_ANY)) return 0; return ARRAY_SIZE(nn->rss_itbl); } static u32 nfp_net_get_rxfh_key_size(struct net_device *netdev) { struct nfp_net *nn = netdev_priv(netdev); if (!(nn->cap & NFP_NET_CFG_CTRL_RSS_ANY)) return -EOPNOTSUPP; return nfp_net_rss_key_sz(nn); } static int nfp_net_get_rxfh(struct net_device *netdev, struct ethtool_rxfh_param *rxfh) { struct nfp_net *nn = netdev_priv(netdev); int i; if (!(nn->cap & NFP_NET_CFG_CTRL_RSS_ANY)) return -EOPNOTSUPP; if (rxfh->indir) for (i = 0; i < ARRAY_SIZE(nn->rss_itbl); i++) rxfh->indir[i] = nn->rss_itbl[i]; if (rxfh->key) memcpy(rxfh->key, nn->rss_key, nfp_net_rss_key_sz(nn)); rxfh->hfunc = nn->rss_hfunc; if (rxfh->hfunc >= 1 << ETH_RSS_HASH_FUNCS_COUNT) rxfh->hfunc = ETH_RSS_HASH_UNKNOWN; return 0; } static int nfp_net_set_rxfh(struct net_device *netdev, struct ethtool_rxfh_param *rxfh, struct netlink_ext_ack *extack) { struct nfp_net *nn = netdev_priv(netdev); int i; if (!(nn->cap & NFP_NET_CFG_CTRL_RSS_ANY) || !(rxfh->hfunc == ETH_RSS_HASH_NO_CHANGE || rxfh->hfunc == nn->rss_hfunc)) return -EOPNOTSUPP; if (!rxfh->key && !rxfh->indir) return 0; if (rxfh->key) { memcpy(nn->rss_key, rxfh->key, nfp_net_rss_key_sz(nn)); nfp_net_rss_write_key(nn); } if (rxfh->indir) { for (i = 0; i < ARRAY_SIZE(nn->rss_itbl); i++) nn->rss_itbl[i] = rxfh->indir[i]; nfp_net_rss_write_itbl(nn); } return nfp_net_reconfig(nn, NFP_NET_CFG_UPDATE_RSS); } /* Dump BAR registers */ static int nfp_net_get_regs_len(struct net_device *netdev) { return NFP_NET_CFG_BAR_SZ; } static void nfp_net_get_regs(struct net_device *netdev, struct ethtool_regs *regs, void *p) { struct nfp_net *nn = netdev_priv(netdev); u32 *regs_buf = p; int i; regs->version = nn_readl(nn, NFP_NET_CFG_VERSION); for (i = 0; i < NFP_NET_CFG_BAR_SZ / sizeof(u32); i++) regs_buf[i] = readl(nn->dp.ctrl_bar + (i * sizeof(u32))); } static int nfp_net_get_coalesce(struct net_device *netdev, struct ethtool_coalesce *ec, struct kernel_ethtool_coalesce *kernel_coal, struct netlink_ext_ack *extack) { struct nfp_net *nn = netdev_priv(netdev); if (!(nn->cap & NFP_NET_CFG_CTRL_IRQMOD)) return -EOPNOTSUPP; ec->use_adaptive_rx_coalesce = nn->rx_coalesce_adapt_on; ec->use_adaptive_tx_coalesce = nn->tx_coalesce_adapt_on; ec->rx_coalesce_usecs = nn->rx_coalesce_usecs; ec->rx_max_coalesced_frames = nn->rx_coalesce_max_frames; ec->tx_coalesce_usecs = nn->tx_coalesce_usecs; ec->tx_max_coalesced_frames = nn->tx_coalesce_max_frames; return 0; } /* Other debug dumps */ static int nfp_dump_nsp_diag(struct nfp_app *app, struct ethtool_dump *dump, void *buffer) { struct nfp_resource *res; int ret; if (!app) return -EOPNOTSUPP; dump->version = 1; dump->flag = NFP_DUMP_NSP_DIAG; res = nfp_resource_acquire(app->cpp, NFP_RESOURCE_NSP_DIAG); if (IS_ERR(res)) return PTR_ERR(res); if (buffer) { if (dump->len != nfp_resource_size(res)) { ret = -EINVAL; goto exit_release; } ret = nfp_cpp_read(app->cpp, nfp_resource_cpp_id(res), nfp_resource_address(res), buffer, dump->len); if (ret != dump->len) ret = ret < 0 ? ret : -EIO; else ret = 0; } else { dump->len = nfp_resource_size(res); ret = 0; } exit_release: nfp_resource_release(res); return ret; } /* Set the dump flag/level. Calculate the dump length for flag > 0 only (new TLV * based dumps), since flag 0 (default) calculates the length in * nfp_app_get_dump_flag(), and we need to support triggering a level 0 dump * without setting the flag first, for backward compatibility. */ static int nfp_app_set_dump(struct net_device *netdev, struct ethtool_dump *val) { struct nfp_app *app = nfp_app_from_netdev(netdev); s64 len; if (!app) return -EOPNOTSUPP; if (val->flag == NFP_DUMP_NSP_DIAG) { app->pf->dump_flag = val->flag; return 0; } if (!app->pf->dumpspec) return -EOPNOTSUPP; len = nfp_net_dump_calculate_size(app->pf, app->pf->dumpspec, val->flag); if (len < 0) return len; app->pf->dump_flag = val->flag; app->pf->dump_len = len; return 0; } static int nfp_app_get_dump_flag(struct net_device *netdev, struct ethtool_dump *dump) { struct nfp_app *app = nfp_app_from_netdev(netdev); if (!app) return -EOPNOTSUPP; if (app->pf->dump_flag == NFP_DUMP_NSP_DIAG) return nfp_dump_nsp_diag(app, dump, NULL); dump->flag = app->pf->dump_flag; dump->len = app->pf->dump_len; return 0; } static int nfp_app_get_dump_data(struct net_device *netdev, struct ethtool_dump *dump, void *buffer) { struct nfp_app *app = nfp_app_from_netdev(netdev); if (!app) return -EOPNOTSUPP; if (app->pf->dump_flag == NFP_DUMP_NSP_DIAG) return nfp_dump_nsp_diag(app, dump, buffer); dump->flag = app->pf->dump_flag; dump->len = app->pf->dump_len; return nfp_net_dump_populate_buffer(app->pf, app->pf->dumpspec, dump, buffer); } static int nfp_port_get_module_info(struct net_device *netdev, struct ethtool_modinfo *modinfo) { struct nfp_eth_table_port *eth_port; struct nfp_port *port; unsigned int read_len; struct nfp_nsp *nsp; int err = 0; u8 data; port = nfp_port_from_netdev(netdev); if (!port) return -EOPNOTSUPP; /* update port state to get latest interface */ set_bit(NFP_PORT_CHANGED, &port->flags); eth_port = nfp_port_get_eth_port(port); if (!eth_port) return -EOPNOTSUPP; nsp = nfp_nsp_open(port->app->cpp); if (IS_ERR(nsp)) { err = PTR_ERR(nsp); netdev_err(netdev, "Failed to access the NSP: %d\n", err); return err; } if (!nfp_nsp_has_read_module_eeprom(nsp)) { netdev_info(netdev, "reading module EEPROM not supported. Please update flash\n"); err = -EOPNOTSUPP; goto exit_close_nsp; } switch (eth_port->interface) { case NFP_INTERFACE_SFP: case NFP_INTERFACE_SFP28: err = nfp_nsp_read_module_eeprom(nsp, eth_port->eth_index, SFP_SFF8472_COMPLIANCE, &data, 1, &read_len); if (err < 0) goto exit_close_nsp; if (!data) { modinfo->type = ETH_MODULE_SFF_8079; modinfo->eeprom_len = ETH_MODULE_SFF_8079_LEN; } else { modinfo->type = ETH_MODULE_SFF_8472; modinfo->eeprom_len = ETH_MODULE_SFF_8472_LEN; } break; case NFP_INTERFACE_QSFP: err = nfp_nsp_read_module_eeprom(nsp, eth_port->eth_index, SFP_SFF_REV_COMPLIANCE, &data, 1, &read_len); if (err < 0) goto exit_close_nsp; if (data < 0x3) { modinfo->type = ETH_MODULE_SFF_8436; modinfo->eeprom_len = ETH_MODULE_SFF_8436_MAX_LEN; } else { modinfo->type = ETH_MODULE_SFF_8636; modinfo->eeprom_len = ETH_MODULE_SFF_8636_MAX_LEN; } break; case NFP_INTERFACE_QSFP28: modinfo->type = ETH_MODULE_SFF_8636; modinfo->eeprom_len = ETH_MODULE_SFF_8636_MAX_LEN; break; default: netdev_err(netdev, "Unsupported module 0x%x detected\n", eth_port->interface); err = -EINVAL; } exit_close_nsp: nfp_nsp_close(nsp); return err; } static int nfp_port_get_module_eeprom(struct net_device *netdev, struct ethtool_eeprom *eeprom, u8 *data) { struct nfp_eth_table_port *eth_port; struct nfp_port *port; struct nfp_nsp *nsp; int err; port = nfp_port_from_netdev(netdev); eth_port = __nfp_port_get_eth_port(port); if (!eth_port) return -EOPNOTSUPP; nsp = nfp_nsp_open(port->app->cpp); if (IS_ERR(nsp)) { err = PTR_ERR(nsp); netdev_err(netdev, "Failed to access the NSP: %d\n", err); return err; } if (!nfp_nsp_has_read_module_eeprom(nsp)) { netdev_info(netdev, "reading module EEPROM not supported. Please update flash\n"); err = -EOPNOTSUPP; goto exit_close_nsp; } err = nfp_nsp_read_module_eeprom(nsp, eth_port->eth_index, eeprom->offset, data, eeprom->len, &eeprom->len); if (err < 0) { if (eeprom->len) { netdev_warn(netdev, "Incomplete read from module EEPROM: %d\n", err); err = 0; } else { netdev_err(netdev, "Reading from module EEPROM failed: %d\n", err); } } exit_close_nsp: nfp_nsp_close(nsp); return err; } static int nfp_net_set_coalesce(struct net_device *netdev, struct ethtool_coalesce *ec, struct kernel_ethtool_coalesce *kernel_coal, struct netlink_ext_ack *extack) { struct nfp_net *nn = netdev_priv(netdev); unsigned int factor; /* Compute factor used to convert coalesce '_usecs' parameters to * ME timestamp ticks. There are 16 ME clock cycles for each timestamp * count. */ factor = nn->tlv_caps.me_freq_mhz / 16; /* Each pair of (usecs, max_frames) fields specifies that interrupts * should be coalesced until * (usecs > 0 && time_since_first_completion >= usecs) || * (max_frames > 0 && completed_frames >= max_frames) * * It is illegal to set both usecs and max_frames to zero as this would * cause interrupts to never be generated. To disable coalescing, set * usecs = 0 and max_frames = 1. * * Some implementations ignore the value of max_frames and use the * condition time_since_first_completion >= usecs */ if (!(nn->cap & NFP_NET_CFG_CTRL_IRQMOD)) return -EOPNOTSUPP; /* ensure valid configuration */ if (!ec->rx_coalesce_usecs && !ec->rx_max_coalesced_frames) { NL_SET_ERR_MSG_MOD(extack, "rx-usecs and rx-frames cannot both be zero"); return -EINVAL; } if (!ec->tx_coalesce_usecs && !ec->tx_max_coalesced_frames) { NL_SET_ERR_MSG_MOD(extack, "tx-usecs and tx-frames cannot both be zero"); return -EINVAL; } if (nfp_net_coalesce_para_check(ec->rx_coalesce_usecs * factor)) { NL_SET_ERR_MSG_MOD(extack, "rx-usecs too large"); return -EINVAL; } if (nfp_net_coalesce_para_check(ec->rx_max_coalesced_frames)) { NL_SET_ERR_MSG_MOD(extack, "rx-frames too large"); return -EINVAL; } if (nfp_net_coalesce_para_check(ec->tx_coalesce_usecs * factor)) { NL_SET_ERR_MSG_MOD(extack, "tx-usecs too large"); return -EINVAL; } if (nfp_net_coalesce_para_check(ec->tx_max_coalesced_frames)) { NL_SET_ERR_MSG_MOD(extack, "tx-frames too large"); return -EINVAL; } /* configuration is valid */ nn->rx_coalesce_adapt_on = !!ec->use_adaptive_rx_coalesce; nn->tx_coalesce_adapt_on = !!ec->use_adaptive_tx_coalesce; nn->rx_coalesce_usecs = ec->rx_coalesce_usecs; nn->rx_coalesce_max_frames = ec->rx_max_coalesced_frames; nn->tx_coalesce_usecs = ec->tx_coalesce_usecs; nn->tx_coalesce_max_frames = ec->tx_max_coalesced_frames; /* write configuration to device */ nfp_net_coalesce_write_cfg(nn); return nfp_net_reconfig(nn, NFP_NET_CFG_UPDATE_IRQMOD); } static void nfp_net_get_channels(struct net_device *netdev, struct ethtool_channels *channel) { struct nfp_net *nn = netdev_priv(netdev); unsigned int num_tx_rings; num_tx_rings = nn->dp.num_tx_rings; if (nn->dp.xdp_prog) num_tx_rings -= nn->dp.num_rx_rings; channel->max_rx = min(nn->max_rx_rings, nn->max_r_vecs); channel->max_tx = min(nn->max_tx_rings, nn->max_r_vecs); channel->max_combined = min(channel->max_rx, channel->max_tx); channel->max_other = NFP_NET_NON_Q_VECTORS; channel->combined_count = min(nn->dp.num_rx_rings, num_tx_rings); channel->rx_count = nn->dp.num_rx_rings - channel->combined_count; channel->tx_count = num_tx_rings - channel->combined_count; channel->other_count = NFP_NET_NON_Q_VECTORS; } static int nfp_net_set_num_rings(struct nfp_net *nn, unsigned int total_rx, unsigned int total_tx) { struct nfp_net_dp *dp; dp = nfp_net_clone_dp(nn); if (!dp) return -ENOMEM; dp->num_rx_rings = total_rx; dp->num_tx_rings = total_tx; /* nfp_net_check_config() will catch num_tx_rings > nn->max_tx_rings */ if (dp->xdp_prog) dp->num_tx_rings += total_rx; return nfp_net_ring_reconfig(nn, dp, NULL); } static int nfp_net_set_channels(struct net_device *netdev, struct ethtool_channels *channel) { struct nfp_net *nn = netdev_priv(netdev); unsigned int total_rx, total_tx; /* Reject unsupported */ if (channel->other_count != NFP_NET_NON_Q_VECTORS || (channel->rx_count && channel->tx_count)) return -EINVAL; total_rx = channel->combined_count + channel->rx_count; total_tx = channel->combined_count + channel->tx_count; if (total_rx > min(nn->max_rx_rings, nn->max_r_vecs) || total_tx > min(nn->max_tx_rings, nn->max_r_vecs)) return -EINVAL; return nfp_net_set_num_rings(nn, total_rx, total_tx); } static int nfp_port_set_pauseparam(struct net_device *netdev, struct ethtool_pauseparam *pause) { struct nfp_eth_table_port *eth_port; struct nfp_port *port; int err; port = nfp_port_from_netdev(netdev); eth_port = nfp_port_get_eth_port(port); if (!eth_port) return -EOPNOTSUPP; if (pause->autoneg != AUTONEG_DISABLE) return -EOPNOTSUPP; err = nfp_eth_set_pauseparam(port->app->cpp, eth_port->index, pause->tx_pause, pause->rx_pause); if (!err) /* Only refresh if we did something */ nfp_net_refresh_port_table(port); return err < 0 ? err : 0; } static void nfp_port_get_pauseparam(struct net_device *netdev, struct ethtool_pauseparam *pause) { struct nfp_eth_table_port *eth_port; struct nfp_port *port; port = nfp_port_from_netdev(netdev); eth_port = nfp_port_get_eth_port(port); if (!eth_port) return; /* Currently pause frame autoneg is fixed */ pause->autoneg = AUTONEG_DISABLE; pause->rx_pause = eth_port->rx_pause; pause->tx_pause = eth_port->tx_pause; } static int nfp_net_set_phys_id(struct net_device *netdev, enum ethtool_phys_id_state state) { struct nfp_eth_table_port *eth_port; struct nfp_port *port; int err; port = nfp_port_from_netdev(netdev); eth_port = __nfp_port_get_eth_port(port); if (!eth_port) return -EOPNOTSUPP; switch (state) { case ETHTOOL_ID_ACTIVE: /* Control LED to blink */ err = nfp_eth_set_idmode(port->app->cpp, eth_port->index, 1); break; case ETHTOOL_ID_INACTIVE: /* Control LED to normal mode */ err = nfp_eth_set_idmode(port->app->cpp, eth_port->index, 0); break; case ETHTOOL_ID_ON: case ETHTOOL_ID_OFF: default: return -EOPNOTSUPP; } return err; } #define NFP_EEPROM_LEN ETH_ALEN static int nfp_net_get_eeprom_len(struct net_device *netdev) { struct nfp_eth_table_port *eth_port; struct nfp_port *port; port = nfp_port_from_netdev(netdev); eth_port = __nfp_port_get_eth_port(port); if (!eth_port) return 0; return NFP_EEPROM_LEN; } static int nfp_net_get_nsp_hwindex(struct net_device *netdev, struct nfp_nsp **nspptr, u32 *index) { struct nfp_eth_table_port *eth_port; struct nfp_port *port; struct nfp_nsp *nsp; int err; port = nfp_port_from_netdev(netdev); eth_port = __nfp_port_get_eth_port(port); if (!eth_port) return -EOPNOTSUPP; nsp = nfp_nsp_open(port->app->cpp); if (IS_ERR(nsp)) { err = PTR_ERR(nsp); netdev_err(netdev, "Failed to access the NSP: %d\n", err); return err; } if (!nfp_nsp_has_hwinfo_lookup(nsp)) { netdev_err(netdev, "NSP doesn't support PF MAC generation\n"); nfp_nsp_close(nsp); return -EOPNOTSUPP; } *nspptr = nsp; *index = eth_port->eth_index; return 0; } static int nfp_net_get_port_mac_by_hwinfo(struct net_device *netdev, u8 *mac_addr) { char hwinfo[32] = {}; struct nfp_nsp *nsp; u32 index; int err; err = nfp_net_get_nsp_hwindex(netdev, &nsp, &index); if (err) return err; snprintf(hwinfo, sizeof(hwinfo), "eth%u.mac", index); err = nfp_nsp_hwinfo_lookup(nsp, hwinfo, sizeof(hwinfo)); nfp_nsp_close(nsp); if (err) { netdev_err(netdev, "Reading persistent MAC address failed: %d\n", err); return -EOPNOTSUPP; } if (sscanf(hwinfo, "%02hhx:%02hhx:%02hhx:%02hhx:%02hhx:%02hhx", &mac_addr[0], &mac_addr[1], &mac_addr[2], &mac_addr[3], &mac_addr[4], &mac_addr[5]) != 6) { netdev_err(netdev, "Can't parse persistent MAC address (%s)\n", hwinfo); return -EOPNOTSUPP; } return 0; } static int nfp_net_set_port_mac_by_hwinfo(struct net_device *netdev, u8 *mac_addr) { char hwinfo[32] = {}; struct nfp_nsp *nsp; u32 index; int err; err = nfp_net_get_nsp_hwindex(netdev, &nsp, &index); if (err) return err; snprintf(hwinfo, sizeof(hwinfo), "eth%u.mac=%02hhx:%02hhx:%02hhx:%02hhx:%02hhx:%02hhx", index, mac_addr[0], mac_addr[1], mac_addr[2], mac_addr[3], mac_addr[4], mac_addr[5]); err = nfp_nsp_hwinfo_set(nsp, hwinfo, sizeof(hwinfo)); nfp_nsp_close(nsp); if (err) { netdev_err(netdev, "HWinfo set failed: %d, hwinfo: %s\n", err, hwinfo); return -EOPNOTSUPP; } return 0; } static int nfp_net_get_eeprom(struct net_device *netdev, struct ethtool_eeprom *eeprom, u8 *bytes) { struct nfp_app *app = nfp_app_from_netdev(netdev); u8 buf[NFP_EEPROM_LEN] = {}; if (nfp_net_get_port_mac_by_hwinfo(netdev, buf)) return -EOPNOTSUPP; if (eeprom->len == 0) return -EINVAL; eeprom->magic = app->pdev->vendor | (app->pdev->device << 16); memcpy(bytes, buf + eeprom->offset, eeprom->len); return 0; } static int nfp_net_set_eeprom(struct net_device *netdev, struct ethtool_eeprom *eeprom, u8 *bytes) { struct nfp_app *app = nfp_app_from_netdev(netdev); u8 buf[NFP_EEPROM_LEN] = {}; if (nfp_net_get_port_mac_by_hwinfo(netdev, buf)) return -EOPNOTSUPP; if (eeprom->len == 0) return -EINVAL; if (eeprom->magic != (app->pdev->vendor | app->pdev->device << 16)) return -EINVAL; memcpy(buf + eeprom->offset, bytes, eeprom->len); if (nfp_net_set_port_mac_by_hwinfo(netdev, buf)) return -EOPNOTSUPP; return 0; } static const struct ethtool_ops nfp_net_ethtool_ops = { .supported_coalesce_params = ETHTOOL_COALESCE_USECS | ETHTOOL_COALESCE_MAX_FRAMES | ETHTOOL_COALESCE_USE_ADAPTIVE, .get_drvinfo = nfp_net_get_drvinfo, .nway_reset = nfp_net_nway_reset, .get_link = ethtool_op_get_link, .get_ringparam = nfp_net_get_ringparam, .set_ringparam = nfp_net_set_ringparam, .self_test = nfp_net_self_test, .get_strings = nfp_net_get_strings, .get_ethtool_stats = nfp_net_get_stats, .get_sset_count = nfp_net_get_sset_count, .get_rxnfc = nfp_net_get_rxnfc, .set_rxnfc = nfp_net_set_rxnfc, .get_rxfh_indir_size = nfp_net_get_rxfh_indir_size, .get_rxfh_key_size = nfp_net_get_rxfh_key_size, .get_rxfh = nfp_net_get_rxfh, .set_rxfh = nfp_net_set_rxfh, .get_regs_len = nfp_net_get_regs_len, .get_regs = nfp_net_get_regs, .set_dump = nfp_app_set_dump, .get_dump_flag = nfp_app_get_dump_flag, .get_dump_data = nfp_app_get_dump_data, .get_eeprom_len = nfp_net_get_eeprom_len, .get_eeprom = nfp_net_get_eeprom, .set_eeprom = nfp_net_set_eeprom, .get_module_info = nfp_port_get_module_info, .get_module_eeprom = nfp_port_get_module_eeprom, .get_coalesce = nfp_net_get_coalesce, .set_coalesce = nfp_net_set_coalesce, .get_channels = nfp_net_get_channels, .set_channels = nfp_net_set_channels, .get_link_ksettings = nfp_net_get_link_ksettings, .set_link_ksettings = nfp_net_set_link_ksettings, .get_fecparam = nfp_port_get_fecparam, .set_fecparam = nfp_port_set_fecparam, .set_pauseparam = nfp_port_set_pauseparam, .get_pauseparam = nfp_port_get_pauseparam, .set_phys_id = nfp_net_set_phys_id, .get_ts_info = ethtool_op_get_ts_info, }; const struct ethtool_ops nfp_port_ethtool_ops = { .get_drvinfo = nfp_app_get_drvinfo, .nway_reset = nfp_net_nway_reset, .get_link = ethtool_op_get_link, .get_strings = nfp_port_get_strings, .get_ethtool_stats = nfp_port_get_stats, .self_test = nfp_net_self_test, .get_sset_count = nfp_port_get_sset_count, .set_dump = nfp_app_set_dump, .get_dump_flag = nfp_app_get_dump_flag, .get_dump_data = nfp_app_get_dump_data, .get_eeprom_len = nfp_net_get_eeprom_len, .get_eeprom = nfp_net_get_eeprom, .set_eeprom = nfp_net_set_eeprom, .get_module_info = nfp_port_get_module_info, .get_module_eeprom = nfp_port_get_module_eeprom, .get_link_ksettings = nfp_net_get_link_ksettings, .set_link_ksettings = nfp_net_set_link_ksettings, .get_fecparam = nfp_port_get_fecparam, .set_fecparam = nfp_port_set_fecparam, .set_pauseparam = nfp_port_set_pauseparam, .get_pauseparam = nfp_port_get_pauseparam, .set_phys_id = nfp_net_set_phys_id, }; void nfp_net_set_ethtool_ops(struct net_device *netdev) { netdev->ethtool_ops = &nfp_net_ethtool_ops; }