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