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) | |
bfb27814 | 7 | * Copyright (C) 2018 Intel Corporation |
b7ffbd7e JB |
8 | * |
9 | * This file is GPLv2 as found in COPYING. | |
10 | */ | |
11 | #include <linux/types.h> | |
12 | #include <net/cfg80211.h> | |
13 | #include "ieee80211_i.h" | |
14 | #include "sta_info.h" | |
15 | #include "driver-ops.h" | |
16 | ||
17 | static int ieee80211_set_ringparam(struct net_device *dev, | |
18 | struct ethtool_ringparam *rp) | |
19 | { | |
20 | struct ieee80211_local *local = wiphy_priv(dev->ieee80211_ptr->wiphy); | |
21 | ||
22 | if (rp->rx_mini_pending != 0 || rp->rx_jumbo_pending != 0) | |
23 | return -EINVAL; | |
24 | ||
25 | return drv_set_ringparam(local, rp->tx_pending, rp->rx_pending); | |
26 | } | |
27 | ||
28 | static void ieee80211_get_ringparam(struct net_device *dev, | |
29 | struct ethtool_ringparam *rp) | |
30 | { | |
31 | struct ieee80211_local *local = wiphy_priv(dev->ieee80211_ptr->wiphy); | |
32 | ||
33 | memset(rp, 0, sizeof(*rp)); | |
34 | ||
35 | drv_get_ringparam(local, &rp->tx_pending, &rp->tx_max_pending, | |
36 | &rp->rx_pending, &rp->rx_max_pending); | |
37 | } | |
38 | ||
39 | static const char ieee80211_gstrings_sta_stats[][ETH_GSTRING_LEN] = { | |
40 | "rx_packets", "rx_bytes", | |
41 | "rx_duplicates", "rx_fragments", "rx_dropped", | |
f83f1c12 | 42 | "tx_packets", "tx_bytes", |
b7ffbd7e | 43 | "tx_filtered", "tx_retry_failed", "tx_retries", |
976bd9ef | 44 | "sta_state", "txrate", "rxrate", "signal", |
b7ffbd7e JB |
45 | "channel", "noise", "ch_time", "ch_time_busy", |
46 | "ch_time_ext_busy", "ch_time_rx", "ch_time_tx" | |
47 | }; | |
48 | #define STA_STATS_LEN ARRAY_SIZE(ieee80211_gstrings_sta_stats) | |
49 | ||
50 | static int ieee80211_get_sset_count(struct net_device *dev, int sset) | |
51 | { | |
52 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); | |
53 | int rv = 0; | |
54 | ||
55 | if (sset == ETH_SS_STATS) | |
56 | rv += STA_STATS_LEN; | |
57 | ||
58 | rv += drv_get_et_sset_count(sdata, sset); | |
59 | ||
60 | if (rv == 0) | |
61 | return -EOPNOTSUPP; | |
62 | return rv; | |
63 | } | |
64 | ||
65 | static void ieee80211_get_stats(struct net_device *dev, | |
66 | struct ethtool_stats *stats, | |
67 | u64 *data) | |
68 | { | |
69 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); | |
70 | struct ieee80211_chanctx_conf *chanctx_conf; | |
71 | struct ieee80211_channel *channel; | |
72 | struct sta_info *sta; | |
73 | struct ieee80211_local *local = sdata->local; | |
73887fd9 | 74 | struct station_info sinfo; |
b7ffbd7e JB |
75 | struct survey_info survey; |
76 | int i, q; | |
77 | #define STA_STATS_SURVEY_LEN 7 | |
78 | ||
79 | memset(data, 0, sizeof(u64) * STA_STATS_LEN); | |
80 | ||
e5a9f8d0 JB |
81 | #define ADD_STA_STATS(sta) \ |
82 | do { \ | |
83 | data[i++] += sta->rx_stats.packets; \ | |
84 | data[i++] += sta->rx_stats.bytes; \ | |
85 | data[i++] += sta->rx_stats.num_duplicates; \ | |
86 | data[i++] += sta->rx_stats.fragments; \ | |
87 | data[i++] += sta->rx_stats.dropped; \ | |
88 | \ | |
73887fd9 JB |
89 | data[i++] += sinfo.tx_packets; \ |
90 | data[i++] += sinfo.tx_bytes; \ | |
e5a9f8d0 JB |
91 | data[i++] += sta->status_stats.filtered; \ |
92 | data[i++] += sta->status_stats.retry_failed; \ | |
93 | data[i++] += sta->status_stats.retry_count; \ | |
b7ffbd7e JB |
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 | ||
73887fd9 | 110 | memset(&sinfo, 0, sizeof(sinfo)); |
0fdf1493 | 111 | sta_set_sinfo(sta, &sinfo, false); |
b7ffbd7e JB |
112 | |
113 | i = 0; | |
114 | ADD_STA_STATS(sta); | |
115 | ||
116 | data[i++] = sta->sta_state; | |
117 | ||
118 | ||
a4217750 | 119 | if (sinfo.filled & BIT_ULL(NL80211_STA_INFO_TX_BITRATE)) |
57c6cb81 | 120 | data[i] = 100000ULL * |
73887fd9 | 121 | cfg80211_calculate_bitrate(&sinfo.txrate); |
b7ffbd7e | 122 | i++; |
a4217750 | 123 | if (sinfo.filled & BIT_ULL(NL80211_STA_INFO_RX_BITRATE)) |
57c6cb81 | 124 | data[i] = 100000ULL * |
73887fd9 | 125 | cfg80211_calculate_bitrate(&sinfo.rxrate); |
b7ffbd7e JB |
126 | i++; |
127 | ||
a4217750 | 128 | if (sinfo.filled & BIT_ULL(NL80211_STA_INFO_SIGNAL_AVG)) |
73887fd9 | 129 | data[i] = (u8)sinfo.signal_avg; |
b7ffbd7e JB |
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 | ||
73887fd9 | 137 | memset(&sinfo, 0, sizeof(sinfo)); |
0fdf1493 | 138 | sta_set_sinfo(sta, &sinfo, false); |
b7ffbd7e JB |
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 | }; |