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