| #include <net/if.h> |
| #include <errno.h> |
| #include <string.h> |
| |
| #include <netlink/genl/genl.h> |
| #include <netlink/genl/family.h> |
| #include <netlink/genl/ctrl.h> |
| #include <netlink/msg.h> |
| #include <netlink/attr.h> |
| |
| #include "nl80211.h" |
| #include "iw.h" |
| |
| SECTION(mpath); |
| |
| enum plink_state { |
| LISTEN, |
| OPN_SNT, |
| OPN_RCVD, |
| CNF_RCVD, |
| ESTAB, |
| HOLDING, |
| BLOCKED |
| }; |
| |
| |
| static int print_mpath_handler(struct nl_msg *msg, void *arg) |
| { |
| struct nlattr *tb[NL80211_ATTR_MAX + 1]; |
| struct genlmsghdr *gnlh = nlmsg_data(nlmsg_hdr(msg)); |
| struct nlattr *pinfo[NL80211_MPATH_INFO_MAX + 1]; |
| char dst[20], next_hop[20], dev[20]; |
| static struct nla_policy mpath_policy[NL80211_MPATH_INFO_MAX + 1] = { |
| [NL80211_MPATH_INFO_FRAME_QLEN] = { .type = NLA_U32 }, |
| [NL80211_MPATH_INFO_SN] = { .type = NLA_U32 }, |
| [NL80211_MPATH_INFO_METRIC] = { .type = NLA_U32 }, |
| [NL80211_MPATH_INFO_EXPTIME] = { .type = NLA_U32 }, |
| [NL80211_MPATH_INFO_DISCOVERY_TIMEOUT] = { .type = NLA_U32 }, |
| [NL80211_MPATH_INFO_DISCOVERY_RETRIES] = { .type = NLA_U8 }, |
| [NL80211_MPATH_INFO_FLAGS] = { .type = NLA_U8 }, |
| }; |
| |
| nla_parse(tb, NL80211_ATTR_MAX, genlmsg_attrdata(gnlh, 0), |
| genlmsg_attrlen(gnlh, 0), NULL); |
| |
| /* |
| * TODO: validate the interface and mac address! |
| * Otherwise, there's a race condition as soon as |
| * the kernel starts sending mpath notifications. |
| */ |
| |
| if (!tb[NL80211_ATTR_MPATH_INFO]) { |
| fprintf(stderr, "mpath info missing!\n"); |
| return NL_SKIP; |
| } |
| if (nla_parse_nested(pinfo, NL80211_MPATH_INFO_MAX, |
| tb[NL80211_ATTR_MPATH_INFO], |
| mpath_policy)) { |
| fprintf(stderr, "failed to parse nested attributes!\n"); |
| return NL_SKIP; |
| } |
| |
| mac_addr_n2a(dst, nla_data(tb[NL80211_ATTR_MAC])); |
| mac_addr_n2a(next_hop, nla_data(tb[NL80211_ATTR_MPATH_NEXT_HOP])); |
| if_indextoname(nla_get_u32(tb[NL80211_ATTR_IFINDEX]), dev); |
| printf("%s %s %s", dst, next_hop, dev); |
| if (pinfo[NL80211_MPATH_INFO_SN]) |
| printf("\t%u", |
| nla_get_u32(pinfo[NL80211_MPATH_INFO_SN])); |
| if (pinfo[NL80211_MPATH_INFO_METRIC]) |
| printf("\t%u", |
| nla_get_u32(pinfo[NL80211_MPATH_INFO_METRIC])); |
| if (pinfo[NL80211_MPATH_INFO_FRAME_QLEN]) |
| printf("\t%u", |
| nla_get_u32(pinfo[NL80211_MPATH_INFO_FRAME_QLEN])); |
| if (pinfo[NL80211_MPATH_INFO_EXPTIME]) |
| printf("\t%u", |
| nla_get_u32(pinfo[NL80211_MPATH_INFO_EXPTIME])); |
| if (pinfo[NL80211_MPATH_INFO_DISCOVERY_TIMEOUT]) |
| printf("\t%u", |
| nla_get_u32(pinfo[NL80211_MPATH_INFO_DISCOVERY_TIMEOUT])); |
| if (pinfo[NL80211_MPATH_INFO_DISCOVERY_RETRIES]) |
| printf("\t%u", |
| nla_get_u8(pinfo[NL80211_MPATH_INFO_DISCOVERY_RETRIES])); |
| if (pinfo[NL80211_MPATH_INFO_FLAGS]) |
| printf("\t0x%x", |
| nla_get_u8(pinfo[NL80211_MPATH_INFO_FLAGS])); |
| |
| printf("\n"); |
| return NL_SKIP; |
| } |
| |
| static int handle_mpath_get(struct nl80211_state *state, |
| struct nl_cb *cb, |
| struct nl_msg *msg, |
| int argc, char **argv, |
| enum id_input id) |
| { |
| unsigned char dst[ETH_ALEN]; |
| |
| if (argc < 1) |
| return 1; |
| |
| if (mac_addr_a2n(dst, argv[0])) { |
| fprintf(stderr, "invalid mac address\n"); |
| return 2; |
| } |
| argc--; |
| argv++; |
| |
| if (argc) |
| return 1; |
| |
| NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, dst); |
| |
| nl_cb_set(cb, NL_CB_VALID, NL_CB_CUSTOM, print_mpath_handler, NULL); |
| |
| return 0; |
| nla_put_failure: |
| return -ENOBUFS; |
| } |
| COMMAND(mpath, get, "<MAC address>", |
| NL80211_CMD_GET_MPATH, 0, CIB_NETDEV, handle_mpath_get, |
| "Get information on mesh path to the given node."); |
| COMMAND(mpath, del, "<MAC address>", |
| NL80211_CMD_DEL_MPATH, 0, CIB_NETDEV, handle_mpath_get, |
| "Remove the mesh path to the given node."); |
| |
| static int handle_mpath_set(struct nl80211_state *state, |
| struct nl_cb *cb, |
| struct nl_msg *msg, |
| int argc, char **argv, |
| enum id_input id) |
| { |
| unsigned char dst[ETH_ALEN]; |
| unsigned char next_hop[ETH_ALEN]; |
| |
| if (argc < 3) |
| return 1; |
| |
| if (mac_addr_a2n(dst, argv[0])) { |
| fprintf(stderr, "invalid destination mac address\n"); |
| return 2; |
| } |
| argc--; |
| argv++; |
| |
| if (strcmp("next_hop", argv[0]) != 0) |
| return 1; |
| argc--; |
| argv++; |
| |
| if (mac_addr_a2n(next_hop, argv[0])) { |
| fprintf(stderr, "invalid next hop mac address\n"); |
| return 2; |
| } |
| argc--; |
| argv++; |
| |
| if (argc) |
| return 1; |
| |
| NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, dst); |
| NLA_PUT(msg, NL80211_ATTR_MPATH_NEXT_HOP, ETH_ALEN, next_hop); |
| |
| nl_cb_set(cb, NL_CB_VALID, NL_CB_CUSTOM, print_mpath_handler, NULL); |
| return 0; |
| nla_put_failure: |
| return -ENOBUFS; |
| } |
| COMMAND(mpath, new, "<destination MAC address> next_hop <next hop MAC address>", |
| NL80211_CMD_NEW_MPATH, 0, CIB_NETDEV, handle_mpath_set, |
| "Create a new mesh path (instead of relying on automatic discovery)."); |
| COMMAND(mpath, set, "<destination MAC address> next_hop <next hop MAC address>", |
| NL80211_CMD_SET_MPATH, 0, CIB_NETDEV, handle_mpath_set, |
| "Set an existing mesh path's next hop."); |
| |
| static int handle_mpath_dump(struct nl80211_state *state, |
| struct nl_cb *cb, |
| struct nl_msg *msg, |
| int argc, char **argv, |
| enum id_input id) |
| { |
| printf("DEST ADDR NEXT HOP IFACE\tSN\tMETRIC\tQLEN\t" |
| "EXPTIME\t\tDTIM\tDRET\tFLAGS\n"); |
| nl_cb_set(cb, NL_CB_VALID, NL_CB_CUSTOM, print_mpath_handler, NULL); |
| return 0; |
| } |
| COMMAND(mpath, dump, NULL, |
| NL80211_CMD_GET_MPATH, NLM_F_DUMP, CIB_NETDEV, handle_mpath_dump, |
| "List known mesh paths."); |