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(wiphy: 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(wiphy: local->hw.wiphy); |
28 | ret = drv_set_ringparam(local, tx: rp->tx_pending, rx: rp->rx_pending); |
29 | wiphy_unlock(wiphy: 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(wiphy: dev->ieee80211_ptr->wiphy); |
40 | |
41 | memset(rp, 0, sizeof(*rp)); |
42 | |
43 | wiphy_lock(wiphy: local->hw.wiphy); |
44 | drv_get_ringparam(local, tx: &rp->tx_pending, tx_max: &rp->tx_max_pending, |
45 | rx: &rp->rx_pending, rx_max: &rp->rx_max_pending); |
46 | wiphy_unlock(wiphy: 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(wiphy: local->hw.wiphy); |
113 | |
114 | if (sdata->vif.type == NL80211_IFTYPE_STATION) { |
115 | sta = sta_info_get_bss(sdata, addr: 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: &sinfo, tidstats: 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(rate: &sinfo.txrate); |
132 | i++; |
133 | if (sinfo.filled & BIT_ULL(NL80211_STA_INFO_RX_BITRATE)) |
134 | data[i] = 100000ULL * |
135 | cfg80211_calculate_bitrate(rate: &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: &sinfo, tidstats: 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, idx: q, survey: &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(wiphy: local->hw.wiphy); |
210 | return; |
211 | } |
212 | |
213 | drv_get_et_stats(sdata, stats, data: &(data[STA_STATS_LEN])); |
214 | wiphy_unlock(wiphy: 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: &(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 | |