1f09ea6fbSJakub Kicinski // SPDX-License-Identifier: GPL-2.0-only 2f09ea6fbSJakub Kicinski 3f09ea6fbSJakub Kicinski #include "netlink.h" 4f09ea6fbSJakub Kicinski #include "common.h" 5f09ea6fbSJakub Kicinski #include "bitset.h" 6f09ea6fbSJakub Kicinski 7f09ea6fbSJakub Kicinski struct stats_req_info { 8f09ea6fbSJakub Kicinski struct ethnl_req_info base; 9f09ea6fbSJakub Kicinski DECLARE_BITMAP(stat_mask, __ETHTOOL_STATS_CNT); 10f09ea6fbSJakub Kicinski }; 11f09ea6fbSJakub Kicinski 12f09ea6fbSJakub Kicinski #define STATS_REQINFO(__req_base) \ 13f09ea6fbSJakub Kicinski container_of(__req_base, struct stats_req_info, base) 14f09ea6fbSJakub Kicinski 15f09ea6fbSJakub Kicinski struct stats_reply_data { 16f09ea6fbSJakub Kicinski struct ethnl_reply_data base; 17*812ad3d2SKees Cook struct_group(stats, 18f09ea6fbSJakub Kicinski struct ethtool_eth_phy_stats phy_stats; 19ca224454SJakub Kicinski struct ethtool_eth_mac_stats mac_stats; 20bfad2b97SJakub Kicinski struct ethtool_eth_ctrl_stats ctrl_stats; 21a8b06e9dSJakub Kicinski struct ethtool_rmon_stats rmon_stats; 22*812ad3d2SKees Cook ); 23a8b06e9dSJakub Kicinski const struct ethtool_rmon_hist_range *rmon_ranges; 24f09ea6fbSJakub Kicinski }; 25f09ea6fbSJakub Kicinski 26f09ea6fbSJakub Kicinski #define STATS_REPDATA(__reply_base) \ 27f09ea6fbSJakub Kicinski container_of(__reply_base, struct stats_reply_data, base) 28f09ea6fbSJakub Kicinski 29f09ea6fbSJakub Kicinski const char stats_std_names[__ETHTOOL_STATS_CNT][ETH_GSTRING_LEN] = { 30f09ea6fbSJakub Kicinski [ETHTOOL_STATS_ETH_PHY] = "eth-phy", 31ca224454SJakub Kicinski [ETHTOOL_STATS_ETH_MAC] = "eth-mac", 32bfad2b97SJakub Kicinski [ETHTOOL_STATS_ETH_CTRL] = "eth-ctrl", 33a8b06e9dSJakub Kicinski [ETHTOOL_STATS_RMON] = "rmon", 34f09ea6fbSJakub Kicinski }; 35f09ea6fbSJakub Kicinski 36f09ea6fbSJakub Kicinski const char stats_eth_phy_names[__ETHTOOL_A_STATS_ETH_PHY_CNT][ETH_GSTRING_LEN] = { 37f09ea6fbSJakub Kicinski [ETHTOOL_A_STATS_ETH_PHY_5_SYM_ERR] = "SymbolErrorDuringCarrier", 38f09ea6fbSJakub Kicinski }; 39f09ea6fbSJakub Kicinski 40ca224454SJakub Kicinski const char stats_eth_mac_names[__ETHTOOL_A_STATS_ETH_MAC_CNT][ETH_GSTRING_LEN] = { 41ca224454SJakub Kicinski [ETHTOOL_A_STATS_ETH_MAC_2_TX_PKT] = "FramesTransmittedOK", 42ca224454SJakub Kicinski [ETHTOOL_A_STATS_ETH_MAC_3_SINGLE_COL] = "SingleCollisionFrames", 43ca224454SJakub Kicinski [ETHTOOL_A_STATS_ETH_MAC_4_MULTI_COL] = "MultipleCollisionFrames", 44ca224454SJakub Kicinski [ETHTOOL_A_STATS_ETH_MAC_5_RX_PKT] = "FramesReceivedOK", 45ca224454SJakub Kicinski [ETHTOOL_A_STATS_ETH_MAC_6_FCS_ERR] = "FrameCheckSequenceErrors", 46ca224454SJakub Kicinski [ETHTOOL_A_STATS_ETH_MAC_7_ALIGN_ERR] = "AlignmentErrors", 47ca224454SJakub Kicinski [ETHTOOL_A_STATS_ETH_MAC_8_TX_BYTES] = "OctetsTransmittedOK", 48ca224454SJakub Kicinski [ETHTOOL_A_STATS_ETH_MAC_9_TX_DEFER] = "FramesWithDeferredXmissions", 49ca224454SJakub Kicinski [ETHTOOL_A_STATS_ETH_MAC_10_LATE_COL] = "LateCollisions", 50ca224454SJakub Kicinski [ETHTOOL_A_STATS_ETH_MAC_11_XS_COL] = "FramesAbortedDueToXSColls", 51ca224454SJakub Kicinski [ETHTOOL_A_STATS_ETH_MAC_12_TX_INT_ERR] = "FramesLostDueToIntMACXmitError", 52ca224454SJakub Kicinski [ETHTOOL_A_STATS_ETH_MAC_13_CS_ERR] = "CarrierSenseErrors", 53ca224454SJakub Kicinski [ETHTOOL_A_STATS_ETH_MAC_14_RX_BYTES] = "OctetsReceivedOK", 54ca224454SJakub Kicinski [ETHTOOL_A_STATS_ETH_MAC_15_RX_INT_ERR] = "FramesLostDueToIntMACRcvError", 55ca224454SJakub Kicinski [ETHTOOL_A_STATS_ETH_MAC_18_TX_MCAST] = "MulticastFramesXmittedOK", 56ca224454SJakub Kicinski [ETHTOOL_A_STATS_ETH_MAC_19_TX_BCAST] = "BroadcastFramesXmittedOK", 57ca224454SJakub Kicinski [ETHTOOL_A_STATS_ETH_MAC_20_XS_DEFER] = "FramesWithExcessiveDeferral", 58ca224454SJakub Kicinski [ETHTOOL_A_STATS_ETH_MAC_21_RX_MCAST] = "MulticastFramesReceivedOK", 59ca224454SJakub Kicinski [ETHTOOL_A_STATS_ETH_MAC_22_RX_BCAST] = "BroadcastFramesReceivedOK", 60ca224454SJakub Kicinski [ETHTOOL_A_STATS_ETH_MAC_23_IR_LEN_ERR] = "InRangeLengthErrors", 61ca224454SJakub Kicinski [ETHTOOL_A_STATS_ETH_MAC_24_OOR_LEN] = "OutOfRangeLengthField", 62ca224454SJakub Kicinski [ETHTOOL_A_STATS_ETH_MAC_25_TOO_LONG_ERR] = "FrameTooLongErrors", 63ca224454SJakub Kicinski }; 64ca224454SJakub Kicinski 65bfad2b97SJakub Kicinski const char stats_eth_ctrl_names[__ETHTOOL_A_STATS_ETH_CTRL_CNT][ETH_GSTRING_LEN] = { 66bfad2b97SJakub Kicinski [ETHTOOL_A_STATS_ETH_CTRL_3_TX] = "MACControlFramesTransmitted", 67bfad2b97SJakub Kicinski [ETHTOOL_A_STATS_ETH_CTRL_4_RX] = "MACControlFramesReceived", 68bfad2b97SJakub Kicinski [ETHTOOL_A_STATS_ETH_CTRL_5_RX_UNSUP] = "UnsupportedOpcodesReceived", 69bfad2b97SJakub Kicinski }; 70bfad2b97SJakub Kicinski 71a8b06e9dSJakub Kicinski const char stats_rmon_names[__ETHTOOL_A_STATS_RMON_CNT][ETH_GSTRING_LEN] = { 72a8b06e9dSJakub Kicinski [ETHTOOL_A_STATS_RMON_UNDERSIZE] = "etherStatsUndersizePkts", 73a8b06e9dSJakub Kicinski [ETHTOOL_A_STATS_RMON_OVERSIZE] = "etherStatsOversizePkts", 74a8b06e9dSJakub Kicinski [ETHTOOL_A_STATS_RMON_FRAG] = "etherStatsFragments", 75a8b06e9dSJakub Kicinski [ETHTOOL_A_STATS_RMON_JABBER] = "etherStatsJabbers", 76a8b06e9dSJakub Kicinski }; 77a8b06e9dSJakub Kicinski 78f09ea6fbSJakub Kicinski const struct nla_policy ethnl_stats_get_policy[ETHTOOL_A_STATS_GROUPS + 1] = { 79f09ea6fbSJakub Kicinski [ETHTOOL_A_STATS_HEADER] = 80f09ea6fbSJakub Kicinski NLA_POLICY_NESTED(ethnl_header_policy), 81f09ea6fbSJakub Kicinski [ETHTOOL_A_STATS_GROUPS] = { .type = NLA_NESTED }, 82f09ea6fbSJakub Kicinski }; 83f09ea6fbSJakub Kicinski 84f09ea6fbSJakub Kicinski static int stats_parse_request(struct ethnl_req_info *req_base, 85f09ea6fbSJakub Kicinski struct nlattr **tb, 86f09ea6fbSJakub Kicinski struct netlink_ext_ack *extack) 87f09ea6fbSJakub Kicinski { 88f09ea6fbSJakub Kicinski struct stats_req_info *req_info = STATS_REQINFO(req_base); 89f09ea6fbSJakub Kicinski bool mod = false; 90f09ea6fbSJakub Kicinski int err; 91f09ea6fbSJakub Kicinski 92f09ea6fbSJakub Kicinski err = ethnl_update_bitset(req_info->stat_mask, __ETHTOOL_STATS_CNT, 93f09ea6fbSJakub Kicinski tb[ETHTOOL_A_STATS_GROUPS], stats_std_names, 94f09ea6fbSJakub Kicinski extack, &mod); 95f09ea6fbSJakub Kicinski if (err) 96f09ea6fbSJakub Kicinski return err; 97f09ea6fbSJakub Kicinski 98f09ea6fbSJakub Kicinski if (!mod) { 99f09ea6fbSJakub Kicinski NL_SET_ERR_MSG(extack, "no stats requested"); 100f09ea6fbSJakub Kicinski return -EINVAL; 101f09ea6fbSJakub Kicinski } 102f09ea6fbSJakub Kicinski 103f09ea6fbSJakub Kicinski return 0; 104f09ea6fbSJakub Kicinski } 105f09ea6fbSJakub Kicinski 106f09ea6fbSJakub Kicinski static int stats_prepare_data(const struct ethnl_req_info *req_base, 107f09ea6fbSJakub Kicinski struct ethnl_reply_data *reply_base, 108f09ea6fbSJakub Kicinski struct genl_info *info) 109f09ea6fbSJakub Kicinski { 110f09ea6fbSJakub Kicinski const struct stats_req_info *req_info = STATS_REQINFO(req_base); 111f09ea6fbSJakub Kicinski struct stats_reply_data *data = STATS_REPDATA(reply_base); 112f09ea6fbSJakub Kicinski struct net_device *dev = reply_base->dev; 113f09ea6fbSJakub Kicinski int ret; 114f09ea6fbSJakub Kicinski 115f09ea6fbSJakub Kicinski ret = ethnl_ops_begin(dev); 116f09ea6fbSJakub Kicinski if (ret < 0) 117f09ea6fbSJakub Kicinski return ret; 118f09ea6fbSJakub Kicinski 119d1f0a5e1SJakub Kicinski /* Mark all stats as unset (see ETHTOOL_STAT_NOT_SET) to prevent them 120d1f0a5e1SJakub Kicinski * from being reported to user space in case driver did not set them. 121d1f0a5e1SJakub Kicinski */ 122*812ad3d2SKees Cook memset(&data->stats, 0xff, sizeof(data->stats)); 123f09ea6fbSJakub Kicinski 124f09ea6fbSJakub Kicinski if (test_bit(ETHTOOL_STATS_ETH_PHY, req_info->stat_mask) && 125f09ea6fbSJakub Kicinski dev->ethtool_ops->get_eth_phy_stats) 126f09ea6fbSJakub Kicinski dev->ethtool_ops->get_eth_phy_stats(dev, &data->phy_stats); 127ca224454SJakub Kicinski if (test_bit(ETHTOOL_STATS_ETH_MAC, req_info->stat_mask) && 128ca224454SJakub Kicinski dev->ethtool_ops->get_eth_mac_stats) 129ca224454SJakub Kicinski dev->ethtool_ops->get_eth_mac_stats(dev, &data->mac_stats); 130bfad2b97SJakub Kicinski if (test_bit(ETHTOOL_STATS_ETH_CTRL, req_info->stat_mask) && 131bfad2b97SJakub Kicinski dev->ethtool_ops->get_eth_ctrl_stats) 132bfad2b97SJakub Kicinski dev->ethtool_ops->get_eth_ctrl_stats(dev, &data->ctrl_stats); 133a8b06e9dSJakub Kicinski if (test_bit(ETHTOOL_STATS_RMON, req_info->stat_mask) && 134a8b06e9dSJakub Kicinski dev->ethtool_ops->get_rmon_stats) 135a8b06e9dSJakub Kicinski dev->ethtool_ops->get_rmon_stats(dev, &data->rmon_stats, 136a8b06e9dSJakub Kicinski &data->rmon_ranges); 137f09ea6fbSJakub Kicinski 138f09ea6fbSJakub Kicinski ethnl_ops_complete(dev); 139f09ea6fbSJakub Kicinski return 0; 140f09ea6fbSJakub Kicinski } 141f09ea6fbSJakub Kicinski 142f09ea6fbSJakub Kicinski static int stats_reply_size(const struct ethnl_req_info *req_base, 143f09ea6fbSJakub Kicinski const struct ethnl_reply_data *reply_base) 144f09ea6fbSJakub Kicinski { 145f09ea6fbSJakub Kicinski const struct stats_req_info *req_info = STATS_REQINFO(req_base); 146f09ea6fbSJakub Kicinski unsigned int n_grps = 0, n_stats = 0; 147f09ea6fbSJakub Kicinski int len = 0; 148f09ea6fbSJakub Kicinski 149f09ea6fbSJakub Kicinski if (test_bit(ETHTOOL_STATS_ETH_PHY, req_info->stat_mask)) { 150f09ea6fbSJakub Kicinski n_stats += sizeof(struct ethtool_eth_phy_stats) / sizeof(u64); 151f09ea6fbSJakub Kicinski n_grps++; 152f09ea6fbSJakub Kicinski } 153ca224454SJakub Kicinski if (test_bit(ETHTOOL_STATS_ETH_MAC, req_info->stat_mask)) { 154ca224454SJakub Kicinski n_stats += sizeof(struct ethtool_eth_mac_stats) / sizeof(u64); 155ca224454SJakub Kicinski n_grps++; 156ca224454SJakub Kicinski } 157bfad2b97SJakub Kicinski if (test_bit(ETHTOOL_STATS_ETH_CTRL, req_info->stat_mask)) { 158bfad2b97SJakub Kicinski n_stats += sizeof(struct ethtool_eth_ctrl_stats) / sizeof(u64); 159bfad2b97SJakub Kicinski n_grps++; 160bfad2b97SJakub Kicinski } 161a8b06e9dSJakub Kicinski if (test_bit(ETHTOOL_STATS_RMON, req_info->stat_mask)) { 162a8b06e9dSJakub Kicinski n_stats += sizeof(struct ethtool_rmon_stats) / sizeof(u64); 163a8b06e9dSJakub Kicinski n_grps++; 164a8b06e9dSJakub Kicinski /* Above includes the space for _A_STATS_GRP_HIST_VALs */ 165a8b06e9dSJakub Kicinski 166a8b06e9dSJakub Kicinski len += (nla_total_size(0) + /* _A_STATS_GRP_HIST */ 167a8b06e9dSJakub Kicinski nla_total_size(4) + /* _A_STATS_GRP_HIST_BKT_LOW */ 168a8b06e9dSJakub Kicinski nla_total_size(4)) * /* _A_STATS_GRP_HIST_BKT_HI */ 169a8b06e9dSJakub Kicinski ETHTOOL_RMON_HIST_MAX * 2; 170a8b06e9dSJakub Kicinski } 171f09ea6fbSJakub Kicinski 172f09ea6fbSJakub Kicinski len += n_grps * (nla_total_size(0) + /* _A_STATS_GRP */ 173f09ea6fbSJakub Kicinski nla_total_size(4) + /* _A_STATS_GRP_ID */ 174f09ea6fbSJakub Kicinski nla_total_size(4)); /* _A_STATS_GRP_SS_ID */ 175f09ea6fbSJakub Kicinski len += n_stats * (nla_total_size(0) + /* _A_STATS_GRP_STAT */ 176f09ea6fbSJakub Kicinski nla_total_size_64bit(sizeof(u64))); 177f09ea6fbSJakub Kicinski 178f09ea6fbSJakub Kicinski return len; 179f09ea6fbSJakub Kicinski } 180f09ea6fbSJakub Kicinski 181f09ea6fbSJakub Kicinski static int stat_put(struct sk_buff *skb, u16 attrtype, u64 val) 182f09ea6fbSJakub Kicinski { 183f09ea6fbSJakub Kicinski struct nlattr *nest; 184f09ea6fbSJakub Kicinski int ret; 185f09ea6fbSJakub Kicinski 186f09ea6fbSJakub Kicinski if (val == ETHTOOL_STAT_NOT_SET) 187f09ea6fbSJakub Kicinski return 0; 188f09ea6fbSJakub Kicinski 189f09ea6fbSJakub Kicinski /* We want to start stats attr types from 0, so we don't have a type 190f09ea6fbSJakub Kicinski * for pad inside ETHTOOL_A_STATS_GRP_STAT. Pad things on the outside 191f09ea6fbSJakub Kicinski * of ETHTOOL_A_STATS_GRP_STAT. Since we're one nest away from the 192f09ea6fbSJakub Kicinski * actual attr we're 4B off - nla_need_padding_for_64bit() & co. 193f09ea6fbSJakub Kicinski * can't be used. 194f09ea6fbSJakub Kicinski */ 195f09ea6fbSJakub Kicinski #ifndef CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS 196f09ea6fbSJakub Kicinski if (!IS_ALIGNED((unsigned long)skb_tail_pointer(skb), 8)) 197f09ea6fbSJakub Kicinski if (!nla_reserve(skb, ETHTOOL_A_STATS_GRP_PAD, 0)) 198f09ea6fbSJakub Kicinski return -EMSGSIZE; 199f09ea6fbSJakub Kicinski #endif 200f09ea6fbSJakub Kicinski 201f09ea6fbSJakub Kicinski nest = nla_nest_start(skb, ETHTOOL_A_STATS_GRP_STAT); 202f09ea6fbSJakub Kicinski if (!nest) 203f09ea6fbSJakub Kicinski return -EMSGSIZE; 204f09ea6fbSJakub Kicinski 205f09ea6fbSJakub Kicinski ret = nla_put_u64_64bit(skb, attrtype, val, -1 /* not used */); 206f09ea6fbSJakub Kicinski if (ret) { 207f09ea6fbSJakub Kicinski nla_nest_cancel(skb, nest); 208f09ea6fbSJakub Kicinski return ret; 209f09ea6fbSJakub Kicinski } 210f09ea6fbSJakub Kicinski 211f09ea6fbSJakub Kicinski nla_nest_end(skb, nest); 212f09ea6fbSJakub Kicinski return 0; 213f09ea6fbSJakub Kicinski } 214f09ea6fbSJakub Kicinski 215f09ea6fbSJakub Kicinski static int stats_put_phy_stats(struct sk_buff *skb, 216f09ea6fbSJakub Kicinski const struct stats_reply_data *data) 217f09ea6fbSJakub Kicinski { 218f09ea6fbSJakub Kicinski if (stat_put(skb, ETHTOOL_A_STATS_ETH_PHY_5_SYM_ERR, 219f09ea6fbSJakub Kicinski data->phy_stats.SymbolErrorDuringCarrier)) 220f09ea6fbSJakub Kicinski return -EMSGSIZE; 221f09ea6fbSJakub Kicinski return 0; 222f09ea6fbSJakub Kicinski } 223f09ea6fbSJakub Kicinski 224ca224454SJakub Kicinski static int stats_put_mac_stats(struct sk_buff *skb, 225ca224454SJakub Kicinski const struct stats_reply_data *data) 226ca224454SJakub Kicinski { 227ca224454SJakub Kicinski if (stat_put(skb, ETHTOOL_A_STATS_ETH_MAC_2_TX_PKT, 228ca224454SJakub Kicinski data->mac_stats.FramesTransmittedOK) || 229ca224454SJakub Kicinski stat_put(skb, ETHTOOL_A_STATS_ETH_MAC_3_SINGLE_COL, 230ca224454SJakub Kicinski data->mac_stats.SingleCollisionFrames) || 231ca224454SJakub Kicinski stat_put(skb, ETHTOOL_A_STATS_ETH_MAC_4_MULTI_COL, 232ca224454SJakub Kicinski data->mac_stats.MultipleCollisionFrames) || 233ca224454SJakub Kicinski stat_put(skb, ETHTOOL_A_STATS_ETH_MAC_5_RX_PKT, 234ca224454SJakub Kicinski data->mac_stats.FramesReceivedOK) || 235ca224454SJakub Kicinski stat_put(skb, ETHTOOL_A_STATS_ETH_MAC_6_FCS_ERR, 236ca224454SJakub Kicinski data->mac_stats.FrameCheckSequenceErrors) || 237ca224454SJakub Kicinski stat_put(skb, ETHTOOL_A_STATS_ETH_MAC_7_ALIGN_ERR, 238ca224454SJakub Kicinski data->mac_stats.AlignmentErrors) || 239ca224454SJakub Kicinski stat_put(skb, ETHTOOL_A_STATS_ETH_MAC_8_TX_BYTES, 240ca224454SJakub Kicinski data->mac_stats.OctetsTransmittedOK) || 241ca224454SJakub Kicinski stat_put(skb, ETHTOOL_A_STATS_ETH_MAC_9_TX_DEFER, 242ca224454SJakub Kicinski data->mac_stats.FramesWithDeferredXmissions) || 243ca224454SJakub Kicinski stat_put(skb, ETHTOOL_A_STATS_ETH_MAC_10_LATE_COL, 244ca224454SJakub Kicinski data->mac_stats.LateCollisions) || 245ca224454SJakub Kicinski stat_put(skb, ETHTOOL_A_STATS_ETH_MAC_11_XS_COL, 246ca224454SJakub Kicinski data->mac_stats.FramesAbortedDueToXSColls) || 247ca224454SJakub Kicinski stat_put(skb, ETHTOOL_A_STATS_ETH_MAC_12_TX_INT_ERR, 248ca224454SJakub Kicinski data->mac_stats.FramesLostDueToIntMACXmitError) || 249ca224454SJakub Kicinski stat_put(skb, ETHTOOL_A_STATS_ETH_MAC_13_CS_ERR, 250ca224454SJakub Kicinski data->mac_stats.CarrierSenseErrors) || 251ca224454SJakub Kicinski stat_put(skb, ETHTOOL_A_STATS_ETH_MAC_14_RX_BYTES, 252ca224454SJakub Kicinski data->mac_stats.OctetsReceivedOK) || 253ca224454SJakub Kicinski stat_put(skb, ETHTOOL_A_STATS_ETH_MAC_15_RX_INT_ERR, 254ca224454SJakub Kicinski data->mac_stats.FramesLostDueToIntMACRcvError) || 255ca224454SJakub Kicinski stat_put(skb, ETHTOOL_A_STATS_ETH_MAC_18_TX_MCAST, 256ca224454SJakub Kicinski data->mac_stats.MulticastFramesXmittedOK) || 257ca224454SJakub Kicinski stat_put(skb, ETHTOOL_A_STATS_ETH_MAC_19_TX_BCAST, 258ca224454SJakub Kicinski data->mac_stats.BroadcastFramesXmittedOK) || 259ca224454SJakub Kicinski stat_put(skb, ETHTOOL_A_STATS_ETH_MAC_20_XS_DEFER, 260ca224454SJakub Kicinski data->mac_stats.FramesWithExcessiveDeferral) || 261ca224454SJakub Kicinski stat_put(skb, ETHTOOL_A_STATS_ETH_MAC_21_RX_MCAST, 262ca224454SJakub Kicinski data->mac_stats.MulticastFramesReceivedOK) || 263ca224454SJakub Kicinski stat_put(skb, ETHTOOL_A_STATS_ETH_MAC_22_RX_BCAST, 264ca224454SJakub Kicinski data->mac_stats.BroadcastFramesReceivedOK) || 265ca224454SJakub Kicinski stat_put(skb, ETHTOOL_A_STATS_ETH_MAC_23_IR_LEN_ERR, 266ca224454SJakub Kicinski data->mac_stats.InRangeLengthErrors) || 267ca224454SJakub Kicinski stat_put(skb, ETHTOOL_A_STATS_ETH_MAC_24_OOR_LEN, 268ca224454SJakub Kicinski data->mac_stats.OutOfRangeLengthField) || 269ca224454SJakub Kicinski stat_put(skb, ETHTOOL_A_STATS_ETH_MAC_25_TOO_LONG_ERR, 270ca224454SJakub Kicinski data->mac_stats.FrameTooLongErrors)) 271ca224454SJakub Kicinski return -EMSGSIZE; 272ca224454SJakub Kicinski return 0; 273ca224454SJakub Kicinski } 274ca224454SJakub Kicinski 275bfad2b97SJakub Kicinski static int stats_put_ctrl_stats(struct sk_buff *skb, 276bfad2b97SJakub Kicinski const struct stats_reply_data *data) 277bfad2b97SJakub Kicinski { 278bfad2b97SJakub Kicinski if (stat_put(skb, ETHTOOL_A_STATS_ETH_CTRL_3_TX, 279bfad2b97SJakub Kicinski data->ctrl_stats.MACControlFramesTransmitted) || 280bfad2b97SJakub Kicinski stat_put(skb, ETHTOOL_A_STATS_ETH_CTRL_4_RX, 281bfad2b97SJakub Kicinski data->ctrl_stats.MACControlFramesReceived) || 282bfad2b97SJakub Kicinski stat_put(skb, ETHTOOL_A_STATS_ETH_CTRL_5_RX_UNSUP, 283bfad2b97SJakub Kicinski data->ctrl_stats.UnsupportedOpcodesReceived)) 284bfad2b97SJakub Kicinski return -EMSGSIZE; 285bfad2b97SJakub Kicinski return 0; 286bfad2b97SJakub Kicinski } 287bfad2b97SJakub Kicinski 288a8b06e9dSJakub Kicinski static int stats_put_rmon_hist(struct sk_buff *skb, u32 attr, const u64 *hist, 289a8b06e9dSJakub Kicinski const struct ethtool_rmon_hist_range *ranges) 290a8b06e9dSJakub Kicinski { 291a8b06e9dSJakub Kicinski struct nlattr *nest; 292a8b06e9dSJakub Kicinski int i; 293a8b06e9dSJakub Kicinski 294a8b06e9dSJakub Kicinski if (!ranges) 295a8b06e9dSJakub Kicinski return 0; 296a8b06e9dSJakub Kicinski 297a8b06e9dSJakub Kicinski for (i = 0; i < ETHTOOL_RMON_HIST_MAX; i++) { 298a8b06e9dSJakub Kicinski if (!ranges[i].low && !ranges[i].high) 299a8b06e9dSJakub Kicinski break; 300a8b06e9dSJakub Kicinski if (hist[i] == ETHTOOL_STAT_NOT_SET) 301a8b06e9dSJakub Kicinski continue; 302a8b06e9dSJakub Kicinski 303a8b06e9dSJakub Kicinski nest = nla_nest_start(skb, attr); 304a8b06e9dSJakub Kicinski if (!nest) 305a8b06e9dSJakub Kicinski return -EMSGSIZE; 306a8b06e9dSJakub Kicinski 307a8b06e9dSJakub Kicinski if (nla_put_u32(skb, ETHTOOL_A_STATS_GRP_HIST_BKT_LOW, 308a8b06e9dSJakub Kicinski ranges[i].low) || 309a8b06e9dSJakub Kicinski nla_put_u32(skb, ETHTOOL_A_STATS_GRP_HIST_BKT_HI, 310a8b06e9dSJakub Kicinski ranges[i].high) || 311a8b06e9dSJakub Kicinski nla_put_u64_64bit(skb, ETHTOOL_A_STATS_GRP_HIST_VAL, 312a8b06e9dSJakub Kicinski hist[i], ETHTOOL_A_STATS_GRP_PAD)) 313a8b06e9dSJakub Kicinski goto err_cancel_hist; 314a8b06e9dSJakub Kicinski 315a8b06e9dSJakub Kicinski nla_nest_end(skb, nest); 316a8b06e9dSJakub Kicinski } 317a8b06e9dSJakub Kicinski 318a8b06e9dSJakub Kicinski return 0; 319a8b06e9dSJakub Kicinski 320a8b06e9dSJakub Kicinski err_cancel_hist: 321a8b06e9dSJakub Kicinski nla_nest_cancel(skb, nest); 322a8b06e9dSJakub Kicinski return -EMSGSIZE; 323a8b06e9dSJakub Kicinski } 324a8b06e9dSJakub Kicinski 325a8b06e9dSJakub Kicinski static int stats_put_rmon_stats(struct sk_buff *skb, 326a8b06e9dSJakub Kicinski const struct stats_reply_data *data) 327a8b06e9dSJakub Kicinski { 328a8b06e9dSJakub Kicinski if (stats_put_rmon_hist(skb, ETHTOOL_A_STATS_GRP_HIST_RX, 329a8b06e9dSJakub Kicinski data->rmon_stats.hist, data->rmon_ranges) || 330a8b06e9dSJakub Kicinski stats_put_rmon_hist(skb, ETHTOOL_A_STATS_GRP_HIST_TX, 331a8b06e9dSJakub Kicinski data->rmon_stats.hist_tx, data->rmon_ranges)) 332a8b06e9dSJakub Kicinski return -EMSGSIZE; 333a8b06e9dSJakub Kicinski 334a8b06e9dSJakub Kicinski if (stat_put(skb, ETHTOOL_A_STATS_RMON_UNDERSIZE, 335a8b06e9dSJakub Kicinski data->rmon_stats.undersize_pkts) || 336a8b06e9dSJakub Kicinski stat_put(skb, ETHTOOL_A_STATS_RMON_OVERSIZE, 337a8b06e9dSJakub Kicinski data->rmon_stats.oversize_pkts) || 338a8b06e9dSJakub Kicinski stat_put(skb, ETHTOOL_A_STATS_RMON_FRAG, 339a8b06e9dSJakub Kicinski data->rmon_stats.fragments) || 340a8b06e9dSJakub Kicinski stat_put(skb, ETHTOOL_A_STATS_RMON_JABBER, 341a8b06e9dSJakub Kicinski data->rmon_stats.jabbers)) 342a8b06e9dSJakub Kicinski return -EMSGSIZE; 343a8b06e9dSJakub Kicinski 344a8b06e9dSJakub Kicinski return 0; 345a8b06e9dSJakub Kicinski } 346a8b06e9dSJakub Kicinski 347f09ea6fbSJakub Kicinski static int stats_put_stats(struct sk_buff *skb, 348f09ea6fbSJakub Kicinski const struct stats_reply_data *data, 349f09ea6fbSJakub Kicinski u32 id, u32 ss_id, 350f09ea6fbSJakub Kicinski int (*cb)(struct sk_buff *skb, 351f09ea6fbSJakub Kicinski const struct stats_reply_data *data)) 352f09ea6fbSJakub Kicinski { 353f09ea6fbSJakub Kicinski struct nlattr *nest; 354f09ea6fbSJakub Kicinski 355f09ea6fbSJakub Kicinski nest = nla_nest_start(skb, ETHTOOL_A_STATS_GRP); 356f09ea6fbSJakub Kicinski if (!nest) 357f09ea6fbSJakub Kicinski return -EMSGSIZE; 358f09ea6fbSJakub Kicinski 359f09ea6fbSJakub Kicinski if (nla_put_u32(skb, ETHTOOL_A_STATS_GRP_ID, id) || 360f09ea6fbSJakub Kicinski nla_put_u32(skb, ETHTOOL_A_STATS_GRP_SS_ID, ss_id)) 361f09ea6fbSJakub Kicinski goto err_cancel; 362f09ea6fbSJakub Kicinski 363f09ea6fbSJakub Kicinski if (cb(skb, data)) 364f09ea6fbSJakub Kicinski goto err_cancel; 365f09ea6fbSJakub Kicinski 366f09ea6fbSJakub Kicinski nla_nest_end(skb, nest); 367f09ea6fbSJakub Kicinski return 0; 368f09ea6fbSJakub Kicinski 369f09ea6fbSJakub Kicinski err_cancel: 370f09ea6fbSJakub Kicinski nla_nest_cancel(skb, nest); 371f09ea6fbSJakub Kicinski return -EMSGSIZE; 372f09ea6fbSJakub Kicinski } 373f09ea6fbSJakub Kicinski 374f09ea6fbSJakub Kicinski static int stats_fill_reply(struct sk_buff *skb, 375f09ea6fbSJakub Kicinski const struct ethnl_req_info *req_base, 376f09ea6fbSJakub Kicinski const struct ethnl_reply_data *reply_base) 377f09ea6fbSJakub Kicinski { 378f09ea6fbSJakub Kicinski const struct stats_req_info *req_info = STATS_REQINFO(req_base); 379f09ea6fbSJakub Kicinski const struct stats_reply_data *data = STATS_REPDATA(reply_base); 380f09ea6fbSJakub Kicinski int ret = 0; 381f09ea6fbSJakub Kicinski 382f09ea6fbSJakub Kicinski if (!ret && test_bit(ETHTOOL_STATS_ETH_PHY, req_info->stat_mask)) 383f09ea6fbSJakub Kicinski ret = stats_put_stats(skb, data, ETHTOOL_STATS_ETH_PHY, 384f09ea6fbSJakub Kicinski ETH_SS_STATS_ETH_PHY, 385f09ea6fbSJakub Kicinski stats_put_phy_stats); 386ca224454SJakub Kicinski if (!ret && test_bit(ETHTOOL_STATS_ETH_MAC, req_info->stat_mask)) 387ca224454SJakub Kicinski ret = stats_put_stats(skb, data, ETHTOOL_STATS_ETH_MAC, 388ca224454SJakub Kicinski ETH_SS_STATS_ETH_MAC, 389ca224454SJakub Kicinski stats_put_mac_stats); 390bfad2b97SJakub Kicinski if (!ret && test_bit(ETHTOOL_STATS_ETH_CTRL, req_info->stat_mask)) 391bfad2b97SJakub Kicinski ret = stats_put_stats(skb, data, ETHTOOL_STATS_ETH_CTRL, 392bfad2b97SJakub Kicinski ETH_SS_STATS_ETH_CTRL, 393bfad2b97SJakub Kicinski stats_put_ctrl_stats); 394a8b06e9dSJakub Kicinski if (!ret && test_bit(ETHTOOL_STATS_RMON, req_info->stat_mask)) 395a8b06e9dSJakub Kicinski ret = stats_put_stats(skb, data, ETHTOOL_STATS_RMON, 396a8b06e9dSJakub Kicinski ETH_SS_STATS_RMON, stats_put_rmon_stats); 397f09ea6fbSJakub Kicinski 398f09ea6fbSJakub Kicinski return ret; 399f09ea6fbSJakub Kicinski } 400f09ea6fbSJakub Kicinski 401f09ea6fbSJakub Kicinski const struct ethnl_request_ops ethnl_stats_request_ops = { 402f09ea6fbSJakub Kicinski .request_cmd = ETHTOOL_MSG_STATS_GET, 403f09ea6fbSJakub Kicinski .reply_cmd = ETHTOOL_MSG_STATS_GET_REPLY, 404f09ea6fbSJakub Kicinski .hdr_attr = ETHTOOL_A_STATS_HEADER, 405f09ea6fbSJakub Kicinski .req_info_size = sizeof(struct stats_req_info), 406f09ea6fbSJakub Kicinski .reply_data_size = sizeof(struct stats_reply_data), 407f09ea6fbSJakub Kicinski 408f09ea6fbSJakub Kicinski .parse_request = stats_parse_request, 409f09ea6fbSJakub Kicinski .prepare_data = stats_prepare_data, 410f09ea6fbSJakub Kicinski .reply_size = stats_reply_size, 411f09ea6fbSJakub Kicinski .fill_reply = stats_fill_reply, 412f09ea6fbSJakub Kicinski }; 413