Commit | Line | Data |
---|---|---|
28c61a66 | 1 | // SPDX-License-Identifier: GPL-2.0-only |
b7ffbd7e JB |
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) | |
d0a9123e | 8 | * Copyright (C) 2018, 2022 Intel Corporation |
b7ffbd7e JB |
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, | |
74624944 HC |
17 | struct ethtool_ringparam *rp, |
18 | struct kernel_ethtool_ringparam *kernel_rp, | |
19 | struct netlink_ext_ack *extack) | |
b7ffbd7e JB |
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 | ||
29 | static void ieee80211_get_ringparam(struct net_device *dev, | |
74624944 HC |
30 | struct ethtool_ringparam *rp, |
31 | struct kernel_ethtool_ringparam *kernel_rp, | |
32 | struct netlink_ext_ack *extack) | |
b7ffbd7e JB |
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", | |
f83f1c12 | 45 | "tx_packets", "tx_bytes", |
b7ffbd7e | 46 | "tx_filtered", "tx_retry_failed", "tx_retries", |
976bd9ef | 47 | "sta_state", "txrate", "rxrate", "signal", |
b7ffbd7e JB |
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 | ||
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 | ||
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; | |
73887fd9 | 77 | struct station_info sinfo; |
b7ffbd7e JB |
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 | ||
e5a9f8d0 JB |
84 | #define ADD_STA_STATS(sta) \ |
85 | do { \ | |
83888346 RL |
86 | data[i++] += sinfo.rx_packets; \ |
87 | data[i++] += sinfo.rx_bytes; \ | |
ce6893e9 JB |
88 | data[i++] += (sta)->rx_stats.num_duplicates; \ |
89 | data[i++] += (sta)->rx_stats.fragments; \ | |
83888346 | 90 | data[i++] += sinfo.rx_dropped_misc; \ |
e5a9f8d0 | 91 | \ |
73887fd9 JB |
92 | data[i++] += sinfo.tx_packets; \ |
93 | data[i++] += sinfo.tx_bytes; \ | |
ce6893e9 | 94 | data[i++] += (sta)->status_stats.filtered; \ |
83888346 RL |
95 | data[i++] += sinfo.tx_failed; \ |
96 | data[i++] += sinfo.tx_retries; \ | |
b7ffbd7e JB |
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) { | |
bfd8403a | 108 | sta = sta_info_get_bss(sdata, sdata->deflink.u.mgd.bssid); |
b7ffbd7e JB |
109 | |
110 | if (!(sta && !WARN_ON(sta->sdata->dev != dev))) | |
111 | goto do_survey; | |
112 | ||
73887fd9 | 113 | memset(&sinfo, 0, sizeof(sinfo)); |
0fdf1493 | 114 | sta_set_sinfo(sta, &sinfo, false); |
b7ffbd7e JB |
115 | |
116 | i = 0; | |
ce6893e9 | 117 | ADD_STA_STATS(&sta->deflink); |
b7ffbd7e JB |
118 | |
119 | data[i++] = sta->sta_state; | |
120 | ||
121 | ||
a4217750 | 122 | if (sinfo.filled & BIT_ULL(NL80211_STA_INFO_TX_BITRATE)) |
57c6cb81 | 123 | data[i] = 100000ULL * |
73887fd9 | 124 | cfg80211_calculate_bitrate(&sinfo.txrate); |
b7ffbd7e | 125 | i++; |
a4217750 | 126 | if (sinfo.filled & BIT_ULL(NL80211_STA_INFO_RX_BITRATE)) |
57c6cb81 | 127 | data[i] = 100000ULL * |
73887fd9 | 128 | cfg80211_calculate_bitrate(&sinfo.rxrate); |
b7ffbd7e JB |
129 | i++; |
130 | ||
a4217750 | 131 | if (sinfo.filled & BIT_ULL(NL80211_STA_INFO_SIGNAL_AVG)) |
73887fd9 | 132 | data[i] = (u8)sinfo.signal_avg; |
b7ffbd7e JB |
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 | ||
73887fd9 | 140 | memset(&sinfo, 0, sizeof(sinfo)); |
0fdf1493 | 141 | sta_set_sinfo(sta, &sinfo, false); |
b7ffbd7e | 142 | i = 0; |
ce6893e9 | 143 | ADD_STA_STATS(&sta->deflink); |
b7ffbd7e JB |
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(); | |
d0a9123e | 153 | chanctx_conf = rcu_dereference(sdata->vif.bss_conf.chanctx_conf); |
b7ffbd7e JB |
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; | |
4ed20beb JB |
180 | if (survey.filled & SURVEY_INFO_TIME) |
181 | data[i++] = survey.time; | |
b7ffbd7e JB |
182 | else |
183 | data[i++] = -1LL; | |
4ed20beb JB |
184 | if (survey.filled & SURVEY_INFO_TIME_BUSY) |
185 | data[i++] = survey.time_busy; | |
b7ffbd7e JB |
186 | else |
187 | data[i++] = -1LL; | |
4ed20beb JB |
188 | if (survey.filled & SURVEY_INFO_TIME_EXT_BUSY) |
189 | data[i++] = survey.time_ext_busy; | |
b7ffbd7e JB |
190 | else |
191 | data[i++] = -1LL; | |
4ed20beb JB |
192 | if (survey.filled & SURVEY_INFO_TIME_RX) |
193 | data[i++] = survey.time_rx; | |
b7ffbd7e JB |
194 | else |
195 | data[i++] = -1LL; | |
4ed20beb JB |
196 | if (survey.filled & SURVEY_INFO_TIME_TX) |
197 | data[i++] = survey.time_tx; | |
b7ffbd7e JB |
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 | ||
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 | ||
221 | static int ieee80211_get_regs_len(struct net_device *dev) | |
222 | { | |
223 | return 0; | |
224 | } | |
225 | ||
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 | }; |