]> git.ipfire.org Git - thirdparty/iw.git/blame - mesh.c
iw: add support for 5 and 10 MHz channels in IBSS mode
[thirdparty/iw.git] / mesh.c
CommitLineData
46c1ad1f 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
400efd3e
JB
14SECTION(mesh);
15
16
46c1ad1f 17typedef struct _any_t {
18 union {
19 uint32_t as_32;
be97e513 20 int32_t as_s32;
46c1ad1f 21 uint16_t as_16;
22 uint8_t as_8;
23 } u;
24} _any;
25
26/* describes a mesh parameter */
27struct 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. */
37static 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
42static 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
47static 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
52static 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
64static 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
76static 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
88static 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
be97e513
AN
100static 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
46758fa3
MP
112static 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}
be97e513 129
656aa246 130static void _print_u8(struct nlattr *a)
46c1ad1f 131{
132 printf("%d", nla_get_u8(a));
133}
134
656aa246 135static void _print_u16(struct nlattr *a)
46c1ad1f 136{
137 printf("%d", nla_get_u16(a));
138}
139
656aa246 140static void _print_u16_timeout(struct nlattr *a)
46c1ad1f 141{
142 printf("%d milliseconds", nla_get_u16(a));
143}
144
656aa246 145static void _print_u16_in_TUs(struct nlattr *a)
46c1ad1f 146{
147 printf("%d TUs", nla_get_u16(a));
148}
149
d9f730c4
AN
150static void _print_u32(struct nlattr *a)
151{
152 printf("%d", nla_get_u32(a));
153}
154
656aa246 155static void _print_u32_timeout(struct nlattr *a)
46c1ad1f 156{
157 printf("%u milliseconds", nla_get_u32(a));
158}
159
770f80c9
CT
160static void _print_u32_in_seconds(struct nlattr *a)
161{
162 printf("%d seconds", nla_get_u32(a));
163}
164
656aa246 165static void _print_u32_in_TUs(struct nlattr *a)
46c1ad1f 166{
167 printf("%d TUs", nla_get_u32(a));
168}
169
46758fa3
MP
170static 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
be97e513
AN
190static void _print_s32_in_dBm(struct nlattr *a)
191{
192 printf("%d dBm", (int32_t) nla_get_u32(a));
193}
194
195
46c1ad1f 196/* The current mesh parameters */
197const 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},
247beb99
JB
217 {"mesh_element_ttl",
218 NL80211_MESHCONF_ELEMENT_TTL,
219 _my_nla_put_u8, _parse_u8, _print_u8},
46c1ad1f 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},
cc37218f
RP
241 {"mesh_hwmp_rootmode", NL80211_MESHCONF_HWMP_ROOTMODE,
242 _my_nla_put_u8, _parse_u8, _print_u8},
b9aa711a 243 {"mesh_hwmp_rann_interval", NL80211_MESHCONF_HWMP_RANN_INTERVAL,
b1b5713b 244 _my_nla_put_u16, _parse_u16, _print_u16_in_TUs},
b9aa711a
JC
245 {"mesh_gate_announcements", NL80211_MESHCONF_GATE_ANNOUNCEMENTS,
246 _my_nla_put_u8, _parse_u8, _print_u8},
accd0d23
CYY
247 {"mesh_fwding", NL80211_MESHCONF_FORWARDING,
248 _my_nla_put_u8, _parse_u8_as_bool, _print_u8},
d9f730c4
AN
249 {"mesh_sync_offset_max_neighor",
250 NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR,
251 _my_nla_put_u32, _parse_u32, _print_u32},
be97e513
AN
252 {"mesh_rssi_threshold", NL80211_MESHCONF_RSSI_THRESHOLD,
253 _my_nla_put_u32, _parse_s32, _print_s32_in_dBm},
b1b5713b
CYY
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},
46758fa3
MP
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},
770f80c9
CT
266 {"mesh_plink_timeout", NL80211_MESHCONF_PLINK_TIMEOUT,
267 _my_nla_put_u32, _parse_u32, _print_u32_in_seconds},
46c1ad1f 268};
269
270static void print_all_mesh_param_descr(void)
271{
272 int i;
46c1ad1f 273
f089471a
JB
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);
46c1ad1f 278}
279
a34f62cf 280static const struct mesh_param_descr *find_mesh_param(const char *name)
46c1ad1f 281{
282 int i;
46c1ad1f 283
284 /* Find out what mesh parameter we want to change. */
4d0d2ea7 285 for (i = 0; i < ARRAY_SIZE(_mesh_param_descrs); i++) {
83cb979b 286 if (strcmp(_mesh_param_descrs[i].name, name) == 0)
46c1ad1f 287 return _mesh_param_descrs + i;
4d0d2ea7 288 }
46c1ad1f 289
83cb979b
AN
290 print_all_mesh_param_descr();
291 return NULL;
46c1ad1f 292}
293
294/* Setter */
7c37a24d
JB
295static int set_interface_meshparam(struct nl80211_state *state,
296 struct nl_cb *cb,
297 struct nl_msg *msg,
05514f95
JB
298 int argc, char **argv,
299 enum id_input id)
46c1ad1f 300{
46c1ad1f 301 const struct mesh_param_descr *mdescr;
656aa246 302 struct nlattr *container;
a34f62cf
JB
303 uint32_t ret;
304 int err;
46c1ad1f 305
656aa246 306 container = nla_nest_start(msg, NL80211_ATTR_MESH_PARAMS);
46c1ad1f 307 if (!container)
308 return -ENOBUFS;
a34f62cf
JB
309
310 if (!argc)
311 return 1;
312
313 while (argc) {
314 const char *name;
315 char *value;
316 _any any;
317
318 memset(&any, 0, sizeof(_any));
319
320 name = argv[0];
321 value = strchr(name, '=');
322 if (value) {
323 *value = '\0';
324 value++;
325 argc--;
326 argv++;
327 } else {
328 /* backward compat -- accept w/o '=' */
329 if (argc < 2) {
330 printf("Must specify a value for %s.\n", name);
331 return 2;
332 }
333 value = argv[1];
334 argc -= 2;
335 argv += 2;
336 }
337
338 mdescr = find_mesh_param(name);
339 if (!mdescr)
340 return 2;
341
342 /* Parse the new value */
343 ret = mdescr->parse_fn(value, &any);
344 if (ret != 0) {
46758fa3
MP
345 if (mdescr->mesh_param_num
346 == NL80211_MESHCONF_POWER_MODE)
347 printf("%s must be set to active, light or "
348 "deep.\n", mdescr->name);
349 else
350 printf("%s must be set to a number "
351 "between 0 and %u\n",
352 mdescr->name, ret);
353
a34f62cf
JB
354 return 2;
355 }
356
357 err = mdescr->nla_put_fn(msg, mdescr->mesh_param_num, &any);
358 if (err)
359 return err;
360 }
46c1ad1f 361 nla_nest_end(msg, container);
362
363 return err;
364}
365
a34f62cf 366COMMAND(set, mesh_param, "<param>=<value> [<param>=<value>]*",
70cf4544
JB
367 NL80211_CMD_SET_MESH_PARAMS, 0, CIB_NETDEV, set_interface_meshparam,
368 "Set mesh parameter (run command without any to see available ones).");
46c1ad1f 369
370/* Getter */
371static int print_mesh_param_handler(struct nl_msg *msg, void *arg)
372{
373 const struct mesh_param_descr *mdescr = arg;
374 struct nlattr *attrs[NL80211_ATTR_MAX + 1];
375 struct nlattr *parent_attr;
376 struct nlattr *mesh_params[NL80211_MESHCONF_ATTR_MAX + 1];
377 struct genlmsghdr *gnlh = nlmsg_data(nlmsg_hdr(msg));
378
379 /* locate NL80211_ATTR_MESH_PARAMS */
380 nla_parse(attrs, NL80211_ATTR_MAX, genlmsg_attrdata(gnlh, 0),
381 genlmsg_attrlen(gnlh, 0), NULL);
382 parent_attr = attrs[NL80211_ATTR_MESH_PARAMS];
383 if (!parent_attr)
384 return -EINVAL;
385
386 /* unpack the mesh parameters */
387 if (nla_parse_nested(mesh_params, NL80211_MESHCONF_ATTR_MAX,
97e21372 388 parent_attr, NULL))
46c1ad1f 389 return -EINVAL;
390
97e21372
JB
391 if (!mdescr) {
392 int i;
393
394 for (i = 0; i < ARRAY_SIZE(_mesh_param_descrs); i++) {
395 mdescr = &_mesh_param_descrs[i];
396 printf("%s = ", mdescr->name);
397 mdescr->nla_print_fn(mesh_params[mdescr->mesh_param_num]);
398 printf("\n");
399 }
400 return NL_SKIP;
401 }
402
46c1ad1f 403 /* print out the mesh parameter */
404 mdescr->nla_print_fn(mesh_params[mdescr->mesh_param_num]);
405 printf("\n");
406 return NL_SKIP;
407}
408
7c37a24d
JB
409static int get_interface_meshparam(struct nl80211_state *state,
410 struct nl_cb *cb,
411 struct nl_msg *msg,
05514f95
JB
412 int argc, char **argv,
413 enum id_input id)
46c1ad1f 414{
97e21372 415 const struct mesh_param_descr *mdescr = NULL;
46c1ad1f 416
97e21372
JB
417 if (argc > 1)
418 return 1;
419
420 if (argc == 1) {
a34f62cf 421 mdescr = find_mesh_param(argv[0]);
97e21372
JB
422 if (!mdescr)
423 return 2;
424 }
46c1ad1f 425
426 nl_cb_set(cb, NL_CB_VALID, NL_CB_CUSTOM,
427 print_mesh_param_handler, (void *)mdescr);
428 return 0;
429}
430
97e21372 431COMMAND(get, mesh_param, "[<param>]",
70cf4544
JB
432 NL80211_CMD_GET_MESH_PARAMS, 0, CIB_NETDEV, get_interface_meshparam,
433 "Retrieve mesh parameter (run command without any to see available ones).");
400efd3e
JB
434
435static int join_mesh(struct nl80211_state *state, struct nl_cb *cb,
05514f95
JB
436 struct nl_msg *msg, int argc, char **argv,
437 enum id_input id)
400efd3e 438{
9560e43d 439 struct nlattr *container;
7d01a091 440 float rate;
a8c2e76d 441 int bintval, dtim_period;
7d01a091
CYY
442 char *end;
443
400efd3e
JB
444 if (argc < 1)
445 return 1;
446
447 NLA_PUT(msg, NL80211_ATTR_MESH_ID, strlen(argv[0]), argv[0]);
448 argc--;
449 argv++;
450
7d01a091
CYY
451 if (argc > 1 && strcmp(argv[0], "mcast-rate") == 0) {
452 argv++;
453 argc--;
454
455 rate = strtod(argv[0], &end);
456 if (*end != '\0')
457 return 1;
458
459 NLA_PUT_U32(msg, NL80211_ATTR_MCAST_RATE, (int)(rate * 10));
460 argv++;
461 argc--;
462 }
463
a8c2e76d
MP
464 if (argc > 1 && strcmp(argv[0], "beacon-interval") == 0) {
465 argc--;
466 argv++;
467
468 bintval = strtoul(argv[0], &end, 10);
469 if (*end != '\0')
470 return 1;
471
472 NLA_PUT_U32(msg, NL80211_ATTR_BEACON_INTERVAL, bintval);
473 argv++;
474 argc--;
475 }
476
477 if (argc > 1 && strcmp(argv[0], "dtim-period") == 0) {
478 argc--;
479 argv++;
480
481 dtim_period = strtoul(argv[0], &end, 10);
482 if (*end != '\0')
483 return 1;
484
485 NLA_PUT_U32(msg, NL80211_ATTR_DTIM_PERIOD, dtim_period);
486 argv++;
487 argc--;
488 }
489
9560e43d
AN
490 container = nla_nest_start(msg, NL80211_ATTR_MESH_SETUP);
491 if (!container)
492 return -ENOBUFS;
493
494 if (argc > 1 && strcmp(argv[0], "vendor_sync") == 0) {
495 argv++;
496 argc--;
497 if (strcmp(argv[0], "on") == 0)
498 NLA_PUT_U8(msg,
499 NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC, 1);
500 else
501 NLA_PUT_U8(msg,
502 NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC, 0);
503 argv++;
504 argc--;
505 }
506 /* parse and put other NL80211_ATTR_MESH_SETUP elements here */
507
508 nla_nest_end(msg, container);
509
400efd3e
JB
510 if (!argc)
511 return 0;
05514f95 512 return set_interface_meshparam(state, cb, msg, argc, argv, id);
400efd3e
JB
513 nla_put_failure:
514 return -ENOBUFS;
515}
a8c2e76d
MP
516COMMAND(mesh, join, "<mesh ID> [mcast-rate <rate in Mbps>]"
517 " [beacon-interval <time in TUs>] [dtim-period <value>]"
518 " [vendor_sync on|off] [<param>=<value>]*",
400efd3e 519 NL80211_CMD_JOIN_MESH, 0, CIB_NETDEV, join_mesh,
7d01a091 520 "Join a mesh with the given mesh ID with mcast-rate and mesh parameters.");
400efd3e
JB
521
522static int leave_mesh(struct nl80211_state *state, struct nl_cb *cb,
05514f95
JB
523 struct nl_msg *msg, int argc, char **argv,
524 enum id_input id)
400efd3e
JB
525{
526 if (argc)
527 return 1;
528
529 return 0;
530}
531COMMAND(mesh, leave, NULL, NL80211_CMD_LEAVE_MESH, 0, CIB_NETDEV, leave_mesh,
532 "Leave a mesh.");