interface.c

   1 #include <errno.h>
   2 #include <string.h>
   3 #include <stdbool.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 #define VALID_FLAGS     "none:     no special flags\n"\
  15                         "fcsfail:  show frames with FCS errors\n"\
  16                         "control:  show control frames\n"\
  17                         "otherbss: show frames from other BSSes\n"\
  18                         "cook:     use cooked mode\n"\
  19                         "active:   use active mode (ACK incoming unicast packets)\n"\
  20                         "mumimo-groupid <GROUP_ID>: use MUMIMO according to a group id\n"\
  21                         "mumimo-follow-mac <MAC_ADDRESS>: use MUMIMO according to a MAC address"
  22
  23 SECTION(interface);
  24
  25 static char *mntr_flags[NL80211_MNTR_FLAG_MAX + 1] = {
  26         "none",
  27         "fcsfail",
  28         "plcpfail",
  29         "control",
  30         "otherbss",
  31         "cook",
  32         "active",
  33 };
  34
  35 static int parse_mumimo_options(int *_argc, char ***_argv, struct nl_msg *msg)
  36 {
  37         uint8_t mumimo_group[VHT_MUMIMO_GROUP_LEN];
  38         unsigned char mac_addr[ETH_ALEN];
  39         char **argv = *_argv;
  40         int argc = *_argc;
  41         int i;
  42         unsigned int val;
  43
  44         if (strcmp(*argv, "mumimo-groupid") == 0) {
  45                 argc--;
  46                 argv++;
  47                 if (!argc || strlen(*argv) != VHT_MUMIMO_GROUP_LEN*2) {
  48                         fprintf(stderr, "Invalid groupID: %s\n", *argv);
  49                         return 1;
  50                 }
  51
  52                 for (i = 0; i < VHT_MUMIMO_GROUP_LEN; i++) {
  53                         if (sscanf((*argv) + i*2, "%2x", &val) != 1) {
  54                                 fprintf(stderr, "Failed reading groupID\n");
  55                                 return 1;
  56                         }
  57                         mumimo_group[i] = val;
  58                 }
  59
  60                 NLA_PUT(msg,
  61                         NL80211_ATTR_MU_MIMO_GROUP_DATA,
  62                         VHT_MUMIMO_GROUP_LEN,
  63                         mumimo_group);
  64                 argc--;
  65                 argv++;
  66         } else if (strcmp(*argv, "mumimo-follow-mac") == 0) {
  67                 argc--;
  68                 argv++;
  69                 if (!argc || mac_addr_a2n(mac_addr, *argv)) {
  70                         fprintf(stderr, "Invalid MAC address\n");
  71                         return 1;
  72                 }
  73                 NLA_PUT(msg, NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR,
  74                         ETH_ALEN, mac_addr);
  75                 argc--;
  76                 argv++;
  77         }
  78  nla_put_failure:
  79         *_argc = argc;
  80         *_argv = argv;
  81         return 0;
  82 }
  83
  84 static int parse_mntr_flags(int *_argc, char ***_argv,
  85                             struct nl_msg *msg)
  86 {
  87         struct nl_msg *flags;
  88         int err = -ENOBUFS;
  89         enum nl80211_mntr_flags flag;
  90         int argc = *_argc;
  91         char **argv = *_argv;
  92
  93         flags = nlmsg_alloc();
  94         if (!flags)
  95                 return -ENOMEM;
  96
  97         while (argc) {
  98                 int ok = 0;
  99
 100                 /* parse MU-MIMO options */
 101                 err = parse_mumimo_options(&argc, &argv, msg);
 102                 if (err)
 103                         goto out;
 104                 else if (!argc)
 105                         break;
 106
 107                 /* parse monitor flags */
 108                 for (flag = __NL80211_MNTR_FLAG_INVALID;
 109                      flag <= NL80211_MNTR_FLAG_MAX; flag++) {
 110                         if (strcmp(*argv, mntr_flags[flag]) == 0) {
 111                                 ok = 1;
 112                                 /*
 113                                  * This shouldn't be adding "flag" if that is
 114                                  * zero, but due to a problem in the kernel's
 115                                  * nl80211 code (using NLA_NESTED policy) it
 116                                  * will reject an empty nested attribute but
 117                                  * not one that contains an invalid attribute
 118                                  */
 119                                 NLA_PUT_FLAG(flags, flag);
 120                                 break;
 121                         }
 122                 }
 123                 if (!ok) {
 124                         err = -EINVAL;
 125                         goto out;
 126                 }
 127                 argc--;
 128                 argv++;
 129         }
 130
 131         nla_put_nested(msg, NL80211_ATTR_MNTR_FLAGS, flags);
 132         err = 0;
 133  nla_put_failure:
 134  out:
 135         nlmsg_free(flags);
 136
 137         *_argc = argc;
 138         *_argv = argv;
 139
 140         return err;
 141 }
 142
 143 /* for help */
 144 #define IFACE_TYPES "Valid interface types are: managed, ibss, monitor, mesh, wds."
 145
 146 /* return 0 if ok, internal error otherwise */
 147 static int get_if_type(int *argc, char ***argv, enum nl80211_iftype *type,
 148                        bool need_type)
 149 {
 150         char *tpstr;
 151
 152         if (*argc < 1 + !!need_type)
 153                 return 1;
 154
 155         if (need_type && strcmp((*argv)[0], "type"))
 156                 return 1;
 157
 158         tpstr = (*argv)[!!need_type];
 159         *argc -= 1 + !!need_type;
 160         *argv += 1 + !!need_type;
 161
 162         if (strcmp(tpstr, "adhoc") == 0 ||
 163             strcmp(tpstr, "ibss") == 0) {
 164                 *type = NL80211_IFTYPE_ADHOC;
 165                 return 0;
 166         } else if (strcmp(tpstr, "ocb") == 0) {
 167                 *type = NL80211_IFTYPE_OCB;
 168                 return 0;
 169         } else if (strcmp(tpstr, "monitor") == 0) {
 170                 *type = NL80211_IFTYPE_MONITOR;
 171                 return 0;
 172         } else if (strcmp(tpstr, "master") == 0 ||
 173                    strcmp(tpstr, "ap") == 0) {
 174                 *type = NL80211_IFTYPE_UNSPECIFIED;
 175                 fprintf(stderr, "You need to run a management daemon, e.g. hostapd,\n");
 176                 fprintf(stderr, "see http://wireless.kernel.org/en/users/Documentation/hostapd\n");
 177                 fprintf(stderr, "for more information on how to do that.\n");
 178                 return 2;
 179         } else if (strcmp(tpstr, "__ap") == 0) {
 180                 *type = NL80211_IFTYPE_AP;
 181                 return 0;
 182         } else if (strcmp(tpstr, "__ap_vlan") == 0) {
 183                 *type = NL80211_IFTYPE_AP_VLAN;
 184                 return 0;
 185         } else if (strcmp(tpstr, "wds") == 0) {
 186                 *type = NL80211_IFTYPE_WDS;
 187                 return 0;
 188         } else if (strcmp(tpstr, "managed") == 0 ||
 189                    strcmp(tpstr, "mgd") == 0 ||
 190                    strcmp(tpstr, "station") == 0) {
 191                 *type = NL80211_IFTYPE_STATION;
 192                 return 0;
 193         } else if (strcmp(tpstr, "mp") == 0 ||
 194                    strcmp(tpstr, "mesh") == 0) {
 195                 *type = NL80211_IFTYPE_MESH_POINT;
 196                 return 0;
 197         } else if (strcmp(tpstr, "__p2pcl") == 0) {
 198                 *type = NL80211_IFTYPE_P2P_CLIENT;
 199                 return 0;
 200         } else if (strcmp(tpstr, "__p2pdev") == 0) {
 201                 *type = NL80211_IFTYPE_P2P_DEVICE;
 202                 return 0;
 203         } else if (strcmp(tpstr, "__p2pgo") == 0) {
 204                 *type = NL80211_IFTYPE_P2P_GO;
 205                 return 0;
 206         } else if (strcmp(tpstr, "__nan") == 0) {
 207                 *type = NL80211_IFTYPE_NAN;
 208                 return 0;
 209         }
 210
 211         fprintf(stderr, "invalid interface type %s\n", tpstr);
 212         return 2;
 213 }
 214
 215 static int parse_4addr_flag(const char *value, struct nl_msg *msg)
 216 {
 217         if (strcmp(value, "on") == 0)
 218                 NLA_PUT_U8(msg, NL80211_ATTR_4ADDR, 1);
 219         else if (strcmp(value, "off") == 0)
 220                 NLA_PUT_U8(msg, NL80211_ATTR_4ADDR, 0);
 221         else
 222                 return 1;
 223         return 0;
 224
 225 nla_put_failure:
 226         return 1;
 227 }
 228
 229 static int handle_interface_add(struct nl80211_state *state,
 230                                 struct nl_msg *msg,
 231                                 int argc, char **argv,
 232                                 enum id_input id)
 233 {
 234         char *name;
 235         char *mesh_id = NULL;
 236         enum nl80211_iftype type;
 237         int tpset;
 238         unsigned char mac_addr[ETH_ALEN];
 239         int found_mac = 0;
 240
 241         if (argc < 1)
 242                 return 1;
 243
 244         name = argv[0];
 245         argc--;
 246         argv++;
 247
 248         tpset = get_if_type(&argc, &argv, &type, true);
 249         if (tpset)
 250                 return tpset;
 251
 252 try_another:
 253         if (argc) {
 254                 if (strcmp(argv[0], "mesh_id") == 0) {
 255                         argc--;
 256                         argv++;
 257
 258                         if (!argc)
 259                                 return 1;
 260                         mesh_id = argv[0];
 261                         argc--;
 262                         argv++;
 263                 } else if (strcmp(argv[0], "addr") == 0) {
 264                         argc--;
 265                         argv++;
 266                         if (mac_addr_a2n(mac_addr, argv[0])) {
 267                                 fprintf(stderr, "Invalid MAC address\n");
 268                                 return 2;
 269                         }
 270                         argc--;
 271                         argv++;
 272                         found_mac = 1;
 273                         goto try_another;
 274                 } else if (strcmp(argv[0], "4addr") == 0) {
 275                         argc--;
 276                         argv++;
 277                         if (parse_4addr_flag(argv[0], msg)) {
 278                                 fprintf(stderr, "4addr error\n");
 279                                 return 2;
 280                         }
 281                         argc--;
 282                         argv++;
 283                 } else if (strcmp(argv[0], "flags") == 0) {
 284                         argc--;
 285                         argv++;
 286                         if (parse_mntr_flags(&argc, &argv, msg)) {
 287                                 fprintf(stderr, "flags error\n");
 288                                 return 2;
 289                         }
 290                 } else {
 291                         return 1;
 292                 }
 293         }
 294
 295         if (argc)
 296                 return 1;
 297
 298         NLA_PUT_STRING(msg, NL80211_ATTR_IFNAME, name);
 299         NLA_PUT_U32(msg, NL80211_ATTR_IFTYPE, type);
 300         if (mesh_id)
 301                 NLA_PUT(msg, NL80211_ATTR_MESH_ID, strlen(mesh_id), mesh_id);
 302         if (found_mac)
 303                 NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr);
 304
 305         return 0;
 306  nla_put_failure:
 307         return -ENOBUFS;
 308 }
 309 COMMAND(interface, add, "<name> type <type> [mesh_id <meshid>] [4addr on|off] [flags <flag>*] [addr <mac-addr>]",
 310         NL80211_CMD_NEW_INTERFACE, 0, CIB_PHY, handle_interface_add,
 311         "Add a new virtual interface with the given configuration.\n"
 312         IFACE_TYPES "\n\n"
 313         "The flags are only used for monitor interfaces, valid flags are:\n"
 314         VALID_FLAGS "\n\n"
 315         "The mesh_id is used only for mesh mode.");
 316 COMMAND(interface, add, "<name> type <type> [mesh_id <meshid>] [4addr on|off] [flags <flag>*] [addr <mac-addr>]",
 317         NL80211_CMD_NEW_INTERFACE, 0, CIB_NETDEV, handle_interface_add, NULL);
 318
 319 static int handle_interface_del(struct nl80211_state *state,
 320                                 struct nl_msg *msg,
 321                                 int argc, char **argv,
 322                                 enum id_input id)
 323 {
 324         return 0;
 325 }
 326 TOPLEVEL(del, NULL, NL80211_CMD_DEL_INTERFACE, 0, CIB_NETDEV, handle_interface_del,
 327          "Remove this virtual interface");
 328 HIDDEN(interface, del, NULL, NL80211_CMD_DEL_INTERFACE, 0, CIB_NETDEV, handle_interface_del);
 329
 330 static char *channel_type_name(enum nl80211_channel_type channel_type)
 331 {
 332         switch (channel_type) {
 333         case NL80211_CHAN_NO_HT:
 334                 return "NO HT";
 335         case NL80211_CHAN_HT20:
 336                 return "HT20";
 337         case NL80211_CHAN_HT40MINUS:
 338                 return "HT40-";
 339         case NL80211_CHAN_HT40PLUS:
 340                 return "HT40+";
 341         default:
 342                 return "unknown";
 343         }
 344 }
 345
 346 char *channel_width_name(enum nl80211_chan_width width)
 347 {
 348         switch (width) {
 349         case NL80211_CHAN_WIDTH_20_NOHT:
 350                 return "20 MHz (no HT)";
 351         case NL80211_CHAN_WIDTH_20:
 352                 return "20 MHz";
 353         case NL80211_CHAN_WIDTH_40:
 354                 return "40 MHz";
 355         case NL80211_CHAN_WIDTH_80:
 356                 return "80 MHz";
 357         case NL80211_CHAN_WIDTH_80P80:
 358                 return "80+80 MHz";
 359         case NL80211_CHAN_WIDTH_160:
 360                 return "160 MHz";
 361         case NL80211_CHAN_WIDTH_5:
 362                 return "5 MHz";
 363         case NL80211_CHAN_WIDTH_10:
 364                 return "10 MHz";
 365         case NL80211_CHAN_WIDTH_320:
 366                 return "320 MHz";
 367         default:
 368                 return "unknown";
 369         }
 370 }
 371
 372 static void print_channel(struct nlattr **tb)
 373 {
 374         uint32_t freq = nla_get_u32(tb[NL80211_ATTR_WIPHY_FREQ]);
 375
 376         printf("channel %d (%d MHz)",
 377                ieee80211_frequency_to_channel(freq), freq);
 378
 379         if (tb[NL80211_ATTR_CHANNEL_WIDTH]) {
 380                 printf(", width: %s",
 381                         channel_width_name(nla_get_u32(tb[NL80211_ATTR_CHANNEL_WIDTH])));
 382                 if (tb[NL80211_ATTR_CENTER_FREQ1])
 383                         printf(", center1: %d MHz",
 384                                 nla_get_u32(tb[NL80211_ATTR_CENTER_FREQ1]));
 385                 if (tb[NL80211_ATTR_CENTER_FREQ2])
 386                         printf(", center2: %d MHz",
 387                                 nla_get_u32(tb[NL80211_ATTR_CENTER_FREQ2]));
 388
 389                 if (tb[NL80211_ATTR_PUNCT_BITMAP]) {
 390                         uint32_t punct = nla_get_u32(tb[NL80211_ATTR_PUNCT_BITMAP]);
 391
 392                         if (punct)
 393                                 printf(", punctured: 0x%x", punct);
 394                 }
 395         } else if (tb[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) {
 396                 enum nl80211_channel_type channel_type;
 397
 398                 channel_type = nla_get_u32(tb[NL80211_ATTR_WIPHY_CHANNEL_TYPE]);
 399                 printf(" %s", channel_type_name(channel_type));
 400         }
 401 }
 402
 403 static int print_iface_handler(struct nl_msg *msg, void *arg)
 404 {
 405         struct genlmsghdr *gnlh = nlmsg_data(nlmsg_hdr(msg));
 406         struct nlattr *tb_msg[NL80211_ATTR_MAX + 1];
 407         unsigned int *wiphy = arg;
 408         const char *indent = "";
 409
 410         nla_parse(tb_msg, NL80211_ATTR_MAX, genlmsg_attrdata(gnlh, 0),
 411                   genlmsg_attrlen(gnlh, 0), NULL);
 412
 413         if (wiphy && tb_msg[NL80211_ATTR_WIPHY]) {
 414                 unsigned int thiswiphy = nla_get_u32(tb_msg[NL80211_ATTR_WIPHY]);
 415                 indent = "\t";
 416                 if (*wiphy != thiswiphy)
 417                         printf("phy#%d\n", thiswiphy);
 418                 *wiphy = thiswiphy;
 419         }
 420
 421         if (tb_msg[NL80211_ATTR_IFNAME])
 422                 printf("%sInterface %s\n", indent, nla_get_string(tb_msg[NL80211_ATTR_IFNAME]));
 423         else
 424                 printf("%sUnnamed/non-netdev interface\n", indent);
 425         if (tb_msg[NL80211_ATTR_IFINDEX])
 426                 printf("%s\tifindex %d\n", indent, nla_get_u32(tb_msg[NL80211_ATTR_IFINDEX]));
 427         if (tb_msg[NL80211_ATTR_WDEV])
 428                 printf("%s\twdev 0x%llx\n", indent,
 429                        (unsigned long long)nla_get_u64(tb_msg[NL80211_ATTR_WDEV]));
 430         if (tb_msg[NL80211_ATTR_MAC]) {
 431                 char mac_addr[20];
 432                 mac_addr_n2a(mac_addr, nla_data(tb_msg[NL80211_ATTR_MAC]));
 433                 printf("%s\taddr %s\n", indent, mac_addr);
 434         }
 435         if (tb_msg[NL80211_ATTR_SSID]) {
 436                 printf("%s\tssid ", indent);
 437                 print_ssid_escaped(nla_len(tb_msg[NL80211_ATTR_SSID]),
 438                                    nla_data(tb_msg[NL80211_ATTR_SSID]));
 439                 printf("\n");
 440         }
 441         if (tb_msg[NL80211_ATTR_IFTYPE])
 442                 printf("%s\ttype %s\n", indent, iftype_name(nla_get_u32(tb_msg[NL80211_ATTR_IFTYPE])));
 443         if (!wiphy && tb_msg[NL80211_ATTR_WIPHY])
 444                 printf("%s\twiphy %d\n", indent, nla_get_u32(tb_msg[NL80211_ATTR_WIPHY]));
 445         if (tb_msg[NL80211_ATTR_WIPHY_FREQ]) {
 446                 printf("%s\t", indent);
 447                 print_channel(tb_msg);
 448                 printf("\n");
 449         }
 450
 451         if (tb_msg[NL80211_ATTR_WIPHY_TX_POWER_LEVEL]) {
 452                 int32_t txp = nla_get_u32(tb_msg[NL80211_ATTR_WIPHY_TX_POWER_LEVEL]);
 453
 454                 printf("%s\ttxpower %d.%.2d dBm\n",
 455                        indent, txp / 100, txp % 100);
 456         }
 457
 458         if (tb_msg[NL80211_ATTR_TXQ_STATS]) {
 459                 char buf[150];
 460                 parse_txq_stats(buf, sizeof(buf), tb_msg[NL80211_ATTR_TXQ_STATS], 1, -1, indent);
 461                 printf("%s\tmulticast TXQ:%s\n", indent, buf);
 462         }
 463
 464         if (tb_msg[NL80211_ATTR_4ADDR]) {
 465                 uint8_t use_4addr = nla_get_u8(tb_msg[NL80211_ATTR_4ADDR]);
 466                 if (use_4addr)
 467                         printf("%s\t4addr: on\n", indent);
 468         }
 469
 470         if (tb_msg[NL80211_ATTR_MLO_LINKS]) {
 471                 struct nlattr *link;
 472                 int n;
 473
 474                 printf("%s\tMLD with links:\n", indent);
 475
 476                 nla_for_each_nested(link, tb_msg[NL80211_ATTR_MLO_LINKS], n) {
 477                         struct nlattr *tb[NL80211_ATTR_MAX + 1];
 478
 479                         nla_parse_nested(tb, NL80211_ATTR_MAX, link, NULL);
 480                         printf("%s\t - link", indent);
 481                         if (tb[NL80211_ATTR_MLO_LINK_ID])
 482                                 printf(" ID %2d", nla_get_u32(tb[NL80211_ATTR_MLO_LINK_ID]));
 483                         if (tb[NL80211_ATTR_MAC]) {
 484                                 char buf[20];
 485
 486                                 mac_addr_n2a(buf, nla_data(tb[NL80211_ATTR_MAC]));
 487                                 printf(" link addr %s", buf);
 488                         }
 489                         if (tb[NL80211_ATTR_WIPHY_FREQ]) {
 490                                 printf("\n%s\t   ", indent);
 491                                 print_channel(tb);
 492                         }
 493                         if (tb[NL80211_ATTR_WIPHY_TX_POWER_LEVEL]) {
 494                                 int32_t txp = nla_get_u32(tb[NL80211_ATTR_WIPHY_TX_POWER_LEVEL]);
 495
 496                                 printf("\n%s\t   txpower %d.%.2d dBm", indent, txp / 100, txp % 100);
 497                         }
 498                         printf("\n");
 499                 }
 500         }
 501
 502         return NL_SKIP;
 503 }
 504
 505 static int handle_interface_info(struct nl80211_state *state,
 506                                  struct nl_msg *msg,
 507                                  int argc, char **argv,
 508                                  enum id_input id)
 509 {
 510         register_handler(print_iface_handler, NULL);
 511         return 0;
 512 }
 513 TOPLEVEL(info, NULL, NL80211_CMD_GET_INTERFACE, 0, CIB_NETDEV, handle_interface_info,
 514          "Show information for this interface.");
 515
 516 static int handle_interface_set(struct nl80211_state *state,
 517                                 struct nl_msg *msg,
 518                                 int argc, char **argv,
 519                                 enum id_input id)
 520 {
 521         if (!argc)
 522                 return 1;
 523
 524         NLA_PUT_U32(msg, NL80211_ATTR_IFTYPE, NL80211_IFTYPE_MONITOR);
 525
 526         switch (parse_mntr_flags(&argc, &argv, msg)) {
 527         case 0:
 528                 return 0;
 529         case 1:
 530                 return 1;
 531         case -ENOMEM:
 532                 fprintf(stderr, "failed to allocate flags\n");
 533                 return 2;
 534         case -EINVAL:
 535                 fprintf(stderr, "unknown flag %s\n", *argv);
 536                 return 2;
 537         default:
 538                 return 2;
 539         }
 540  nla_put_failure:
 541         return -ENOBUFS;
 542 }
 543 COMMAND(set, monitor, "<flag>*",
 544         NL80211_CMD_SET_INTERFACE, 0, CIB_NETDEV, handle_interface_set,
 545         "Set monitor flags. Valid flags are:\n"
 546         VALID_FLAGS);
 547
 548 static int handle_interface_meshid(struct nl80211_state *state,
 549                                    struct nl_msg *msg,
 550                                    int argc, char **argv,
 551                                    enum id_input id)
 552 {
 553         char *mesh_id = NULL;
 554
 555         if (argc != 1)
 556                 return 1;
 557
 558         mesh_id = argv[0];
 559
 560         NLA_PUT(msg, NL80211_ATTR_MESH_ID, strlen(mesh_id), mesh_id);
 561
 562         return 0;
 563  nla_put_failure:
 564         return -ENOBUFS;
 565 }
 566 COMMAND(set, meshid, "<meshid>",
 567         NL80211_CMD_SET_INTERFACE, 0, CIB_NETDEV, handle_interface_meshid, NULL);
 568
 569 static unsigned int dev_dump_wiphy;
 570
 571 static int handle_dev_dump(struct nl80211_state *state,
 572                            struct nl_msg *msg,
 573                            int argc, char **argv,
 574                            enum id_input id)
 575 {
 576         dev_dump_wiphy = -1;
 577         register_handler(print_iface_handler, &dev_dump_wiphy);
 578         return 0;
 579 }
 580 TOPLEVEL(dev, NULL, NL80211_CMD_GET_INTERFACE, NLM_F_DUMP, CIB_NONE, handle_dev_dump,
 581          "List all network interfaces for wireless hardware.");
 582
 583 static int handle_interface_type(struct nl80211_state *state,
 584                                  struct nl_msg *msg,
 585                                  int argc, char **argv,
 586                                  enum id_input id)
 587 {
 588         enum nl80211_iftype type;
 589         int tpset;
 590
 591         tpset = get_if_type(&argc, &argv, &type, false);
 592         if (tpset)
 593                 return tpset;
 594
 595         if (argc)
 596                 return 1;
 597
 598         NLA_PUT_U32(msg, NL80211_ATTR_IFTYPE, type);
 599
 600         return 0;
 601  nla_put_failure:
 602         return -ENOBUFS;
 603 }
 604 COMMAND(set, type, "<type>",
 605         NL80211_CMD_SET_INTERFACE, 0, CIB_NETDEV, handle_interface_type,
 606         "Set interface type/mode.\n"
 607         IFACE_TYPES);
 608
 609 static int handle_interface_4addr(struct nl80211_state *state,
 610                                   struct nl_msg *msg,
 611                                   int argc, char **argv,
 612                                   enum id_input id)
 613 {
 614         if (argc != 1)
 615                 return 1;
 616         return parse_4addr_flag(argv[0], msg);
 617 }
 618 COMMAND(set, 4addr, "<on|off>",
 619         NL80211_CMD_SET_INTERFACE, 0, CIB_NETDEV, handle_interface_4addr,
 620         "Set interface 4addr (WDS) mode.");
 621
 622 static int handle_interface_noack_map(struct nl80211_state *state,
 623                                       struct nl_msg *msg,
 624                                       int argc, char **argv,
 625                                       enum id_input id)
 626 {
 627         uint16_t noack_map;
 628         char *end;
 629
 630         if (argc != 1)
 631                 return 1;
 632
 633         noack_map = strtoul(argv[0], &end, 16);
 634         if (*end)
 635                 return 1;
 636
 637         NLA_PUT_U16(msg, NL80211_ATTR_NOACK_MAP, noack_map);
 638
 639         return 0;
 640  nla_put_failure:
 641         return -ENOBUFS;
 642
 643 }
 644 COMMAND(set, noack_map, "<map>",
 645         NL80211_CMD_SET_NOACK_MAP, 0, CIB_NETDEV, handle_interface_noack_map,
 646         "Set the NoAck map for the TIDs. (0x0009 = BE, 0x0006 = BK, 0x0030 = VI, 0x00C0 = VO)");
 647
 648
 649 static int handle_interface_wds_peer(struct nl80211_state *state,
 650                                      struct nl_msg *msg,
 651                                      int argc, char **argv,
 652                                      enum id_input id)
 653 {
 654         unsigned char mac_addr[ETH_ALEN];
 655
 656         if (argc < 1)
 657                 return 1;
 658
 659         if (mac_addr_a2n(mac_addr, argv[0])) {
 660                 fprintf(stderr, "Invalid MAC address\n");
 661                 return 2;
 662         }
 663
 664         argc--;
 665         argv++;
 666
 667         if (argc)
 668                 return 1;
 669
 670         NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr);
 671
 672         return 0;
 673  nla_put_failure:
 674         return -ENOBUFS;
 675 }
 676 COMMAND(set, peer, "<MAC address>",
 677         NL80211_CMD_SET_WDS_PEER, 0, CIB_NETDEV, handle_interface_wds_peer,
 678         "Set interface WDS peer.");
 679
 680 static int set_mcast_rate(struct nl80211_state *state,
 681                           struct nl_msg *msg,
 682                           int argc, char **argv,
 683                           enum id_input id)
 684 {
 685         float rate;
 686         char *end;
 687
 688         if (argc != 1)
 689                 return 1;
 690
 691         rate = strtod(argv[0], &end);
 692         if (*end != '\0')
 693                 return 1;
 694
 695         NLA_PUT_U32(msg, NL80211_ATTR_MCAST_RATE, (int)(rate * 10));
 696
 697         return 0;
 698 nla_put_failure:
 699         return -ENOBUFS;
 700 }
 701
 702 COMMAND(set, mcast_rate, "<rate in Mbps>",
 703         NL80211_CMD_SET_MCAST_RATE, 0, CIB_NETDEV, set_mcast_rate,
 704         "Set the multicast bitrate.");
 705
 706
 707 static int handle_chanfreq(struct nl80211_state *state, struct nl_msg *msg,
 708                            bool chan, int argc, char **argv,
 709                            enum id_input id)
 710 {
 711         struct chandef chandef;
 712         int res;
 713         int parsed;
 714         char *end;
 715
 716         res = parse_freqchan(&chandef, chan, argc, argv, &parsed, false);
 717         if (res)
 718                 return res;
 719
 720         argc -= parsed;
 721         argv += parsed;
 722
 723         while (argc) {
 724                 unsigned int beacons = 10;
 725
 726                 if (strcmp(argv[0], "beacons") == 0) {
 727                         if (argc < 2)
 728                                 return 1;
 729
 730                         beacons = strtol(argv[1], &end, 10);
 731                         if (*end)
 732                                 return 1;
 733
 734                         argc -= 2;
 735                         argv += 2;
 736
 737                         NLA_PUT_U32(msg, NL80211_ATTR_CH_SWITCH_COUNT, beacons);
 738                 } else if (strcmp(argv[0], "block-tx") == 0) {
 739                         argc -= 1;
 740                         argv += 1;
 741
 742                         NLA_PUT_FLAG(msg, NL80211_ATTR_CH_SWITCH_BLOCK_TX);
 743                 } else {
 744                         return 1;
 745                 }
 746         }
 747
 748         return put_chandef(msg, &chandef);
 749
 750  nla_put_failure:
 751         return -ENOBUFS;
 752 }
 753
 754 static int handle_freq(struct nl80211_state *state, struct nl_msg *msg,
 755                        int argc, char **argv,
 756                        enum id_input id)
 757 {
 758         return handle_chanfreq(state, msg, false, argc, argv, id);
 759 }
 760
 761 static int handle_chan(struct nl80211_state *state, struct nl_msg *msg,
 762                        int argc, char **argv,
 763                        enum id_input id)
 764 {
 765         return handle_chanfreq(state, msg, true, argc, argv, id);
 766 }
 767
 768 SECTION(switch);
 769 COMMAND(switch, freq,
 770         "<freq> [NOHT|HT20|HT40+|HT40-|5MHz|10MHz|80MHz] [beacons <count>] [block-tx]\n"
 771         "<control freq> [5|10|20|40|80|80+80|160] [<center1_freq> [<center2_freq>]] [beacons <count>] [block-tx]",
 772         NL80211_CMD_CHANNEL_SWITCH, 0, CIB_NETDEV, handle_freq,
 773         "Switch the operating channel by sending a channel switch announcement (CSA).");
 774 COMMAND(switch, channel, "<channel> [NOHT|HT20|HT40+|HT40-|5MHz|10MHz|80MHz] [beacons <count>] [block-tx]",
 775         NL80211_CMD_CHANNEL_SWITCH, 0, CIB_NETDEV, handle_chan, NULL);
 776
 777
 778 static int toggle_tid_param(const char *argv0, const char *argv1,
 779                             struct nl_msg *msg, uint32_t attr)
 780 {
 781         uint8_t val;
 782
 783         if (strcmp(argv1, "on") == 0) {
 784                 val = NL80211_TID_CONFIG_ENABLE;
 785         } else if (strcmp(argv1, "off") == 0) {
 786                 val = NL80211_TID_CONFIG_DISABLE;
 787         } else {
 788                 fprintf(stderr, "Invalid %s parameter: %s\n", argv0, argv1);
 789                 return 2;
 790         }
 791
 792         NLA_PUT_U8(msg, attr, val);
 793         return 0;
 794
 795  nla_put_failure:
 796         return -ENOBUFS;
 797 }
 798
 799 static int handle_tid_config(struct nl80211_state *state,
 800                              struct nl_msg *msg,
 801                              int argc, char **argv,
 802                              enum id_input id)
 803 {
 804         struct nlattr *tids_array = NULL;
 805         struct nlattr *tids_entry = NULL;
 806         enum nl80211_tx_rate_setting txrate_type;
 807         unsigned char peer[ETH_ALEN];
 808         int tids_num = 0;
 809         char *end;
 810         int ret;
 811         enum {
 812                 PS_ADDR,
 813                 PS_TIDS,
 814                 PS_CONF,
 815         } parse_state = PS_ADDR;
 816         unsigned int attr;
 817
 818         while (argc) {
 819                 switch (parse_state) {
 820                 case PS_ADDR:
 821                         if (strcmp(argv[0], "peer") == 0) {
 822                                 if (argc < 2) {
 823                                         fprintf(stderr, "Not enough args for %s\n", argv[0]);
 824                                         return HANDLER_RET_USAGE;
 825                                 }
 826
 827                                 if (mac_addr_a2n(peer, argv[1])) {
 828                                         fprintf(stderr, "Invalid MAC address\n");
 829                                         return 2;
 830                                 }
 831
 832                                 NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, peer);
 833
 834                                 argc -= 2;
 835                                 argv += 2;
 836                                 parse_state = PS_TIDS;
 837
 838                         } else if (strcmp(argv[0], "tids") == 0) {
 839                                 parse_state = PS_TIDS;
 840                         } else {
 841                                 fprintf(stderr, "Peer MAC address expected\n");
 842                                 return HANDLER_RET_USAGE;
 843                         }
 844
 845                         break;
 846                 case PS_TIDS:
 847                         if (strcmp(argv[0], "tids") == 0) {
 848                                 if (argc < 2) {
 849                                         fprintf(stderr, "not enough args for %s\n", argv[0]);
 850                                         return HANDLER_RET_USAGE;
 851                                 }
 852
 853                                 if (!tids_array) {
 854                                         tids_array = nla_nest_start(msg, NL80211_ATTR_TID_CONFIG);
 855                                         if (!tids_array)
 856                                                 return -ENOBUFS;
 857                                 }
 858
 859                                 if (tids_entry) {
 860                                         nla_nest_end(msg, tids_entry);
 861                                         tids_num++;
 862                                 }
 863
 864                                 tids_entry = nla_nest_start(msg, tids_num);
 865                                 if (!tids_entry)
 866                                         return -ENOBUFS;
 867
 868                                 NLA_PUT_U16(msg, NL80211_TID_CONFIG_ATTR_TIDS, strtol(argv[1], &end, 0));
 869                                 if (*end) {
 870                                         fprintf(stderr, "Invalid TID mask value: %s\n", argv[1]);
 871                                         return 2;
 872                                 }
 873
 874                                 argc -= 2;
 875                                 argv += 2;
 876                                 parse_state = PS_CONF;
 877                         } else {
 878                                 fprintf(stderr, "TID mask expected\n");
 879                                 return HANDLER_RET_USAGE;
 880                         }
 881
 882                         break;
 883                 case PS_CONF:
 884                         if (strcmp(argv[0], "tids") == 0) {
 885                                 parse_state = PS_TIDS;
 886                         } else if (strcmp(argv[0], "override") == 0) {
 887                                 NLA_PUT_FLAG(msg, NL80211_TID_CONFIG_ATTR_OVERRIDE);
 888
 889                                 argc -= 1;
 890                                 argv += 1;
 891                         } else if (strcmp(argv[0], "ampdu") == 0) {
 892                                 if (argc < 2) {
 893                                         fprintf(stderr, "not enough args for %s\n", argv[0]);
 894                                         return HANDLER_RET_USAGE;
 895                                 }
 896
 897                                 ret = toggle_tid_param(argv[0], argv[1], msg,
 898                                                        NL80211_TID_CONFIG_ATTR_AMPDU_CTRL);
 899                                 if (ret)
 900                                         return ret;
 901
 902                                 argc -= 2;
 903                                 argv += 2;
 904                         } else if (strcmp(argv[0], "amsdu") == 0) {
 905                                 if (argc < 2) {
 906                                         fprintf(stderr, "not enough args for %s\n", argv[0]);
 907                                         return HANDLER_RET_USAGE;
 908                                 }
 909
 910                                 ret = toggle_tid_param(argv[0], argv[1], msg,
 911                                                        NL80211_TID_CONFIG_ATTR_AMSDU_CTRL);
 912                                 if (ret)
 913                                         return ret;
 914
 915                                 argc -= 2;
 916                                 argv += 2;
 917                         } else if (strcmp(argv[0], "noack") == 0) {
 918                                 if (argc < 2) {
 919                                         fprintf(stderr, "not enough args for %s\n", argv[0]);
 920                                         return HANDLER_RET_USAGE;
 921                                 }
 922
 923                                 ret = toggle_tid_param(argv[0], argv[1], msg,
 924                                                        NL80211_TID_CONFIG_ATTR_NOACK);
 925                                 if (ret)
 926                                         return ret;
 927
 928                                 argc -= 2;
 929                                 argv += 2;
 930                         } else if (strcmp(argv[0], "rtscts") == 0) {
 931                                 if (argc < 2) {
 932                                         fprintf(stderr, "not enough args for %s\n", argv[0]);
 933                                         return HANDLER_RET_USAGE;
 934                                 }
 935
 936                                 ret = toggle_tid_param(argv[0], argv[1], msg,
 937                                                        NL80211_TID_CONFIG_ATTR_RTSCTS_CTRL);
 938                                 if (ret)
 939                                         return ret;
 940
 941                                 argc -= 2;
 942                                 argv += 2;
 943                         } else if (strcmp(argv[0], "sretry") == 0) {
 944                                 if (argc < 2) {
 945                                         fprintf(stderr, "not enough args for %s\n", argv[0]);
 946                                         return HANDLER_RET_USAGE;
 947                                 }
 948
 949                                 NLA_PUT_U8(msg, NL80211_TID_CONFIG_ATTR_RETRY_SHORT, strtol(argv[1], &end, 0));
 950                                 if (*end) {
 951                                         fprintf(stderr, "Invalid short_retry value: %s\n", argv[1]);
 952                                         return 2;
 953                                 }
 954
 955                                 argc -= 2;
 956                                 argv += 2;
 957                         } else if (strcmp(argv[0], "lretry") == 0) {
 958                                 if (argc < 2) {
 959                                         fprintf(stderr, "not enough args for %s\n", argv[0]);
 960                                         return HANDLER_RET_USAGE;
 961                                 }
 962
 963                                 NLA_PUT_U8(msg, NL80211_TID_CONFIG_ATTR_RETRY_LONG, strtol(argv[1], &end, 0));
 964                                 if (*end) {
 965                                         fprintf(stderr, "Invalid long_retry value: %s\n", argv[1]);
 966                                         return 2;
 967                                 }
 968
 969                                 argc -= 2;
 970                                 argv += 2;
 971                         } else if (strcmp(argv[0], "bitrates") == 0) {
 972                                 if (argc < 2) {
 973                                         fprintf(stderr, "not enough args for %s\n", argv[0]);
 974                                         return HANDLER_RET_USAGE;
 975                                 }
 976                                 if (!strcmp(argv[1], "auto"))
 977                                         txrate_type = NL80211_TX_RATE_AUTOMATIC;
 978                                 else if (!strcmp(argv[1], "fixed"))
 979                                         txrate_type = NL80211_TX_RATE_FIXED;
 980                                 else if (!strcmp(argv[1], "limit"))
 981                                         txrate_type = NL80211_TX_RATE_LIMITED;
 982                                 else {
 983                                         printf("Invalid parameter: %s\n", argv[0]);
 984                                         return 2;
 985                                 }
 986                                 NLA_PUT_U8(msg, NL80211_TID_CONFIG_ATTR_TX_RATE_TYPE, txrate_type);
 987                                 argc -= 2;
 988                                 argv += 2;
 989                                 if (txrate_type != NL80211_TX_RATE_AUTOMATIC) {
 990                                         attr = NL80211_TID_CONFIG_ATTR_TX_RATE;
 991                                         ret = set_bitrates(msg, argc, argv,
 992                                                            attr);
 993                                         if (ret < 2)
 994                                                 return 1;
 995
 996                                         argc -= ret;
 997                                         argv += ret;
 998                                 }
 999                         } else {
1000                                 fprintf(stderr, "Unknown parameter: %s\n", argv[0]);
1001                                 return HANDLER_RET_USAGE;
1002                         }
1003
1004                         break;
1005                 default:
1006                         fprintf(stderr, "Failed to parse: internal failure\n");
1007                         return HANDLER_RET_USAGE;
1008                 }
1009         }
1010
1011         if (tids_entry)
1012                 nla_nest_end(msg, tids_entry);
1013
1014         if (tids_array)
1015                 nla_nest_end(msg, tids_array);
1016
1017         return 0;
1018
1019 nla_put_failure:
1020         return -ENOBUFS;
1021 }
1022
1023 COMMAND(set, tidconf, "[peer <MAC address>] tids <mask> [override] [sretry <num>] [lretry <num>] "
1024         "[ampdu [on|off]] [amsdu [on|off]] [noack [on|off]] [rtscts [on|off]]"
1025         "[bitrates <type [auto|fixed|limit]> [legacy-<2.4|5> <legacy rate in Mbps>*] [ht-mcs-<2.4|5> <MCS index>*]"
1026         " [vht-mcs-<2.4|5> <NSS:MCSx,MCSy... | NSS:MCSx-MCSy>*] [sgi-2.4|lgi-2.4] [sgi-5|lgi-5]]",
1027         NL80211_CMD_SET_TID_CONFIG, 0, CIB_NETDEV, handle_tid_config,
1028         "Setup per-node TID specific configuration for TIDs selected by bitmask.\n"
1029         "If MAC address is not specified, then supplied TID configuration\n"
1030         "applied to all the peers.\n"
1031         "Examples:\n"
1032         "  $ iw dev wlan0 set tidconf tids 0x1 ampdu off\n"
1033         "  $ iw dev wlan0 set tidconf tids 0x5 ampdu off amsdu off rtscts on\n"
1034         "  $ iw dev wlan0 set tidconf tids 0x3 override ampdu on noack on rtscts on\n"
1035         "  $ iw dev wlan0 set tidconf peer xx:xx:xx:xx:xx:xx tids 0x1 ampdu off tids 0x3 amsdu off rtscts on\n"
1036         "  $ iw dev wlan0 set tidconf peer xx:xx:xx:xx:xx:xx tids 0x2 bitrates auto\n"
1037         "  $ iw dev wlan0 set tidconf peer xx:xx:xx:xx:xx:xx tids 0x2 bitrates limit vht-mcs-5 4:9\n"
1038         );
1039
1040 static int handle_set_epcs(struct nl80211_state *state,
1041                            struct nl_msg *msg,
1042                            int argc, char **argv,
1043                            enum id_input id)
1044 {
1045         if (argc != 1)
1046                 return 1;
1047
1048         if (strcmp(argv[0], "enable") == 0)
1049                 NLA_PUT_FLAG(msg, NL80211_ATTR_EPCS);
1050         else if (strcmp(argv[0], "disable") != 0)
1051                 return 1;
1052
1053         return 0;
1054
1055 nla_put_failure:
1056         return 1;
1057 }
1058
1059 COMMAND(set, epcs, "<enable|disable>",
1060         NL80211_CMD_EPCS_CFG, 0, CIB_NETDEV, handle_set_epcs,
1061         "Enable/Disable EPCS support");