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>
27 static int print_mpath_handler(struct nl_msg
*msg
, void *arg
)
29 struct nlattr
*tb
[NL80211_ATTR_MAX
+ 1];
30 struct genlmsghdr
*gnlh
= nlmsg_data(nlmsg_hdr(msg
));
31 struct nlattr
*pinfo
[NL80211_MPATH_INFO_MAX
+ 1];
32 char dst
[20], next_hop
[20], dev
[20];
33 static struct nla_policy mpath_policy
[NL80211_MPATH_INFO_MAX
+ 1] = {
34 [NL80211_MPATH_INFO_FRAME_QLEN
] = { .type
= NLA_U32
},
35 [NL80211_MPATH_INFO_SN
] = { .type
= NLA_U32
},
36 [NL80211_MPATH_INFO_METRIC
] = { .type
= NLA_U32
},
37 [NL80211_MPATH_INFO_EXPTIME
] = { .type
= NLA_U32
},
38 [NL80211_MPATH_INFO_DISCOVERY_TIMEOUT
] = { .type
= NLA_U32
},
39 [NL80211_MPATH_INFO_DISCOVERY_RETRIES
] = { .type
= NLA_U8
},
40 [NL80211_MPATH_INFO_FLAGS
] = { .type
= NLA_U8
},
43 nla_parse(tb
, NL80211_ATTR_MAX
, genlmsg_attrdata(gnlh
, 0),
44 genlmsg_attrlen(gnlh
, 0), NULL
);
47 * TODO: validate the interface and mac address!
48 * Otherwise, there's a race condition as soon as
49 * the kernel starts sending mpath notifications.
52 if (!tb
[NL80211_ATTR_MPATH_INFO
]) {
53 fprintf(stderr
, "mpath info missing!\n");
56 if (nla_parse_nested(pinfo
, NL80211_MPATH_INFO_MAX
,
57 tb
[NL80211_ATTR_MPATH_INFO
],
59 fprintf(stderr
, "failed to parse nested attributes!\n");
63 mac_addr_n2a(dst
, nla_data(tb
[NL80211_ATTR_MAC
]));
64 mac_addr_n2a(next_hop
, nla_data(tb
[NL80211_ATTR_MPATH_NEXT_HOP
]));
65 if_indextoname(nla_get_u32(tb
[NL80211_ATTR_IFINDEX
]), dev
);
66 printf("%s %s %s", dst
, next_hop
, dev
);
67 if (pinfo
[NL80211_MPATH_INFO_SN
])
69 nla_get_u32(pinfo
[NL80211_MPATH_INFO_SN
]));
70 if (pinfo
[NL80211_MPATH_INFO_METRIC
])
72 nla_get_u32(pinfo
[NL80211_MPATH_INFO_METRIC
]));
73 if (pinfo
[NL80211_MPATH_INFO_FRAME_QLEN
])
75 nla_get_u32(pinfo
[NL80211_MPATH_INFO_FRAME_QLEN
]));
76 if (pinfo
[NL80211_MPATH_INFO_EXPTIME
])
78 nla_get_u32(pinfo
[NL80211_MPATH_INFO_EXPTIME
]));
79 if (pinfo
[NL80211_MPATH_INFO_DISCOVERY_TIMEOUT
])
81 nla_get_u32(pinfo
[NL80211_MPATH_INFO_DISCOVERY_TIMEOUT
]));
82 if (pinfo
[NL80211_MPATH_INFO_DISCOVERY_RETRIES
])
84 nla_get_u8(pinfo
[NL80211_MPATH_INFO_DISCOVERY_RETRIES
]));
85 if (pinfo
[NL80211_MPATH_INFO_FLAGS
])
87 nla_get_u8(pinfo
[NL80211_MPATH_INFO_FLAGS
]));
93 static int handle_mpath_probe(struct nl80211_state
*state
,
95 int argc
, char **argv
,
98 unsigned char dst
[ETH_ALEN
];
105 if (mac_addr_a2n(dst
, argv
[0])) {
106 fprintf(stderr
, "invalid mac address\n");
110 if (strcmp("frame", argv
[1]) != 0)
113 frame
= parse_hex(argv
[2], &frame_len
);
115 fprintf(stderr
, "invalid frame pattern: %p\n", frame
);
119 NLA_PUT(msg
, NL80211_ATTR_MAC
, ETH_ALEN
, dst
);
120 NLA_PUT(msg
, NL80211_ATTR_FRAME
, frame_len
, frame
);
126 COMMAND(mpath
, probe
, "<destination MAC address> frame <frame>",
127 NL80211_CMD_PROBE_MESH_LINK
, 0, CIB_NETDEV
, handle_mpath_probe
,
128 "Inject ethernet frame to given peer overriding the next hop\n"
129 "lookup from mpath table.\n."
130 "Example: iw dev wlan0 mpath probe xx:xx:xx:xx:xx:xx frame 01:xx:xx:00\n");
132 static int handle_mpath_get(struct nl80211_state
*state
,
134 int argc
, char **argv
,
137 unsigned char dst
[ETH_ALEN
];
142 if (mac_addr_a2n(dst
, argv
[0])) {
143 fprintf(stderr
, "invalid mac address\n");
152 NLA_PUT(msg
, NL80211_ATTR_MAC
, ETH_ALEN
, dst
);
154 register_handler(print_mpath_handler
, NULL
);
160 COMMAND(mpath
, get
, "<MAC address>",
161 NL80211_CMD_GET_MPATH
, 0, CIB_NETDEV
, handle_mpath_get
,
162 "Get information on mesh path to the given node.");
163 COMMAND(mpath
, del
, "<MAC address>",
164 NL80211_CMD_DEL_MPATH
, 0, CIB_NETDEV
, handle_mpath_get
,
165 "Remove the mesh path to the given node.");
167 static int handle_mpath_set(struct nl80211_state
*state
,
169 int argc
, char **argv
,
172 unsigned char dst
[ETH_ALEN
];
173 unsigned char next_hop
[ETH_ALEN
];
178 if (mac_addr_a2n(dst
, argv
[0])) {
179 fprintf(stderr
, "invalid destination mac address\n");
185 if (strcmp("next_hop", argv
[0]) != 0)
190 if (mac_addr_a2n(next_hop
, argv
[0])) {
191 fprintf(stderr
, "invalid next hop mac address\n");
200 NLA_PUT(msg
, NL80211_ATTR_MAC
, ETH_ALEN
, dst
);
201 NLA_PUT(msg
, NL80211_ATTR_MPATH_NEXT_HOP
, ETH_ALEN
, next_hop
);
203 register_handler(print_mpath_handler
, NULL
);
208 COMMAND(mpath
, new, "<destination MAC address> next_hop <next hop MAC address>",
209 NL80211_CMD_NEW_MPATH
, 0, CIB_NETDEV
, handle_mpath_set
,
210 "Create a new mesh path (instead of relying on automatic discovery).");
211 COMMAND(mpath
, set
, "<destination MAC address> next_hop <next hop MAC address>",
212 NL80211_CMD_SET_MPATH
, 0, CIB_NETDEV
, handle_mpath_set
,
213 "Set an existing mesh path's next hop.");
215 static int handle_mpath_dump(struct nl80211_state
*state
,
217 int argc
, char **argv
,
220 printf("DEST ADDR NEXT HOP IFACE\tSN\tMETRIC\tQLEN\t"
221 "EXPTIME\t\tDTIM\tDRET\tFLAGS\n");
222 register_handler(print_mpath_handler
, NULL
);
225 COMMAND(mpath
, dump
, NULL
,
226 NL80211_CMD_GET_MPATH
, NLM_F_DUMP
, CIB_NETDEV
, handle_mpath_dump
,
227 "List known mesh paths.");