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
16static 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
34static 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
49static 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
60static 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
75static 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
154do_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
217static 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
229static int ieee80211_get_regs_len(struct net_device *dev)
230{
231	return 0;
232}
233
234static 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
244const 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