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)"
  20
  21 SECTION(interface);
  22
  23 static char *mntr_flags[NL80211_MNTR_FLAG_MAX + 1] = {
  24         "none",
  25         "fcsfail",
  26         "plcpfail",
  27         "control",
  28         "otherbss",
  29         "cook",
  30         "active",
  31 };
  32
  33 static int parse_mntr_flags(int *_argc, char ***_argv,
  34                             struct nl_msg *msg)
  35 {
  36         struct nl_msg *flags;
  37         int err = -ENOBUFS;
  38         enum nl80211_mntr_flags flag;
  39         int argc = *_argc;
  40         char **argv = *_argv;
  41
  42         flags = nlmsg_alloc();
  43         if (!flags)
  44                 return -ENOMEM;
  45
  46         while (argc) {
  47                 int ok = 0;
  48                 for (flag = __NL80211_MNTR_FLAG_INVALID;
  49                      flag <= NL80211_MNTR_FLAG_MAX; flag++) {
  50                         if (strcmp(*argv, mntr_flags[flag]) == 0) {
  51                                 ok = 1;
  52                                 /*
  53                                  * This shouldn't be adding "flag" if that is
  54                                  * zero, but due to a problem in the kernel's
  55                                  * nl80211 code (using NLA_NESTED policy) it
  56                                  * will reject an empty nested attribute but
  57                                  * not one that contains an invalid attribute
  58                                  */
  59                                 NLA_PUT_FLAG(flags, flag);
  60                                 break;
  61                         }
  62                 }
  63                 if (!ok) {
  64                         err = -EINVAL;
  65                         goto out;
  66                 }
  67                 argc--;
  68                 argv++;
  69         }
  70
  71         nla_put_nested(msg, NL80211_ATTR_MNTR_FLAGS, flags);
  72         err = 0;
  73  nla_put_failure:
  74  out:
  75         nlmsg_free(flags);
  76
  77         *_argc = argc;
  78         *_argv = argv;
  79
  80         return err;
  81 }
  82
  83 /* for help */
  84 #define IFACE_TYPES "Valid interface types are: managed, ibss, monitor, mesh, wds."
  85
  86 /* return 0 if ok, internal error otherwise */
  87 static int get_if_type(int *argc, char ***argv, enum nl80211_iftype *type,
  88                        bool need_type)
  89 {
  90         char *tpstr;
  91
  92         if (*argc < 1 + !!need_type)
  93                 return 1;
  94
  95         if (need_type && strcmp((*argv)[0], "type"))
  96                 return 1;
  97
  98         tpstr = (*argv)[!!need_type];
  99         *argc -= 1 + !!need_type;
 100         *argv += 1 + !!need_type;
 101
 102         if (strcmp(tpstr, "adhoc") == 0 ||
 103             strcmp(tpstr, "ibss") == 0) {
 104                 *type = NL80211_IFTYPE_ADHOC;
 105                 return 0;
 106         } else if (strcmp(tpstr, "ocb") == 0) {
 107                 *type = NL80211_IFTYPE_OCB;
 108                 return 0;
 109         } else if (strcmp(tpstr, "monitor") == 0) {
 110                 *type = NL80211_IFTYPE_MONITOR;
 111                 return 0;
 112         } else if (strcmp(tpstr, "master") == 0 ||
 113                    strcmp(tpstr, "ap") == 0) {
 114                 *type = NL80211_IFTYPE_UNSPECIFIED;
 115                 fprintf(stderr, "You need to run a management daemon, e.g. hostapd,\n");
 116                 fprintf(stderr, "see http://wireless.kernel.org/en/users/Documentation/hostapd\n");
 117                 fprintf(stderr, "for more information on how to do that.\n");
 118                 return 2;
 119         } else if (strcmp(tpstr, "__ap") == 0) {
 120                 *type = NL80211_IFTYPE_AP;
 121                 return 0;
 122         } else if (strcmp(tpstr, "__ap_vlan") == 0) {
 123                 *type = NL80211_IFTYPE_AP_VLAN;
 124                 return 0;
 125         } else if (strcmp(tpstr, "wds") == 0) {
 126                 *type = NL80211_IFTYPE_WDS;
 127                 return 0;
 128         } else if (strcmp(tpstr, "managed") == 0 ||
 129                    strcmp(tpstr, "mgd") == 0 ||
 130                    strcmp(tpstr, "station") == 0) {
 131                 *type = NL80211_IFTYPE_STATION;
 132                 return 0;
 133         } else if (strcmp(tpstr, "mp") == 0 ||
 134                    strcmp(tpstr, "mesh") == 0) {
 135                 *type = NL80211_IFTYPE_MESH_POINT;
 136                 return 0;
 137         } else if (strcmp(tpstr, "__p2pcl") == 0) {
 138                 *type = NL80211_IFTYPE_P2P_CLIENT;
 139                 return 0;
 140         } else if (strcmp(tpstr, "__p2pdev") == 0) {
 141                 *type = NL80211_IFTYPE_P2P_DEVICE;
 142                 return 0;
 143         } else if (strcmp(tpstr, "__p2pgo") == 0) {
 144                 *type = NL80211_IFTYPE_P2P_GO;
 145                 return 0;
 146         }
 147
 148         fprintf(stderr, "invalid interface type %s\n", tpstr);
 149         return 2;
 150 }
 151
 152 static int parse_4addr_flag(const char *value, struct nl_msg *msg)
 153 {
 154         if (strcmp(value, "on") == 0)
 155                 NLA_PUT_U8(msg, NL80211_ATTR_4ADDR, 1);
 156         else if (strcmp(value, "off") == 0)
 157                 NLA_PUT_U8(msg, NL80211_ATTR_4ADDR, 0);
 158         else
 159                 return 1;
 160         return 0;
 161
 162 nla_put_failure:
 163         return 1;
 164 }
 165
 166 static int handle_interface_add(struct nl80211_state *state,
 167                                 struct nl_msg *msg,
 168                                 int argc, char **argv,
 169                                 enum id_input id)
 170 {
 171         char *name;
 172         char *mesh_id = NULL;
 173         enum nl80211_iftype type;
 174         int tpset;
 175         unsigned char mac_addr[ETH_ALEN];
 176         int found_mac = 0;
 177
 178         if (argc < 1)
 179                 return 1;
 180
 181         name = argv[0];
 182         argc--;
 183         argv++;
 184
 185         tpset = get_if_type(&argc, &argv, &type, true);
 186         if (tpset)
 187                 return tpset;
 188
 189 try_another:
 190         if (argc) {
 191                 if (strcmp(argv[0], "mesh_id") == 0) {
 192                         argc--;
 193                         argv++;
 194
 195                         if (!argc)
 196                                 return 1;
 197                         mesh_id = argv[0];
 198                         argc--;
 199                         argv++;
 200                 } else if (strcmp(argv[0], "addr") == 0) {
 201                         argc--;
 202                         argv++;
 203                         if (mac_addr_a2n(mac_addr, argv[0])) {
 204                                 fprintf(stderr, "Invalid MAC address\n");
 205                                 return 2;
 206                         }
 207                         argc--;
 208                         argv++;
 209                         found_mac = 1;
 210                         goto try_another;
 211                 } else if (strcmp(argv[0], "4addr") == 0) {
 212                         argc--;
 213                         argv++;
 214                         if (parse_4addr_flag(argv[0], msg)) {
 215                                 fprintf(stderr, "4addr error\n");
 216                                 return 2;
 217                         }
 218                         argc--;
 219                         argv++;
 220                 } else if (strcmp(argv[0], "flags") == 0) {
 221                         argc--;
 222                         argv++;
 223                         if (parse_mntr_flags(&argc, &argv, msg)) {
 224                                 fprintf(stderr, "flags error\n");
 225                                 return 2;
 226                         }
 227                 } else {
 228                         return 1;
 229                 }
 230         }
 231
 232         if (argc)
 233                 return 1;
 234
 235         NLA_PUT_STRING(msg, NL80211_ATTR_IFNAME, name);
 236         NLA_PUT_U32(msg, NL80211_ATTR_IFTYPE, type);
 237         if (mesh_id)
 238                 NLA_PUT(msg, NL80211_ATTR_MESH_ID, strlen(mesh_id), mesh_id);
 239         if (found_mac)
 240                 NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr);
 241
 242         return 0;
 243  nla_put_failure:
 244         return -ENOBUFS;
 245 }
 246 COMMAND(interface, add, "<name> type <type> [mesh_id <meshid>] [4addr on|off] [flags <flag>*] [addr <mac-addr>]",
 247         NL80211_CMD_NEW_INTERFACE, 0, CIB_PHY, handle_interface_add,
 248         "Add a new virtual interface with the given configuration.\n"
 249         IFACE_TYPES "\n\n"
 250         "The flags are only used for monitor interfaces, valid flags are:\n"
 251         VALID_FLAGS "\n\n"
 252         "The mesh_id is used only for mesh mode.");
 253 COMMAND(interface, add, "<name> type <type> [mesh_id <meshid>] [4addr on|off] [flags <flag>*] [addr <mac-addr>]",
 254         NL80211_CMD_NEW_INTERFACE, 0, CIB_NETDEV, handle_interface_add, NULL);
 255
 256 static int handle_interface_del(struct nl80211_state *state,
 257                                 struct nl_msg *msg,
 258                                 int argc, char **argv,
 259                                 enum id_input id)
 260 {
 261         return 0;
 262 }
 263 TOPLEVEL(del, NULL, NL80211_CMD_DEL_INTERFACE, 0, CIB_NETDEV, handle_interface_del,
 264          "Remove this virtual interface");
 265 HIDDEN(interface, del, NULL, NL80211_CMD_DEL_INTERFACE, 0, CIB_NETDEV, handle_interface_del);
 266
 267 static char *channel_type_name(enum nl80211_channel_type channel_type)
 268 {
 269         switch (channel_type) {
 270         case NL80211_CHAN_NO_HT:
 271                 return "NO HT";
 272         case NL80211_CHAN_HT20:
 273                 return "HT20";
 274         case NL80211_CHAN_HT40MINUS:
 275                 return "HT40-";
 276         case NL80211_CHAN_HT40PLUS:
 277                 return "HT40+";
 278         default:
 279                 return "unknown";
 280         }
 281 }
 282
 283 char *channel_width_name(enum nl80211_chan_width width)
 284 {
 285         switch (width) {
 286         case NL80211_CHAN_WIDTH_20_NOHT:
 287                 return "20 MHz (no HT)";
 288         case NL80211_CHAN_WIDTH_20:
 289                 return "20 MHz";
 290         case NL80211_CHAN_WIDTH_40:
 291                 return "40 MHz";
 292         case NL80211_CHAN_WIDTH_80:
 293                 return "80 MHz";
 294         case NL80211_CHAN_WIDTH_80P80:
 295                 return "80+80 MHz";
 296         case NL80211_CHAN_WIDTH_160:
 297                 return "160 MHz";
 298         case NL80211_CHAN_WIDTH_5:
 299                 return "5 MHz";
 300         case NL80211_CHAN_WIDTH_10:
 301                 return "10 MHz";
 302         default:
 303                 return "unknown";
 304         }
 305 }
 306
 307 static int print_iface_handler(struct nl_msg *msg, void *arg)
 308 {
 309         struct genlmsghdr *gnlh = nlmsg_data(nlmsg_hdr(msg));
 310         struct nlattr *tb_msg[NL80211_ATTR_MAX + 1];
 311         unsigned int *wiphy = arg;
 312         const char *indent = "";
 313
 314         nla_parse(tb_msg, NL80211_ATTR_MAX, genlmsg_attrdata(gnlh, 0),
 315                   genlmsg_attrlen(gnlh, 0), NULL);
 316
 317         if (wiphy && tb_msg[NL80211_ATTR_WIPHY]) {
 318                 unsigned int thiswiphy = nla_get_u32(tb_msg[NL80211_ATTR_WIPHY]);
 319                 indent = "\t";
 320                 if (*wiphy != thiswiphy)
 321                         printf("phy#%d\n", thiswiphy);
 322                 *wiphy = thiswiphy;
 323         }
 324
 325         if (tb_msg[NL80211_ATTR_IFNAME])
 326                 printf("%sInterface %s\n", indent, nla_get_string(tb_msg[NL80211_ATTR_IFNAME]));
 327         else
 328                 printf("%sUnnamed/non-netdev interface\n", indent);
 329         if (tb_msg[NL80211_ATTR_IFINDEX])
 330                 printf("%s\tifindex %d\n", indent, nla_get_u32(tb_msg[NL80211_ATTR_IFINDEX]));
 331         if (tb_msg[NL80211_ATTR_WDEV])
 332                 printf("%s\twdev 0x%llx\n", indent,
 333                        (unsigned long long)nla_get_u64(tb_msg[NL80211_ATTR_WDEV]));
 334         if (tb_msg[NL80211_ATTR_MAC]) {
 335                 char mac_addr[20];
 336                 mac_addr_n2a(mac_addr, nla_data(tb_msg[NL80211_ATTR_MAC]));
 337                 printf("%s\taddr %s\n", indent, mac_addr);
 338         }
 339         if (tb_msg[NL80211_ATTR_SSID]) {
 340                 printf("%s\tssid ", indent);
 341                 print_ssid_escaped(nla_len(tb_msg[NL80211_ATTR_SSID]),
 342                                    nla_data(tb_msg[NL80211_ATTR_SSID]));
 343                 printf("\n");
 344         }
 345         if (tb_msg[NL80211_ATTR_IFTYPE])
 346                 printf("%s\ttype %s\n", indent, iftype_name(nla_get_u32(tb_msg[NL80211_ATTR_IFTYPE])));
 347         if (!wiphy && tb_msg[NL80211_ATTR_WIPHY])
 348                 printf("%s\twiphy %d\n", indent, nla_get_u32(tb_msg[NL80211_ATTR_WIPHY]));
 349         if (tb_msg[NL80211_ATTR_WIPHY_FREQ]) {
 350                 uint32_t freq = nla_get_u32(tb_msg[NL80211_ATTR_WIPHY_FREQ]);
 351
 352                 printf("%s\tchannel %d (%d MHz)", indent,
 353                        ieee80211_frequency_to_channel(freq), freq);
 354
 355                 if (tb_msg[NL80211_ATTR_CHANNEL_WIDTH]) {
 356                         printf(", width: %s",
 357                                 channel_width_name(nla_get_u32(tb_msg[NL80211_ATTR_CHANNEL_WIDTH])));
 358                         if (tb_msg[NL80211_ATTR_CENTER_FREQ1])
 359                                 printf(", center1: %d MHz",
 360                                         nla_get_u32(tb_msg[NL80211_ATTR_CENTER_FREQ1]));
 361                         if (tb_msg[NL80211_ATTR_CENTER_FREQ2])
 362                                 printf(", center2: %d MHz",
 363                                         nla_get_u32(tb_msg[NL80211_ATTR_CENTER_FREQ2]));
 364                 } else if (tb_msg[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) {
 365                         enum nl80211_channel_type channel_type;
 366
 367                         channel_type = nla_get_u32(tb_msg[NL80211_ATTR_WIPHY_CHANNEL_TYPE]);
 368                         printf(" %s", channel_type_name(channel_type));
 369                 }
 370
 371                 printf("\n");
 372         }
 373
 374         if (tb_msg[NL80211_ATTR_WIPHY_TX_POWER_LEVEL]) {
 375                 uint32_t txp = nla_get_u32(tb_msg[NL80211_ATTR_WIPHY_TX_POWER_LEVEL]);
 376
 377                 printf("%s\ttxpower %d.%.2d dBm\n",
 378                        indent, txp / 100, txp % 100);
 379         }
 380
 381         return NL_SKIP;
 382 }
 383
 384 static int handle_interface_info(struct nl80211_state *state,
 385                                  struct nl_msg *msg,
 386                                  int argc, char **argv,
 387                                  enum id_input id)
 388 {
 389         register_handler(print_iface_handler, NULL);
 390         return 0;
 391 }
 392 TOPLEVEL(info, NULL, NL80211_CMD_GET_INTERFACE, 0, CIB_NETDEV, handle_interface_info,
 393          "Show information for this interface.");
 394
 395 static int handle_interface_set(struct nl80211_state *state,
 396                                 struct nl_msg *msg,
 397                                 int argc, char **argv,
 398                                 enum id_input id)
 399 {
 400         if (!argc)
 401                 return 1;
 402
 403         NLA_PUT_U32(msg, NL80211_ATTR_IFTYPE, NL80211_IFTYPE_MONITOR);
 404
 405         switch (parse_mntr_flags(&argc, &argv, msg)) {
 406         case 0:
 407                 return 0;
 408         case -ENOMEM:
 409                 fprintf(stderr, "failed to allocate flags\n");
 410                 return 2;
 411         case -EINVAL:
 412                 fprintf(stderr, "unknown flag %s\n", *argv);
 413                 return 2;
 414         default:
 415                 return 2;
 416         }
 417  nla_put_failure:
 418         return -ENOBUFS;
 419 }
 420 COMMAND(set, monitor, "<flag>*",
 421         NL80211_CMD_SET_INTERFACE, 0, CIB_NETDEV, handle_interface_set,
 422         "Set monitor flags. Valid flags are:\n"
 423         VALID_FLAGS);
 424
 425 static int handle_interface_meshid(struct nl80211_state *state,
 426                                    struct nl_msg *msg,
 427                                    int argc, char **argv,
 428                                    enum id_input id)
 429 {
 430         char *mesh_id = NULL;
 431
 432         if (argc != 1)
 433                 return 1;
 434
 435         mesh_id = argv[0];
 436
 437         NLA_PUT(msg, NL80211_ATTR_MESH_ID, strlen(mesh_id), mesh_id);
 438
 439         return 0;
 440  nla_put_failure:
 441         return -ENOBUFS;
 442 }
 443 COMMAND(set, meshid, "<meshid>",
 444         NL80211_CMD_SET_INTERFACE, 0, CIB_NETDEV, handle_interface_meshid, NULL);
 445
 446 static unsigned int dev_dump_wiphy;
 447
 448 static int handle_dev_dump(struct nl80211_state *state,
 449                            struct nl_msg *msg,
 450                            int argc, char **argv,
 451                            enum id_input id)
 452 {
 453         dev_dump_wiphy = -1;
 454         register_handler(print_iface_handler, &dev_dump_wiphy);
 455         return 0;
 456 }
 457 TOPLEVEL(dev, NULL, NL80211_CMD_GET_INTERFACE, NLM_F_DUMP, CIB_NONE, handle_dev_dump,
 458          "List all network interfaces for wireless hardware.");
 459
 460 static int handle_interface_type(struct nl80211_state *state,
 461                                  struct nl_msg *msg,
 462                                  int argc, char **argv,
 463                                  enum id_input id)
 464 {
 465         enum nl80211_iftype type;
 466         int tpset;
 467
 468         tpset = get_if_type(&argc, &argv, &type, false);
 469         if (tpset)
 470                 return tpset;
 471
 472         if (argc)
 473                 return 1;
 474
 475         NLA_PUT_U32(msg, NL80211_ATTR_IFTYPE, type);
 476
 477         return 0;
 478  nla_put_failure:
 479         return -ENOBUFS;
 480 }
 481 COMMAND(set, type, "<type>",
 482         NL80211_CMD_SET_INTERFACE, 0, CIB_NETDEV, handle_interface_type,
 483         "Set interface type/mode.\n"
 484         IFACE_TYPES);
 485
 486 static int handle_interface_4addr(struct nl80211_state *state,
 487                                   struct nl_msg *msg,
 488                                   int argc, char **argv,
 489                                   enum id_input id)
 490 {
 491         if (argc != 1)
 492                 return 1;
 493         return parse_4addr_flag(argv[0], msg);
 494 }
 495 COMMAND(set, 4addr, "<on|off>",
 496         NL80211_CMD_SET_INTERFACE, 0, CIB_NETDEV, handle_interface_4addr,
 497         "Set interface 4addr (WDS) mode.");
 498
 499 static int handle_interface_noack_map(struct nl80211_state *state,
 500                                       struct nl_msg *msg,
 501                                       int argc, char **argv,
 502                                       enum id_input id)
 503 {
 504         uint16_t noack_map;
 505         char *end;
 506
 507         if (argc != 1)
 508                 return 1;
 509
 510         noack_map = strtoul(argv[0], &end, 16);
 511         if (*end)
 512                 return 1;
 513
 514         NLA_PUT_U16(msg, NL80211_ATTR_NOACK_MAP, noack_map);
 515
 516         return 0;
 517  nla_put_failure:
 518         return -ENOBUFS;
 519
 520 }
 521 COMMAND(set, noack_map, "<map>",
 522         NL80211_CMD_SET_NOACK_MAP, 0, CIB_NETDEV, handle_interface_noack_map,
 523         "Set the NoAck map for the TIDs. (0x0009 = BE, 0x0006 = BK, 0x0030 = VI, 0x00C0 = VO)");
 524
 525
 526 static int handle_interface_wds_peer(struct nl80211_state *state,
 527                                      struct nl_msg *msg,
 528                                      int argc, char **argv,
 529                                      enum id_input id)
 530 {
 531         unsigned char mac_addr[ETH_ALEN];
 532
 533         if (argc < 1)
 534                 return 1;
 535
 536         if (mac_addr_a2n(mac_addr, argv[0])) {
 537                 fprintf(stderr, "Invalid MAC address\n");
 538                 return 2;
 539         }
 540
 541         argc--;
 542         argv++;
 543
 544         if (argc)
 545                 return 1;
 546
 547         NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr);
 548
 549         return 0;
 550  nla_put_failure:
 551         return -ENOBUFS;
 552 }
 553 COMMAND(set, peer, "<MAC address>",
 554         NL80211_CMD_SET_WDS_PEER, 0, CIB_NETDEV, handle_interface_wds_peer,
 555         "Set interface WDS peer.");
 556
 557 static int set_mcast_rate(struct nl80211_state *state,
 558                           struct nl_msg *msg,
 559                           int argc, char **argv,
 560                           enum id_input id)
 561 {
 562         float rate;
 563         char *end;
 564
 565         if (argc != 1)
 566                 return 1;
 567
 568         rate = strtod(argv[0], &end);
 569         if (*end != '\0')
 570                 return 1;
 571
 572         NLA_PUT_U32(msg, NL80211_ATTR_MCAST_RATE, (int)(rate * 10));
 573
 574         return 0;
 575 nla_put_failure:
 576         return -ENOBUFS;
 577 }
 578
 579 COMMAND(set, mcast_rate, "<rate in Mbps>",
 580         NL80211_CMD_SET_MCAST_RATE, 0, CIB_NETDEV, set_mcast_rate,
 581         "Set the multicast bitrate.");