blob: 6713bdf414cdacdaf36ecd6ac516f99e079fb51e [file] [log] [blame]
Sven Eckelmann0046b042016-01-01 00:01:03 +01001/* Copyright (C) 2007-2016 B.A.T.M.A.N. contributors:
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00002 *
3 * Marek Lindner, Simon Wunderlich
4 *
5 * This program is free software; you can redistribute it and/or
6 * modify it under the terms of version 2 of the GNU General Public
7 * License as published by the Free Software Foundation.
8 *
9 * This program is distributed in the hope that it will be useful, but
10 * WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
12 * General Public License for more details.
13 *
14 * You should have received a copy of the GNU General Public License
Antonio Quartulliebf38fb2013-11-03 20:40:48 +010015 * along with this program; if not, see <http://www.gnu.org/licenses/>.
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000016 */
17
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000018#include "routing.h"
Sven Eckelmann1e2c2a42015-04-17 19:40:28 +020019#include "main.h"
20
21#include <linux/atomic.h>
22#include <linux/byteorder/generic.h>
23#include <linux/compiler.h>
24#include <linux/errno.h>
25#include <linux/etherdevice.h>
26#include <linux/if_ether.h>
27#include <linux/jiffies.h>
Sven Eckelmanna6ba0d32016-01-16 10:29:52 +010028#include <linux/kref.h>
Sven Eckelmann1e2c2a42015-04-17 19:40:28 +020029#include <linux/netdevice.h>
30#include <linux/printk.h>
31#include <linux/rculist.h>
32#include <linux/rcupdate.h>
33#include <linux/skbuff.h>
34#include <linux/spinlock.h>
35#include <linux/stddef.h>
36
37#include "bitarray.h"
Simon Wunderlich23721382012-01-22 20:00:19 +010038#include "bridge_loop_avoidance.h"
Antonio Quartullic384ea32011-06-26 03:37:18 +020039#include "distributed-arp-table.h"
Martin Hundebøll610bfc6bc2013-05-23 16:53:02 +020040#include "fragmentation.h"
Sven Eckelmann1e2c2a42015-04-17 19:40:28 +020041#include "hard-interface.h"
42#include "icmp_socket.h"
Sven Eckelmannba412082016-05-15 23:48:31 +020043#include "log.h"
Sven Eckelmann1e2c2a42015-04-17 19:40:28 +020044#include "network-coding.h"
45#include "originator.h"
46#include "packet.h"
47#include "send.h"
48#include "soft-interface.h"
Antonio Quartulli33a3bb42016-05-05 13:09:43 +020049#include "tp_meter.h"
Sven Eckelmann1e2c2a42015-04-17 19:40:28 +020050#include "translation-table.h"
Markus Pargmann1f8dce42016-05-15 11:07:43 +020051#include "tvlv.h"
Antonio Quartullic018ad32013-06-04 12:11:39 +020052
Sven Eckelmann63b01032012-05-16 20:23:13 +020053static int batadv_route_unicast_packet(struct sk_buff *skb,
Sven Eckelmann56303d32012-06-05 22:31:31 +020054 struct batadv_hard_iface *recv_if);
Simon Wunderlicha7f6ee92012-01-22 20:00:18 +010055
Simon Wunderlich7351a4822013-11-13 19:14:47 +010056/**
57 * _batadv_update_route - set the router for this originator
58 * @bat_priv: the bat priv with all the soft interface information
59 * @orig_node: orig node which is to be configured
60 * @recv_if: the receive interface for which this route is set
61 * @neigh_node: neighbor which should be the next router
62 *
63 * This function does not perform any error checks
64 */
Sven Eckelmann56303d32012-06-05 22:31:31 +020065static void _batadv_update_route(struct batadv_priv *bat_priv,
66 struct batadv_orig_node *orig_node,
Simon Wunderlich7351a4822013-11-13 19:14:47 +010067 struct batadv_hard_iface *recv_if,
Sven Eckelmann56303d32012-06-05 22:31:31 +020068 struct batadv_neigh_node *neigh_node)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000069{
Simon Wunderlich7351a4822013-11-13 19:14:47 +010070 struct batadv_orig_ifinfo *orig_ifinfo;
Sven Eckelmann56303d32012-06-05 22:31:31 +020071 struct batadv_neigh_node *curr_router;
Linus Lüssinge1a5382f2011-03-14 22:43:37 +000072
Simon Wunderlich7351a4822013-11-13 19:14:47 +010073 orig_ifinfo = batadv_orig_ifinfo_get(orig_node, recv_if);
74 if (!orig_ifinfo)
75 return;
76
Sven Eckelmannb5dcbad2016-06-29 23:45:57 +020077 spin_lock_bh(&orig_node->neigh_list_lock);
78 /* curr_router used earlier may not be the current orig_ifinfo->router
79 * anymore because it was dereferenced outside of the neigh_list_lock
80 * protected region. After the new best neighbor has replace the current
81 * best neighbor the reference counter needs to decrease. Consequently,
82 * the code needs to ensure the curr_router variable contains a pointer
83 * to the replaced best neighbor.
84 */
85 curr_router = rcu_dereference_protected(orig_ifinfo->router, true);
86
87 /* increase refcount of new best neighbor */
88 if (neigh_node)
89 kref_get(&neigh_node->refcount);
90
91 rcu_assign_pointer(orig_ifinfo->router, neigh_node);
92 spin_unlock_bh(&orig_node->neigh_list_lock);
93 batadv_orig_ifinfo_put(orig_ifinfo);
Marek Lindnera8e7f4b2010-12-12 21:57:10 +000094
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000095 /* route deleted */
Linus Lüssinge1a5382f2011-03-14 22:43:37 +000096 if ((curr_router) && (!neigh_node)) {
Sven Eckelmann39c75a52012-06-03 22:19:22 +020097 batadv_dbg(BATADV_DBG_ROUTES, bat_priv,
98 "Deleting route towards: %pM\n", orig_node->orig);
Antonio Quartulli95fb1302013-08-07 18:28:55 +020099 batadv_tt_global_del_orig(bat_priv, orig_node, -1,
Sven Eckelmann08c36d32012-05-12 02:09:39 +0200100 "Deleted route towards originator");
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000101
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000102 /* route added */
103 } else if ((!curr_router) && (neigh_node)) {
Sven Eckelmann39c75a52012-06-03 22:19:22 +0200104 batadv_dbg(BATADV_DBG_ROUTES, bat_priv,
Sven Eckelmann1eda58b2012-05-12 13:48:58 +0200105 "Adding route towards: %pM (via %pM)\n",
106 orig_node->orig, neigh_node->addr);
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000107 /* route changed */
Sven Eckelmannbb899b82011-05-10 11:22:37 +0200108 } else if (neigh_node && curr_router) {
Sven Eckelmann39c75a52012-06-03 22:19:22 +0200109 batadv_dbg(BATADV_DBG_ROUTES, bat_priv,
Sven Eckelmann1eda58b2012-05-12 13:48:58 +0200110 "Changing route towards: %pM (now via %pM - was via %pM)\n",
111 orig_node->orig, neigh_node->addr,
112 curr_router->addr);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000113 }
114
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000115 /* decrease refcount of previous best neighbor */
116 if (curr_router)
Sven Eckelmann25bb2502016-01-17 11:01:11 +0100117 batadv_neigh_node_put(curr_router);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000118}
119
Simon Wunderlich7351a4822013-11-13 19:14:47 +0100120/**
121 * batadv_update_route - set the router for this originator
122 * @bat_priv: the bat priv with all the soft interface information
123 * @orig_node: orig node which is to be configured
124 * @recv_if: the receive interface for which this route is set
125 * @neigh_node: neighbor which should be the next router
126 */
Sven Eckelmann56303d32012-06-05 22:31:31 +0200127void batadv_update_route(struct batadv_priv *bat_priv,
128 struct batadv_orig_node *orig_node,
Simon Wunderlich7351a4822013-11-13 19:14:47 +0100129 struct batadv_hard_iface *recv_if,
Sven Eckelmann56303d32012-06-05 22:31:31 +0200130 struct batadv_neigh_node *neigh_node)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000131{
Sven Eckelmann56303d32012-06-05 22:31:31 +0200132 struct batadv_neigh_node *router = NULL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000133
134 if (!orig_node)
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000135 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000136
Simon Wunderlich7351a4822013-11-13 19:14:47 +0100137 router = batadv_orig_router_get(orig_node, recv_if);
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000138
139 if (router != neigh_node)
Simon Wunderlich7351a4822013-11-13 19:14:47 +0100140 _batadv_update_route(bat_priv, orig_node, recv_if, neigh_node);
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000141
142out:
143 if (router)
Sven Eckelmann25bb2502016-01-17 11:01:11 +0100144 batadv_neigh_node_put(router);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000145}
146
Sven Eckelmann62fe7102015-09-15 19:00:48 +0200147/**
Sven Eckelmann7afcbbe2015-10-31 12:29:29 +0100148 * batadv_window_protected - checks whether the host restarted and is in the
Sven Eckelmann62fe7102015-09-15 19:00:48 +0200149 * protection time.
Sven Eckelmann7afcbbe2015-10-31 12:29:29 +0100150 * @bat_priv: the bat priv with all the soft interface information
151 * @seq_num_diff: difference between the current/received sequence number and
152 * the last sequence number
Simon Wunderlich81f02682015-11-23 19:57:22 +0100153 * @seq_old_max_diff: maximum age of sequence number not considered as restart
Sven Eckelmann7afcbbe2015-10-31 12:29:29 +0100154 * @last_reset: jiffies timestamp of the last reset, will be updated when reset
155 * is detected
Simon Wunderlich81f02682015-11-23 19:57:22 +0100156 * @protection_started: is set to true if the protection window was started,
157 * doesn't change otherwise.
Sven Eckelmann62fe7102015-09-15 19:00:48 +0200158 *
159 * Return:
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100160 * false if the packet is to be accepted.
161 * true if the packet is to be ignored.
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000162 */
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100163bool batadv_window_protected(struct batadv_priv *bat_priv, s32 seq_num_diff,
164 s32 seq_old_max_diff, unsigned long *last_reset,
165 bool *protection_started)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000166{
Simon Wunderlich81f02682015-11-23 19:57:22 +0100167 if (seq_num_diff <= -seq_old_max_diff ||
Sven Eckelmann42d0b042012-06-03 22:19:17 +0200168 seq_num_diff >= BATADV_EXPECTED_SEQNO_RANGE) {
169 if (!batadv_has_timed_out(*last_reset,
170 BATADV_RESET_PROTECTION_MS))
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100171 return true;
Marek Lindner8c7bf242012-03-17 15:28:33 +0800172
173 *last_reset = jiffies;
Simon Wunderlich81f02682015-11-23 19:57:22 +0100174 if (protection_started)
175 *protection_started = true;
Sven Eckelmann39c75a52012-06-03 22:19:22 +0200176 batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
Sven Eckelmann1eda58b2012-05-12 13:48:58 +0200177 "old packet received, start protection\n");
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000178 }
Marek Lindner8c7bf242012-03-17 15:28:33 +0800179
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100180 return false;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000181}
182
Sven Eckelmann30d3c512012-05-12 02:09:36 +0200183bool batadv_check_management_packet(struct sk_buff *skb,
Sven Eckelmann56303d32012-06-05 22:31:31 +0200184 struct batadv_hard_iface *hard_iface,
Sven Eckelmann30d3c512012-05-12 02:09:36 +0200185 int header_len)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000186{
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000187 struct ethhdr *ethhdr;
188
189 /* drop packet if it has not necessary minimum size */
Marek Lindnerc3e29312012-03-04 16:56:25 +0800190 if (unlikely(!pskb_may_pull(skb, header_len)))
191 return false;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000192
Antonio Quartulli7ed4be92013-04-08 15:08:18 +0200193 ethhdr = eth_hdr(skb);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000194
195 /* packet with broadcast indication but unicast recipient */
196 if (!is_broadcast_ether_addr(ethhdr->h_dest))
Marek Lindnerc3e29312012-03-04 16:56:25 +0800197 return false;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000198
Sven Eckelmann92eef522016-08-06 17:04:22 +0200199 /* packet with invalid sender address */
200 if (!is_valid_ether_addr(ethhdr->h_source))
Marek Lindnerc3e29312012-03-04 16:56:25 +0800201 return false;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000202
203 /* create a copy of the skb, if needed, to modify it. */
204 if (skb_cow(skb, 0) < 0)
Marek Lindnerc3e29312012-03-04 16:56:25 +0800205 return false;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000206
207 /* keep skb linear */
208 if (skb_linearize(skb) < 0)
Marek Lindnerc3e29312012-03-04 16:56:25 +0800209 return false;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000210
Marek Lindnerc3e29312012-03-04 16:56:25 +0800211 return true;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000212}
213
Simon Wunderlichda6b8c22013-10-22 22:50:09 +0200214/**
215 * batadv_recv_my_icmp_packet - receive an icmp packet locally
216 * @bat_priv: the bat priv with all the soft interface information
217 * @skb: icmp packet to process
218 *
Sven Eckelmann62fe7102015-09-15 19:00:48 +0200219 * Return: NET_RX_SUCCESS if the packet has been consumed or NET_RX_DROP
Simon Wunderlichda6b8c22013-10-22 22:50:09 +0200220 * otherwise.
221 */
Sven Eckelmann56303d32012-06-05 22:31:31 +0200222static int batadv_recv_my_icmp_packet(struct batadv_priv *bat_priv,
Simon Wunderlichda6b8c22013-10-22 22:50:09 +0200223 struct sk_buff *skb)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000224{
Sven Eckelmann56303d32012-06-05 22:31:31 +0200225 struct batadv_hard_iface *primary_if = NULL;
226 struct batadv_orig_node *orig_node = NULL;
Simon Wunderlichda6b8c22013-10-22 22:50:09 +0200227 struct batadv_icmp_header *icmph;
228 int res, ret = NET_RX_DROP;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000229
Simon Wunderlichda6b8c22013-10-22 22:50:09 +0200230 icmph = (struct batadv_icmp_header *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000231
Simon Wunderlichda6b8c22013-10-22 22:50:09 +0200232 switch (icmph->msg_type) {
233 case BATADV_ECHO_REPLY:
234 case BATADV_DESTINATION_UNREACHABLE:
235 case BATADV_TTL_EXCEEDED:
236 /* receive the packet */
237 if (skb_linearize(skb) < 0)
238 break;
239
240 batadv_socket_receive_packet(icmph, skb->len);
241 break;
242 case BATADV_ECHO_REQUEST:
243 /* answer echo request (ping) */
244 primary_if = batadv_primary_if_get_selected(bat_priv);
245 if (!primary_if)
246 goto out;
247
248 /* get routing information */
249 orig_node = batadv_orig_hash_find(bat_priv, icmph->orig);
250 if (!orig_node)
251 goto out;
252
253 /* create a copy of the skb, if needed, to modify it. */
254 if (skb_cow(skb, ETH_HLEN) < 0)
255 goto out;
256
257 icmph = (struct batadv_icmp_header *)skb->data;
258
Antonio Quartulli8fdd0152014-01-22 00:42:11 +0100259 ether_addr_copy(icmph->dst, icmph->orig);
260 ether_addr_copy(icmph->orig, primary_if->net_dev->dev_addr);
Simon Wunderlichda6b8c22013-10-22 22:50:09 +0200261 icmph->msg_type = BATADV_ECHO_REPLY;
Simon Wunderlicha40d9b02013-12-02 20:38:31 +0100262 icmph->ttl = BATADV_TTL;
Simon Wunderlichda6b8c22013-10-22 22:50:09 +0200263
264 res = batadv_send_skb_to_orig(skb, orig_node, NULL);
Sven Eckelmannb91a2542016-07-17 21:04:04 +0200265 if (res == NET_XMIT_SUCCESS)
266 ret = NET_RX_SUCCESS;
Simon Wunderlichda6b8c22013-10-22 22:50:09 +0200267
Sven Eckelmannb91a2542016-07-17 21:04:04 +0200268 /* skb was consumed */
269 skb = NULL;
Simon Wunderlichda6b8c22013-10-22 22:50:09 +0200270 break;
Antonio Quartulli33a3bb42016-05-05 13:09:43 +0200271 case BATADV_TP:
272 if (!pskb_may_pull(skb, sizeof(struct batadv_icmp_tp_packet)))
273 goto out;
274
275 batadv_tp_meter_recv(bat_priv, skb);
276 ret = NET_RX_SUCCESS;
Sven Eckelmannb91a2542016-07-17 21:04:04 +0200277 /* skb was consumed */
278 skb = NULL;
Antonio Quartulli33a3bb42016-05-05 13:09:43 +0200279 goto out;
Simon Wunderlichda6b8c22013-10-22 22:50:09 +0200280 default:
281 /* drop unknown type */
Marek Lindner44524fc2011-02-10 14:33:53 +0000282 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000283 }
Marek Lindner44524fc2011-02-10 14:33:53 +0000284out:
Marek Lindner32ae9b22011-04-20 15:40:58 +0200285 if (primary_if)
Sven Eckelmann82047ad2016-01-17 11:01:10 +0100286 batadv_hardif_put(primary_if);
Marek Lindner44524fc2011-02-10 14:33:53 +0000287 if (orig_node)
Sven Eckelmann5d967312016-01-17 11:01:09 +0100288 batadv_orig_node_put(orig_node);
Sven Eckelmannb91a2542016-07-17 21:04:04 +0200289
290 kfree_skb(skb);
291
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000292 return ret;
293}
294
Sven Eckelmann56303d32012-06-05 22:31:31 +0200295static int batadv_recv_icmp_ttl_exceeded(struct batadv_priv *bat_priv,
Sven Eckelmann63b01032012-05-16 20:23:13 +0200296 struct sk_buff *skb)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000297{
Sven Eckelmann56303d32012-06-05 22:31:31 +0200298 struct batadv_hard_iface *primary_if = NULL;
299 struct batadv_orig_node *orig_node = NULL;
Sven Eckelmann96412692012-06-05 22:31:30 +0200300 struct batadv_icmp_packet *icmp_packet;
Antonio Quartullif50ca952016-05-18 11:38:48 +0200301 int res, ret = NET_RX_DROP;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000302
Sven Eckelmann96412692012-06-05 22:31:30 +0200303 icmp_packet = (struct batadv_icmp_packet *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000304
305 /* send TTL exceeded if packet is an echo request (traceroute) */
Antonio Quartulli27a417e2013-12-05 15:33:00 +0100306 if (icmp_packet->msg_type != BATADV_ECHO_REQUEST) {
Sven Eckelmann86ceb362012-03-07 09:07:45 +0100307 pr_debug("Warning - can't forward icmp packet from %pM to %pM: ttl exceeded\n",
Antonio Quartulli27a417e2013-12-05 15:33:00 +0100308 icmp_packet->orig, icmp_packet->dst);
Marek Lindner44524fc2011-02-10 14:33:53 +0000309 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000310 }
311
Sven Eckelmanne5d89252012-05-12 13:48:54 +0200312 primary_if = batadv_primary_if_get_selected(bat_priv);
Marek Lindner32ae9b22011-04-20 15:40:58 +0200313 if (!primary_if)
Marek Lindner44524fc2011-02-10 14:33:53 +0000314 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000315
316 /* get routing information */
Antonio Quartulli27a417e2013-12-05 15:33:00 +0100317 orig_node = batadv_orig_hash_find(bat_priv, icmp_packet->orig);
Marek Lindner44524fc2011-02-10 14:33:53 +0000318 if (!orig_node)
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000319 goto out;
Marek Lindner44524fc2011-02-10 14:33:53 +0000320
Marek Lindner44524fc2011-02-10 14:33:53 +0000321 /* create a copy of the skb, if needed, to modify it. */
Antonio Quartulli0d125072012-02-18 11:27:34 +0100322 if (skb_cow(skb, ETH_HLEN) < 0)
Marek Lindner44524fc2011-02-10 14:33:53 +0000323 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000324
Sven Eckelmann96412692012-06-05 22:31:30 +0200325 icmp_packet = (struct batadv_icmp_packet *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000326
Antonio Quartulli8fdd0152014-01-22 00:42:11 +0100327 ether_addr_copy(icmp_packet->dst, icmp_packet->orig);
328 ether_addr_copy(icmp_packet->orig, primary_if->net_dev->dev_addr);
Antonio Quartulli27a417e2013-12-05 15:33:00 +0100329 icmp_packet->msg_type = BATADV_TTL_EXCEEDED;
330 icmp_packet->ttl = BATADV_TTL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000331
Antonio Quartullif50ca952016-05-18 11:38:48 +0200332 res = batadv_send_skb_to_orig(skb, orig_node, NULL);
Sven Eckelmannb91a2542016-07-17 21:04:04 +0200333 if (res == NET_RX_SUCCESS)
334 ret = NET_XMIT_SUCCESS;
335
336 /* skb was consumed */
337 skb = NULL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000338
Marek Lindner44524fc2011-02-10 14:33:53 +0000339out:
Marek Lindner32ae9b22011-04-20 15:40:58 +0200340 if (primary_if)
Sven Eckelmann82047ad2016-01-17 11:01:10 +0100341 batadv_hardif_put(primary_if);
Marek Lindner44524fc2011-02-10 14:33:53 +0000342 if (orig_node)
Sven Eckelmann5d967312016-01-17 11:01:09 +0100343 batadv_orig_node_put(orig_node);
Sven Eckelmannb91a2542016-07-17 21:04:04 +0200344
345 kfree_skb(skb);
346
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000347 return ret;
348}
349
Sven Eckelmann56303d32012-06-05 22:31:31 +0200350int batadv_recv_icmp_packet(struct sk_buff *skb,
351 struct batadv_hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000352{
Sven Eckelmann56303d32012-06-05 22:31:31 +0200353 struct batadv_priv *bat_priv = netdev_priv(recv_if->soft_iface);
Simon Wunderlichda6b8c22013-10-22 22:50:09 +0200354 struct batadv_icmp_header *icmph;
355 struct batadv_icmp_packet_rr *icmp_packet_rr;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000356 struct ethhdr *ethhdr;
Sven Eckelmann56303d32012-06-05 22:31:31 +0200357 struct batadv_orig_node *orig_node = NULL;
Simon Wunderlichda6b8c22013-10-22 22:50:09 +0200358 int hdr_size = sizeof(struct batadv_icmp_header);
Antonio Quartullif50ca952016-05-18 11:38:48 +0200359 int res, ret = NET_RX_DROP;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000360
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000361 /* drop packet if it has not necessary minimum size */
362 if (unlikely(!pskb_may_pull(skb, hdr_size)))
Sven Eckelmannb91a2542016-07-17 21:04:04 +0200363 goto free_skb;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000364
Antonio Quartulli7ed4be92013-04-08 15:08:18 +0200365 ethhdr = eth_hdr(skb);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000366
Sven Eckelmann93bbaab2016-08-06 17:04:23 +0200367 /* packet with unicast indication but non-unicast recipient */
368 if (!is_valid_ether_addr(ethhdr->h_dest))
Sven Eckelmannb91a2542016-07-17 21:04:04 +0200369 goto free_skb;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000370
Sven Eckelmann9f75c8e2016-08-06 17:04:21 +0200371 /* packet with broadcast/multicast sender address */
372 if (is_multicast_ether_addr(ethhdr->h_source))
Sven Eckelmannb91a2542016-07-17 21:04:04 +0200373 goto free_skb;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000374
375 /* not for me */
Antonio Quartullife8a93b2013-04-03 19:10:26 +0200376 if (!batadv_is_my_mac(bat_priv, ethhdr->h_dest))
Sven Eckelmannb91a2542016-07-17 21:04:04 +0200377 goto free_skb;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000378
Simon Wunderlichda6b8c22013-10-22 22:50:09 +0200379 icmph = (struct batadv_icmp_header *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000380
381 /* add record route information if not full */
Simon Wunderlichda6b8c22013-10-22 22:50:09 +0200382 if ((icmph->msg_type == BATADV_ECHO_REPLY ||
383 icmph->msg_type == BATADV_ECHO_REQUEST) &&
384 (skb->len >= sizeof(struct batadv_icmp_packet_rr))) {
385 if (skb_linearize(skb) < 0)
Sven Eckelmannb91a2542016-07-17 21:04:04 +0200386 goto free_skb;
Simon Wunderlichda6b8c22013-10-22 22:50:09 +0200387
388 /* create a copy of the skb, if needed, to modify it. */
389 if (skb_cow(skb, ETH_HLEN) < 0)
Sven Eckelmannb91a2542016-07-17 21:04:04 +0200390 goto free_skb;
Simon Wunderlichda6b8c22013-10-22 22:50:09 +0200391
Sven Eckelmann3b55e442016-06-26 11:16:12 +0200392 ethhdr = eth_hdr(skb);
Simon Wunderlichda6b8c22013-10-22 22:50:09 +0200393 icmph = (struct batadv_icmp_header *)skb->data;
394 icmp_packet_rr = (struct batadv_icmp_packet_rr *)icmph;
395 if (icmp_packet_rr->rr_cur >= BATADV_RR_LEN)
Sven Eckelmannb91a2542016-07-17 21:04:04 +0200396 goto free_skb;
Simon Wunderlichda6b8c22013-10-22 22:50:09 +0200397
Antonio Quartulli8fdd0152014-01-22 00:42:11 +0100398 ether_addr_copy(icmp_packet_rr->rr[icmp_packet_rr->rr_cur],
399 ethhdr->h_dest);
Simon Wunderlichda6b8c22013-10-22 22:50:09 +0200400 icmp_packet_rr->rr_cur++;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000401 }
402
403 /* packet for me */
Simon Wunderlichda6b8c22013-10-22 22:50:09 +0200404 if (batadv_is_my_mac(bat_priv, icmph->dst))
405 return batadv_recv_my_icmp_packet(bat_priv, skb);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000406
407 /* TTL exceeded */
Simon Wunderlicha40d9b02013-12-02 20:38:31 +0100408 if (icmph->ttl < 2)
Sven Eckelmann63b01032012-05-16 20:23:13 +0200409 return batadv_recv_icmp_ttl_exceeded(bat_priv, skb);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000410
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000411 /* get routing information */
Simon Wunderlichda6b8c22013-10-22 22:50:09 +0200412 orig_node = batadv_orig_hash_find(bat_priv, icmph->dst);
Marek Lindner44524fc2011-02-10 14:33:53 +0000413 if (!orig_node)
Sven Eckelmannb91a2542016-07-17 21:04:04 +0200414 goto free_skb;
Marek Lindner44524fc2011-02-10 14:33:53 +0000415
Marek Lindner44524fc2011-02-10 14:33:53 +0000416 /* create a copy of the skb, if needed, to modify it. */
Antonio Quartulli0d125072012-02-18 11:27:34 +0100417 if (skb_cow(skb, ETH_HLEN) < 0)
Sven Eckelmannb91a2542016-07-17 21:04:04 +0200418 goto put_orig_node;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000419
Simon Wunderlichda6b8c22013-10-22 22:50:09 +0200420 icmph = (struct batadv_icmp_header *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000421
Marek Lindner44524fc2011-02-10 14:33:53 +0000422 /* decrement ttl */
Simon Wunderlicha40d9b02013-12-02 20:38:31 +0100423 icmph->ttl--;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000424
Marek Lindner44524fc2011-02-10 14:33:53 +0000425 /* route it */
Antonio Quartullif50ca952016-05-18 11:38:48 +0200426 res = batadv_send_skb_to_orig(skb, orig_node, recv_if);
Sven Eckelmannb91a2542016-07-17 21:04:04 +0200427 if (res == NET_XMIT_SUCCESS)
428 ret = NET_RX_SUCCESS;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000429
Sven Eckelmannb91a2542016-07-17 21:04:04 +0200430 /* skb was consumed */
431 skb = NULL;
432
433put_orig_node:
Marek Lindner44524fc2011-02-10 14:33:53 +0000434 if (orig_node)
Sven Eckelmann5d967312016-01-17 11:01:09 +0100435 batadv_orig_node_put(orig_node);
Sven Eckelmannb91a2542016-07-17 21:04:04 +0200436free_skb:
437 kfree_skb(skb);
438
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000439 return ret;
440}
441
Martin Hundebøllf86ce0a2013-01-14 00:20:32 +0100442/**
443 * batadv_check_unicast_packet - Check for malformed unicast packets
David S. Miller6e0895c2013-04-22 20:32:51 -0400444 * @bat_priv: the bat priv with all the soft interface information
Martin Hundebøllf86ce0a2013-01-14 00:20:32 +0100445 * @skb: packet to check
446 * @hdr_size: size of header to pull
447 *
Sven Eckelmann62fe7102015-09-15 19:00:48 +0200448 * Check for short header and bad addresses in given packet.
449 *
450 * Return: negative value when check fails and 0 otherwise. The negative value
451 * depends on the reason: -ENODATA for bad header, -EBADR for broadcast
452 * destination or source, and -EREMOTE for non-local (other host) destination.
Martin Hundebøllf86ce0a2013-01-14 00:20:32 +0100453 */
Antonio Quartullife8a93b2013-04-03 19:10:26 +0200454static int batadv_check_unicast_packet(struct batadv_priv *bat_priv,
455 struct sk_buff *skb, int hdr_size)
Martin Hundebøllff51fd72012-07-05 11:34:27 +0200456{
457 struct ethhdr *ethhdr;
458
459 /* drop packet if it has not necessary minimum size */
460 if (unlikely(!pskb_may_pull(skb, hdr_size)))
Martin Hundebøllf86ce0a2013-01-14 00:20:32 +0100461 return -ENODATA;
Martin Hundebøllff51fd72012-07-05 11:34:27 +0200462
Antonio Quartulli7ed4be92013-04-08 15:08:18 +0200463 ethhdr = eth_hdr(skb);
Martin Hundebøllff51fd72012-07-05 11:34:27 +0200464
Sven Eckelmann93bbaab2016-08-06 17:04:23 +0200465 /* packet with unicast indication but non-unicast recipient */
466 if (!is_valid_ether_addr(ethhdr->h_dest))
Martin Hundebøllf86ce0a2013-01-14 00:20:32 +0100467 return -EBADR;
Martin Hundebøllff51fd72012-07-05 11:34:27 +0200468
Sven Eckelmann9f75c8e2016-08-06 17:04:21 +0200469 /* packet with broadcast/multicast sender address */
470 if (is_multicast_ether_addr(ethhdr->h_source))
Martin Hundebøllf86ce0a2013-01-14 00:20:32 +0100471 return -EBADR;
Martin Hundebøllff51fd72012-07-05 11:34:27 +0200472
473 /* not for me */
Antonio Quartullife8a93b2013-04-03 19:10:26 +0200474 if (!batadv_is_my_mac(bat_priv, ethhdr->h_dest))
Martin Hundebøllf86ce0a2013-01-14 00:20:32 +0100475 return -EREMOTE;
Martin Hundebøllff51fd72012-07-05 11:34:27 +0200476
477 return 0;
478}
479
Simon Wunderlichf6c8b712013-11-13 19:14:45 +0100480/**
Sven Eckelmann93652342016-08-06 15:50:52 +0200481 * batadv_last_bonding_get - Get last_bonding_candidate of orig_node
482 * @orig_node: originator node whose last bonding candidate should be retrieved
483 *
484 * Return: last bonding candidate of router or NULL if not found
485 *
486 * The object is returned with refcounter increased by 1.
487 */
488static struct batadv_orig_ifinfo *
489batadv_last_bonding_get(struct batadv_orig_node *orig_node)
490{
491 struct batadv_orig_ifinfo *last_bonding_candidate;
492
493 spin_lock_bh(&orig_node->neigh_list_lock);
494 last_bonding_candidate = orig_node->last_bonding_candidate;
495
496 if (last_bonding_candidate)
497 kref_get(&last_bonding_candidate->refcount);
498 spin_unlock_bh(&orig_node->neigh_list_lock);
499
500 return last_bonding_candidate;
501}
502
503/**
Sven Eckelmann15c2ed752016-06-30 20:11:34 +0200504 * batadv_last_bonding_replace - Replace last_bonding_candidate of orig_node
505 * @orig_node: originator node whose bonding candidates should be replaced
506 * @new_candidate: new bonding candidate or NULL
507 */
508static void
509batadv_last_bonding_replace(struct batadv_orig_node *orig_node,
510 struct batadv_orig_ifinfo *new_candidate)
511{
512 struct batadv_orig_ifinfo *old_candidate;
513
514 spin_lock_bh(&orig_node->neigh_list_lock);
515 old_candidate = orig_node->last_bonding_candidate;
516
517 if (new_candidate)
518 kref_get(&new_candidate->refcount);
519 orig_node->last_bonding_candidate = new_candidate;
520 spin_unlock_bh(&orig_node->neigh_list_lock);
521
522 if (old_candidate)
523 batadv_orig_ifinfo_put(old_candidate);
524}
525
526/**
Simon Wunderlichf6c8b712013-11-13 19:14:45 +0100527 * batadv_find_router - find a suitable router for this originator
528 * @bat_priv: the bat priv with all the soft interface information
529 * @orig_node: the destination node
530 * @recv_if: pointer to interface this packet was received on
531 *
Sven Eckelmann62fe7102015-09-15 19:00:48 +0200532 * Return: the router which should be used for this orig_node on
Simon Wunderlichf6c8b712013-11-13 19:14:45 +0100533 * this interface, or NULL if not available.
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200534 */
Sven Eckelmann56303d32012-06-05 22:31:31 +0200535struct batadv_neigh_node *
536batadv_find_router(struct batadv_priv *bat_priv,
537 struct batadv_orig_node *orig_node,
Simon Wunderlichf3b3d902013-11-13 19:14:50 +0100538 struct batadv_hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000539{
Antonio Quartulli29824a52016-05-25 23:27:31 +0800540 struct batadv_algo_ops *bao = bat_priv->algo_ops;
Simon Wunderlichf3b3d902013-11-13 19:14:50 +0100541 struct batadv_neigh_node *first_candidate_router = NULL;
542 struct batadv_neigh_node *next_candidate_router = NULL;
543 struct batadv_neigh_node *router, *cand_router = NULL;
544 struct batadv_neigh_node *last_cand_router = NULL;
545 struct batadv_orig_ifinfo *cand, *first_candidate = NULL;
546 struct batadv_orig_ifinfo *next_candidate = NULL;
547 struct batadv_orig_ifinfo *last_candidate;
548 bool last_candidate_found = false;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000549
550 if (!orig_node)
551 return NULL;
552
Simon Wunderlich7351a4822013-11-13 19:14:47 +0100553 router = batadv_orig_router_get(orig_node, recv_if);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000554
Simon Wunderlich329887a2014-08-13 14:26:56 +0200555 if (!router)
556 return router;
557
Simon Wunderlichf3b3d902013-11-13 19:14:50 +0100558 /* only consider bonding for recv_if == BATADV_IF_DEFAULT (first hop)
559 * and if activated.
560 */
Simon Wunderlich329887a2014-08-13 14:26:56 +0200561 if (!(recv_if == BATADV_IF_DEFAULT && atomic_read(&bat_priv->bonding)))
Simon Wunderlichf3b3d902013-11-13 19:14:50 +0100562 return router;
563
564 /* bonding: loop through the list of possible routers found
565 * for the various outgoing interfaces and find a candidate after
566 * the last chosen bonding candidate (next_candidate). If no such
567 * router is found, use the first candidate found (the previously
568 * chosen bonding candidate might have been the last one in the list).
Antonio Quartulli3f687852014-11-02 11:29:56 +0100569 * If this can't be found either, return the previously chosen
Simon Wunderlichf3b3d902013-11-13 19:14:50 +0100570 * router - obviously there are no other candidates.
571 */
572 rcu_read_lock();
Sven Eckelmann93652342016-08-06 15:50:52 +0200573 last_candidate = batadv_last_bonding_get(orig_node);
Simon Wunderlichf3b3d902013-11-13 19:14:50 +0100574 if (last_candidate)
575 last_cand_router = rcu_dereference(last_candidate->router);
576
577 hlist_for_each_entry_rcu(cand, &orig_node->ifinfo_list, list) {
578 /* acquire some structures and references ... */
Sven Eckelmanna6ba0d32016-01-16 10:29:52 +0100579 if (!kref_get_unless_zero(&cand->refcount))
Simon Wunderlichf3b3d902013-11-13 19:14:50 +0100580 continue;
581
582 cand_router = rcu_dereference(cand->router);
583 if (!cand_router)
584 goto next;
585
Sven Eckelmann77ae32e2016-01-16 10:29:53 +0100586 if (!kref_get_unless_zero(&cand_router->refcount)) {
Simon Wunderlichf3b3d902013-11-13 19:14:50 +0100587 cand_router = NULL;
588 goto next;
589 }
590
591 /* alternative candidate should be good enough to be
592 * considered
593 */
Antonio Quartulli29824a52016-05-25 23:27:31 +0800594 if (!bao->neigh.is_similar_or_better(cand_router,
595 cand->if_outgoing, router,
596 recv_if))
Simon Wunderlichf3b3d902013-11-13 19:14:50 +0100597 goto next;
598
599 /* don't use the same router twice */
600 if (last_cand_router == cand_router)
601 goto next;
602
603 /* mark the first possible candidate */
604 if (!first_candidate) {
Sven Eckelmann77ae32e2016-01-16 10:29:53 +0100605 kref_get(&cand_router->refcount);
Sven Eckelmanna6ba0d32016-01-16 10:29:52 +0100606 kref_get(&cand->refcount);
Simon Wunderlichf3b3d902013-11-13 19:14:50 +0100607 first_candidate = cand;
608 first_candidate_router = cand_router;
609 }
610
611 /* check if the loop has already passed the previously selected
612 * candidate ... this function should select the next candidate
613 * AFTER the previously used bonding candidate.
614 */
615 if (!last_candidate || last_candidate_found) {
616 next_candidate = cand;
617 next_candidate_router = cand_router;
618 break;
619 }
620
621 if (last_candidate == cand)
622 last_candidate_found = true;
623next:
624 /* free references */
625 if (cand_router) {
Sven Eckelmann25bb2502016-01-17 11:01:11 +0100626 batadv_neigh_node_put(cand_router);
Simon Wunderlichf3b3d902013-11-13 19:14:50 +0100627 cand_router = NULL;
628 }
Sven Eckelmann35f94772016-01-17 11:01:13 +0100629 batadv_orig_ifinfo_put(cand);
Simon Wunderlichf3b3d902013-11-13 19:14:50 +0100630 }
631 rcu_read_unlock();
632
Simon Wunderlichf3b3d902013-11-13 19:14:50 +0100633 /* After finding candidates, handle the three cases:
634 * 1) there is a next candidate, use that
635 * 2) there is no next candidate, use the first of the list
636 * 3) there is no candidate at all, return the default router
637 */
638 if (next_candidate) {
Sven Eckelmann25bb2502016-01-17 11:01:11 +0100639 batadv_neigh_node_put(router);
Simon Wunderlichf3b3d902013-11-13 19:14:50 +0100640
Sven Eckelmann15c2ed752016-06-30 20:11:34 +0200641 kref_get(&next_candidate_router->refcount);
Simon Wunderlichf3b3d902013-11-13 19:14:50 +0100642 router = next_candidate_router;
Sven Eckelmann15c2ed752016-06-30 20:11:34 +0200643 batadv_last_bonding_replace(orig_node, next_candidate);
Simon Wunderlichf3b3d902013-11-13 19:14:50 +0100644 } else if (first_candidate) {
Sven Eckelmann25bb2502016-01-17 11:01:11 +0100645 batadv_neigh_node_put(router);
Simon Wunderlichf3b3d902013-11-13 19:14:50 +0100646
Sven Eckelmann15c2ed752016-06-30 20:11:34 +0200647 kref_get(&first_candidate_router->refcount);
Simon Wunderlichf3b3d902013-11-13 19:14:50 +0100648 router = first_candidate_router;
Sven Eckelmann15c2ed752016-06-30 20:11:34 +0200649 batadv_last_bonding_replace(orig_node, first_candidate);
Simon Wunderlichf3b3d902013-11-13 19:14:50 +0100650 } else {
Sven Eckelmann15c2ed752016-06-30 20:11:34 +0200651 batadv_last_bonding_replace(orig_node, NULL);
652 }
653
654 /* cleanup of candidates */
655 if (first_candidate) {
656 batadv_neigh_node_put(first_candidate_router);
657 batadv_orig_ifinfo_put(first_candidate);
658 }
659
660 if (next_candidate) {
661 batadv_neigh_node_put(next_candidate_router);
662 batadv_orig_ifinfo_put(next_candidate);
Simon Wunderlichf3b3d902013-11-13 19:14:50 +0100663 }
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000664
Sven Eckelmann93652342016-08-06 15:50:52 +0200665 if (last_candidate)
666 batadv_orig_ifinfo_put(last_candidate);
667
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000668 return router;
669}
670
Sven Eckelmann63b01032012-05-16 20:23:13 +0200671static int batadv_route_unicast_packet(struct sk_buff *skb,
Sven Eckelmann56303d32012-06-05 22:31:31 +0200672 struct batadv_hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000673{
Sven Eckelmann56303d32012-06-05 22:31:31 +0200674 struct batadv_priv *bat_priv = netdev_priv(recv_if->soft_iface);
675 struct batadv_orig_node *orig_node = NULL;
Sven Eckelmann96412692012-06-05 22:31:30 +0200676 struct batadv_unicast_packet *unicast_packet;
Antonio Quartulli7ed4be92013-04-08 15:08:18 +0200677 struct ethhdr *ethhdr = eth_hdr(skb);
Simon Wunderlichc54f38c92013-07-29 17:56:44 +0200678 int res, hdr_len, ret = NET_RX_DROP;
Florian Westphal63d443e2016-05-10 23:17:59 +0200679 unsigned int len;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000680
Sven Eckelmann96412692012-06-05 22:31:30 +0200681 unicast_packet = (struct batadv_unicast_packet *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000682
683 /* TTL exceeded */
Simon Wunderlicha40d9b02013-12-02 20:38:31 +0100684 if (unicast_packet->ttl < 2) {
Sven Eckelmann86ceb362012-03-07 09:07:45 +0100685 pr_debug("Warning - can't forward unicast packet from %pM to %pM: ttl exceeded\n",
686 ethhdr->h_source, unicast_packet->dest);
Sven Eckelmannb91a2542016-07-17 21:04:04 +0200687 goto free_skb;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000688 }
689
690 /* get routing information */
Sven Eckelmannda641192012-05-12 13:48:56 +0200691 orig_node = batadv_orig_hash_find(bat_priv, unicast_packet->dest);
Marek Lindner7aadf882011-02-18 12:28:09 +0000692
Marek Lindner44524fc2011-02-10 14:33:53 +0000693 if (!orig_node)
Sven Eckelmannb91a2542016-07-17 21:04:04 +0200694 goto free_skb;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000695
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000696 /* create a copy of the skb, if needed, to modify it. */
Antonio Quartulli0d125072012-02-18 11:27:34 +0100697 if (skb_cow(skb, ETH_HLEN) < 0)
Sven Eckelmannb91a2542016-07-17 21:04:04 +0200698 goto put_orig_node;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000699
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000700 /* decrement ttl */
Martin Hundebøllf097e252013-05-23 16:53:01 +0200701 unicast_packet = (struct batadv_unicast_packet *)skb->data;
Simon Wunderlicha40d9b02013-12-02 20:38:31 +0100702 unicast_packet->ttl--;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000703
Simon Wunderlicha40d9b02013-12-02 20:38:31 +0100704 switch (unicast_packet->packet_type) {
Simon Wunderlichc54f38c92013-07-29 17:56:44 +0200705 case BATADV_UNICAST_4ADDR:
706 hdr_len = sizeof(struct batadv_unicast_4addr_packet);
707 break;
708 case BATADV_UNICAST:
709 hdr_len = sizeof(struct batadv_unicast_packet);
710 break;
711 default:
712 /* other packet types not supported - yet */
713 hdr_len = -1;
714 break;
715 }
716
717 if (hdr_len > 0)
718 batadv_skb_set_priority(skb, hdr_len);
719
Florian Westphal63d443e2016-05-10 23:17:59 +0200720 len = skb->len;
Martin Hundebølle91ecfc2013-04-20 13:54:39 +0200721 res = batadv_send_skb_to_orig(skb, orig_node, recv_if);
Sven Eckelmannb91a2542016-07-17 21:04:04 +0200722 if (res == NET_XMIT_SUCCESS)
723 ret = NET_RX_SUCCESS;
724
725 /* skb was consumed */
726 skb = NULL;
Martin Hundebøll95332472013-01-25 11:12:40 +0100727
Martin Hundebølle91ecfc2013-04-20 13:54:39 +0200728 /* translate transmit result into receive result */
729 if (res == NET_XMIT_SUCCESS) {
730 /* skb was transmitted and consumed */
Martin Hundebøll95332472013-01-25 11:12:40 +0100731 batadv_inc_counter(bat_priv, BATADV_CNT_FORWARD);
732 batadv_add_counter(bat_priv, BATADV_CNT_FORWARD_BYTES,
Florian Westphal63d443e2016-05-10 23:17:59 +0200733 len + ETH_HLEN);
Martin Hundebøll95332472013-01-25 11:12:40 +0100734 }
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000735
Sven Eckelmannb91a2542016-07-17 21:04:04 +0200736put_orig_node:
737 batadv_orig_node_put(orig_node);
738free_skb:
739 kfree_skb(skb);
Antonio Quartullif50ca952016-05-18 11:38:48 +0200740
Marek Lindner44524fc2011-02-10 14:33:53 +0000741 return ret;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000742}
743
Antonio Quartulli7c1fd912012-09-23 22:38:34 +0200744/**
745 * batadv_reroute_unicast_packet - update the unicast header for re-routing
746 * @bat_priv: the bat priv with all the soft interface information
747 * @unicast_packet: the unicast header to be updated
748 * @dst_addr: the payload destination
Antonio Quartullic018ad32013-06-04 12:11:39 +0200749 * @vid: VLAN identifier
Antonio Quartulli7c1fd912012-09-23 22:38:34 +0200750 *
751 * Search the translation table for dst_addr and update the unicast header with
752 * the new corresponding information (originator address where the destination
753 * client currently is and its known TTVN)
754 *
Sven Eckelmann62fe7102015-09-15 19:00:48 +0200755 * Return: true if the packet header has been updated, false otherwise
Antonio Quartulli7c1fd912012-09-23 22:38:34 +0200756 */
757static bool
758batadv_reroute_unicast_packet(struct batadv_priv *bat_priv,
759 struct batadv_unicast_packet *unicast_packet,
Sven Eckelmann6b5e9712015-05-26 18:34:26 +0200760 u8 *dst_addr, unsigned short vid)
Antonio Quartulli7c1fd912012-09-23 22:38:34 +0200761{
762 struct batadv_orig_node *orig_node = NULL;
763 struct batadv_hard_iface *primary_if = NULL;
764 bool ret = false;
Sven Eckelmann6b5e9712015-05-26 18:34:26 +0200765 u8 *orig_addr, orig_ttvn;
Antonio Quartulli7c1fd912012-09-23 22:38:34 +0200766
Antonio Quartullic018ad32013-06-04 12:11:39 +0200767 if (batadv_is_my_client(bat_priv, dst_addr, vid)) {
Antonio Quartulli7c1fd912012-09-23 22:38:34 +0200768 primary_if = batadv_primary_if_get_selected(bat_priv);
769 if (!primary_if)
770 goto out;
771 orig_addr = primary_if->net_dev->dev_addr;
Sven Eckelmann6b5e9712015-05-26 18:34:26 +0200772 orig_ttvn = (u8)atomic_read(&bat_priv->tt.vn);
Antonio Quartulli7c1fd912012-09-23 22:38:34 +0200773 } else {
Antonio Quartullic018ad32013-06-04 12:11:39 +0200774 orig_node = batadv_transtable_search(bat_priv, NULL, dst_addr,
775 vid);
Antonio Quartulli7c1fd912012-09-23 22:38:34 +0200776 if (!orig_node)
777 goto out;
778
779 if (batadv_compare_eth(orig_node->orig, unicast_packet->dest))
780 goto out;
781
782 orig_addr = orig_node->orig;
Sven Eckelmann6b5e9712015-05-26 18:34:26 +0200783 orig_ttvn = (u8)atomic_read(&orig_node->last_ttvn);
Antonio Quartulli7c1fd912012-09-23 22:38:34 +0200784 }
785
786 /* update the packet header */
Antonio Quartulli8fdd0152014-01-22 00:42:11 +0100787 ether_addr_copy(unicast_packet->dest, orig_addr);
Antonio Quartulli7c1fd912012-09-23 22:38:34 +0200788 unicast_packet->ttvn = orig_ttvn;
789
790 ret = true;
791out:
792 if (primary_if)
Sven Eckelmann82047ad2016-01-17 11:01:10 +0100793 batadv_hardif_put(primary_if);
Antonio Quartulli7c1fd912012-09-23 22:38:34 +0200794 if (orig_node)
Sven Eckelmann5d967312016-01-17 11:01:09 +0100795 batadv_orig_node_put(orig_node);
Antonio Quartulli7c1fd912012-09-23 22:38:34 +0200796
797 return ret;
798}
799
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100800static bool batadv_check_unicast_ttvn(struct batadv_priv *bat_priv,
801 struct sk_buff *skb, int hdr_len)
802{
Sven Eckelmann96412692012-06-05 22:31:30 +0200803 struct batadv_unicast_packet *unicast_packet;
Antonio Quartullic018ad32013-06-04 12:11:39 +0200804 struct batadv_hard_iface *primary_if;
805 struct batadv_orig_node *orig_node;
Sven Eckelmann6b5e9712015-05-26 18:34:26 +0200806 u8 curr_ttvn, old_ttvn;
Antonio Quartullic018ad32013-06-04 12:11:39 +0200807 struct ethhdr *ethhdr;
808 unsigned short vid;
Sven Eckelmann3e348192012-05-16 20:23:22 +0200809 int is_old_ttvn;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200810
Antonio Quartullib8fcfa42012-08-26 23:25:59 +0200811 /* check if there is enough data before accessing it */
Antonio Quartullif1791422014-01-30 00:12:24 +0100812 if (!pskb_may_pull(skb, hdr_len + ETH_HLEN))
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100813 return false;
Antonio Quartullib8fcfa42012-08-26 23:25:59 +0200814
815 /* create a copy of the skb (in case of for re-routing) to modify it. */
816 if (skb_cow(skb, sizeof(*unicast_packet)) < 0)
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100817 return false;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200818
Sven Eckelmann96412692012-06-05 22:31:30 +0200819 unicast_packet = (struct batadv_unicast_packet *)skb->data;
Antonio Quartullic018ad32013-06-04 12:11:39 +0200820 vid = batadv_get_vid(skb, hdr_len);
Antonio Quartullidd981ab2013-04-03 10:14:20 +0200821 ethhdr = (struct ethhdr *)(skb->data + hdr_len);
Antonio Quartullia73105b2011-04-27 14:27:44 +0200822
Antonio Quartulli7c1fd912012-09-23 22:38:34 +0200823 /* check if the destination client was served by this node and it is now
824 * roaming. In this case, it means that the node has got a ROAM_ADV
825 * message and that it knows the new destination in the mesh to re-route
826 * the packet to
827 */
Antonio Quartullic018ad32013-06-04 12:11:39 +0200828 if (batadv_tt_local_client_is_roaming(bat_priv, ethhdr->h_dest, vid)) {
Antonio Quartulli7c1fd912012-09-23 22:38:34 +0200829 if (batadv_reroute_unicast_packet(bat_priv, unicast_packet,
Antonio Quartullic018ad32013-06-04 12:11:39 +0200830 ethhdr->h_dest, vid))
André Gaul23c4ec12014-06-10 17:50:31 +0200831 batadv_dbg_ratelimited(BATADV_DBG_TT,
832 bat_priv,
833 "Rerouting unicast packet to %pM (dst=%pM): Local Roaming\n",
834 unicast_packet->dest,
835 ethhdr->h_dest);
Antonio Quartulli7c1fd912012-09-23 22:38:34 +0200836 /* at this point the mesh destination should have been
837 * substituted with the originator address found in the global
838 * table. If not, let the packet go untouched anyway because
839 * there is nothing the node can do
840 */
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100841 return true;
Antonio Quartulli7c1fd912012-09-23 22:38:34 +0200842 }
843
844 /* retrieve the TTVN known by this node for the packet destination. This
845 * value is used later to check if the node which sent (or re-routed
846 * last time) the packet had an updated information or not
847 */
Sven Eckelmann6b5e9712015-05-26 18:34:26 +0200848 curr_ttvn = (u8)atomic_read(&bat_priv->tt.vn);
Antonio Quartullife8a93b2013-04-03 19:10:26 +0200849 if (!batadv_is_my_mac(bat_priv, unicast_packet->dest)) {
Sven Eckelmannda641192012-05-12 13:48:56 +0200850 orig_node = batadv_orig_hash_find(bat_priv,
851 unicast_packet->dest);
Antonio Quartulli7c1fd912012-09-23 22:38:34 +0200852 /* if it is not possible to find the orig_node representing the
853 * destination, the packet can immediately be dropped as it will
854 * not be possible to deliver it
855 */
Antonio Quartullia73105b2011-04-27 14:27:44 +0200856 if (!orig_node)
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100857 return false;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200858
Sven Eckelmann6b5e9712015-05-26 18:34:26 +0200859 curr_ttvn = (u8)atomic_read(&orig_node->last_ttvn);
Sven Eckelmann5d967312016-01-17 11:01:09 +0100860 batadv_orig_node_put(orig_node);
Antonio Quartullia73105b2011-04-27 14:27:44 +0200861 }
862
Antonio Quartulli7c1fd912012-09-23 22:38:34 +0200863 /* check if the TTVN contained in the packet is fresher than what the
864 * node knows
865 */
Sven Eckelmann3e348192012-05-16 20:23:22 +0200866 is_old_ttvn = batadv_seq_before(unicast_packet->ttvn, curr_ttvn);
Antonio Quartulli7c1fd912012-09-23 22:38:34 +0200867 if (!is_old_ttvn)
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100868 return true;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200869
Antonio Quartulli7c1fd912012-09-23 22:38:34 +0200870 old_ttvn = unicast_packet->ttvn;
871 /* the packet was forged based on outdated network information. Its
872 * destination can possibly be updated and forwarded towards the new
873 * target host
874 */
875 if (batadv_reroute_unicast_packet(bat_priv, unicast_packet,
Antonio Quartullic018ad32013-06-04 12:11:39 +0200876 ethhdr->h_dest, vid)) {
André Gaul23c4ec12014-06-10 17:50:31 +0200877 batadv_dbg_ratelimited(BATADV_DBG_TT, bat_priv,
878 "Rerouting unicast packet to %pM (dst=%pM): TTVN mismatch old_ttvn=%u new_ttvn=%u\n",
879 unicast_packet->dest, ethhdr->h_dest,
880 old_ttvn, curr_ttvn);
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100881 return true;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200882 }
Antonio Quartulli7c1fd912012-09-23 22:38:34 +0200883
884 /* the packet has not been re-routed: either the destination is
885 * currently served by this node or there is no destination at all and
886 * it is possible to drop the packet
887 */
Antonio Quartullic018ad32013-06-04 12:11:39 +0200888 if (!batadv_is_my_client(bat_priv, ethhdr->h_dest, vid))
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100889 return false;
Antonio Quartulli7c1fd912012-09-23 22:38:34 +0200890
891 /* update the header in order to let the packet be delivered to this
892 * node's soft interface
893 */
894 primary_if = batadv_primary_if_get_selected(bat_priv);
895 if (!primary_if)
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100896 return false;
Antonio Quartulli7c1fd912012-09-23 22:38:34 +0200897
Antonio Quartulli8fdd0152014-01-22 00:42:11 +0100898 ether_addr_copy(unicast_packet->dest, primary_if->net_dev->dev_addr);
Antonio Quartulli7c1fd912012-09-23 22:38:34 +0200899
Sven Eckelmann82047ad2016-01-17 11:01:10 +0100900 batadv_hardif_put(primary_if);
Antonio Quartulli7c1fd912012-09-23 22:38:34 +0200901
902 unicast_packet->ttvn = curr_ttvn;
903
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100904 return true;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200905}
906
Simon Wunderlicha1f1ac52013-04-25 10:37:23 +0200907/**
908 * batadv_recv_unhandled_unicast_packet - receive and process packets which
909 * are in the unicast number space but not yet known to the implementation
910 * @skb: unicast tvlv packet to process
911 * @recv_if: pointer to interface this packet was received on
912 *
Sven Eckelmann62fe7102015-09-15 19:00:48 +0200913 * Return: NET_RX_SUCCESS if the packet has been consumed or NET_RX_DROP
Simon Wunderlicha1f1ac52013-04-25 10:37:23 +0200914 * otherwise.
915 */
916int batadv_recv_unhandled_unicast_packet(struct sk_buff *skb,
917 struct batadv_hard_iface *recv_if)
918{
919 struct batadv_unicast_packet *unicast_packet;
920 struct batadv_priv *bat_priv = netdev_priv(recv_if->soft_iface);
921 int check, hdr_size = sizeof(*unicast_packet);
922
923 check = batadv_check_unicast_packet(bat_priv, skb, hdr_size);
924 if (check < 0)
Sven Eckelmannb91a2542016-07-17 21:04:04 +0200925 goto free_skb;
Simon Wunderlicha1f1ac52013-04-25 10:37:23 +0200926
927 /* we don't know about this type, drop it. */
928 unicast_packet = (struct batadv_unicast_packet *)skb->data;
929 if (batadv_is_my_mac(bat_priv, unicast_packet->dest))
Sven Eckelmannb91a2542016-07-17 21:04:04 +0200930 goto free_skb;
Simon Wunderlicha1f1ac52013-04-25 10:37:23 +0200931
932 return batadv_route_unicast_packet(skb, recv_if);
Sven Eckelmannb91a2542016-07-17 21:04:04 +0200933
934free_skb:
935 kfree_skb(skb);
936 return NET_RX_DROP;
Simon Wunderlicha1f1ac52013-04-25 10:37:23 +0200937}
938
Sven Eckelmann56303d32012-06-05 22:31:31 +0200939int batadv_recv_unicast_packet(struct sk_buff *skb,
940 struct batadv_hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000941{
Sven Eckelmann56303d32012-06-05 22:31:31 +0200942 struct batadv_priv *bat_priv = netdev_priv(recv_if->soft_iface);
Sven Eckelmann96412692012-06-05 22:31:30 +0200943 struct batadv_unicast_packet *unicast_packet;
Martin Hundebøll4046b242012-04-20 17:02:45 +0200944 struct batadv_unicast_4addr_packet *unicast_4addr_packet;
Sven Eckelmann6b5e9712015-05-26 18:34:26 +0200945 u8 *orig_addr;
Antonio Quartulli9affec62012-10-14 17:19:19 +0200946 struct batadv_orig_node *orig_node = NULL;
Martin Hundebøll612d2b42013-01-25 11:12:42 +0100947 int check, hdr_size = sizeof(*unicast_packet);
Simon Wunderlich437bb0e2015-09-02 20:09:54 +0200948 enum batadv_subtype subtype;
Antonio Quartullic384ea32011-06-26 03:37:18 +0200949 bool is4addr;
Sven Eckelmannb91a2542016-07-17 21:04:04 +0200950 int ret = NET_RX_DROP;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000951
Antonio Quartulli7cdcf6d2012-10-01 09:57:35 +0200952 unicast_packet = (struct batadv_unicast_packet *)skb->data;
Martin Hundebøll4046b242012-04-20 17:02:45 +0200953 unicast_4addr_packet = (struct batadv_unicast_4addr_packet *)skb->data;
Antonio Quartulli7cdcf6d2012-10-01 09:57:35 +0200954
Simon Wunderlicha40d9b02013-12-02 20:38:31 +0100955 is4addr = unicast_packet->packet_type == BATADV_UNICAST_4ADDR;
Antonio Quartulli7cdcf6d2012-10-01 09:57:35 +0200956 /* the caller function should have already pulled 2 bytes */
Antonio Quartullic384ea32011-06-26 03:37:18 +0200957 if (is4addr)
Martin Hundebøll4046b242012-04-20 17:02:45 +0200958 hdr_size = sizeof(*unicast_4addr_packet);
Antonio Quartulli7cdcf6d2012-10-01 09:57:35 +0200959
Martin Hundebøll612d2b42013-01-25 11:12:42 +0100960 /* function returns -EREMOTE for promiscuous packets */
David S. Miller6e0895c2013-04-22 20:32:51 -0400961 check = batadv_check_unicast_packet(bat_priv, skb, hdr_size);
Martin Hundebøll612d2b42013-01-25 11:12:42 +0100962
963 /* Even though the packet is not for us, we might save it to use for
964 * decoding a later received coded packet
965 */
966 if (check == -EREMOTE)
967 batadv_nc_skb_store_sniffed_unicast(bat_priv, skb);
968
969 if (check < 0)
Sven Eckelmannb91a2542016-07-17 21:04:04 +0200970 goto free_skb;
Antonio Quartullidd981ab2013-04-03 10:14:20 +0200971 if (!batadv_check_unicast_ttvn(bat_priv, skb, hdr_size))
Sven Eckelmannb91a2542016-07-17 21:04:04 +0200972 goto free_skb;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200973
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000974 /* packet for me */
Antonio Quartullife8a93b2013-04-03 19:10:26 +0200975 if (batadv_is_my_mac(bat_priv, unicast_packet->dest)) {
Antonio Quartulli9affec62012-10-14 17:19:19 +0200976 if (is4addr) {
Simon Wunderlich437bb0e2015-09-02 20:09:54 +0200977 subtype = unicast_4addr_packet->subtype;
978 batadv_dat_inc_counter(bat_priv, subtype);
979
980 /* Only payload data should be considered for speedy
981 * join. For example, DAT also uses unicast 4addr
982 * types, but those packets should not be considered
983 * for speedy join, since the clients do not actually
984 * reside at the sending originator.
985 */
986 if (subtype == BATADV_P_DATA) {
987 orig_addr = unicast_4addr_packet->src;
988 orig_node = batadv_orig_hash_find(bat_priv,
989 orig_addr);
990 }
Antonio Quartulli9affec62012-10-14 17:19:19 +0200991 }
Martin Hundebøll4046b242012-04-20 17:02:45 +0200992
Antonio Quartullic384ea32011-06-26 03:37:18 +0200993 if (batadv_dat_snoop_incoming_arp_request(bat_priv, skb,
994 hdr_size))
995 goto rx_success;
996 if (batadv_dat_snoop_incoming_arp_reply(bat_priv, skb,
997 hdr_size))
998 goto rx_success;
999
Sven Eckelmann6535db52016-02-28 11:38:51 +01001000 batadv_interface_rx(recv_if->soft_iface, skb, hdr_size,
Antonio Quartulli9affec62012-10-14 17:19:19 +02001001 orig_node);
Antonio Quartulli37135172012-07-05 23:38:30 +02001002
Antonio Quartullic384ea32011-06-26 03:37:18 +02001003rx_success:
Antonio Quartulli9affec62012-10-14 17:19:19 +02001004 if (orig_node)
Sven Eckelmann5d967312016-01-17 11:01:09 +01001005 batadv_orig_node_put(orig_node);
Antonio Quartulli9affec62012-10-14 17:19:19 +02001006
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001007 return NET_RX_SUCCESS;
1008 }
1009
Sven Eckelmannb91a2542016-07-17 21:04:04 +02001010 ret = batadv_route_unicast_packet(skb, recv_if);
1011 /* skb was consumed */
1012 skb = NULL;
1013
1014free_skb:
1015 kfree_skb(skb);
1016
1017 return ret;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001018}
1019
Marek Lindneref261572013-04-23 21:39:57 +08001020/**
1021 * batadv_recv_unicast_tvlv - receive and process unicast tvlv packets
1022 * @skb: unicast tvlv packet to process
1023 * @recv_if: pointer to interface this packet was received on
Marek Lindneref261572013-04-23 21:39:57 +08001024 *
Sven Eckelmann62fe7102015-09-15 19:00:48 +02001025 * Return: NET_RX_SUCCESS if the packet has been consumed or NET_RX_DROP
Marek Lindneref261572013-04-23 21:39:57 +08001026 * otherwise.
1027 */
1028int batadv_recv_unicast_tvlv(struct sk_buff *skb,
1029 struct batadv_hard_iface *recv_if)
1030{
1031 struct batadv_priv *bat_priv = netdev_priv(recv_if->soft_iface);
1032 struct batadv_unicast_tvlv_packet *unicast_tvlv_packet;
1033 unsigned char *tvlv_buff;
Sven Eckelmann6b5e9712015-05-26 18:34:26 +02001034 u16 tvlv_buff_len;
Marek Lindneref261572013-04-23 21:39:57 +08001035 int hdr_size = sizeof(*unicast_tvlv_packet);
1036 int ret = NET_RX_DROP;
1037
1038 if (batadv_check_unicast_packet(bat_priv, skb, hdr_size) < 0)
Sven Eckelmannb91a2542016-07-17 21:04:04 +02001039 goto free_skb;
Marek Lindneref261572013-04-23 21:39:57 +08001040
1041 /* the header is likely to be modified while forwarding */
1042 if (skb_cow(skb, hdr_size) < 0)
Sven Eckelmannb91a2542016-07-17 21:04:04 +02001043 goto free_skb;
Marek Lindneref261572013-04-23 21:39:57 +08001044
1045 /* packet needs to be linearized to access the tvlv content */
1046 if (skb_linearize(skb) < 0)
Sven Eckelmannb91a2542016-07-17 21:04:04 +02001047 goto free_skb;
Marek Lindneref261572013-04-23 21:39:57 +08001048
1049 unicast_tvlv_packet = (struct batadv_unicast_tvlv_packet *)skb->data;
1050
1051 tvlv_buff = (unsigned char *)(skb->data + hdr_size);
1052 tvlv_buff_len = ntohs(unicast_tvlv_packet->tvlv_len);
1053
1054 if (tvlv_buff_len > skb->len - hdr_size)
Sven Eckelmannb91a2542016-07-17 21:04:04 +02001055 goto free_skb;
Marek Lindneref261572013-04-23 21:39:57 +08001056
1057 ret = batadv_tvlv_containers_process(bat_priv, false, NULL,
1058 unicast_tvlv_packet->src,
1059 unicast_tvlv_packet->dst,
1060 tvlv_buff, tvlv_buff_len);
1061
Sven Eckelmannb91a2542016-07-17 21:04:04 +02001062 if (ret != NET_RX_SUCCESS) {
Marek Lindneref261572013-04-23 21:39:57 +08001063 ret = batadv_route_unicast_packet(skb, recv_if);
Sven Eckelmannb91a2542016-07-17 21:04:04 +02001064 /* skb was consumed */
1065 skb = NULL;
1066 }
1067
1068free_skb:
1069 kfree_skb(skb);
Marek Lindneref261572013-04-23 21:39:57 +08001070
1071 return ret;
1072}
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001073
Martin Hundebøll610bfc6bc2013-05-23 16:53:02 +02001074/**
1075 * batadv_recv_frag_packet - process received fragment
1076 * @skb: the received fragment
1077 * @recv_if: interface that the skb is received on
1078 *
1079 * This function does one of the three following things: 1) Forward fragment, if
1080 * the assembled packet will exceed our MTU; 2) Buffer fragment, if we till
1081 * lack further fragments; 3) Merge fragments, if we have all needed parts.
1082 *
Sven Eckelmann62fe7102015-09-15 19:00:48 +02001083 * Return: NET_RX_DROP if the skb is not consumed, NET_RX_SUCCESS otherwise.
Martin Hundebøll610bfc6bc2013-05-23 16:53:02 +02001084 */
1085int batadv_recv_frag_packet(struct sk_buff *skb,
1086 struct batadv_hard_iface *recv_if)
1087{
1088 struct batadv_priv *bat_priv = netdev_priv(recv_if->soft_iface);
1089 struct batadv_orig_node *orig_node_src = NULL;
1090 struct batadv_frag_packet *frag_packet;
1091 int ret = NET_RX_DROP;
1092
1093 if (batadv_check_unicast_packet(bat_priv, skb,
1094 sizeof(*frag_packet)) < 0)
Sven Eckelmannb91a2542016-07-17 21:04:04 +02001095 goto free_skb;
Martin Hundebøll610bfc6bc2013-05-23 16:53:02 +02001096
1097 frag_packet = (struct batadv_frag_packet *)skb->data;
1098 orig_node_src = batadv_orig_hash_find(bat_priv, frag_packet->orig);
1099 if (!orig_node_src)
Sven Eckelmannb91a2542016-07-17 21:04:04 +02001100 goto free_skb;
Martin Hundebøll610bfc6bc2013-05-23 16:53:02 +02001101
Andrew Lunnc0f25c82016-05-09 20:03:36 +02001102 skb->priority = frag_packet->priority + 256;
1103
Martin Hundebøll610bfc6bc2013-05-23 16:53:02 +02001104 /* Route the fragment if it is not for us and too big to be merged. */
1105 if (!batadv_is_my_mac(bat_priv, frag_packet->dest) &&
1106 batadv_frag_skb_fwd(skb, recv_if, orig_node_src)) {
Sven Eckelmannb91a2542016-07-17 21:04:04 +02001107 /* skb was consumed */
1108 skb = NULL;
Martin Hundebøll610bfc6bc2013-05-23 16:53:02 +02001109 ret = NET_RX_SUCCESS;
Sven Eckelmannb91a2542016-07-17 21:04:04 +02001110 goto put_orig_node;
Martin Hundebøll610bfc6bc2013-05-23 16:53:02 +02001111 }
1112
1113 batadv_inc_counter(bat_priv, BATADV_CNT_FRAG_RX);
1114 batadv_add_counter(bat_priv, BATADV_CNT_FRAG_RX_BYTES, skb->len);
1115
1116 /* Add fragment to buffer and merge if possible. */
1117 if (!batadv_frag_skb_buffer(&skb, orig_node_src))
Sven Eckelmannb91a2542016-07-17 21:04:04 +02001118 goto put_orig_node;
Martin Hundebøll610bfc6bc2013-05-23 16:53:02 +02001119
1120 /* Deliver merged packet to the appropriate handler, if it was
1121 * merged
1122 */
Sven Eckelmannb91a2542016-07-17 21:04:04 +02001123 if (skb) {
Martin Hundebøll610bfc6bc2013-05-23 16:53:02 +02001124 batadv_batman_skb_recv(skb, recv_if->net_dev,
1125 &recv_if->batman_adv_ptype, NULL);
Sven Eckelmannb91a2542016-07-17 21:04:04 +02001126 /* skb was consumed */
1127 skb = NULL;
1128 }
Martin Hundebøll610bfc6bc2013-05-23 16:53:02 +02001129
1130 ret = NET_RX_SUCCESS;
1131
Sven Eckelmannb91a2542016-07-17 21:04:04 +02001132put_orig_node:
1133 batadv_orig_node_put(orig_node_src);
1134free_skb:
1135 kfree_skb(skb);
Martin Hundebøll610bfc6bc2013-05-23 16:53:02 +02001136
1137 return ret;
1138}
1139
Sven Eckelmann56303d32012-06-05 22:31:31 +02001140int batadv_recv_bcast_packet(struct sk_buff *skb,
1141 struct batadv_hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001142{
Sven Eckelmann56303d32012-06-05 22:31:31 +02001143 struct batadv_priv *bat_priv = netdev_priv(recv_if->soft_iface);
1144 struct batadv_orig_node *orig_node = NULL;
Sven Eckelmann96412692012-06-05 22:31:30 +02001145 struct batadv_bcast_packet *bcast_packet;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001146 struct ethhdr *ethhdr;
Sven Eckelmann704509b2011-05-14 23:14:54 +02001147 int hdr_size = sizeof(*bcast_packet);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001148 int ret = NET_RX_DROP;
Sven Eckelmann6b5e9712015-05-26 18:34:26 +02001149 s32 seq_diff;
1150 u32 seqno;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001151
1152 /* drop packet if it has not necessary minimum size */
1153 if (unlikely(!pskb_may_pull(skb, hdr_size)))
Sven Eckelmannb91a2542016-07-17 21:04:04 +02001154 goto free_skb;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001155
Antonio Quartulli7ed4be92013-04-08 15:08:18 +02001156 ethhdr = eth_hdr(skb);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001157
1158 /* packet with broadcast indication but unicast recipient */
1159 if (!is_broadcast_ether_addr(ethhdr->h_dest))
Sven Eckelmannb91a2542016-07-17 21:04:04 +02001160 goto free_skb;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001161
Sven Eckelmann9f75c8e2016-08-06 17:04:21 +02001162 /* packet with broadcast/multicast sender address */
1163 if (is_multicast_ether_addr(ethhdr->h_source))
Sven Eckelmannb91a2542016-07-17 21:04:04 +02001164 goto free_skb;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001165
1166 /* ignore broadcasts sent by myself */
Antonio Quartullife8a93b2013-04-03 19:10:26 +02001167 if (batadv_is_my_mac(bat_priv, ethhdr->h_source))
Sven Eckelmannb91a2542016-07-17 21:04:04 +02001168 goto free_skb;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001169
Sven Eckelmann96412692012-06-05 22:31:30 +02001170 bcast_packet = (struct batadv_bcast_packet *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001171
1172 /* ignore broadcasts originated by myself */
Antonio Quartullife8a93b2013-04-03 19:10:26 +02001173 if (batadv_is_my_mac(bat_priv, bcast_packet->orig))
Sven Eckelmannb91a2542016-07-17 21:04:04 +02001174 goto free_skb;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001175
Simon Wunderlicha40d9b02013-12-02 20:38:31 +01001176 if (bcast_packet->ttl < 2)
Sven Eckelmannb91a2542016-07-17 21:04:04 +02001177 goto free_skb;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001178
Sven Eckelmannda641192012-05-12 13:48:56 +02001179 orig_node = batadv_orig_hash_find(bat_priv, bcast_packet->orig);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001180
1181 if (!orig_node)
Sven Eckelmannb91a2542016-07-17 21:04:04 +02001182 goto free_skb;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001183
Marek Lindnerf3e00082011-01-25 21:52:11 +00001184 spin_lock_bh(&orig_node->bcast_seqno_lock);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001185
Antonio Quartulli3fba7322013-10-13 02:50:17 +02001186 seqno = ntohl(bcast_packet->seqno);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001187 /* check whether the packet is a duplicate */
Sven Eckelmann9b4a1152012-05-12 13:48:53 +02001188 if (batadv_test_bit(orig_node->bcast_bits, orig_node->last_bcast_seqno,
Antonio Quartulli3fba7322013-10-13 02:50:17 +02001189 seqno))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001190 goto spin_unlock;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001191
Antonio Quartulli3fba7322013-10-13 02:50:17 +02001192 seq_diff = seqno - orig_node->last_bcast_seqno;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001193
1194 /* check whether the packet is old and the host just restarted. */
Sven Eckelmann30d3c512012-05-12 02:09:36 +02001195 if (batadv_window_protected(bat_priv, seq_diff,
Simon Wunderlich81f02682015-11-23 19:57:22 +01001196 BATADV_BCAST_MAX_AGE,
1197 &orig_node->bcast_seqno_reset, NULL))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001198 goto spin_unlock;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001199
1200 /* mark broadcast in flood history, update window position
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +02001201 * if required.
1202 */
Sven Eckelmann0f5f93222012-05-12 02:09:25 +02001203 if (batadv_bit_get_packet(bat_priv, orig_node->bcast_bits, seq_diff, 1))
Antonio Quartulli3fba7322013-10-13 02:50:17 +02001204 orig_node->last_bcast_seqno = seqno;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001205
Marek Lindnerf3e00082011-01-25 21:52:11 +00001206 spin_unlock_bh(&orig_node->bcast_seqno_lock);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001207
Simon Wunderlichfe2da6f2012-01-22 20:00:24 +01001208 /* check whether this has been sent by another originator before */
Simon Wunderlich004e86f2012-10-18 13:47:42 +02001209 if (batadv_bla_check_bcast_duplist(bat_priv, skb))
Sven Eckelmannb91a2542016-07-17 21:04:04 +02001210 goto free_skb;
Simon Wunderlichfe2da6f2012-01-22 20:00:24 +01001211
Simon Wunderlichc54f38c92013-07-29 17:56:44 +02001212 batadv_skb_set_priority(skb, sizeof(struct batadv_bcast_packet));
1213
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001214 /* rebroadcast packet */
Linus Lüssing3111bee2016-08-07 12:34:19 +02001215 batadv_add_bcast_packet_to_list(bat_priv, skb, 1, false);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001216
Simon Wunderlich23721382012-01-22 20:00:19 +01001217 /* don't hand the broadcast up if it is from an originator
1218 * from the same backbone.
1219 */
Sven Eckelmann08adf152012-05-12 13:38:47 +02001220 if (batadv_bla_is_backbone_gw(skb, orig_node, hdr_size))
Sven Eckelmannb91a2542016-07-17 21:04:04 +02001221 goto free_skb;
Simon Wunderlich23721382012-01-22 20:00:19 +01001222
Antonio Quartullic384ea32011-06-26 03:37:18 +02001223 if (batadv_dat_snoop_incoming_arp_request(bat_priv, skb, hdr_size))
1224 goto rx_success;
1225 if (batadv_dat_snoop_incoming_arp_reply(bat_priv, skb, hdr_size))
1226 goto rx_success;
1227
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001228 /* broadcast for me */
Sven Eckelmann6535db52016-02-28 11:38:51 +01001229 batadv_interface_rx(recv_if->soft_iface, skb, hdr_size, orig_node);
Antonio Quartullic384ea32011-06-26 03:37:18 +02001230
1231rx_success:
Marek Lindnerf3e00082011-01-25 21:52:11 +00001232 ret = NET_RX_SUCCESS;
1233 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001234
Marek Lindnerf3e00082011-01-25 21:52:11 +00001235spin_unlock:
1236 spin_unlock_bh(&orig_node->bcast_seqno_lock);
Sven Eckelmannb91a2542016-07-17 21:04:04 +02001237free_skb:
1238 kfree_skb(skb);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001239out:
1240 if (orig_node)
Sven Eckelmann5d967312016-01-17 11:01:09 +01001241 batadv_orig_node_put(orig_node);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001242 return ret;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001243}