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