mpp.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(mpp);
  15
  16 static int print_mpp_handler(struct nl_msg *msg, void *arg)
  17 {
  18         struct nlattr *tb[NL80211_ATTR_MAX + 1];
  19         struct genlmsghdr *gnlh = nlmsg_data(nlmsg_hdr(msg));
  20         char dst[20], next_hop[20], dev[20];
  21
  22         nla_parse(tb, NL80211_ATTR_MAX, genlmsg_attrdata(gnlh, 0),
  23                   genlmsg_attrlen(gnlh, 0), NULL);
  24
  25         /*
  26          * TODO: validate the interface and mac address!
  27          * Otherwise, there's a race condition as soon as
  28          * the kernel starts sending mpath notifications.
  29          */
  30
  31         mac_addr_n2a(dst, nla_data(tb[NL80211_ATTR_MAC]));
  32         mac_addr_n2a(next_hop, nla_data(tb[NL80211_ATTR_MPATH_NEXT_HOP]));
  33         if_indextoname(nla_get_u32(tb[NL80211_ATTR_IFINDEX]), dev);
  34         printf("%s %s %s\n", dst, next_hop, dev);
  35
  36         return NL_SKIP;
  37 }
  38
  39 static int handle_mpp_get(struct nl80211_state *state,
  40                           struct nl_cb *cb,
  41                           struct nl_msg *msg,
  42                           int argc, char **argv,
  43                           enum id_input id)
  44 {
  45         unsigned char dst[ETH_ALEN];
  46
  47         if (argc < 1)
  48                 return 1;
  49
  50         if (mac_addr_a2n(dst, argv[0])) {
  51                 fprintf(stderr, "invalid mac address\n");
  52                 return 2;
  53         }
  54         argc--;
  55         argv++;
  56
  57         if (argc)
  58                 return 1;
  59
  60         NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, dst);
  61
  62         nl_cb_set(cb, NL_CB_VALID, NL_CB_CUSTOM, print_mpp_handler, NULL);
  63
  64         return 0;
  65  nla_put_failure:
  66         return -ENOBUFS;
  67 }
  68 COMMAND(mpp, get, "<MAC address>",
  69         NL80211_CMD_GET_MPP, 0, CIB_NETDEV, handle_mpp_get,
  70         "Get information on mesh proxy path to the given node.");
  71
  72 static int handle_mpp_dump(struct nl80211_state *state,
  73                              struct nl_cb *cb,
  74                              struct nl_msg *msg,
  75                              int argc, char **argv,
  76                              enum id_input id)
  77 {
  78         printf("DEST ADDR         PROXY NODE        IFACE\n");
  79         nl_cb_set(cb, NL_CB_VALID, NL_CB_CUSTOM, print_mpp_handler, NULL);
  80         return 0;
  81 }
  82 COMMAND(mpp, dump, NULL,
  83         NL80211_CMD_GET_MPP, NLM_F_DUMP, CIB_NETDEV, handle_mpp_dump,
  84         "List known mesh proxy paths.");