1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * mac80211 ethtool hooks for cfg80211 4 * 5 * Copied from cfg.c - originally 6 * Copyright 2006-2010 Johannes Berg <johannes@sipsolutions.net> 7 * Copyright 2014 Intel Corporation (Author: Johannes Berg) 8 * Copyright (C) 2018, 2022-2023 Intel Corporation 9 */ 10 #include <linux/types.h> 11 #include <net/cfg80211.h> 12 #include "ieee80211_i.h" 13 #include "sta_info.h" 14 #include "driver-ops.h" 15 16 static int ieee80211_set_ringparam(struct net_device *dev, 17 struct ethtool_ringparam *rp, 18 struct kernel_ethtool_ringparam *kernel_rp, 19 struct netlink_ext_ack *extack) 20 { 21 struct ieee80211_local *local = wiphy_priv(dev->ieee80211_ptr->wiphy); 22 int ret; 23 24 if (rp->rx_mini_pending != 0 || rp->rx_jumbo_pending != 0) 25 return -EINVAL; 26 27 wiphy_lock(local->hw.wiphy); 28 ret = drv_set_ringparam(local, rp->tx_pending, rp->rx_pending); 29 wiphy_unlock(local->hw.wiphy); 30 31 return ret; 32 } 33 34 static void ieee80211_get_ringparam(struct net_device *dev, 35 struct ethtool_ringparam *rp, 36 struct kernel_ethtool_ringparam *kernel_rp, 37 struct netlink_ext_ack *extack) 38 { 39 struct ieee80211_local *local = wiphy_priv(dev->ieee80211_ptr->wiphy); 40 41 memset(rp, 0, sizeof(*rp)); 42 43 wiphy_lock(local->hw.wiphy); 44 drv_get_ringparam(local, &rp->tx_pending, &rp->tx_max_pending, 45 &rp->rx_pending, &rp->rx_max_pending); 46 wiphy_unlock(local->hw.wiphy); 47 } 48 49 static const char ieee80211_gstrings_sta_stats[][ETH_GSTRING_LEN] = { 50 "rx_packets", "rx_bytes", 51 "rx_duplicates", "rx_fragments", "rx_dropped", 52 "tx_packets", "tx_bytes", 53 "tx_filtered", "tx_retry_failed", "tx_retries", 54 "sta_state", "txrate", "rxrate", "signal", 55 "channel", "noise", "ch_time", "ch_time_busy", 56 "ch_time_ext_busy", "ch_time_rx", "ch_time_tx" 57 }; 58 #define STA_STATS_LEN ARRAY_SIZE(ieee80211_gstrings_sta_stats) 59 60 static int ieee80211_get_sset_count(struct net_device *dev, int sset) 61 { 62 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); 63 int rv = 0; 64 65 if (sset == ETH_SS_STATS) 66 rv += STA_STATS_LEN; 67 68 rv += drv_get_et_sset_count(sdata, sset); 69 70 if (rv == 0) 71 return -EOPNOTSUPP; 72 return rv; 73 } 74 75 static void ieee80211_get_stats(struct net_device *dev, 76 struct ethtool_stats *stats, 77 u64 *data) 78 { 79 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); 80 struct ieee80211_chanctx_conf *chanctx_conf; 81 struct ieee80211_channel *channel; 82 struct sta_info *sta; 83 struct ieee80211_local *local = sdata->local; 84 struct station_info sinfo; 85 struct survey_info survey; 86 int i, q; 87 #define STA_STATS_SURVEY_LEN 7 88 89 memset(data, 0, sizeof(u64) * STA_STATS_LEN); 90 91 #define ADD_STA_STATS(sta) \ 92 do { \ 93 data[i++] += sinfo.rx_packets; \ 94 data[i++] += sinfo.rx_bytes; \ 95 data[i++] += (sta)->rx_stats.num_duplicates; \ 96 data[i++] += (sta)->rx_stats.fragments; \ 97 data[i++] += sinfo.rx_dropped_misc; \ 98 \ 99 data[i++] += sinfo.tx_packets; \ 100 data[i++] += sinfo.tx_bytes; \ 101 data[i++] += (sta)->status_stats.filtered; \ 102 data[i++] += sinfo.tx_failed; \ 103 data[i++] += sinfo.tx_retries; \ 104 } while (0) 105 106 /* For Managed stations, find the single station based on BSSID 107 * and use that. For interface types, iterate through all available 108 * stations and add stats for any station that is assigned to this 109 * network device. 110 */ 111 112 wiphy_lock(local->hw.wiphy); 113 114 if (sdata->vif.type == NL80211_IFTYPE_STATION) { 115 sta = sta_info_get_bss(sdata, sdata->deflink.u.mgd.bssid); 116 117 if (!(sta && !WARN_ON(sta->sdata->dev != dev))) 118 goto do_survey; 119 120 memset(&sinfo, 0, sizeof(sinfo)); 121 sta_set_sinfo(sta, &sinfo, false); 122 123 i = 0; 124 ADD_STA_STATS(&sta->deflink); 125 126 data[i++] = sta->sta_state; 127 128 129 if (sinfo.filled & BIT_ULL(NL80211_STA_INFO_TX_BITRATE)) 130 data[i] = 100000ULL * 131 cfg80211_calculate_bitrate(&sinfo.txrate); 132 i++; 133 if (sinfo.filled & BIT_ULL(NL80211_STA_INFO_RX_BITRATE)) 134 data[i] = 100000ULL * 135 cfg80211_calculate_bitrate(&sinfo.rxrate); 136 i++; 137 138 if (sinfo.filled & BIT_ULL(NL80211_STA_INFO_SIGNAL_AVG)) 139 data[i] = (u8)sinfo.signal_avg; 140 i++; 141 } else { 142 list_for_each_entry(sta, &local->sta_list, list) { 143 /* Make sure this station belongs to the proper dev */ 144 if (sta->sdata->dev != dev) 145 continue; 146 147 memset(&sinfo, 0, sizeof(sinfo)); 148 sta_set_sinfo(sta, &sinfo, false); 149 i = 0; 150 ADD_STA_STATS(&sta->deflink); 151 } 152 } 153 154 do_survey: 155 i = STA_STATS_LEN - STA_STATS_SURVEY_LEN; 156 /* Get survey stats for current channel */ 157 survey.filled = 0; 158 159 rcu_read_lock(); 160 chanctx_conf = rcu_dereference(sdata->vif.bss_conf.chanctx_conf); 161 if (chanctx_conf) 162 channel = chanctx_conf->def.chan; 163 else 164 channel = NULL; 165 rcu_read_unlock(); 166 167 if (channel) { 168 q = 0; 169 do { 170 survey.filled = 0; 171 if (drv_get_survey(local, q, &survey) != 0) { 172 survey.filled = 0; 173 break; 174 } 175 q++; 176 } while (channel != survey.channel); 177 } 178 179 if (survey.filled) 180 data[i++] = survey.channel->center_freq; 181 else 182 data[i++] = 0; 183 if (survey.filled & SURVEY_INFO_NOISE_DBM) 184 data[i++] = (u8)survey.noise; 185 else 186 data[i++] = -1LL; 187 if (survey.filled & SURVEY_INFO_TIME) 188 data[i++] = survey.time; 189 else 190 data[i++] = -1LL; 191 if (survey.filled & SURVEY_INFO_TIME_BUSY) 192 data[i++] = survey.time_busy; 193 else 194 data[i++] = -1LL; 195 if (survey.filled & SURVEY_INFO_TIME_EXT_BUSY) 196 data[i++] = survey.time_ext_busy; 197 else 198 data[i++] = -1LL; 199 if (survey.filled & SURVEY_INFO_TIME_RX) 200 data[i++] = survey.time_rx; 201 else 202 data[i++] = -1LL; 203 if (survey.filled & SURVEY_INFO_TIME_TX) 204 data[i++] = survey.time_tx; 205 else 206 data[i++] = -1LL; 207 208 if (WARN_ON(i != STA_STATS_LEN)) { 209 wiphy_unlock(local->hw.wiphy); 210 return; 211 } 212 213 drv_get_et_stats(sdata, stats, &(data[STA_STATS_LEN])); 214 wiphy_unlock(local->hw.wiphy); 215 } 216 217 static void ieee80211_get_strings(struct net_device *dev, u32 sset, u8 *data) 218 { 219 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); 220 int sz_sta_stats = 0; 221 222 if (sset == ETH_SS_STATS) { 223 sz_sta_stats = sizeof(ieee80211_gstrings_sta_stats); 224 memcpy(data, ieee80211_gstrings_sta_stats, sz_sta_stats); 225 } 226 drv_get_et_strings(sdata, sset, &(data[sz_sta_stats])); 227 } 228 229 static int ieee80211_get_regs_len(struct net_device *dev) 230 { 231 return 0; 232 } 233 234 static void ieee80211_get_regs(struct net_device *dev, 235 struct ethtool_regs *regs, 236 void *data) 237 { 238 struct wireless_dev *wdev = dev->ieee80211_ptr; 239 240 regs->version = wdev->wiphy->hw_version; 241 regs->len = 0; 242 } 243 244 const struct ethtool_ops ieee80211_ethtool_ops = { 245 .get_drvinfo = cfg80211_get_drvinfo, 246 .get_regs_len = ieee80211_get_regs_len, 247 .get_regs = ieee80211_get_regs, 248 .get_link = ethtool_op_get_link, 249 .get_ringparam = ieee80211_get_ringparam, 250 .set_ringparam = ieee80211_set_ringparam, 251 .get_strings = ieee80211_get_strings, 252 .get_ethtool_stats = ieee80211_get_stats, 253 .get_sset_count = ieee80211_get_sset_count, 254 }; 255