]> git.ipfire.org Git - thirdparty/iw.git/blob - station.c
Prefer 32-bit bitrate
[thirdparty/iw.git] / station.c
1 #include <net/if.h>
2 #include <errno.h>
3 #include <string.h>
4
5 #include <netlink/genl/genl.h>
6 #include <netlink/genl/family.h>
7 #include <netlink/genl/ctrl.h>
8 #include <netlink/msg.h>
9 #include <netlink/attr.h>
10
11 #include "nl80211.h"
12 #include "iw.h"
13
14 SECTION(station);
15
16 enum plink_state {
17 LISTEN,
18 OPN_SNT,
19 OPN_RCVD,
20 CNF_RCVD,
21 ESTAB,
22 HOLDING,
23 BLOCKED
24 };
25
26 enum plink_actions {
27 PLINK_ACTION_UNDEFINED,
28 PLINK_ACTION_OPEN,
29 PLINK_ACTION_BLOCK,
30 };
31
32
33 static int print_sta_handler(struct nl_msg *msg, void *arg)
34 {
35 struct nlattr *tb[NL80211_ATTR_MAX + 1];
36 struct genlmsghdr *gnlh = nlmsg_data(nlmsg_hdr(msg));
37 struct nlattr *sinfo[NL80211_STA_INFO_MAX + 1];
38 struct nlattr *rinfo[NL80211_RATE_INFO_MAX + 1];
39 char mac_addr[20], state_name[10], dev[20];
40 struct nl80211_sta_flag_update *sta_flags;
41 static struct nla_policy stats_policy[NL80211_STA_INFO_MAX + 1] = {
42 [NL80211_STA_INFO_INACTIVE_TIME] = { .type = NLA_U32 },
43 [NL80211_STA_INFO_RX_BYTES] = { .type = NLA_U32 },
44 [NL80211_STA_INFO_TX_BYTES] = { .type = NLA_U32 },
45 [NL80211_STA_INFO_RX_PACKETS] = { .type = NLA_U32 },
46 [NL80211_STA_INFO_TX_PACKETS] = { .type = NLA_U32 },
47 [NL80211_STA_INFO_SIGNAL] = { .type = NLA_U8 },
48 [NL80211_STA_INFO_T_OFFSET] = { .type = NLA_U64 },
49 [NL80211_STA_INFO_TX_BITRATE] = { .type = NLA_NESTED },
50 [NL80211_STA_INFO_LLID] = { .type = NLA_U16 },
51 [NL80211_STA_INFO_PLID] = { .type = NLA_U16 },
52 [NL80211_STA_INFO_PLINK_STATE] = { .type = NLA_U8 },
53 [NL80211_STA_INFO_TX_RETRIES] = { .type = NLA_U32 },
54 [NL80211_STA_INFO_TX_FAILED] = { .type = NLA_U32 },
55 [NL80211_STA_INFO_STA_FLAGS] =
56 { .minlen = sizeof(struct nl80211_sta_flag_update) },
57 };
58
59 static struct nla_policy rate_policy[NL80211_RATE_INFO_MAX + 1] = {
60 [NL80211_RATE_INFO_BITRATE] = { .type = NLA_U16 },
61 [NL80211_RATE_INFO_BITRATE32] = { .type = NLA_U32 },
62 [NL80211_RATE_INFO_MCS] = { .type = NLA_U8 },
63 [NL80211_RATE_INFO_40_MHZ_WIDTH] = { .type = NLA_FLAG },
64 [NL80211_RATE_INFO_SHORT_GI] = { .type = NLA_FLAG },
65 };
66
67 nla_parse(tb, NL80211_ATTR_MAX, genlmsg_attrdata(gnlh, 0),
68 genlmsg_attrlen(gnlh, 0), NULL);
69
70 /*
71 * TODO: validate the interface and mac address!
72 * Otherwise, there's a race condition as soon as
73 * the kernel starts sending station notifications.
74 */
75
76 if (!tb[NL80211_ATTR_STA_INFO]) {
77 fprintf(stderr, "sta stats missing!\n");
78 return NL_SKIP;
79 }
80 if (nla_parse_nested(sinfo, NL80211_STA_INFO_MAX,
81 tb[NL80211_ATTR_STA_INFO],
82 stats_policy)) {
83 fprintf(stderr, "failed to parse nested attributes!\n");
84 return NL_SKIP;
85 }
86
87 mac_addr_n2a(mac_addr, nla_data(tb[NL80211_ATTR_MAC]));
88 if_indextoname(nla_get_u32(tb[NL80211_ATTR_IFINDEX]), dev);
89 printf("Station %s (on %s)", mac_addr, dev);
90
91 if (sinfo[NL80211_STA_INFO_INACTIVE_TIME])
92 printf("\n\tinactive time:\t%u ms",
93 nla_get_u32(sinfo[NL80211_STA_INFO_INACTIVE_TIME]));
94 if (sinfo[NL80211_STA_INFO_RX_BYTES])
95 printf("\n\trx bytes:\t%u",
96 nla_get_u32(sinfo[NL80211_STA_INFO_RX_BYTES]));
97 if (sinfo[NL80211_STA_INFO_RX_PACKETS])
98 printf("\n\trx packets:\t%u",
99 nla_get_u32(sinfo[NL80211_STA_INFO_RX_PACKETS]));
100 if (sinfo[NL80211_STA_INFO_TX_BYTES])
101 printf("\n\ttx bytes:\t%u",
102 nla_get_u32(sinfo[NL80211_STA_INFO_TX_BYTES]));
103 if (sinfo[NL80211_STA_INFO_TX_PACKETS])
104 printf("\n\ttx packets:\t%u",
105 nla_get_u32(sinfo[NL80211_STA_INFO_TX_PACKETS]));
106 if (sinfo[NL80211_STA_INFO_TX_RETRIES])
107 printf("\n\ttx retries:\t%u",
108 nla_get_u32(sinfo[NL80211_STA_INFO_TX_RETRIES]));
109 if (sinfo[NL80211_STA_INFO_TX_FAILED])
110 printf("\n\ttx failed:\t%u",
111 nla_get_u32(sinfo[NL80211_STA_INFO_TX_FAILED]));
112 if (sinfo[NL80211_STA_INFO_SIGNAL])
113 printf("\n\tsignal: \t%d dBm",
114 (int8_t)nla_get_u8(sinfo[NL80211_STA_INFO_SIGNAL]));
115 if (sinfo[NL80211_STA_INFO_SIGNAL_AVG])
116 printf("\n\tsignal avg:\t%d dBm",
117 (int8_t)nla_get_u8(sinfo[NL80211_STA_INFO_SIGNAL_AVG]));
118 if (sinfo[NL80211_STA_INFO_T_OFFSET])
119 printf("\n\tToffset:\t%lld us",
120 (unsigned long long)nla_get_u64(sinfo[NL80211_STA_INFO_T_OFFSET]));
121
122 if (sinfo[NL80211_STA_INFO_TX_BITRATE]) {
123 if (nla_parse_nested(rinfo, NL80211_RATE_INFO_MAX,
124 sinfo[NL80211_STA_INFO_TX_BITRATE], rate_policy)) {
125 fprintf(stderr, "failed to parse nested rate attributes!\n");
126 } else {
127 int rate = 0;
128 printf("\n\ttx bitrate:\t");
129 if (rinfo[NL80211_RATE_INFO_BITRATE32])
130 rate = nla_get_u32(rinfo[NL80211_RATE_INFO_BITRATE32]);
131 else if (rinfo[NL80211_RATE_INFO_BITRATE])
132 rate = nla_get_u16(rinfo[NL80211_RATE_INFO_BITRATE]);
133 if (rate > 0)
134 printf("%d.%d MBit/s", rate / 10, rate % 10);
135
136 if (rinfo[NL80211_RATE_INFO_MCS])
137 printf(" MCS %d", nla_get_u8(rinfo[NL80211_RATE_INFO_MCS]));
138 if (rinfo[NL80211_RATE_INFO_40_MHZ_WIDTH])
139 printf(" 40Mhz");
140 if (rinfo[NL80211_RATE_INFO_SHORT_GI])
141 printf(" short GI");
142 }
143 }
144
145 if (sinfo[NL80211_STA_INFO_LLID])
146 printf("\n\tmesh llid:\t%d",
147 nla_get_u16(sinfo[NL80211_STA_INFO_LLID]));
148 if (sinfo[NL80211_STA_INFO_PLID])
149 printf("\n\tmesh plid:\t%d",
150 nla_get_u16(sinfo[NL80211_STA_INFO_PLID]));
151 if (sinfo[NL80211_STA_INFO_PLINK_STATE]) {
152 switch (nla_get_u8(sinfo[NL80211_STA_INFO_PLINK_STATE])) {
153 case LISTEN:
154 strcpy(state_name, "LISTEN");
155 break;
156 case OPN_SNT:
157 strcpy(state_name, "OPN_SNT");
158 break;
159 case OPN_RCVD:
160 strcpy(state_name, "OPN_RCVD");
161 break;
162 case CNF_RCVD:
163 strcpy(state_name, "CNF_RCVD");
164 break;
165 case ESTAB:
166 strcpy(state_name, "ESTAB");
167 break;
168 case HOLDING:
169 strcpy(state_name, "HOLDING");
170 break;
171 case BLOCKED:
172 strcpy(state_name, "BLOCKED");
173 break;
174 default:
175 strcpy(state_name, "UNKNOWN");
176 break;
177 }
178 printf("\n\tmesh plink:\t%s", state_name);
179 }
180
181 if (sinfo[NL80211_STA_INFO_STA_FLAGS]) {
182 sta_flags = (struct nl80211_sta_flag_update *)
183 nla_data(sinfo[NL80211_STA_INFO_STA_FLAGS]);
184
185 if (sta_flags->mask & BIT(NL80211_STA_FLAG_AUTHORIZED)) {
186 printf("\n\tauthorized:\t");
187 if (sta_flags->set & BIT(NL80211_STA_FLAG_AUTHORIZED))
188 printf("yes");
189 else
190 printf("no");
191 }
192
193 if (sta_flags->mask & BIT(NL80211_STA_FLAG_AUTHENTICATED)) {
194 printf("\n\tauthenticated:\t");
195 if (sta_flags->set & BIT(NL80211_STA_FLAG_AUTHENTICATED))
196 printf("yes");
197 else
198 printf("no");
199 }
200
201 if (sta_flags->mask & BIT(NL80211_STA_FLAG_SHORT_PREAMBLE)) {
202 printf("\n\tpreamble:\t");
203 if (sta_flags->set & BIT(NL80211_STA_FLAG_SHORT_PREAMBLE))
204 printf("short");
205 else
206 printf("long");
207 }
208
209 if (sta_flags->mask & BIT(NL80211_STA_FLAG_WME)) {
210 printf("\n\tWMM/WME:\t");
211 if (sta_flags->set & BIT(NL80211_STA_FLAG_WME))
212 printf("yes");
213 else
214 printf("no");
215 }
216
217 if (sta_flags->mask & BIT(NL80211_STA_FLAG_MFP)) {
218 printf("\n\tMFP:\t\t");
219 if (sta_flags->set & BIT(NL80211_STA_FLAG_MFP))
220 printf("yes");
221 else
222 printf("no");
223 }
224
225 if (sta_flags->mask & BIT(NL80211_STA_FLAG_TDLS_PEER)) {
226 printf("\n\tTDLS peer:\t\t");
227 if (sta_flags->set & BIT(NL80211_STA_FLAG_TDLS_PEER))
228 printf("yes");
229 else
230 printf("no");
231 }
232 }
233
234 printf("\n");
235 return NL_SKIP;
236 }
237
238 static int handle_station_get(struct nl80211_state *state,
239 struct nl_cb *cb,
240 struct nl_msg *msg,
241 int argc, char **argv)
242 {
243 unsigned char mac_addr[ETH_ALEN];
244
245 if (argc < 1)
246 return 1;
247
248 if (mac_addr_a2n(mac_addr, argv[0])) {
249 fprintf(stderr, "invalid mac address\n");
250 return 2;
251 }
252
253 argc--;
254 argv++;
255
256 if (argc)
257 return 1;
258
259 NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr);
260
261 nl_cb_set(cb, NL_CB_VALID, NL_CB_CUSTOM, print_sta_handler, NULL);
262
263 return 0;
264 nla_put_failure:
265 return -ENOBUFS;
266 }
267 COMMAND(station, get, "<MAC address>",
268 NL80211_CMD_GET_STATION, 0, CIB_NETDEV, handle_station_get,
269 "Get information for a specific station.");
270 COMMAND(station, del, "<MAC address>",
271 NL80211_CMD_DEL_STATION, 0, CIB_NETDEV, handle_station_get,
272 "Remove the given station entry (use with caution!)");
273
274 static const struct cmd *station_set_plink;
275 static const struct cmd *station_set_vlan;
276
277 static const struct cmd *select_station_cmd(int argc, char **argv)
278 {
279 if (argc < 2)
280 return NULL;
281 if (strcmp(argv[1], "plink_action") == 0)
282 return station_set_plink;
283 if (strcmp(argv[1], "vlan") == 0)
284 return station_set_vlan;
285 return NULL;
286 }
287
288 static int handle_station_set_plink(struct nl80211_state *state,
289 struct nl_cb *cb,
290 struct nl_msg *msg,
291 int argc, char **argv)
292 {
293 unsigned char plink_action;
294 unsigned char mac_addr[ETH_ALEN];
295
296 if (argc < 3)
297 return 1;
298
299 if (mac_addr_a2n(mac_addr, argv[0])) {
300 fprintf(stderr, "invalid mac address\n");
301 return 2;
302 }
303 argc--;
304 argv++;
305
306 if (strcmp("plink_action", argv[0]) != 0)
307 return 1;
308 argc--;
309 argv++;
310
311 if (strcmp("open", argv[0]) == 0)
312 plink_action = PLINK_ACTION_OPEN;
313 else if (strcmp("block", argv[0]) == 0)
314 plink_action = PLINK_ACTION_BLOCK;
315 else {
316 fprintf(stderr, "plink action not supported\n");
317 return 2;
318 }
319 argc--;
320 argv++;
321
322 if (argc)
323 return 1;
324
325 NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr);
326 NLA_PUT_U8(msg, NL80211_ATTR_STA_PLINK_ACTION, plink_action);
327
328 return 0;
329 nla_put_failure:
330 return -ENOBUFS;
331 }
332 COMMAND_ALIAS(station, set, "<MAC address> plink_action <open|block>",
333 NL80211_CMD_SET_STATION, 0, CIB_NETDEV, handle_station_set_plink,
334 "Set mesh peer link action for this station (peer).",
335 select_station_cmd, station_set_plink);
336
337 static int handle_station_set_vlan(struct nl80211_state *state,
338 struct nl_cb *cb,
339 struct nl_msg *msg,
340 int argc, char **argv)
341 {
342 unsigned char mac_addr[ETH_ALEN];
343 unsigned long sta_vlan = 0;
344 char *err = NULL;
345
346 if (argc < 3)
347 return 1;
348
349 if (mac_addr_a2n(mac_addr, argv[0])) {
350 fprintf(stderr, "invalid mac address\n");
351 return 2;
352 }
353 argc--;
354 argv++;
355
356 if (strcmp("vlan", argv[0]) != 0)
357 return 1;
358 argc--;
359 argv++;
360
361 sta_vlan = strtoul(argv[0], &err, 0);
362 if (err && *err) {
363 fprintf(stderr, "invalid vlan id\n");
364 return 2;
365 }
366 argc--;
367 argv++;
368
369 if (argc)
370 return 1;
371
372 NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr);
373 NLA_PUT_U32(msg, NL80211_ATTR_STA_VLAN, sta_vlan);
374
375 return 0;
376 nla_put_failure:
377 return -ENOBUFS;
378 }
379 COMMAND_ALIAS(station, set, "<MAC address> vlan <ifindex>",
380 NL80211_CMD_SET_STATION, 0, CIB_NETDEV, handle_station_set_vlan,
381 "Set an AP VLAN for this station.",
382 select_station_cmd, station_set_vlan);
383
384
385 static int handle_station_dump(struct nl80211_state *state,
386 struct nl_cb *cb,
387 struct nl_msg *msg,
388 int argc, char **argv)
389 {
390 nl_cb_set(cb, NL_CB_VALID, NL_CB_CUSTOM, print_sta_handler, NULL);
391 return 0;
392 }
393 COMMAND(station, dump, NULL,
394 NL80211_CMD_GET_STATION, NLM_F_DUMP, CIB_NETDEV, handle_station_dump,
395 "List all stations known, e.g. the AP on managed interfaces");