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