| @@ -35,6 +35,7 @@ · 34 unmodified lines |
| 35 | 35 | #include <linux/list.h> |
| 36 | 36 | #include <linux/lockdep.h> |
| 37 | 37 | #include <linux/netdevice.h> |
| 38 | +#include <linux/netlink.h> |
| 38 | 39 | #include <linux/pkt_sched.h> |
| 39 | 40 | #include <linux/printk.h> |
| 40 | 41 | #include <linux/random.h> |
| @@ -48,6 +49,9 @@ · 7 unmodified lines |
| 48 | 49 | #include <linux/string.h> |
| 49 | 50 | #include <linux/types.h> |
| 50 | 51 | #include <linux/workqueue.h> |
| 52 | +#include <net/genetlink.h> |
| 53 | +#include <net/netlink.h> |
| 54 | +#include <uapi/linux/batman_adv.h> |
| 51 | 55 | |
| 52 | 56 | #include "bat_algo.h" |
| 53 | 57 | #include "bitarray.h" |
| @@ -55,6 +59,7 @@ · 1 unmodified line |
| 55 | 59 | #include "hard-interface.h" |
| 56 | 60 | #include "hash.h" |
| 57 | 61 | #include "log.h" |
| 62 | +#include "netlink.h" |
| 58 | 63 | #include "network-coding.h" |
| 59 | 64 | #include "originator.h" |
| 60 | 65 | #include "packet.h" |
| @@ -1947,6 +1952,235 @@ next: · 1886 unmodified lines |
| 1947 | 1952 | seq_puts(seq, "No batman nodes in range ...\n"); |
| 1948 | 1953 | } |
| 1949 | 1954 | |
| 1955 | +/** |
| 1956 | + * batadv_iv_ogm_neigh_get_tq_avg - Get the TQ average for a neighbour on a |
| 1957 | + * given outgoing interface. |
| 1958 | + * @neigh_node: Neighbour of interest |
| 1959 | + * @if_outgoing: Outgoing interface of interest |
| 1960 | + * @tq_avg: Pointer of where to store the TQ average |
| 1961 | + * |
| 1962 | + * Return: False if no average TQ available, otherwise true. |
| 1963 | + */ |
| 1964 | +static bool |
| 1965 | +batadv_iv_ogm_neigh_get_tq_avg(struct batadv_neigh_node *neigh_node, |
| 1966 | + struct batadv_hard_iface *if_outgoing, |
| 1967 | + u8 *tq_avg) |
| 1968 | +{ |
| 1969 | + struct batadv_neigh_ifinfo *n_ifinfo; |
| 1970 | + |
| 1971 | + n_ifinfo = batadv_neigh_ifinfo_get(neigh_node, if_outgoing); |
| 1972 | + if (!n_ifinfo) |
| 1973 | + return false; |
| 1974 | + |
| 1975 | + *tq_avg = n_ifinfo->bat_iv.tq_avg; |
| 1976 | + batadv_neigh_ifinfo_put(n_ifinfo); |
| 1977 | + |
| 1978 | + return true; |
| 1979 | +} |
| 1980 | + |
| 1981 | +/** |
| 1982 | + * batadv_iv_ogm_orig_dump_subentry - Dump an originator subentry into a |
| 1983 | + * message |
| 1984 | + * @msg: Netlink message to dump into |
| 1985 | + * @portid: Port making netlink request |
| 1986 | + * @seq: Sequence number of netlink message |
| 1987 | + * @bat_priv: The bat priv with all the soft interface information |
| 1988 | + * @if_outgoing: Limit dump to entries with this outgoing interface |
| 1989 | + * @orig_node: Originator to dump |
| 1990 | + * @neigh_node: Single hops neighbour |
| 1991 | + * @best: Is the best originator |
| 1992 | + * |
| 1993 | + * Return: Error code, or 0 on success |
| 1994 | + */ |
| 1995 | +static int |
| 1996 | +batadv_iv_ogm_orig_dump_subentry(struct sk_buff *msg, u32 portid, u32 seq, |
| 1997 | + struct batadv_priv *bat_priv, |
| 1998 | + struct batadv_hard_iface *if_outgoing, |
| 1999 | + struct batadv_orig_node *orig_node, |
| 2000 | + struct batadv_neigh_node *neigh_node, |
| 2001 | + bool best) |
| 2002 | +{ |
| 2003 | + void *hdr; |
| 2004 | + u8 tq_avg; |
| 2005 | + unsigned int last_seen_msecs; |
| 2006 | + |
| 2007 | + last_seen_msecs = jiffies_to_msecs(jiffies - orig_node->last_seen); |
| 2008 | + |
| 2009 | + if (!batadv_iv_ogm_neigh_get_tq_avg(neigh_node, if_outgoing, &tq_avg)) |
| 2010 | + return 0; |
| 2011 | + |
| 2012 | + if (if_outgoing != BATADV_IF_DEFAULT && |
| 2013 | + if_outgoing != neigh_node->if_incoming) |
| 2014 | + return 0; |
| 2015 | + |
| 2016 | + hdr = genlmsg_put(msg, portid, seq, &batadv_netlink_family, |
| 2017 | + NLM_F_MULTI, BATADV_CMD_GET_ORIGINATORS); |
| 2018 | + if (!hdr) |
| 2019 | + return -ENOBUFS; |
| 2020 | + |
| 2021 | + if (nla_put(msg, BATADV_ATTR_ORIG_ADDRESS, ETH_ALEN, |
| 2022 | + orig_node->orig) || |
| 2023 | + nla_put(msg, BATADV_ATTR_NEIGH_ADDRESS, ETH_ALEN, |
| 2024 | + neigh_node->addr) || |
| 2025 | + nla_put_u32(msg, BATADV_ATTR_HARD_IFINDEX, |
| 2026 | + neigh_node->if_incoming->net_dev->ifindex) || |
| 2027 | + nla_put_u8(msg, BATADV_ATTR_TQ, tq_avg) || |
| 2028 | + nla_put_u32(msg, BATADV_ATTR_LAST_SEEN_MSECS, |
| 2029 | + last_seen_msecs)) |
| 2030 | + goto nla_put_failure; |
| 2031 | + |
| 2032 | + if (best && nla_put_flag(msg, BATADV_ATTR_FLAG_BEST)) |
| 2033 | + goto nla_put_failure; |
| 2034 | + |
| 2035 | + genlmsg_end(msg, hdr); |
| 2036 | + return 0; |
| 2037 | + |
| 2038 | + nla_put_failure: |
| 2039 | + genlmsg_cancel(msg, hdr); |
| 2040 | + return -EMSGSIZE; |
| 2041 | +} |
| 2042 | + |
| 2043 | +/** |
| 2044 | + * batadv_iv_ogm_orig_dump_entry - Dump an originator entry into a message |
| 2045 | + * @msg: Netlink message to dump into |
| 2046 | + * @portid: Port making netlink request |
| 2047 | + * @seq: Sequence number of netlink message |
| 2048 | + * @bat_priv: The bat priv with all the soft interface information |
| 2049 | + * @if_outgoing: Limit dump to entries with this outgoing interface |
| 2050 | + * @orig_node: Originator to dump |
| 2051 | + * @sub_s: Number of sub entries to skip |
| 2052 | + * |
| 2053 | + * This function assumes the caller holds rcu_read_lock(). |
| 2054 | + * |
| 2055 | + * Return: Error code, or 0 on success |
| 2056 | + */ |
| 2057 | +static int |
| 2058 | +batadv_iv_ogm_orig_dump_entry(struct sk_buff *msg, u32 portid, u32 seq, |
| 2059 | + struct batadv_priv *bat_priv, |
| 2060 | + struct batadv_hard_iface *if_outgoing, |
| 2061 | + struct batadv_orig_node *orig_node, int *sub_s) |
| 2062 | +{ |
| 2063 | + struct batadv_neigh_node *neigh_node_best; |
| 2064 | + struct batadv_neigh_node *neigh_node; |
| 2065 | + int sub = 0; |
| 2066 | + bool best; |
| 2067 | + u8 tq_avg_best; |
| 2068 | + |
| 2069 | + neigh_node_best = batadv_orig_router_get(orig_node, if_outgoing); |
| 2070 | + if (!neigh_node_best) |
| 2071 | + goto out; |
| 2072 | + |
| 2073 | + if (!batadv_iv_ogm_neigh_get_tq_avg(neigh_node_best, if_outgoing, |
| 2074 | + &tq_avg_best)) |
| 2075 | + goto out; |
| 2076 | + |
| 2077 | + if (tq_avg_best == 0) |
| 2078 | + goto out; |
| 2079 | + |
| 2080 | + hlist_for_each_entry_rcu(neigh_node, &orig_node->neigh_list, list) { |
| 2081 | + if (sub++ < *sub_s) |
| 2082 | + continue; |
| 2083 | + |
| 2084 | + best = (neigh_node == neigh_node_best); |
| 2085 | + |
| 2086 | + if (batadv_iv_ogm_orig_dump_subentry(msg, portid, seq, |
| 2087 | + bat_priv, if_outgoing, |
| 2088 | + orig_node, neigh_node, |
| 2089 | + best)) { |
| 2090 | + batadv_neigh_node_put(neigh_node_best); |
| 2091 | + |
| 2092 | + *sub_s = sub - 1; |
| 2093 | + return -EMSGSIZE; |
| 2094 | + } |
| 2095 | + } |
| 2096 | + |
| 2097 | + out: |
| 2098 | + if (neigh_node_best) |
| 2099 | + batadv_neigh_node_put(neigh_node_best); |
| 2100 | + |
| 2101 | + *sub_s = 0; |
| 2102 | + return 0; |
| 2103 | +} |
| 2104 | + |
| 2105 | +/** |
| 2106 | + * batadv_iv_ogm_orig_dump_bucket - Dump an originator bucket into a |
| 2107 | + * message |
| 2108 | + * @msg: Netlink message to dump into |
| 2109 | + * @portid: Port making netlink request |
| 2110 | + * @seq: Sequence number of netlink message |
| 2111 | + * @bat_priv: The bat priv with all the soft interface information |
| 2112 | + * @if_outgoing: Limit dump to entries with this outgoing interface |
| 2113 | + * @head: Bucket to be dumped |
| 2114 | + * @idx_s: Number of entries to be skipped |
| 2115 | + * @sub: Number of sub entries to be skipped |
| 2116 | + * |
| 2117 | + * Return: Error code, or 0 on success |
| 2118 | + */ |
| 2119 | +static int |
| 2120 | +batadv_iv_ogm_orig_dump_bucket(struct sk_buff *msg, u32 portid, u32 seq, |
| 2121 | + struct batadv_priv *bat_priv, |
| 2122 | + struct batadv_hard_iface *if_outgoing, |
| 2123 | + struct hlist_head *head, int *idx_s, int *sub) |
| 2124 | +{ |
| 2125 | + struct batadv_orig_node *orig_node; |
| 2126 | + int idx = 0; |
| 2127 | + |
| 2128 | + rcu_read_lock(); |
| 2129 | + hlist_for_each_entry_rcu(orig_node, head, hash_entry) { |
| 2130 | + if (idx++ < *idx_s) |
| 2131 | + continue; |
| 2132 | + |
| 2133 | + if (batadv_iv_ogm_orig_dump_entry(msg, portid, seq, bat_priv, |
| 2134 | + if_outgoing, orig_node, |
| 2135 | + sub)) { |
| 2136 | + rcu_read_unlock(); |
| 2137 | + *idx_s = idx - 1; |
| 2138 | + return -EMSGSIZE; |
| 2139 | + } |
| 2140 | + } |
| 2141 | + rcu_read_unlock(); |
| 2142 | + |
| 2143 | + *idx_s = 0; |
| 2144 | + *sub = 0; |
| 2145 | + return 0; |
| 2146 | +} |
| 2147 | + |
| 2148 | +/** |
| 2149 | + * batadv_iv_ogm_orig_dump - Dump the originators into a message |
| 2150 | + * @msg: Netlink message to dump into |
| 2151 | + * @cb: Control block containing additional options |
| 2152 | + * @bat_priv: The bat priv with all the soft interface information |
| 2153 | + * @if_outgoing: Limit dump to entries with this outgoing interface |
| 2154 | + */ |
| 2155 | +static void |
| 2156 | +batadv_iv_ogm_orig_dump(struct sk_buff *msg, struct netlink_callback *cb, |
| 2157 | + struct batadv_priv *bat_priv, |
| 2158 | + struct batadv_hard_iface *if_outgoing) |
| 2159 | +{ |
| 2160 | + struct batadv_hashtable *hash = bat_priv->orig_hash; |
| 2161 | + struct hlist_head *head; |
| 2162 | + int bucket = cb->args[0]; |
| 2163 | + int idx = cb->args[1]; |
| 2164 | + int sub = cb->args[2]; |
| 2165 | + int portid = NETLINK_CB(cb->skb).portid; |
| 2166 | + |
| 2167 | + while (bucket < hash->size) { |
| 2168 | + head = &hash->table[bucket]; |
| 2169 | + |
| 2170 | + if (batadv_iv_ogm_orig_dump_bucket(msg, portid, |
| 2171 | + cb->nlh->nlmsg_seq, |
| 2172 | + bat_priv, if_outgoing, head, |
| 2173 | + &idx, &sub)) |
| 2174 | + break; |
| 2175 | + |
| 2176 | + bucket++; |
| 2177 | + } |
| 2178 | + |
| 2179 | + cb->args[0] = bucket; |
| 2180 | + cb->args[1] = idx; |
| 2181 | + cb->args[2] = sub; |
| 2182 | +} |
| 2183 | + |
| 1950 | 2184 | /** |
| 1951 | 2185 | * batadv_iv_hardif_neigh_print - print a single hop neighbour node |
| 1952 | 2186 | * @seq: neighbour table seq_file struct |
| @@ -2043,6 +2277,136 @@ out: · 90 unmodified lines |
| 2043 | 2277 | return ret; |
| 2044 | 2278 | } |
| 2045 | 2279 | |
| 2280 | +/** |
| 2281 | + * batadv_iv_ogm_neigh_dump_neigh - Dump a neighbour into a netlink message |
| 2282 | + * @msg: Netlink message to dump into |
| 2283 | + * @portid: Port making netlink request |
| 2284 | + * @seq: Sequence number of netlink message |
| 2285 | + * @hardif_neigh: Neighbour to be dumped |
| 2286 | + * |
| 2287 | + * Return: Error code, or 0 on success |
| 2288 | + */ |
| 2289 | +static int |
| 2290 | +batadv_iv_ogm_neigh_dump_neigh(struct sk_buff *msg, u32 portid, u32 seq, |
| 2291 | + struct batadv_hardif_neigh_node *hardif_neigh) |
| 2292 | +{ |
| 2293 | + void *hdr; |
| 2294 | + unsigned int last_seen_msecs; |
| 2295 | + |
| 2296 | + last_seen_msecs = jiffies_to_msecs(jiffies - hardif_neigh->last_seen); |
| 2297 | + |
| 2298 | + hdr = genlmsg_put(msg, portid, seq, &batadv_netlink_family, |
| 2299 | + NLM_F_MULTI, BATADV_CMD_GET_NEIGHBORS); |
| 2300 | + if (!hdr) |
| 2301 | + return -ENOBUFS; |
| 2302 | + |
| 2303 | + if (nla_put(msg, BATADV_ATTR_NEIGH_ADDRESS, ETH_ALEN, |
| 2304 | + hardif_neigh->addr) || |
| 2305 | + nla_put_u32(msg, BATADV_ATTR_HARD_IFINDEX, |
| 2306 | + hardif_neigh->if_incoming->net_dev->ifindex) || |
| 2307 | + nla_put_u32(msg, BATADV_ATTR_LAST_SEEN_MSECS, |
| 2308 | + last_seen_msecs)) |
| 2309 | + goto nla_put_failure; |
| 2310 | + |
| 2311 | + genlmsg_end(msg, hdr); |
| 2312 | + return 0; |
| 2313 | + |
| 2314 | + nla_put_failure: |
| 2315 | + genlmsg_cancel(msg, hdr); |
| 2316 | + return -EMSGSIZE; |
| 2317 | +} |
| 2318 | + |
| 2319 | +/** |
| 2320 | + * batadv_iv_ogm_neigh_dump_hardif - Dump the neighbours of a hard interface |
| 2321 | + * into a message |
| 2322 | + * @msg: Netlink message to dump into |
| 2323 | + * @portid: Port making netlink request |
| 2324 | + * @seq: Sequence number of netlink message |
| 2325 | + * @bat_priv: The bat priv with all the soft interface information |
| 2326 | + * @hard_iface: Hard interface to dump the neighbours for |
| 2327 | + * @idx_s: Number of entries to skip |
| 2328 | + * |
| 2329 | + * This function assumes the caller holds rcu_read_lock(). |
| 2330 | + * |
| 2331 | + * Return: Error code, or 0 on success |
| 2332 | + */ |
| 2333 | +static int |
| 2334 | +batadv_iv_ogm_neigh_dump_hardif(struct sk_buff *msg, u32 portid, u32 seq, |
| 2335 | + struct batadv_priv *bat_priv, |
| 2336 | + struct batadv_hard_iface *hard_iface, |
| 2337 | + int *idx_s) |
| 2338 | +{ |
| 2339 | + struct batadv_hardif_neigh_node *hardif_neigh; |
| 2340 | + int idx = 0; |
| 2341 | + |
| 2342 | + hlist_for_each_entry_rcu(hardif_neigh, |
| 2343 | + &hard_iface->neigh_list, list) { |
| 2344 | + if (idx++ < *idx_s) |
| 2345 | + continue; |
| 2346 | + |
| 2347 | + if (batadv_iv_ogm_neigh_dump_neigh(msg, portid, seq, |
| 2348 | + hardif_neigh)) { |
| 2349 | + *idx_s = idx - 1; |
| 2350 | + return -EMSGSIZE; |
| 2351 | + } |
| 2352 | + } |
| 2353 | + |
| 2354 | + *idx_s = 0; |
| 2355 | + return 0; |
| 2356 | +} |
| 2357 | + |
| 2358 | +/** |
| 2359 | + * batadv_iv_ogm_neigh_dump - Dump the neighbours into a message |
| 2360 | + * @msg: Netlink message to dump into |
| 2361 | + * @cb: Control block containing additional options |
| 2362 | + * @bat_priv: The bat priv with all the soft interface information |
| 2363 | + * @single_hardif: Limit dump to this hard interfaace |
| 2364 | + */ |
| 2365 | +static void |
| 2366 | +batadv_iv_ogm_neigh_dump(struct sk_buff *msg, struct netlink_callback *cb, |
| 2367 | + struct batadv_priv *bat_priv, |
| 2368 | + struct batadv_hard_iface *single_hardif) |
| 2369 | +{ |
| 2370 | + struct batadv_hard_iface *hard_iface; |
| 2371 | + int i_hardif = 0; |
| 2372 | + int i_hardif_s = cb->args[0]; |
| 2373 | + int idx = cb->args[1]; |
| 2374 | + int portid = NETLINK_CB(cb->skb).portid; |
| 2375 | + |
| 2376 | + rcu_read_lock(); |
| 2377 | + if (single_hardif) { |
| 2378 | + if (i_hardif_s == 0) { |
| 2379 | + if (batadv_iv_ogm_neigh_dump_hardif(msg, portid, |
| 2380 | + cb->nlh->nlmsg_seq, |
| 2381 | + bat_priv, |
| 2382 | + single_hardif, |
| 2383 | + &idx) == 0) |
| 2384 | + i_hardif++; |
| 2385 | + } |
| 2386 | + } else { |
| 2387 | + list_for_each_entry_rcu(hard_iface, &batadv_hardif_list, |
| 2388 | + list) { |
| 2389 | + if (hard_iface->soft_iface != bat_priv->soft_iface) |
| 2390 | + continue; |
| 2391 | + |
| 2392 | + if (i_hardif++ < i_hardif_s) |
| 2393 | + continue; |
| 2394 | + |
| 2395 | + if (batadv_iv_ogm_neigh_dump_hardif(msg, portid, |
| 2396 | + cb->nlh->nlmsg_seq, |
| 2397 | + bat_priv, |
| 2398 | + hard_iface, &idx)) { |
| 2399 | + i_hardif--; |
| 2400 | + break; |
| 2401 | + } |
| 2402 | + } |
| 2403 | + } |
| 2404 | + rcu_read_unlock(); |
| 2405 | + |
| 2406 | + cb->args[0] = i_hardif; |
| 2407 | + cb->args[1] = idx; |
| 2408 | +} |
| 2409 | + |
| 2046 | 2410 | /** |
| 2047 | 2411 | * batadv_iv_ogm_neigh_cmp - compare the metrics of two neighbors |
| 2048 | 2412 | * @neigh1: the first neighbor object of the comparison |
| @@ -2330,9 +2694,11 @@ static struct batadv_algo_ops batadv_batman_iv __read_mostly = { · 281 unmodified lines |
| 2330 | 2694 | .cmp = batadv_iv_ogm_neigh_cmp, |
| 2331 | 2695 | .is_similar_or_better = batadv_iv_ogm_neigh_is_sob, |
| 2332 | 2696 | .print = batadv_iv_neigh_print, |
| 2697 | + .dump = batadv_iv_ogm_neigh_dump, |
| 2333 | 2698 | }, |
| 2334 | 2699 | .orig = { |
| 2335 | 2700 | .print = batadv_iv_ogm_orig_print, |
| 2701 | + .dump = batadv_iv_ogm_orig_dump, |
| 2336 | 2702 | .free = batadv_iv_ogm_orig_free, |
| 2337 | 2703 | .add_if = batadv_iv_ogm_orig_add_if, |
| 2338 | 2704 | .del_if = batadv_iv_ogm_orig_del_if, |