2 * mac80211 ethtool hooks for cfg80211
4 * Copied from cfg.c - originally
5 * Copyright 2006-2010 Johannes Berg <johannes@sipsolutions.net>
6 * Copyright 2014 Intel Corporation (Author: Johannes Berg)
7 * Copyright (C) 2018 Intel Corporation
9 * This file is GPLv2 as found in COPYING.
11 #include <linux/types.h>
12 #include <net/cfg80211.h>
13 #include "ieee80211_i.h"
15 #include "driver-ops.h"
17 static int ieee80211_set_ringparam(struct net_device *dev,
18 struct ethtool_ringparam *rp)
20 struct ieee80211_local *local = wiphy_priv(dev->ieee80211_ptr->wiphy);
22 if (rp->rx_mini_pending != 0 || rp->rx_jumbo_pending != 0)
25 return drv_set_ringparam(local, rp->tx_pending, rp->rx_pending);
28 static void ieee80211_get_ringparam(struct net_device *dev,
29 struct ethtool_ringparam *rp)
31 struct ieee80211_local *local = wiphy_priv(dev->ieee80211_ptr->wiphy);
33 memset(rp, 0, sizeof(*rp));
35 drv_get_ringparam(local, &rp->tx_pending, &rp->tx_max_pending,
36 &rp->rx_pending, &rp->rx_max_pending);
39 static const char ieee80211_gstrings_sta_stats[][ETH_GSTRING_LEN] = {
40 "rx_packets", "rx_bytes",
41 "rx_duplicates", "rx_fragments", "rx_dropped",
42 "tx_packets", "tx_bytes",
43 "tx_filtered", "tx_retry_failed", "tx_retries",
44 "sta_state", "txrate", "rxrate", "signal",
45 "channel", "noise", "ch_time", "ch_time_busy",
46 "ch_time_ext_busy", "ch_time_rx", "ch_time_tx"
48 #define STA_STATS_LEN ARRAY_SIZE(ieee80211_gstrings_sta_stats)
50 static int ieee80211_get_sset_count(struct net_device *dev, int sset)
52 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
55 if (sset == ETH_SS_STATS)
58 rv += drv_get_et_sset_count(sdata, sset);
65 static void ieee80211_get_stats(struct net_device *dev,
66 struct ethtool_stats *stats,
69 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
70 struct ieee80211_chanctx_conf *chanctx_conf;
71 struct ieee80211_channel *channel;
73 struct ieee80211_local *local = sdata->local;
74 struct station_info *sinfo;
75 struct survey_info survey;
77 #define STA_STATS_SURVEY_LEN 7
79 sinfo = kmalloc(sizeof(*sinfo), GFP_KERNEL);
83 memset(data, 0, sizeof(u64) * STA_STATS_LEN);
85 #define ADD_STA_STATS(sta) \
87 data[i++] += sta->rx_stats.packets; \
88 data[i++] += sta->rx_stats.bytes; \
89 data[i++] += sta->rx_stats.num_duplicates; \
90 data[i++] += sta->rx_stats.fragments; \
91 data[i++] += sta->rx_stats.dropped; \
93 data[i++] += sinfo->tx_packets; \
94 data[i++] += sinfo->tx_bytes; \
95 data[i++] += sta->status_stats.filtered; \
96 data[i++] += sta->status_stats.retry_failed; \
97 data[i++] += sta->status_stats.retry_count; \
100 /* For Managed stations, find the single station based on BSSID
101 * and use that. For interface types, iterate through all available
102 * stations and add stats for any station that is assigned to this
106 mutex_lock(&local->sta_mtx);
108 if (sdata->vif.type == NL80211_IFTYPE_STATION) {
109 sta = sta_info_get_bss(sdata, sdata->u.mgd.bssid);
111 if (!(sta && !WARN_ON(sta->sdata->dev != dev)))
114 memset(sinfo, 0, sizeof(*sinfo));
115 sta_set_sinfo(sta, sinfo);
120 data[i++] = sta->sta_state;
123 if (sinfo->filled & BIT(NL80211_STA_INFO_TX_BITRATE))
125 cfg80211_calculate_bitrate(&sinfo->txrate);
127 if (sinfo->filled & BIT(NL80211_STA_INFO_RX_BITRATE))
129 cfg80211_calculate_bitrate(&sinfo->rxrate);
132 if (sinfo->filled & BIT(NL80211_STA_INFO_SIGNAL_AVG))
133 data[i] = (u8)sinfo->signal_avg;
136 list_for_each_entry(sta, &local->sta_list, list) {
137 /* Make sure this station belongs to the proper dev */
138 if (sta->sdata->dev != dev)
141 memset(sinfo, 0, sizeof(*sinfo));
142 sta_set_sinfo(sta, sinfo);
151 i = STA_STATS_LEN - STA_STATS_SURVEY_LEN;
152 /* Get survey stats for current channel */
156 chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf);
158 channel = chanctx_conf->def.chan;
167 if (drv_get_survey(local, q, &survey) != 0) {
172 } while (channel != survey.channel);
176 data[i++] = survey.channel->center_freq;
179 if (survey.filled & SURVEY_INFO_NOISE_DBM)
180 data[i++] = (u8)survey.noise;
183 if (survey.filled & SURVEY_INFO_TIME)
184 data[i++] = survey.time;
187 if (survey.filled & SURVEY_INFO_TIME_BUSY)
188 data[i++] = survey.time_busy;
191 if (survey.filled & SURVEY_INFO_TIME_EXT_BUSY)
192 data[i++] = survey.time_ext_busy;
195 if (survey.filled & SURVEY_INFO_TIME_RX)
196 data[i++] = survey.time_rx;
199 if (survey.filled & SURVEY_INFO_TIME_TX)
200 data[i++] = survey.time_tx;
204 mutex_unlock(&local->sta_mtx);
206 if (WARN_ON(i != STA_STATS_LEN))
209 drv_get_et_stats(sdata, stats, &(data[STA_STATS_LEN]));
212 static void ieee80211_get_strings(struct net_device *dev, u32 sset, u8 *data)
214 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
215 int sz_sta_stats = 0;
217 if (sset == ETH_SS_STATS) {
218 sz_sta_stats = sizeof(ieee80211_gstrings_sta_stats);
219 memcpy(data, ieee80211_gstrings_sta_stats, sz_sta_stats);
221 drv_get_et_strings(sdata, sset, &(data[sz_sta_stats]));
224 static int ieee80211_get_regs_len(struct net_device *dev)
229 static void ieee80211_get_regs(struct net_device *dev,
230 struct ethtool_regs *regs,
233 struct wireless_dev *wdev = dev->ieee80211_ptr;
235 regs->version = wdev->wiphy->hw_version;
239 const struct ethtool_ops ieee80211_ethtool_ops = {
240 .get_drvinfo = cfg80211_get_drvinfo,
241 .get_regs_len = ieee80211_get_regs_len,
242 .get_regs = ieee80211_get_regs,
243 .get_link = ethtool_op_get_link,
244 .get_ringparam = ieee80211_get_ringparam,
245 .set_ringparam = ieee80211_set_ringparam,
246 .get_strings = ieee80211_get_strings,
247 .get_ethtool_stats = ieee80211_get_stats,
248 .get_sset_count = ieee80211_get_sset_count,