]> git.ipfire.org Git - thirdparty/iw.git/blob - mesh.c
add a few new commands/events
[thirdparty/iw.git] / mesh.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(mesh);
15
16
17 typedef struct _any_t {
18 union {
19 uint32_t as_32;
20 int32_t as_s32;
21 uint16_t as_16;
22 uint8_t as_8;
23 } u;
24 } _any;
25
26 /* describes a mesh parameter */
27 struct mesh_param_descr {
28 const char *name;
29 enum nl80211_meshconf_params mesh_param_num;
30 int (*nla_put_fn)(struct nl_msg*, int, _any*);
31 uint32_t (*parse_fn)(const char*, _any*);
32 void (*nla_print_fn)(struct nlattr *);
33 };
34
35 /* utility functions for manipulating and printing u8/u16/u32 values and
36 * timesouts. */
37 static int _my_nla_put_u8(struct nl_msg *n, int mesh_param_num, _any *value)
38 {
39 return nla_put(n, mesh_param_num, sizeof(uint8_t), &value->u.as_8);
40 }
41
42 static int _my_nla_put_u16(struct nl_msg *n, int mesh_param_num, _any *value)
43 {
44 return nla_put(n, mesh_param_num, sizeof(uint16_t), &value->u.as_16);
45 }
46
47 static int _my_nla_put_u32(struct nl_msg *n, int mesh_param_num, _any *value)
48 {
49 return nla_put(n, mesh_param_num, sizeof(uint32_t), &value->u.as_32);
50 }
51
52 static uint32_t _parse_u8(const char *str, _any *ret)
53 {
54 char *endptr = NULL;
55 unsigned long int v = strtoul(str, &endptr, 10);
56 if (*endptr != '\0')
57 return 0xff;
58 if (v > 0xff)
59 return 0xff;
60 ret->u.as_8 = (uint8_t)v;
61 return 0;
62 }
63
64 static uint32_t _parse_u8_as_bool(const char *str, _any *ret)
65 {
66 char *endptr = NULL;
67 unsigned long int v = strtoul(str, &endptr, 10);
68 if (*endptr != '\0')
69 return 0x1;
70 if (v > 0x1)
71 return 0x1;
72 ret->u.as_8 = (uint8_t)v;
73 return 0;
74 }
75
76 static uint32_t _parse_u16(const char *str, _any *ret)
77 {
78 char *endptr = NULL;
79 long int v = strtol(str, &endptr, 10);
80 if (*endptr != '\0')
81 return 0xffff;
82 if ((v < 0) || (v > 0xffff))
83 return 0xffff;
84 ret->u.as_16 = (uint16_t)v;
85 return 0;
86 }
87
88 static uint32_t _parse_u32(const char *str, _any *ret)
89 {
90 char *endptr = NULL;
91 long long int v = strtoll(str, &endptr, 10);
92 if (*endptr != '\0')
93 return 0xffffffff;
94 if ((v < 0) || (v > 0xffffffff))
95 return 0xffffffff;
96 ret->u.as_32 = (uint32_t)v;
97 return 0;
98 }
99
100 static uint32_t _parse_s32(const char *str, _any *ret)
101 {
102 char *endptr = NULL;
103 long int v = strtol(str, &endptr, 10);
104 if (*endptr != '\0')
105 return 0xffffffff;
106 if (v > 0xff)
107 return 0xffffffff;
108 ret->u.as_s32 = (int32_t)v;
109 return 0;
110 }
111
112 static uint32_t _parse_u32_power_mode(const char *str, _any *ret)
113 {
114 unsigned long int v;
115
116 /* Parse attribute for the name of power mode */
117 if (!strcmp(str, "active"))
118 v = NL80211_MESH_POWER_ACTIVE;
119 else if (!strcmp(str, "light"))
120 v = NL80211_MESH_POWER_LIGHT_SLEEP;
121 else if (!strcmp(str, "deep"))
122 v = NL80211_MESH_POWER_DEEP_SLEEP;
123 else
124 return 0xff;
125
126 ret->u.as_32 = (uint32_t)v;
127 return 0;
128 }
129
130 static void _print_u8(struct nlattr *a)
131 {
132 printf("%d", nla_get_u8(a));
133 }
134
135 static void _print_u16(struct nlattr *a)
136 {
137 printf("%d", nla_get_u16(a));
138 }
139
140 static void _print_u16_timeout(struct nlattr *a)
141 {
142 printf("%d milliseconds", nla_get_u16(a));
143 }
144
145 static void _print_u16_in_TUs(struct nlattr *a)
146 {
147 printf("%d TUs", nla_get_u16(a));
148 }
149
150 static void _print_u32(struct nlattr *a)
151 {
152 printf("%d", nla_get_u32(a));
153 }
154
155 static void _print_u32_timeout(struct nlattr *a)
156 {
157 printf("%u milliseconds", nla_get_u32(a));
158 }
159
160 static void _print_u32_in_seconds(struct nlattr *a)
161 {
162 printf("%d seconds", nla_get_u32(a));
163 }
164
165 static void _print_u32_in_TUs(struct nlattr *a)
166 {
167 printf("%d TUs", nla_get_u32(a));
168 }
169
170 static void _print_u32_power_mode(struct nlattr *a)
171 {
172 unsigned long v = nla_get_u32(a);
173
174 switch (v) {
175 case NL80211_MESH_POWER_ACTIVE:
176 printf("active");
177 break;
178 case NL80211_MESH_POWER_LIGHT_SLEEP:
179 printf("light");
180 break;
181 case NL80211_MESH_POWER_DEEP_SLEEP:
182 printf("deep");
183 break;
184 default:
185 printf("undefined");
186 break;
187 }
188 }
189
190 static void _print_s32_in_dBm(struct nlattr *a)
191 {
192 printf("%d dBm", (int32_t) nla_get_u32(a));
193 }
194
195
196 /* The current mesh parameters */
197 const static struct mesh_param_descr _mesh_param_descrs[] =
198 {
199 {"mesh_retry_timeout",
200 NL80211_MESHCONF_RETRY_TIMEOUT,
201 _my_nla_put_u16, _parse_u16, _print_u16_timeout},
202 {"mesh_confirm_timeout",
203 NL80211_MESHCONF_CONFIRM_TIMEOUT,
204 _my_nla_put_u16, _parse_u16, _print_u16_timeout},
205 {"mesh_holding_timeout",
206 NL80211_MESHCONF_HOLDING_TIMEOUT,
207 _my_nla_put_u16, _parse_u16, _print_u16_timeout},
208 {"mesh_max_peer_links",
209 NL80211_MESHCONF_MAX_PEER_LINKS,
210 _my_nla_put_u16, _parse_u16, _print_u16},
211 {"mesh_max_retries",
212 NL80211_MESHCONF_MAX_RETRIES,
213 _my_nla_put_u8, _parse_u8, _print_u8},
214 {"mesh_ttl",
215 NL80211_MESHCONF_TTL,
216 _my_nla_put_u8, _parse_u8, _print_u8},
217 {"mesh_element_ttl",
218 NL80211_MESHCONF_ELEMENT_TTL,
219 _my_nla_put_u8, _parse_u8, _print_u8},
220 {"mesh_auto_open_plinks",
221 NL80211_MESHCONF_AUTO_OPEN_PLINKS,
222 _my_nla_put_u8, _parse_u8_as_bool, _print_u8},
223 {"mesh_hwmp_max_preq_retries",
224 NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
225 _my_nla_put_u8, _parse_u8, _print_u8},
226 {"mesh_path_refresh_time",
227 NL80211_MESHCONF_PATH_REFRESH_TIME,
228 _my_nla_put_u32, _parse_u32, _print_u32_timeout},
229 {"mesh_min_discovery_timeout",
230 NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
231 _my_nla_put_u16, _parse_u16, _print_u16_timeout},
232 {"mesh_hwmp_active_path_timeout",
233 NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
234 _my_nla_put_u32, _parse_u32, _print_u32_in_TUs},
235 {"mesh_hwmp_preq_min_interval",
236 NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
237 _my_nla_put_u16, _parse_u16, _print_u16_in_TUs},
238 {"mesh_hwmp_net_diameter_traversal_time",
239 NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
240 _my_nla_put_u16, _parse_u16, _print_u16_in_TUs},
241 {"mesh_hwmp_rootmode", NL80211_MESHCONF_HWMP_ROOTMODE,
242 _my_nla_put_u8, _parse_u8, _print_u8},
243 {"mesh_hwmp_rann_interval", NL80211_MESHCONF_HWMP_RANN_INTERVAL,
244 _my_nla_put_u16, _parse_u16, _print_u16_in_TUs},
245 {"mesh_gate_announcements", NL80211_MESHCONF_GATE_ANNOUNCEMENTS,
246 _my_nla_put_u8, _parse_u8, _print_u8},
247 {"mesh_fwding", NL80211_MESHCONF_FORWARDING,
248 _my_nla_put_u8, _parse_u8_as_bool, _print_u8},
249 {"mesh_sync_offset_max_neighor",
250 NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR,
251 _my_nla_put_u32, _parse_u32, _print_u32},
252 {"mesh_rssi_threshold", NL80211_MESHCONF_RSSI_THRESHOLD,
253 _my_nla_put_u32, _parse_s32, _print_s32_in_dBm},
254 {"mesh_hwmp_active_path_to_root_timeout",
255 NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT,
256 _my_nla_put_u32, _parse_u32, _print_u32_in_TUs},
257 {"mesh_hwmp_root_interval", NL80211_MESHCONF_HWMP_ROOT_INTERVAL,
258 _my_nla_put_u16, _parse_u16, _print_u16_in_TUs},
259 {"mesh_hwmp_confirmation_interval",
260 NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL,
261 _my_nla_put_u16, _parse_u16, _print_u16_in_TUs},
262 {"mesh_power_mode", NL80211_MESHCONF_POWER_MODE,
263 _my_nla_put_u32, _parse_u32_power_mode, _print_u32_power_mode},
264 {"mesh_awake_window", NL80211_MESHCONF_AWAKE_WINDOW,
265 _my_nla_put_u16, _parse_u16, _print_u16_in_TUs},
266 {"mesh_plink_timeout", NL80211_MESHCONF_PLINK_TIMEOUT,
267 _my_nla_put_u32, _parse_u32, _print_u32_in_seconds},
268 };
269
270 static void print_all_mesh_param_descr(void)
271 {
272 int i;
273
274 printf("Possible mesh parameters are:\n");
275
276 for (i = 0; i < ARRAY_SIZE(_mesh_param_descrs); i++)
277 printf(" - %s\n", _mesh_param_descrs[i].name);
278 }
279
280 static const struct mesh_param_descr *find_mesh_param(const char *name)
281 {
282 int i;
283
284 /* Find out what mesh parameter we want to change. */
285 for (i = 0; i < ARRAY_SIZE(_mesh_param_descrs); i++) {
286 if (strcmp(_mesh_param_descrs[i].name, name) == 0)
287 return _mesh_param_descrs + i;
288 }
289
290 print_all_mesh_param_descr();
291 return NULL;
292 }
293
294 /* Setter */
295 static int set_interface_meshparam(struct nl80211_state *state,
296 struct nl_msg *msg,
297 int argc, char **argv,
298 enum id_input id)
299 {
300 const struct mesh_param_descr *mdescr;
301 struct nlattr *container;
302 uint32_t ret;
303 int err;
304
305 container = nla_nest_start(msg, NL80211_ATTR_MESH_PARAMS);
306 if (!container)
307 return -ENOBUFS;
308
309 if (!argc)
310 return 1;
311
312 while (argc) {
313 const char *name;
314 char *value;
315 _any any;
316
317 memset(&any, 0, sizeof(_any));
318
319 name = argv[0];
320 value = strchr(name, '=');
321 if (value) {
322 *value = '\0';
323 value++;
324 argc--;
325 argv++;
326 } else {
327 /* backward compat -- accept w/o '=' */
328 if (argc < 2) {
329 printf("Must specify a value for %s.\n", name);
330 return 2;
331 }
332 value = argv[1];
333 argc -= 2;
334 argv += 2;
335 }
336
337 mdescr = find_mesh_param(name);
338 if (!mdescr)
339 return 2;
340
341 /* Parse the new value */
342 ret = mdescr->parse_fn(value, &any);
343 if (ret != 0) {
344 if (mdescr->mesh_param_num
345 == NL80211_MESHCONF_POWER_MODE)
346 printf("%s must be set to active, light or "
347 "deep.\n", mdescr->name);
348 else
349 printf("%s must be set to a number "
350 "between 0 and %u\n",
351 mdescr->name, ret);
352
353 return 2;
354 }
355
356 err = mdescr->nla_put_fn(msg, mdescr->mesh_param_num, &any);
357 if (err)
358 return err;
359 }
360 nla_nest_end(msg, container);
361
362 return err;
363 }
364
365 COMMAND(set, mesh_param, "<param>=<value> [<param>=<value>]*",
366 NL80211_CMD_SET_MESH_PARAMS, 0, CIB_NETDEV, set_interface_meshparam,
367 "Set mesh parameter (run command without any to see available ones).");
368
369 /* Getter */
370 static int print_mesh_param_handler(struct nl_msg *msg, void *arg)
371 {
372 const struct mesh_param_descr *mdescr = arg;
373 struct nlattr *attrs[NL80211_ATTR_MAX + 1];
374 struct nlattr *parent_attr;
375 struct nlattr *mesh_params[NL80211_MESHCONF_ATTR_MAX + 1];
376 struct genlmsghdr *gnlh = nlmsg_data(nlmsg_hdr(msg));
377
378 /* locate NL80211_ATTR_MESH_PARAMS */
379 nla_parse(attrs, NL80211_ATTR_MAX, genlmsg_attrdata(gnlh, 0),
380 genlmsg_attrlen(gnlh, 0), NULL);
381 parent_attr = attrs[NL80211_ATTR_MESH_PARAMS];
382 if (!parent_attr)
383 return -EINVAL;
384
385 /* unpack the mesh parameters */
386 if (nla_parse_nested(mesh_params, NL80211_MESHCONF_ATTR_MAX,
387 parent_attr, NULL))
388 return -EINVAL;
389
390 if (!mdescr) {
391 int i;
392
393 for (i = 0; i < ARRAY_SIZE(_mesh_param_descrs); i++) {
394 mdescr = &_mesh_param_descrs[i];
395 printf("%s = ", mdescr->name);
396 mdescr->nla_print_fn(mesh_params[mdescr->mesh_param_num]);
397 printf("\n");
398 }
399 return NL_SKIP;
400 }
401
402 /* print out the mesh parameter */
403 mdescr->nla_print_fn(mesh_params[mdescr->mesh_param_num]);
404 printf("\n");
405 return NL_SKIP;
406 }
407
408 static int get_interface_meshparam(struct nl80211_state *state,
409 struct nl_msg *msg,
410 int argc, char **argv,
411 enum id_input id)
412 {
413 const struct mesh_param_descr *mdescr = NULL;
414
415 if (argc > 1)
416 return 1;
417
418 if (argc == 1) {
419 mdescr = find_mesh_param(argv[0]);
420 if (!mdescr)
421 return 2;
422 }
423
424 register_handler(print_mesh_param_handler, (void *)mdescr);
425 return 0;
426 }
427
428 COMMAND(get, mesh_param, "[<param>]",
429 NL80211_CMD_GET_MESH_PARAMS, 0, CIB_NETDEV, get_interface_meshparam,
430 "Retrieve mesh parameter (run command without any to see available ones).");
431
432 static int join_mesh(struct nl80211_state *state,
433 struct nl_msg *msg, int argc, char **argv,
434 enum id_input id)
435 {
436 struct nlattr *container;
437 float rate;
438 unsigned char rates[NL80211_MAX_SUPP_RATES];
439 int bintval, dtim_period, i, n_rates = 0;
440 char *end, *value = NULL, *sptr = NULL;
441 unsigned long freq = 0;
442 static const struct {
443 const char *name;
444 unsigned int width;
445 int freq1_diff;
446 int chantype; /* for older kernel */
447 } *chanmode_selected = NULL, chanmode[] = {
448 { .name = "HT20",
449 .width = NL80211_CHAN_WIDTH_20,
450 .freq1_diff = 0,
451 .chantype = NL80211_CHAN_HT20 },
452 { .name = "HT40+",
453 .width = NL80211_CHAN_WIDTH_40,
454 .freq1_diff = 10,
455 .chantype = NL80211_CHAN_HT40PLUS },
456 { .name = "HT40-",
457 .width = NL80211_CHAN_WIDTH_40,
458 .freq1_diff = -10,
459 .chantype = NL80211_CHAN_HT40MINUS },
460 { .name = "NOHT",
461 .width = NL80211_CHAN_WIDTH_20_NOHT,
462 .freq1_diff = 0,
463 .chantype = NL80211_CHAN_NO_HT },
464 };
465
466 if (argc < 1)
467 return 1;
468
469 NLA_PUT(msg, NL80211_ATTR_MESH_ID, strlen(argv[0]), argv[0]);
470 argc--;
471 argv++;
472
473 /* freq */
474 if (argc > 1 && strcmp(argv[0], "freq") == 0) {
475 argv++;
476 argc--;
477
478 freq = strtoul(argv[0], &end, 10);
479 if (*end != '\0')
480 return 1;
481 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY_FREQ, freq);
482
483 argv++;
484 argc--;
485 }
486
487 /* channel type */
488 if (argc) {
489 for (i = 0; i < ARRAY_SIZE(chanmode); i++) {
490 if (strcasecmp(chanmode[i].name, argv[0]) == 0) {
491 chanmode_selected = &chanmode[i];
492 break;
493 }
494 }
495
496 if (chanmode_selected) {
497 NLA_PUT_U32(msg, NL80211_ATTR_CHANNEL_WIDTH,
498 chanmode_selected->width);
499 NLA_PUT_U32(msg, NL80211_ATTR_CENTER_FREQ1,
500 freq + chanmode_selected->freq1_diff);
501 if (chanmode_selected->chantype != -1)
502 NLA_PUT_U32(msg,
503 NL80211_ATTR_WIPHY_CHANNEL_TYPE,
504 chanmode_selected->chantype);
505
506 argv++;
507 argc--;
508 }
509 }
510
511 /* basic rates */
512 if (argc > 1 && strcmp(argv[0], "basic-rates") == 0) {
513 argv++;
514 argc--;
515
516 value = strtok_r(argv[0], ",", &sptr);
517
518 while (value && n_rates < NL80211_MAX_SUPP_RATES) {
519 rate = strtod(value, &end);
520 rates[n_rates] = rate * 2;
521
522 /* filter out suspicious values */
523 if (*end != '\0' || !rates[n_rates] ||
524 rate*2 != rates[n_rates])
525 return 1;
526
527 n_rates++;
528 value = strtok_r(NULL, ",", &sptr);
529 }
530
531 NLA_PUT(msg, NL80211_ATTR_BSS_BASIC_RATES, n_rates, rates);
532 argv++;
533 argc--;
534 }
535
536 /* multicast rate */
537 if (argc > 1 && strcmp(argv[0], "mcast-rate") == 0) {
538 argv++;
539 argc--;
540
541 rate = strtod(argv[0], &end);
542 if (*end != '\0')
543 return 1;
544
545 NLA_PUT_U32(msg, NL80211_ATTR_MCAST_RATE, (int)(rate * 10));
546 argv++;
547 argc--;
548 }
549
550 if (argc > 1 && strcmp(argv[0], "beacon-interval") == 0) {
551 argc--;
552 argv++;
553
554 bintval = strtoul(argv[0], &end, 10);
555 if (*end != '\0')
556 return 1;
557
558 NLA_PUT_U32(msg, NL80211_ATTR_BEACON_INTERVAL, bintval);
559 argv++;
560 argc--;
561 }
562
563 if (argc > 1 && strcmp(argv[0], "dtim-period") == 0) {
564 argc--;
565 argv++;
566
567 dtim_period = strtoul(argv[0], &end, 10);
568 if (*end != '\0')
569 return 1;
570
571 NLA_PUT_U32(msg, NL80211_ATTR_DTIM_PERIOD, dtim_period);
572 argv++;
573 argc--;
574 }
575
576 container = nla_nest_start(msg, NL80211_ATTR_MESH_SETUP);
577 if (!container)
578 return -ENOBUFS;
579
580 if (argc > 1 && strcmp(argv[0], "vendor_sync") == 0) {
581 argv++;
582 argc--;
583 if (strcmp(argv[0], "on") == 0)
584 NLA_PUT_U8(msg,
585 NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC, 1);
586 else
587 NLA_PUT_U8(msg,
588 NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC, 0);
589 argv++;
590 argc--;
591 }
592 /* parse and put other NL80211_ATTR_MESH_SETUP elements here */
593
594 nla_nest_end(msg, container);
595
596 if (!argc)
597 return 0;
598 return set_interface_meshparam(state, msg, argc, argv, id);
599 nla_put_failure:
600 return -ENOBUFS;
601 }
602 COMMAND(mesh, join, "<mesh ID> [[freq <freq in MHz> <HT20|HT40+|HT40-|NOHT>]"
603 " [basic-rates <rate in Mbps,rate2,...>]], [mcast-rate <rate in Mbps>]"
604 " [beacon-interval <time in TUs>] [dtim-period <value>]"
605 " [vendor_sync on|off] [<param>=<value>]*",
606 NL80211_CMD_JOIN_MESH, 0, CIB_NETDEV, join_mesh,
607 "Join a mesh with the given mesh ID with frequency, basic-rates,\n"
608 "mcast-rate and mesh parameters. Basic-rates are applied only if\n"
609 "frequency is provided.");
610
611 static int leave_mesh(struct nl80211_state *state,
612 struct nl_msg *msg, int argc, char **argv,
613 enum id_input id)
614 {
615 if (argc)
616 return 1;
617
618 return 0;
619 }
620 COMMAND(mesh, leave, NULL, NL80211_CMD_LEAVE_MESH, 0, CIB_NETDEV, leave_mesh,
621 "Leave a mesh.");