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
print_mpp_handler(struct nl_msg * msg,void * arg)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
handle_mpp_get(struct nl80211_state * state,struct nl_cb * cb,struct nl_msg * msg,int argc,char ** argv,enum id_input id)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
handle_mpp_dump(struct nl80211_state * state,struct nl_cb * cb,struct nl_msg * msg,int argc,char ** argv,enum id_input id)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.");
85